| 144 | |
| 145 | |
| 146 | void RS485::send(uint8_t receiverID, uint8_t msg[], uint8_t len) |
| 147 | { |
| 148 | uint8_t CHKSUM = 0; |
| 149 | setTXmode(); // transmit mode |
| 150 | _stream->write(SOH); |
| 151 | _stream->write(receiverID); // TO |
| 152 | _stream->write(_deviceID); // FROM |
| 153 | _stream->write(len); // LENGTH BODY |
| 154 | _stream->write(STX); |
| 155 | for (int i = 0; i < len; i++) |
| 156 | { |
| 157 | _stream->write(msg[i]); |
| 158 | CHKSUM ^= msg[i]; // Simple XOR checksum. |
| 159 | } |
| 160 | _stream->write(CHKSUM); |
| 161 | _stream->write(ETX); |
| 162 | _stream->write(EOT); |
| 163 | delayMicroseconds((len + 8 + 2) * _microsPerByte); // + 2 to be sure... |
| 164 | setRXmode(); |
| 165 | } |
| 166 | |
| 167 | |
| 168 | // returns true if complete message is captured. |