Diff: test.cpp

Revision:

0:359dfe20eb14

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/test.cpp	Wed Oct 16 20:47:12 2019 +0000
@@ -0,0 +1,171 @@
+/*    
+                
+               int filter = RX_PGN & 0x00FFFFFF;
+                
+                
+               // if(filter == 0x00FEF100)
+               // {
+                //can1.write(CANMessage (0x18FEC100, SPN, 8, CANData, CANExtended));
+               // }
+     
+               
+                if(filter == 0x00FE6CEE) 
+                {
+                printf("Message recu de : %x \n", BUFRx.id);
+                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]);
+                printf("----------------------------------- \n");
+                }*/
+
+
+
+
+
+
+int SA[5] = {0x27, 0x11, 0x03, 0x00, 0x47};
+
+int testpgn = 0x18FFFF00;
+int count1;
+
+
+
+/*
+
+CANReceive.attach       (&CANreceive, CAN::RxIrq);
+  
+  // DATA[0] = rand() % 255;  
+  //  DATA[1] = rand() % 255; 
+  //  DATA[2] = rand() % 255; 
+  //  DATA[3] = rand() % 255; 
+  //  DATA[4] = rand() % 255; 
+   // DATA[5] = rand() % 255; 
+  //  DATA[6] = rand() % 255; 
+   // DATA[7] = rand() % 255; 
+   
+DATA_1[0] = rand() % 255; 
+DATA_1[1] = rand() % 255; 
+DATA_1[2] = rand() % 255; 
+DATA_1[3] = rand() % 255;
+DATA_1[4] = rand() % 255;
+DATA_1[5] = rand() % 255;
+DATA_1[6] = rand() % 255;
+DATA_1[7] = rand() % 255; 
+
+        can1.write(CANMessage(PGN_T + SATEST, DATA_1, 8, CANData, CANExtended));
+        //can1.write(CANMessage(PGN_T , DATA_1, 8, CANData, CANExtended));
+        //SATEST = SATEST + 1;
+        
+        if(SATEST > 10)
+            {
+            SATEST = 0;
+            PGN_T = PGN_T - 256;
+            }*/
+             //printf("PGN = %x\n",PGN_T + SATEST);
+           // printf("PGN = %x\n",PGN_T);
+
+
+/*
+void data_BAM()
+{
+    
+    
+    switch(counter_2)
+    {
+    
+   
+    //TP-CM
+    case(0):
+    DATA_2[0] = 0x20; //BAM
+    DATA_2[1] = 39;   //nombre total d'octets a transmetre dans le message broadcaster
+    DATA_2[2] = 0;    //CTS(ne pas toucher)  
+    DATA_2[3] = 5;    //nombre  de trame BAM a transmetre
+    DATA_2[4] = 0xFF; //nombre maximal d'octet pouvant etre transmis.
+    DATA_2[5] = 0xE3; //PGN 0x00FEE300
+    DATA_2[6] = 0xFE; //PGN 0x00FEE300
+    DATA_2[7] = 0x00; //non utilisé. 
+    break;
+    
+    //TP-DT
+    case(1):
+    DATA_2[0] = rand() % 255; 
+    DATA_2[1] = rand() % 255; 
+    DATA_2[2] = rand() % 255; 
+    DATA_2[3] = rand() % 255;
+    DATA_2[4] = rand() % 255;
+    DATA_2[5] = rand() % 255;
+    DATA_2[6] = rand() % 255;
+    DATA_2[7] = rand() % 255;  
+    break;
+    
+    case(2):
+    DATA_2[0] = rand() % 255; 
+    DATA_2[1] = rand() % 255; 
+    DATA_2[2] = rand() % 255; 
+    DATA_2[3] = rand() % 255;
+    DATA_2[4] = rand() % 255;
+    DATA_2[5] = rand() % 255;
+    DATA_2[6] = rand() % 255;
+    DATA_2[7] = rand() % 255;  
+    break;
+    
+    }
+}
+*/
+
+ /*
+        printf("------------------------------------- \n");
+        printf("Get data from ID: %x\n",BUFRx.id);
+        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]);
+        */
+
+/*
+if(can2.read(BUFRx)) 
+        {
+        int RX_PGN = BUFRx.id;
+        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]};
+        
+        if(RX_PGN == 0x0CFE6CEE)
+            {
+            RX_DATA[0] =  BUFRx.data[0];
+            RX_DATA[1] =  BUFRx.data[1];
+            RX_DATA[2] =  BUFRx.data[2];
+            RX_DATA[3] =  BUFRx.data[3];
+            RX_DATA[4] =  BUFRx.data[4];
+            RX_DATA[5] =  BUFRx.data[5];
+            RX_DATA[6] =  map(speed_kph, 0, 1300, 0, 33280) & 0x00FF;
+            RX_DATA[7] = (map(speed_kph, 0, 1300, 0, 33280) & 0xFF00)>> 8;
+            
+            }
+            
+        if(RX_PGN == 0x18FEC1EE)
+            {
+            char Veh_Dist[8];
+            Veh_Dist[0] =  (odometer & 0x000000FF);
+            Veh_Dist[1] =  (odometer & 0x0000FF00) >> 8;
+            Veh_Dist[2] =  (odometer & 0x00FF0000) >> 16;
+            Veh_Dist[3] =  (odometer & 0xFF000000) >> 24;
+           
+            Veh_Dist[4] =   rand() % 255;
+            Veh_Dist[5] =   rand() % 255;
+            Veh_Dist[6] =   rand() % 255;
+            Veh_Dist[7] =   rand() % 255;
+
+            can1.write(CANMessage(RX_PGN, Veh_Dist, 8, CANData, CANExtended));
+            }
+   */  
+   
+   
+    /*
+        //          ENGSPDSENS                inc               CAB ILLUM               inc               VEH WEIGHT          CAB INF PROP        ICL INF PROP            inc                    inc               TIMEDATE             AMB COND               GPM1
+        //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)
+         
+       // if(PGN == 0x0CFF0217) 
+        //if(PGN == 0x18AE3317) 
+        //if(PGN == 0x1CDEEE17) 
+        //if(PGN == 0x19FF4917) 
+        //if(PGN == 0x18FD7D17)    
+            {
+            printf("------------------------------------- \n");
+            printf("Get data from ID: %x\n",PGN);
+            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]);
+            }
+        */ 
\ No newline at end of file