![](/media/cache/profiles/aa03f7d585b4ae5554378b5843a73d11.jpg.50x50_q85.png)
Experiment of serial command protocol
Dependencies: RingBuffer SerialInterfaceProtocol duinotech_16x2_LCD mbed
You can edit this area
main.cpp@3:0c4aa3cec685, 2016-06-16 (annotated)
- Committer:
- rba90
- Date:
- Thu Jun 16 03:52:01 2016 +0000
- Revision:
- 3:0c4aa3cec685
- Parent:
- 2:54932809c7b2
1. Update definition for checksum; 2. Add more examples of SIP
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
rba90 | 0:2ba6a9f316b6 | 1 | #include "mbed.h" |
rba90 | 0:2ba6a9f316b6 | 2 | #include "freetronicsLCDShield.h" |
rba90 | 0:2ba6a9f316b6 | 3 | #include "buffer.h" |
rba90 | 0:2ba6a9f316b6 | 4 | #include "CommandPacket.h" |
rba90 | 2:54932809c7b2 | 5 | #include "SerialInterfaceProtocol.h" |
rba90 | 0:2ba6a9f316b6 | 6 | |
rba90 | 0:2ba6a9f316b6 | 7 | // #define DEBUG_MESSAGE |
rba90 | 0:2ba6a9f316b6 | 8 | |
rba90 | 0:2ba6a9f316b6 | 9 | freetronicsLCDShield lcd(D8, D9, D4, D5, D6, D7, D10, A0); // rs, e, d0, d1, d2, d3, bl, a0 |
rba90 | 0:2ba6a9f316b6 | 10 | Serial pc(USBTX, USBRX); |
rba90 | 2:54932809c7b2 | 11 | CircularBuffer<uint8_t> SerialInputBuffer; |
rba90 | 2:54932809c7b2 | 12 | CircularBuffer<uint8_t> SerialOutputBuffer; |
rba90 | 2:54932809c7b2 | 13 | SerialInterfaceProtocol SIP(&SerialInputBuffer, &SerialOutputBuffer); |
rba90 | 0:2ba6a9f316b6 | 14 | |
rba90 | 0:2ba6a9f316b6 | 15 | void serialInterruptHandler() { |
rba90 | 0:2ba6a9f316b6 | 16 | // Note: you need to actually read from the serial to clear the RX interrupt |
rba90 | 0:2ba6a9f316b6 | 17 | int c = pc.getc(); |
rba90 | 0:2ba6a9f316b6 | 18 | |
rba90 | 0:2ba6a9f316b6 | 19 | // add to buffer |
rba90 | 2:54932809c7b2 | 20 | if (SerialInputBuffer.isLocked()) |
rba90 | 0:2ba6a9f316b6 | 21 | { |
rba90 | 0:2ba6a9f316b6 | 22 | printf("Mutex Locked\r\n"); |
rba90 | 0:2ba6a9f316b6 | 23 | } |
rba90 | 0:2ba6a9f316b6 | 24 | else |
rba90 | 0:2ba6a9f316b6 | 25 | { |
rba90 | 2:54932809c7b2 | 26 | SerialInputBuffer.enqueue((uint8_t) c); |
rba90 | 0:2ba6a9f316b6 | 27 | } |
rba90 | 0:2ba6a9f316b6 | 28 | } |
rba90 | 0:2ba6a9f316b6 | 29 | |
rba90 | 2:54932809c7b2 | 30 | int toggleLcdBackLight(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 2:54932809c7b2 | 31 | { |
rba90 | 2:54932809c7b2 | 32 | // wrong payload length |
rba90 | 2:54932809c7b2 | 33 | if (payload_length != 1) |
rba90 | 2:54932809c7b2 | 34 | { |
rba90 | 2:54932809c7b2 | 35 | sprintf((char *) response, "Wrong Payload Length\r\n"); |
rba90 | 2:54932809c7b2 | 36 | *response_length = 22; |
rba90 | 2:54932809c7b2 | 37 | return 1; |
rba90 | 2:54932809c7b2 | 38 | } |
rba90 | 2:54932809c7b2 | 39 | |
rba90 | 2:54932809c7b2 | 40 | // get payload |
rba90 | 2:54932809c7b2 | 41 | bool lcdBackLight = (bool) payload[0]; |
rba90 | 2:54932809c7b2 | 42 | |
rba90 | 2:54932809c7b2 | 43 | // set back light |
rba90 | 2:54932809c7b2 | 44 | lcd.setBackLight(lcdBackLight); |
rba90 | 2:54932809c7b2 | 45 | |
rba90 | 2:54932809c7b2 | 46 | return 0; |
rba90 | 2:54932809c7b2 | 47 | } |
rba90 | 2:54932809c7b2 | 48 | |
rba90 | 2:54932809c7b2 | 49 | int setLcdBackLightIntensity(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 2:54932809c7b2 | 50 | { |
rba90 | 2:54932809c7b2 | 51 | // set intensity |
rba90 | 2:54932809c7b2 | 52 | lcd.setBackLight((float) atof((char*) payload)); |
rba90 | 2:54932809c7b2 | 53 | |
rba90 | 2:54932809c7b2 | 54 | return 0; |
rba90 | 2:54932809c7b2 | 55 | } |
rba90 | 2:54932809c7b2 | 56 | |
rba90 | 2:54932809c7b2 | 57 | int resetLcd(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 2:54932809c7b2 | 58 | { |
rba90 | 2:54932809c7b2 | 59 | // no payload |
rba90 | 2:54932809c7b2 | 60 | if (payload_length != 0) |
rba90 | 2:54932809c7b2 | 61 | { |
rba90 | 2:54932809c7b2 | 62 | sprintf((char *) response, "Wrong Payload Length\r\n"); |
rba90 | 2:54932809c7b2 | 63 | *response_length = 22; |
rba90 | 2:54932809c7b2 | 64 | return 1; |
rba90 | 2:54932809c7b2 | 65 | } |
rba90 | 2:54932809c7b2 | 66 | |
rba90 | 2:54932809c7b2 | 67 | // reset display and settings |
rba90 | 2:54932809c7b2 | 68 | lcd.cls(); |
rba90 | 2:54932809c7b2 | 69 | |
rba90 | 2:54932809c7b2 | 70 | return 0; |
rba90 | 2:54932809c7b2 | 71 | } |
rba90 | 2:54932809c7b2 | 72 | |
rba90 | 2:54932809c7b2 | 73 | int setLcdCursorPosition(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 0:2ba6a9f316b6 | 74 | { |
rba90 | 2:54932809c7b2 | 75 | // two payloads |
rba90 | 2:54932809c7b2 | 76 | if (payload_length != 2) |
rba90 | 0:2ba6a9f316b6 | 77 | { |
rba90 | 2:54932809c7b2 | 78 | sprintf((char *) response, "Wrong Payload Length\r\n"); |
rba90 | 2:54932809c7b2 | 79 | *response_length = 22; |
rba90 | 2:54932809c7b2 | 80 | return 1; |
rba90 | 2:54932809c7b2 | 81 | } |
rba90 | 2:54932809c7b2 | 82 | |
rba90 | 2:54932809c7b2 | 83 | // set current cursor location |
rba90 | 2:54932809c7b2 | 84 | lcd.setCursorPosition( |
rba90 | 2:54932809c7b2 | 85 | (bool) payload[0], |
rba90 | 2:54932809c7b2 | 86 | (bool) payload[1] |
rba90 | 2:54932809c7b2 | 87 | ); |
rba90 | 2:54932809c7b2 | 88 | |
rba90 | 2:54932809c7b2 | 89 | return 0; |
rba90 | 2:54932809c7b2 | 90 | } |
rba90 | 2:54932809c7b2 | 91 | |
rba90 | 2:54932809c7b2 | 92 | int setLcdCursorProperty(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 2:54932809c7b2 | 93 | { |
rba90 | 2:54932809c7b2 | 94 | // two payloads |
rba90 | 2:54932809c7b2 | 95 | if (payload_length != 2) |
rba90 | 2:54932809c7b2 | 96 | { |
rba90 | 2:54932809c7b2 | 97 | sprintf((char *) response, "Wrong Payload Length\r\n"); |
rba90 | 2:54932809c7b2 | 98 | *response_length = 22; |
rba90 | 2:54932809c7b2 | 99 | return 1; |
rba90 | 2:54932809c7b2 | 100 | } |
rba90 | 2:54932809c7b2 | 101 | |
rba90 | 2:54932809c7b2 | 102 | lcd.setCursor( |
rba90 | 2:54932809c7b2 | 103 | (bool) payload[0], |
rba90 | 2:54932809c7b2 | 104 | (bool) payload[1] |
rba90 | 2:54932809c7b2 | 105 | ); |
rba90 | 2:54932809c7b2 | 106 | |
rba90 | 2:54932809c7b2 | 107 | return 0; |
rba90 | 2:54932809c7b2 | 108 | } |
rba90 | 2:54932809c7b2 | 109 | |
rba90 | 2:54932809c7b2 | 110 | int lcdPrintToLine(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 2:54932809c7b2 | 111 | { |
rba90 | 2:54932809c7b2 | 112 | // set cursor position |
rba90 | 2:54932809c7b2 | 113 | lcd.setCursorPosition(payload[0], 0); |
rba90 | 2:54932809c7b2 | 114 | |
rba90 | 2:54932809c7b2 | 115 | // print to screen |
rba90 | 2:54932809c7b2 | 116 | lcd.printf((char *) (payload + 1)); |
rba90 | 2:54932809c7b2 | 117 | |
rba90 | 2:54932809c7b2 | 118 | return 0; |
rba90 | 2:54932809c7b2 | 119 | } |
rba90 | 2:54932809c7b2 | 120 | |
rba90 | 2:54932809c7b2 | 121 | int lcdAppendPrint(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 2:54932809c7b2 | 122 | { |
rba90 | 2:54932809c7b2 | 123 | // print to screen |
rba90 | 2:54932809c7b2 | 124 | lcd.printf((char *) payload); |
rba90 | 2:54932809c7b2 | 125 | |
rba90 | 2:54932809c7b2 | 126 | return 0; |
rba90 | 2:54932809c7b2 | 127 | } |
rba90 | 2:54932809c7b2 | 128 | |
rba90 | 2:54932809c7b2 | 129 | int toggleChecksum(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 2:54932809c7b2 | 130 | { |
rba90 | 2:54932809c7b2 | 131 | // one payload |
rba90 | 2:54932809c7b2 | 132 | if (payload_length != 1) |
rba90 | 2:54932809c7b2 | 133 | { |
rba90 | 2:54932809c7b2 | 134 | sprintf((char *) response, "Wrong Payload Length\r\n"); |
rba90 | 2:54932809c7b2 | 135 | *response_length = 22; |
rba90 | 2:54932809c7b2 | 136 | return 1; |
rba90 | 2:54932809c7b2 | 137 | } |
rba90 | 2:54932809c7b2 | 138 | |
rba90 | 2:54932809c7b2 | 139 | if ((bool) payload[0]) |
rba90 | 2:54932809c7b2 | 140 | { |
rba90 | 2:54932809c7b2 | 141 | SIP.enableChecksum(); |
rba90 | 0:2ba6a9f316b6 | 142 | } |
rba90 | 2:54932809c7b2 | 143 | else |
rba90 | 2:54932809c7b2 | 144 | { |
rba90 | 2:54932809c7b2 | 145 | SIP.disableChecksum(); |
rba90 | 2:54932809c7b2 | 146 | } |
rba90 | 2:54932809c7b2 | 147 | |
rba90 | 2:54932809c7b2 | 148 | return 0; |
rba90 | 0:2ba6a9f316b6 | 149 | } |
rba90 | 3:0c4aa3cec685 | 150 | |
rba90 | 3:0c4aa3cec685 | 151 | int setBaudRate(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 3:0c4aa3cec685 | 152 | { |
rba90 | 3:0c4aa3cec685 | 153 | int baudRate = atoi((char *)payload); |
rba90 | 3:0c4aa3cec685 | 154 | |
rba90 | 3:0c4aa3cec685 | 155 | // set baud rate |
rba90 | 3:0c4aa3cec685 | 156 | pc.baud(baudRate); |
rba90 | 3:0c4aa3cec685 | 157 | |
rba90 | 3:0c4aa3cec685 | 158 | return 0; |
rba90 | 3:0c4aa3cec685 | 159 | } |
rba90 | 3:0c4aa3cec685 | 160 | |
rba90 | 3:0c4aa3cec685 | 161 | int echoPayload(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 3:0c4aa3cec685 | 162 | { |
rba90 | 3:0c4aa3cec685 | 163 | memcpy(response, payload, payload_length); |
rba90 | 3:0c4aa3cec685 | 164 | *response_length = payload_length; |
rba90 | 3:0c4aa3cec685 | 165 | |
rba90 | 3:0c4aa3cec685 | 166 | return 0; |
rba90 | 3:0c4aa3cec685 | 167 | } |
rba90 | 0:2ba6a9f316b6 | 168 | |
rba90 | 0:2ba6a9f316b6 | 169 | int main() { |
rba90 | 0:2ba6a9f316b6 | 170 | // turn on the back light (it's off by default) |
rba90 | 0:2ba6a9f316b6 | 171 | lcd.setBackLight(true); |
rba90 | 0:2ba6a9f316b6 | 172 | lcd.setCursor(true, true); |
rba90 | 0:2ba6a9f316b6 | 173 | lcd.cls(); |
rba90 | 0:2ba6a9f316b6 | 174 | |
rba90 | 0:2ba6a9f316b6 | 175 | pc.attach(&serialInterruptHandler); |
rba90 | 0:2ba6a9f316b6 | 176 | |
rba90 | 2:54932809c7b2 | 177 | // control |
rba90 | 2:54932809c7b2 | 178 | SIP.registerCommand(0x00, toggleChecksum); |
rba90 | 3:0c4aa3cec685 | 179 | SIP.registerCommand(0x01, setBaudRate); |
rba90 | 3:0c4aa3cec685 | 180 | |
rba90 | 3:0c4aa3cec685 | 181 | // misc |
rba90 | 3:0c4aa3cec685 | 182 | SIP.registerCommand(0xe0, echoPayload); |
rba90 | 2:54932809c7b2 | 183 | |
rba90 | 2:54932809c7b2 | 184 | // lcd |
rba90 | 2:54932809c7b2 | 185 | SIP.registerCommand(0xf0, toggleLcdBackLight); |
rba90 | 2:54932809c7b2 | 186 | SIP.registerCommand(0xf1, setLcdBackLightIntensity); |
rba90 | 2:54932809c7b2 | 187 | SIP.registerCommand(0xf2, resetLcd); |
rba90 | 2:54932809c7b2 | 188 | SIP.registerCommand(0xf3, setLcdCursorPosition); |
rba90 | 2:54932809c7b2 | 189 | SIP.registerCommand(0xf4, setLcdCursorProperty); |
rba90 | 2:54932809c7b2 | 190 | SIP.registerCommand(0xf5, lcdPrintToLine); |
rba90 | 2:54932809c7b2 | 191 | SIP.registerCommand(0xf6, lcdAppendPrint); |
rba90 | 2:54932809c7b2 | 192 | |
rba90 | 2:54932809c7b2 | 193 | |
rba90 | 2:54932809c7b2 | 194 | |
rba90 | 0:2ba6a9f316b6 | 195 | while (1) |
rba90 | 0:2ba6a9f316b6 | 196 | { |
rba90 | 2:54932809c7b2 | 197 | SIP.poll(); |
rba90 | 0:2ba6a9f316b6 | 198 | // button event |
rba90 | 0:2ba6a9f316b6 | 199 | switch (lcd.readButton()) |
rba90 | 0:2ba6a9f316b6 | 200 | { |
rba90 | 0:2ba6a9f316b6 | 201 | case freetronicsLCDShield::BTN_SELECT: |
rba90 | 0:2ba6a9f316b6 | 202 | lcd.cls(); |
rba90 | 0:2ba6a9f316b6 | 203 | break; |
rba90 | 0:2ba6a9f316b6 | 204 | case freetronicsLCDShield::BTN_UP: |
rba90 | 0:2ba6a9f316b6 | 205 | break; |
rba90 | 0:2ba6a9f316b6 | 206 | case freetronicsLCDShield::BTN_DOWN: |
rba90 | 0:2ba6a9f316b6 | 207 | break; |
rba90 | 0:2ba6a9f316b6 | 208 | case freetronicsLCDShield::BTN_LEFT: |
rba90 | 0:2ba6a9f316b6 | 209 | break; |
rba90 | 0:2ba6a9f316b6 | 210 | case freetronicsLCDShield::BTN_RIGHT: |
rba90 | 0:2ba6a9f316b6 | 211 | break; |
rba90 | 0:2ba6a9f316b6 | 212 | default: |
rba90 | 0:2ba6a9f316b6 | 213 | break; |
rba90 | 0:2ba6a9f316b6 | 214 | } |
rba90 | 0:2ba6a9f316b6 | 215 | |
rba90 | 0:2ba6a9f316b6 | 216 | |
rba90 | 2:54932809c7b2 | 217 | // extract buffer |
rba90 | 2:54932809c7b2 | 218 | while (SerialOutputBuffer.getCounter() > 0) |
rba90 | 2:54932809c7b2 | 219 | { |
rba90 | 2:54932809c7b2 | 220 | uint8_t ch; |
rba90 | 2:54932809c7b2 | 221 | ch = SerialOutputBuffer.dequeue(); |
rba90 | 2:54932809c7b2 | 222 | pc.putc(ch); |
rba90 | 2:54932809c7b2 | 223 | } |
rba90 | 0:2ba6a9f316b6 | 224 | } |
rba90 | 0:2ba6a9f316b6 | 225 | } |