diff options
| -rw-r--r-- | libraries/Bridge/examples/Bridge/Bridge.ino | 18 |
1 files changed, 16 insertions, 2 deletions
diff --git a/libraries/Bridge/examples/Bridge/Bridge.ino b/libraries/Bridge/examples/Bridge/Bridge.ino index c4f71db..dc453c4 100644 --- a/libraries/Bridge/examples/Bridge/Bridge.ino +++ b/libraries/Bridge/examples/Bridge/Bridge.ino @@ -41,21 +41,34 @@ void process(uint8_t buff[], int l) { // Command selection if (l==5 && cmd0=='D' && cmd1=='W') { char c = buff[4]; - if (c=='0' || c=='1') + if (c=='0' || c=='1') { digitalWrite(pin, c-'0'); + reportDigitalRead(pin, true, true); + } } else if (l==4 && cmd0=='D' && cmd1=='R') { reportDigitalRead(pin, true, true); } else if (l==7 && cmd0=='A' && cmd1=='W') { analogWrite(pin, buff[4]); + reportAnalogRead(pin); } else if (l==4 && cmd0=='A' && cmd1=='R') { reportAnalogRead(pin); } else if (l==4 && cmd0=='P' && cmd1=='I') { pinMode(pin, INPUT); + reportPinMode(pin, INPUT); } else if (l==4 && cmd0=='P' && cmd1=='O') { pinMode(pin, OUTPUT); + reportPinMode(pin, OUTPUT); } } +void reportPinMode(int pin, uint8_t dir) { + uint8_t buff[] = { 'P', 'I', '0', '0' }; + buff[1] = dir == INPUT ? 'I' : 'O'; + buff[2] += pin/10; + buff[3] += pin%10; + Bridge.writeMessage(buff, 4); +} + void reportDigitalRead(int pin, boolean raw, boolean dataset) { // "Dpp0" - "Dpp1" // 0 1 2 3 @@ -87,4 +100,5 @@ void reportAnalogRead(int pin) { buff[4] += v%10; v /= 10; buff[3] += v; Bridge.writeMessage(buff, 7); -}
\ No newline at end of file +} + |