olivier flayols / Mbed 2 deprecated SCANIA_PGRT_V1_2

.

Dependencies:   mbed FastPWM

test.cpp@0:359dfe20eb14, 2019-10-16 (annotated)

Committer:
arcannae
Date:
Wed Oct 16 20:47:12 2019 +0000
Revision:
0:359dfe20eb14
.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
arcannae 0:359dfe20eb14 1 /*
arcannae 0:359dfe20eb14 2
arcannae 0:359dfe20eb14 3 int filter = RX_PGN & 0x00FFFFFF;
arcannae 0:359dfe20eb14 4
arcannae 0:359dfe20eb14 5
arcannae 0:359dfe20eb14 6 // if(filter == 0x00FEF100)
arcannae 0:359dfe20eb14 7 // {
arcannae 0:359dfe20eb14 8 //can1.write(CANMessage (0x18FEC100, SPN, 8, CANData, CANExtended));
arcannae 0:359dfe20eb14 9 // }
arcannae 0:359dfe20eb14 10
arcannae 0:359dfe20eb14 11
arcannae 0:359dfe20eb14 12 if(filter == 0x00FE6CEE)
arcannae 0:359dfe20eb14 13 {
arcannae 0:359dfe20eb14 14 printf("Message recu de : %x \n", BUFRx.id);
arcannae 0:359dfe20eb14 15 printf("%x, %x, %x, %x, %x, %x, %x, %x \n", BUFRx.data[0],BUFRx.data[1],BUFRx.data[2],BUFRx.data[3],BUFRx.data[4],BUFRx.data[5],BUFRx.data[6],BUFRx.data[7]);
arcannae 0:359dfe20eb14 16 printf("----------------------------------- \n");
arcannae 0:359dfe20eb14 17 }*/
arcannae 0:359dfe20eb14 18
arcannae 0:359dfe20eb14 19
arcannae 0:359dfe20eb14 20
arcannae 0:359dfe20eb14 21
arcannae 0:359dfe20eb14 22
arcannae 0:359dfe20eb14 23
arcannae 0:359dfe20eb14 24 int SA[5] = {0x27, 0x11, 0x03, 0x00, 0x47};
arcannae 0:359dfe20eb14 25
arcannae 0:359dfe20eb14 26 int testpgn = 0x18FFFF00;
arcannae 0:359dfe20eb14 27 int count1;
arcannae 0:359dfe20eb14 28
arcannae 0:359dfe20eb14 29
arcannae 0:359dfe20eb14 30
arcannae 0:359dfe20eb14 31 /*
arcannae 0:359dfe20eb14 32
arcannae 0:359dfe20eb14 33 CANReceive.attach (&CANreceive, CAN::RxIrq);
arcannae 0:359dfe20eb14 34
arcannae 0:359dfe20eb14 35 // DATA[0] = rand() % 255;
arcannae 0:359dfe20eb14 36 // DATA[1] = rand() % 255;
arcannae 0:359dfe20eb14 37 // DATA[2] = rand() % 255;
arcannae 0:359dfe20eb14 38 // DATA[3] = rand() % 255;
arcannae 0:359dfe20eb14 39 // DATA[4] = rand() % 255;
arcannae 0:359dfe20eb14 40 // DATA[5] = rand() % 255;
arcannae 0:359dfe20eb14 41 // DATA[6] = rand() % 255;
arcannae 0:359dfe20eb14 42 // DATA[7] = rand() % 255;
arcannae 0:359dfe20eb14 43
arcannae 0:359dfe20eb14 44 DATA_1[0] = rand() % 255;
arcannae 0:359dfe20eb14 45 DATA_1[1] = rand() % 255;
arcannae 0:359dfe20eb14 46 DATA_1[2] = rand() % 255;
arcannae 0:359dfe20eb14 47 DATA_1[3] = rand() % 255;
arcannae 0:359dfe20eb14 48 DATA_1[4] = rand() % 255;
arcannae 0:359dfe20eb14 49 DATA_1[5] = rand() % 255;
arcannae 0:359dfe20eb14 50 DATA_1[6] = rand() % 255;
arcannae 0:359dfe20eb14 51 DATA_1[7] = rand() % 255;
arcannae 0:359dfe20eb14 52
arcannae 0:359dfe20eb14 53 can1.write(CANMessage(PGN_T + SATEST, DATA_1, 8, CANData, CANExtended));
arcannae 0:359dfe20eb14 54 //can1.write(CANMessage(PGN_T , DATA_1, 8, CANData, CANExtended));
arcannae 0:359dfe20eb14 55 //SATEST = SATEST + 1;
arcannae 0:359dfe20eb14 56
arcannae 0:359dfe20eb14 57 if(SATEST > 10)
arcannae 0:359dfe20eb14 58 {
arcannae 0:359dfe20eb14 59 SATEST = 0;
arcannae 0:359dfe20eb14 60 PGN_T = PGN_T - 256;
arcannae 0:359dfe20eb14 61 }*/
arcannae 0:359dfe20eb14 62 //printf("PGN = %x\n",PGN_T + SATEST);
arcannae 0:359dfe20eb14 63 // printf("PGN = %x\n",PGN_T);
arcannae 0:359dfe20eb14 64
arcannae 0:359dfe20eb14 65
arcannae 0:359dfe20eb14 66 /*
arcannae 0:359dfe20eb14 67 void data_BAM()
arcannae 0:359dfe20eb14 68 {
arcannae 0:359dfe20eb14 69
arcannae 0:359dfe20eb14 70
arcannae 0:359dfe20eb14 71 switch(counter_2)
arcannae 0:359dfe20eb14 72 {
arcannae 0:359dfe20eb14 73
arcannae 0:359dfe20eb14 74
arcannae 0:359dfe20eb14 75 //TP-CM
arcannae 0:359dfe20eb14 76 case(0):
arcannae 0:359dfe20eb14 77 DATA_2[0] = 0x20; //BAM
arcannae 0:359dfe20eb14 78 DATA_2[1] = 39; //nombre total d'octets a transmetre dans le message broadcaster
arcannae 0:359dfe20eb14 79 DATA_2[2] = 0; //CTS(ne pas toucher)
arcannae 0:359dfe20eb14 80 DATA_2[3] = 5; //nombre de trame BAM a transmetre
arcannae 0:359dfe20eb14 81 DATA_2[4] = 0xFF; //nombre maximal d'octet pouvant etre transmis.
arcannae 0:359dfe20eb14 82 DATA_2[5] = 0xE3; //PGN 0x00FEE300
arcannae 0:359dfe20eb14 83 DATA_2[6] = 0xFE; //PGN 0x00FEE300
arcannae 0:359dfe20eb14 84 DATA_2[7] = 0x00; //non utilisé.
arcannae 0:359dfe20eb14 85 break;
arcannae 0:359dfe20eb14 86
arcannae 0:359dfe20eb14 87 //TP-DT
arcannae 0:359dfe20eb14 88 case(1):
arcannae 0:359dfe20eb14 89 DATA_2[0] = rand() % 255;
arcannae 0:359dfe20eb14 90 DATA_2[1] = rand() % 255;
arcannae 0:359dfe20eb14 91 DATA_2[2] = rand() % 255;
arcannae 0:359dfe20eb14 92 DATA_2[3] = rand() % 255;
arcannae 0:359dfe20eb14 93 DATA_2[4] = rand() % 255;
arcannae 0:359dfe20eb14 94 DATA_2[5] = rand() % 255;
arcannae 0:359dfe20eb14 95 DATA_2[6] = rand() % 255;
arcannae 0:359dfe20eb14 96 DATA_2[7] = rand() % 255;
arcannae 0:359dfe20eb14 97 break;
arcannae 0:359dfe20eb14 98
arcannae 0:359dfe20eb14 99 case(2):
arcannae 0:359dfe20eb14 100 DATA_2[0] = rand() % 255;
arcannae 0:359dfe20eb14 101 DATA_2[1] = rand() % 255;
arcannae 0:359dfe20eb14 102 DATA_2[2] = rand() % 255;
arcannae 0:359dfe20eb14 103 DATA_2[3] = rand() % 255;
arcannae 0:359dfe20eb14 104 DATA_2[4] = rand() % 255;
arcannae 0:359dfe20eb14 105 DATA_2[5] = rand() % 255;
arcannae 0:359dfe20eb14 106 DATA_2[6] = rand() % 255;
arcannae 0:359dfe20eb14 107 DATA_2[7] = rand() % 255;
arcannae 0:359dfe20eb14 108 break;
arcannae 0:359dfe20eb14 109
arcannae 0:359dfe20eb14 110 }
arcannae 0:359dfe20eb14 111 }
arcannae 0:359dfe20eb14 112 */
arcannae 0:359dfe20eb14 113
arcannae 0:359dfe20eb14 114 /*
arcannae 0:359dfe20eb14 115 printf("------------------------------------- \n");
arcannae 0:359dfe20eb14 116 printf("Get data from ID: %x\n",BUFRx.id);
arcannae 0:359dfe20eb14 117 printf("DATA: %x, %x, %x, %x, %x, %x, %x, %x \n", BUFRx.data[0],BUFRx.data[1],BUFRx.data[2],BUFRx.data[3],BUFRx.data[4],BUFRx.data[5],BUFRx.data[6],BUFRx.data[7]);
arcannae 0:359dfe20eb14 118 */
arcannae 0:359dfe20eb14 119
arcannae 0:359dfe20eb14 120 /*
arcannae 0:359dfe20eb14 121 if(can2.read(BUFRx))
arcannae 0:359dfe20eb14 122 {
arcannae 0:359dfe20eb14 123 int RX_PGN = BUFRx.id;
arcannae 0:359dfe20eb14 124 char RX_DATA[8] = {BUFRx.data[0],BUFRx.data[1],BUFRx.data[2],BUFRx.data[3],BUFRx.data[4],BUFRx.data[5],BUFRx.data[6],BUFRx.data[7]};
arcannae 0:359dfe20eb14 125
arcannae 0:359dfe20eb14 126 if(RX_PGN == 0x0CFE6CEE)
arcannae 0:359dfe20eb14 127 {
arcannae 0:359dfe20eb14 128 RX_DATA[0] = BUFRx.data[0];
arcannae 0:359dfe20eb14 129 RX_DATA[1] = BUFRx.data[1];
arcannae 0:359dfe20eb14 130 RX_DATA[2] = BUFRx.data[2];
arcannae 0:359dfe20eb14 131 RX_DATA[3] = BUFRx.data[3];
arcannae 0:359dfe20eb14 132 RX_DATA[4] = BUFRx.data[4];
arcannae 0:359dfe20eb14 133 RX_DATA[5] = BUFRx.data[5];
arcannae 0:359dfe20eb14 134 RX_DATA[6] = map(speed_kph, 0, 1300, 0, 33280) & 0x00FF;
arcannae 0:359dfe20eb14 135 RX_DATA[7] = (map(speed_kph, 0, 1300, 0, 33280) & 0xFF00)>> 8;
arcannae 0:359dfe20eb14 136
arcannae 0:359dfe20eb14 137 }
arcannae 0:359dfe20eb14 138
arcannae 0:359dfe20eb14 139 if(RX_PGN == 0x18FEC1EE)
arcannae 0:359dfe20eb14 140 {
arcannae 0:359dfe20eb14 141 char Veh_Dist[8];
arcannae 0:359dfe20eb14 142 Veh_Dist[0] = (odometer & 0x000000FF);
arcannae 0:359dfe20eb14 143 Veh_Dist[1] = (odometer & 0x0000FF00) >> 8;
arcannae 0:359dfe20eb14 144 Veh_Dist[2] = (odometer & 0x00FF0000) >> 16;
arcannae 0:359dfe20eb14 145 Veh_Dist[3] = (odometer & 0xFF000000) >> 24;
arcannae 0:359dfe20eb14 146
arcannae 0:359dfe20eb14 147 Veh_Dist[4] = rand() % 255;
arcannae 0:359dfe20eb14 148 Veh_Dist[5] = rand() % 255;
arcannae 0:359dfe20eb14 149 Veh_Dist[6] = rand() % 255;
arcannae 0:359dfe20eb14 150 Veh_Dist[7] = rand() % 255;
arcannae 0:359dfe20eb14 151
arcannae 0:359dfe20eb14 152 can1.write(CANMessage(RX_PGN, Veh_Dist, 8, CANData, CANExtended));
arcannae 0:359dfe20eb14 153 }
arcannae 0:359dfe20eb14 154 */
arcannae 0:359dfe20eb14 155
arcannae 0:359dfe20eb14 156
arcannae 0:359dfe20eb14 157 /*
arcannae 0:359dfe20eb14 158 // ENGSPDSENS inc CAB ILLUM inc VEH WEIGHT CAB INF PROP ICL INF PROP inc inc TIMEDATE AMB COND GPM1
arcannae 0:359dfe20eb14 159 //if(PGN != 0x0CFF0217 && PGN != 0x18AE3317 && PGN != 0x18D0FF17 && PGN != 0x1CDEEE17 && PGN != 0x18FEEA17 && PGN != 0x18FF9617 && PGN !=0x18FFD517 && PGN != 0x19FF4917 && PGN != 0x18FD7D17 && PGN != 0x18FEE617 && PGN != 0x18FEF517 && PGN != 0x18FF6017)
arcannae 0:359dfe20eb14 160
arcannae 0:359dfe20eb14 161 // if(PGN == 0x0CFF0217)
arcannae 0:359dfe20eb14 162 //if(PGN == 0x18AE3317)
arcannae 0:359dfe20eb14 163 //if(PGN == 0x1CDEEE17)
arcannae 0:359dfe20eb14 164 //if(PGN == 0x19FF4917)
arcannae 0:359dfe20eb14 165 //if(PGN == 0x18FD7D17)
arcannae 0:359dfe20eb14 166 {
arcannae 0:359dfe20eb14 167 printf("------------------------------------- \n");
arcannae 0:359dfe20eb14 168 printf("Get data from ID: %x\n",PGN);
arcannae 0:359dfe20eb14 169 printf("DATA: %x, %x, %x, %x, %x, %x, %x, %x \n", BUFRx.data[0],BUFRx.data[1],BUFRx.data[2],BUFRx.data[3],BUFRx.data[4],BUFRx.data[5],BUFRx.data[6],BUFRx.data[7]);
arcannae 0:359dfe20eb14 170 }
arcannae 0:359dfe20eb14 171 */