ArduinoMicro-Portenta-X8-interface/gpio_handler.cpp at master · bcmi-labs/ArduinoMicro-Portenta-X8-interface · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
#include "gpio_handler.h"

#include "at_handler.h"

#define MAX_GPIO_NUMBER 102

chAT::CommandStatus GpioHandler::handle_read(chAT::Server &srv, chAT::ATParser &parser)
{
    if (parser.args.size() != 1){
        return write_error_message(srv, "Invalid number of arguments");
    }

    int interfaceGpio = atoi(parser.args[0].c_str());
    if(interfaceGpio < 0 || interfaceGpio > MAX_GPIO_NUMBER){
        return write_error_message(srv, "Invalid GPIO number");
    }

    int gpioStatus = -1;

    if(get_gpio_status(interfaceGpio, &gpioStatus) != 0){
        return write_error_message(srv, "Error reading GPIO");
    }

    return write_ok_message(srv, ("#"+String(interfaceGpio)+" Value:"+String(gpioStatus)).c_str());
}

chAT::CommandStatus GpioHandler::handle_write(chAT::Server &srv, chAT::ATParser &parser)
{
    if (parser.args.size() != 2){
        return write_error_message(srv, "Invalid number of arguments");
    }

    int interfaceGpio = atoi(parser.args[0].c_str());
    if(interfaceGpio < 0 || interfaceGpio > MAX_GPIO_NUMBER){
        return write_error_message(srv, "Invalid GPIO number");
    }
    int value = atoi(parser.args[1].c_str());

    if (set_gpio_status(interfaceGpio, value) != 0){
        return write_error_message(srv, "Error writing GPIO");
    }

    return write_ok_message(srv, ("#"+String(interfaceGpio)+" Value:"+String(value)).c_str());
}

chAT::CommandStatus GpioHandler::handle_test(chAT::Server &srv, chAT::ATParser &parser)
{
    String message = "\n";
    message += "AT+GPIO?<gpio number> - Read GPIO status\n";
    message += "AT+GPIO=<gpio number>,<value> - Write GPIO status\n";

    return write_ok_message(srv, message.c_str());
}

int GpioHandler::get_gpio_status(int gpio, int *value)
{
    pinMode(gpio, INPUT_PULLUP);
    *value = digitalRead(gpio);

    return 0;
}

int GpioHandler::set_gpio_status(int gpio, int value)
{
    if (false
#ifdef DAC
	    || gpio == DAC
#endif
#ifdef DAC_0
	    || gpio == DAC_0
#endif
#ifdef DAC_1
	    || gpio == DAC_1
#endif
    ) {
        if(value == 1)
            analogWrite(gpio, 255);
        else{
            analogWrite(gpio, 0);
        }
        return 0;
    }

    pinMode(gpio, OUTPUT);
    digitalWrite(gpio, value);

    return 0;
}