Руслан Бредун / Mbed 2 deprecated STM32-MC_node

test

Dependencies:   mbed Watchdog stm32-sensor-base2

RS485/RS485.cpp@9:859bcb293e46, 2020-07-30 (annotated)

Committer:
ruslanbredun
Date:
Thu Jul 30 13:04:10 2020 +0000
Revision:
9:859bcb293e46
Parent:
8:c3cffab85b0d
Child:
10:0b7f23df690a
rs485 request and send first test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ommpy 2:b7fdc74e5c5d 1 #include "RS485.h"
nestedslk 4:f6e22dd39313 2 #include <stdarg.h>
nestedslk 4:f6e22dd39313 3
nestedslk 4:f6e22dd39313 4 typedef unsigned int word;
nestedslk 4:f6e22dd39313 5 typedef uint8_t byte;
nestedslk 4:f6e22dd39313 6 typedef uint8_t boolean;
nestedslk 4:f6e22dd39313 7 typedef void (*voidFuncPtr)(void);
nestedslk 4:f6e22dd39313 8 Timer lapse;
ruslanbredun 9:859bcb293e46 9 const byte STX = '\4';
nestedslk 4:f6e22dd39313 10 const byte ETX = '\3';
nestedslk 4:f6e22dd39313 11
nestedslk 4:f6e22dd39313 12 RS485::RS485(PinName tx, PinName rx, PinName dere)
ruslanbredun 9:859bcb293e46 13 : BufferedSerial(tx, rx )
nestedslk 4:f6e22dd39313 14 {
nestedslk 4:f6e22dd39313 15 return;
ommpy 2:b7fdc74e5c5d 16 }
nestedslk 4:f6e22dd39313 17
nestedslk 4:f6e22dd39313 18
nestedslk 4:f6e22dd39313 19 byte RS485::crc8(const byte *addr, byte len)
nestedslk 4:f6e22dd39313 20 {
nestedslk 4:f6e22dd39313 21 byte crc = 0;
nestedslk 4:f6e22dd39313 22 while (len--)
nestedslk 4:f6e22dd39313 23 {
nestedslk 4:f6e22dd39313 24 byte inbyte = *addr++;
nestedslk 4:f6e22dd39313 25 for (byte i = 8; i; i--)
nestedslk 4:f6e22dd39313 26 {
nestedslk 4:f6e22dd39313 27 byte mix = (crc ^ inbyte) & 0x01;
nestedslk 4:f6e22dd39313 28 crc >>= 1;
nestedslk 4:f6e22dd39313 29 if (mix)
nestedslk 4:f6e22dd39313 30 crc ^= 0x8C;
nestedslk 4:f6e22dd39313 31 inbyte >>= 1;
nestedslk 4:f6e22dd39313 32 } // end of for
nestedslk 4:f6e22dd39313 33 } // end of while
nestedslk 4:f6e22dd39313 34 return crc;
nestedslk 4:f6e22dd39313 35 } // end of crc8
nestedslk 4:f6e22dd39313 36
nestedslk 4:f6e22dd39313 37 void RS485::sendComplemented( const byte what)
nestedslk 4:f6e22dd39313 38 {
nestedslk 4:f6e22dd39313 39 byte c ;
nestedslk 4:f6e22dd39313 40 // first nibble
nestedslk 4:f6e22dd39313 41 c = what >> 4;
nestedslk 4:f6e22dd39313 42 putc((c << 4) | (c ^ 0x0F));
nestedslk 4:f6e22dd39313 43
nestedslk 4:f6e22dd39313 44 // second nibble
nestedslk 4:f6e22dd39313 45 c = what & 0x0F;
nestedslk 4:f6e22dd39313 46 putc((c << 4) | (c ^ 0x0F));
nestedslk 4:f6e22dd39313 47 } // end of sendComplemented
nestedslk 4:f6e22dd39313 48
nestedslk 4:f6e22dd39313 49
nestedslk 4:f6e22dd39313 50 void RS485::sendMsg(const byte * data, const byte length)
nestedslk 4:f6e22dd39313 51 {
nestedslk 4:f6e22dd39313 52 putc(STX); // STX
nestedslk 4:f6e22dd39313 53 for (byte i = 0; i < length; i++)
ruslanbredun 9:859bcb293e46 54 //sendComplemented (data[i]);
ruslanbredun 9:859bcb293e46 55 putc(data[i]);
ruslanbredun 9:859bcb293e46 56 //putc(ETX); // ETX
ruslanbredun 9:859bcb293e46 57 //sendComplemented(crc8(data, length));
ruslanbredun 9:859bcb293e46 58 putc(crc8(data, length));
nestedslk 4:f6e22dd39313 59 } // end of sendMsg
nestedslk 4:f6e22dd39313 60
nestedslk 4:f6e22dd39313 61 // receive a message, maximum "length" bytes, timeout after "timeout" clock_mseconds
nestedslk 4:f6e22dd39313 62 // if nothing received, or an error (eg. bad CRC, bad data) return 0
nestedslk 4:f6e22dd39313 63 // otherwise, returns length of received data
nestedslk 4:f6e22dd39313 64 byte RS485::recvMsg (byte * data, // buffer to receive into
nestedslk 4:f6e22dd39313 65 const byte length, // maximum buffer size
nestedslk 4:f6e22dd39313 66 unsigned long timeout) // clock_mseconds before timing out
nestedslk 4:f6e22dd39313 67 {
nestedslk 4:f6e22dd39313 68
nestedslk 4:f6e22dd39313 69 unsigned long start_time = lapse.read_ms();
nestedslk 4:f6e22dd39313 70
nestedslk 4:f6e22dd39313 71 bool have_stx = false;
nestedslk 4:f6e22dd39313 72
nestedslk 4:f6e22dd39313 73 // variables below are set when we get an STX
nestedslk 4:f6e22dd39313 74 bool have_etx;
nestedslk 4:f6e22dd39313 75 byte input_pos;
nestedslk 4:f6e22dd39313 76 bool first_nibble;
nestedslk 4:f6e22dd39313 77 byte current_byte;
nestedslk 4:f6e22dd39313 78
nestedslk 4:f6e22dd39313 79 while (lapse.read_ms() - start_time < timeout)
nestedslk 4:f6e22dd39313 80 {
nestedslk 4:f6e22dd39313 81 if (readable() > 0)
nestedslk 4:f6e22dd39313 82 {
nestedslk 4:f6e22dd39313 83 byte inByte = getc();
nestedslk 4:f6e22dd39313 84
nestedslk 4:f6e22dd39313 85 switch (inByte)
nestedslk 4:f6e22dd39313 86 {
nestedslk 4:f6e22dd39313 87
nestedslk 4:f6e22dd39313 88 case STX: // start of text
nestedslk 4:f6e22dd39313 89 have_stx = true;
nestedslk 4:f6e22dd39313 90 have_etx = false;
nestedslk 4:f6e22dd39313 91 input_pos = 0;
nestedslk 4:f6e22dd39313 92 first_nibble = true;
nestedslk 4:f6e22dd39313 93 start_time = lapse.read_ms(); // reset timeout period
ruslanbredun 9:859bcb293e46 94 data[0] = STX;
nestedslk 4:f6e22dd39313 95 break;
nestedslk 4:f6e22dd39313 96
nestedslk 4:f6e22dd39313 97 case ETX: // end of text
nestedslk 4:f6e22dd39313 98 have_etx = true;
nestedslk 4:f6e22dd39313 99 break;
nestedslk 4:f6e22dd39313 100
nestedslk 4:f6e22dd39313 101 default:
nestedslk 4:f6e22dd39313 102 // wait until packet officially starts
nestedslk 4:f6e22dd39313 103 if (!have_stx)
nestedslk 4:f6e22dd39313 104 break;
nestedslk 4:f6e22dd39313 105
nestedslk 4:f6e22dd39313 106 // check byte is in valid form (4 bits followed by 4 bits complemented)
nestedslk 4:f6e22dd39313 107 if ((inByte >> 4) != ((inByte & 0x0F) ^ 0x0F) )
nestedslk 4:f6e22dd39313 108 return 0; // bad character
nestedslk 4:f6e22dd39313 109
nestedslk 4:f6e22dd39313 110 // convert back
nestedslk 4:f6e22dd39313 111 inByte >>= 4;
nestedslk 4:f6e22dd39313 112
nestedslk 4:f6e22dd39313 113 // high-order nibble?
nestedslk 4:f6e22dd39313 114 if (first_nibble)
nestedslk 4:f6e22dd39313 115 {
nestedslk 4:f6e22dd39313 116 current_byte = inByte;
nestedslk 4:f6e22dd39313 117 first_nibble = false;
nestedslk 4:f6e22dd39313 118 break;
nestedslk 4:f6e22dd39313 119 } // end of first nibble
nestedslk 4:f6e22dd39313 120
nestedslk 4:f6e22dd39313 121 // low-order nibble
nestedslk 4:f6e22dd39313 122 current_byte <<= 4;
nestedslk 4:f6e22dd39313 123 current_byte |= inByte;
nestedslk 4:f6e22dd39313 124 first_nibble = true;
nestedslk 4:f6e22dd39313 125
nestedslk 4:f6e22dd39313 126 // if we have the ETX this must be the CRC
nestedslk 4:f6e22dd39313 127 if (have_etx)
nestedslk 4:f6e22dd39313 128 {
nestedslk 4:f6e22dd39313 129 if (crc8 (data, input_pos) != current_byte)
nestedslk 4:f6e22dd39313 130 return 0; // bad crc
nestedslk 4:f6e22dd39313 131 return input_pos; // return received length
nestedslk 4:f6e22dd39313 132 } // end if have ETX already
nestedslk 4:f6e22dd39313 133
nestedslk 4:f6e22dd39313 134 // keep adding if not full
nestedslk 4:f6e22dd39313 135 if (input_pos < length)
nestedslk 4:f6e22dd39313 136 data [input_pos++] = current_byte;
nestedslk 4:f6e22dd39313 137 else
nestedslk 4:f6e22dd39313 138 return 0; // overflow
nestedslk 4:f6e22dd39313 139 break;
nestedslk 4:f6e22dd39313 140
nestedslk 4:f6e22dd39313 141 } // end of switch
nestedslk 4:f6e22dd39313 142 } // end of incoming data
nestedslk 4:f6e22dd39313 143 } // end of while not timed out
nestedslk 4:f6e22dd39313 144
nestedslk 4:f6e22dd39313 145 return 0; // timeout
nestedslk 4:f6e22dd39313 146 } // end of recvMsg
nestedslk 4:f6e22dd39313 147