Paul Sainrat / Mbed 2 deprecated App4_Projet

Dependencies:   mbed-rtos mbed

Committer:
Sainratp
Date:
Mon Oct 23 13:13:33 2017 +0000
Revision:
0:703249a56b9d
Child:
1:5c0ca9bdf810
App4;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Sainratp 0:703249a56b9d 1 #include "mbed.h"
Sainratp 0:703249a56b9d 2 #include "DO.h"
Sainratp 0:703249a56b9d 3 #include "config.h"
Sainratp 0:703249a56b9d 4
Sainratp 0:703249a56b9d 5
Sainratp 0:703249a56b9d 6 char calcCRC16(char* trame)
Sainratp 0:703249a56b9d 7 {
Sainratp 0:703249a56b9d 8 char length = trame[2];
Sainratp 0:703249a56b9d 9 int CRC16 = 0xFFFF;
Sainratp 0:703249a56b9d 10 for(char i =0x00; i<length; i++) {
Sainratp 0:703249a56b9d 11 CRC16 = CRC16 ^ trame[3+i];
Sainratp 0:703249a56b9d 12 for(int j = 0 ; j<8 ; j++) {
Sainratp 0:703249a56b9d 13 if((CRC16 & 0x1)==0x01) {
Sainratp 0:703249a56b9d 14 CRC16 = CRC16/2 ^ 0xA001;
Sainratp 0:703249a56b9d 15 } else {
Sainratp 0:703249a56b9d 16 CRC16 = CRC16/2;
Sainratp 0:703249a56b9d 17 }
Sainratp 0:703249a56b9d 18 }
Sainratp 0:703249a56b9d 19 }
Sainratp 0:703249a56b9d 20 return CRC16 & 0x00FF ;
Sainratp 0:703249a56b9d 21 }
Sainratp 0:703249a56b9d 22
Sainratp 0:703249a56b9d 23
Sainratp 0:703249a56b9d 24 void recieveData(char* data){
Sainratp 0:703249a56b9d 25 if(calcCRC16(data)){
Sainratp 0:703249a56b9d 26
Sainratp 0:703249a56b9d 27 }
Sainratp 0:703249a56b9d 28 else{
Sainratp 0:703249a56b9d 29 printf("Erreur : Checksum incorect \n");
Sainratp 0:703249a56b9d 30 }
Sainratp 0:703249a56b9d 31
Sainratp 0:703249a56b9d 32 }