Manchester receiver demo.

Dependencies:   Manchester mbed CRC16 ManchesterMsg

main.cpp

Committer:
hudakz
Date:
2017-05-21
Revision:
4:649d9a4219c0
Parent:
3:0c6680f77855
Child:
5:3dc7d8e25c89

File content as of revision 4:649d9a4219c0:

#include "mbed.h"
#include "Manchester.h"
#include "CRC16.h"

DigitalOut      led(LED1);

int main(void) {
    Manchester      man(p11, p12, 9600);    // Tx pin, Rx pin, speed [bps]
    ManchesterMsg   msg(100);               // Message container (max bytes)
    char            str[80];                // Storage for the received array of char
    uint32_t        val;                    // Storage for the value received
    CRC16           crc16;                  // CRC16 object
    unsigned short  recvCRC16;              // CRC16 received in the message
    unsigned short  calcCRC16;              // CRC16 calculated

    //pc.baud(9600);

    while(1) {
        if(man.receive(msg)) {      // Receive message
            
            // Print data length and raw data bytes
            printf("\r\n----------------------------------------\r\n");
            printf("Message length = %d, Raw data :\r\n", msg.len);
            for(size_t i = 0; i < msg.len; i++) {
                if((i + 1) % 10 == 0)
                    printf("  %.2x\r\n", msg.data[i]);
                else
                    printf("  %.2x", msg.data[i]);
            }
            printf("\r\n\r\n");
            
            // Calculate CRC16 (exclude CRC bytes (last two bytes) from calculation)
            calcCRC16 = crc16.calc(msg.data, msg.len - 2); 
            
            // Extract data and CRC16 from the message
            msg >> str >> val >> recvCRC16;
            
            printf("Calculated CRC16 = %d\r\n", calcCRC16);
            printf("Received   CRC16 = %d\r\n", recvCRC16);
            printf("\r\n");
            
 
            if( calcCRC16 = recvCRC16) {
                printf("Received data :\r\n");
                printf("  str = %s\r\n", str);
                printf("  val = 0x%x\r\n", val);
            }
            else
                printf("CRC error\r\n");
        }
        else
            printf("Error\r\n");

        led = !led;
    }
}