olivier flayols
/
SCANIA_PGRT_V1_2
.
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?
User | Revision | Line number | New 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 | */ |