Stefan Stojkovic
imitator
Revision 0:8b199d53d010, committed 2019-03-25
- Comitter:
- stefan996
- Date:
- Mon Mar 25 17:58:32 2019 +0000
- Commit message:
- Imitator
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/CAN_ID.h Mon Mar 25 17:58:32 2019 +0000 @@ -0,0 +1,31 @@ +#define SPEED_ID 1000 +#define RPM_ID 1001 +#define GEAR_ID 1002 +#define WATER_TEMP_ID 1003 +#define OIL_TEMP_ID 1004 +#define TPS_ID 1005 +#define BRAKE_ID 1006 +#define OIL_P_ID 1007 +#define MAP_ID 1008 +#define AIR_TEMP_ID 1009 +#define LAMBDA_ID 1010 +#define VOLTS_ID 1011 +#define CRANK_ID 1012 +#define FL_LVDT_ID 1013 +#define FR_LVDT_ID 1014 +#define BL_LVDT_ID 1015 +#define BR_LVDT_ID 1016 + +//CAN Identificators +#define DTA_1 0x2000 +#define DTA_2 0x2001 +#define DTA_3 0x2002 +#define DTA_4 0x2003 +#define DTA_5 0x2004 +#define DTA_6 0x2005 +// This IDs can be changed as they are our own IDs +#define LVDT_FRONT 0x6 +#define LVDT_REAR 0x7 +#define BRAKES 0x8 +#define DISTANCE_ID 0x9 +// If we add some other IDs in the vehicle add them here \ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/functions.h Mon Mar 25 17:58:32 2019 +0000
@@ -0,0 +1,283 @@
+#include "mbed.h"
+#include "CAN_ID.h"
+
+CAN can1(PB_8, PB_9, 100000); // PB_8 = CAN_1 RD, PB_9 = CAN_1 TD
+Serial pc(USBTX, USBRX);
+
+class Simulator
+{
+private:
+ char dta1[8];
+ int Rpm, TPS, Water_Temp, Air_Temp; // br. obrtaja, pozicija gasa, temperatura vode, temperatura vazduha
+ char dta2[8];
+ int MAP, Lambda, Speed, Oil_p; // pritisak na usisu, , brzina km/h, pritisak ulja
+ char dta3[8];
+ int Oil_Temp, Volts; // temperatura ulja, napon akumulatora
+ char dta4[8];
+ int Gear; // prenosni odnos
+ char dta6[8];
+ int Crank_Error;
+ char lvdtfront[8];
+ int FL_LVDT, FR_LVDT; // prednji levi LVDT, prednji desni LVDT
+ char lvdtrear[8];
+ int RL_LVDT, RR_LVDT; // zadnji levi LVDT, zadnji desni LVDT
+ char brakes[8];
+ int Brakes; // kocnica
+ char distance[8];
+ int Distance; // kilometraza
+
+ int counter;
+
+public:
+ Simulator()
+ {
+ CANMessage msg;
+ while(1)
+ {
+ pc.printf("\n\n1) Rpm, TPS, Water_temp, Air_temp\n");
+ pc.printf("2) MAP, Lambda, Speed, Oil_p\n");
+ pc.printf("3) Oil_temp, Volts\n");
+ pc.printf("4) Gear\n");
+ pc.printf("5) / \n");
+ pc.printf("6) / \n");
+ pc.printf("7) FL_LVDT, FR_LVDT\n");
+ pc.printf("8) RL_LVDT, RR_LVDT\n");
+ pc.printf("9) Brakes\n");
+ pc.printf("10) DISTANCE_ID\n");
+ pc.printf("0) Exit\n\n");
+
+ int x;
+ pc.scanf("%d",&x);
+
+ if(x == 0)
+ {
+ pc.printf(" :( \n");
+ break;
+ }
+
+ switch(x)
+ {
+ case 1:
+ EnterDTA_1();
+ break;
+ case 2:
+ EnterDTA_2();
+ break;
+ case 3:
+ EnterDTA_3();
+ break;
+ case 4:
+ EnterDTA_4();
+ break;
+ case 5:
+
+ break;
+ case 6:
+
+ break;
+ case 7:
+ EnterLVDT_FRONT();
+ break;
+ case 8:
+ EnterLVDT_REAR();
+ break;
+ case 9:
+ EnterBRAKES();
+ break;
+ case 10:
+ EnterDISTANCE_ID();
+ break;
+ }
+ }
+ }
+
+ void send(uint16_t ID, char dta[8])
+ {
+ if(can1.write(CANMessage((uint16_t)ID,dta, 8)))
+ {
+ counter++;
+ pc.printf("%x\n",ID);
+ pc.printf("Message sent: counter=%d, info1=%x%x, info2=%x%x, info3=%x%x, info4=%x%x\n", counter,dta[1],dta[0],dta[3],dta[2],dta[5],dta[4],dta[7],dta[6]);
+ }
+ else
+ pc.printf("Shit\n");
+ }
+
+ void EnterDTA_1()
+ {
+ pc.printf("Enter Rpm from 0 to 13000 [o/min] : ");
+ pc.scanf("%d", &Rpm);
+ pc.printf("Enter TPS from 0 to 100 [%] : ");
+ pc.scanf("%d", &TPS);
+ pc.printf("Enter Water_Temp from 0 to 120 [stepenC] : ");
+ pc.scanf("%d", &Water_Temp);
+ pc.printf("Enter Air_Temp from 0 to 60 [stepenC] : ");
+ pc.scanf("%d", &Air_Temp);
+
+ dta1[0]=(uint8_t)(Rpm & 0x00FF);
+ dta1[1]=(uint8_t)(Rpm>>8);
+ dta1[2]=(uint8_t)(TPS & 0x00FF);
+ dta1[3]=(uint8_t)(TPS>>8);
+ dta1[4]=(uint8_t)(Water_Temp & 0x00FF);
+ dta1[5]=(uint8_t)(Water_Temp>>8);
+ dta1[6]=(uint8_t)(Air_Temp & 0x00FF);
+ dta1[7]=(uint8_t)(Air_Temp>>8);
+
+ send(DTA_1,dta1);
+ }
+
+ void EnterDTA_2()
+ {
+ pc.printf("Enter MAP from 0 to 100 [kPa] : ");
+ pc.scanf("%d", &MAP);
+ pc.printf("Enter Lambda from 0 to 1.3 : ");
+ pc.scanf("%d", &Lambda);
+ Lambda *= 1000; // mnozimo kako bi izbegli razlomljen deo vrednosti
+ pc.printf("Enter Speed from 0 to 140 [kmh] : ");
+ pc.scanf("%d", &Speed);
+ //pc.printf("Enter Oil_p form to [] : ");
+ //pc.scanf("%d", &Oil_p);
+
+ dta2[0]=(uint8_t)(MAP & 0x00FF);
+ dta2[1]=(uint8_t)(MAP>>8);
+ dta2[2]=(uint8_t)(Lambda & 0x00FF);
+ dta2[3]=(uint8_t)(Lambda>>8);
+ dta2[4]=(uint8_t)(Speed & 0x00FF);
+ dta2[5]=(uint8_t)(Speed>>8);
+ dta2[6]=0;
+ dta2[7]=0;
+
+ send(DTA_2,dta2);
+ }
+
+ void EnterDTA_3()
+ {
+ pc.printf("Enter Oil_temp from 0 to 140 [stepenC] : ");
+ pc.scanf("%d", &Oil_Temp);
+ pc.printf("Enter Volts from 10 to 18 [V] : ");
+ pc.scanf("%d", &Volts);
+ Volts *= 10; // mnozimo kako bi izbegli razlomljen deo vrednosti
+
+ dta3[0]=0;
+ dta3[1]=0;
+ dta3[2]=(uint8_t)(Oil_Temp & 0x00FF);
+ dta3[3]=(uint8_t)(Oil_Temp>>8);
+ dta3[4]=(uint8_t)(Volts & 0x00FF);
+ dta3[5]=(uint8_t)(Volts>>8);
+ dta3[6]=0;
+ dta3[7]=0;
+
+ send(DTA_3,dta3);
+ }
+
+ void EnterDTA_4()
+ {
+ pc.printf("Enter Gear from 0 to 6 : ");
+ pc.scanf("%d", &Gear);
+
+ dta4[0]=Gear;
+ dta4[1]=0;
+ dta4[2]=0;
+ dta4[3]=0;
+ dta4[4]=0;
+ dta4[5]=0;
+ dta4[6]=0;
+ dta4[7]=0;
+
+ send(DTA_4,dta4);
+ }
+ void EnterDTA_5();
+
+ void EnterDTA_6();
+
+ void EnterLVDT_FRONT()
+ {
+ pc.printf("Enter FL_LVDT from 0 to 100 [%] : ");
+ pc.scanf("%d", &FL_LVDT);
+ FL_LVDT *= 10; // mnozimo kako bi izbegli razlomljen deo vrednosti
+ pc.printf("Enter FR_LVDT from 0 to 100 [%] : ");
+ pc.scanf("%d", &FR_LVDT);
+ FR_LVDT *= 10; // mnozimo kako bi izbegli razlomljen deo vrednosti
+
+ lvdtfront[0]=(uint8_t)(FL_LVDT & 0x00FF);
+ lvdtfront[1]=(uint8_t)(FL_LVDT>>8);
+ lvdtfront[2]=(uint8_t)(FR_LVDT & 0x00FF);
+ lvdtfront[3]=(uint8_t)(FR_LVDT>>8);
+ lvdtfront[4]=0;
+ lvdtfront[5]=0;
+ lvdtfront[6]=0;
+ lvdtfront[7]=0;
+
+ send(LVDT_FRONT,lvdtfront);
+ }
+
+ void EnterLVDT_REAR()
+ {
+ pc.printf("Enter RL_LVDT from 0 to 100 [%] : ");
+ pc.scanf("%d", &RL_LVDT);
+ RL_LVDT *= 10; // mnozimo kako bi izbegli razlomljen deo vrednosti
+ pc.printf("Enter RR_LVDT from 0 to 100 [%] : ");
+ pc.scanf("%d", &RR_LVDT);
+ RR_LVDT *= 10; // mnozimo kako bi izbegli razlomljen deo vrednosti
+
+ lvdtrear[0]=(uint8_t)(RL_LVDT & 0x00FF);
+ lvdtrear[1]=(uint8_t)(RL_LVDT>>8);
+ lvdtrear[2]=(uint8_t)(RR_LVDT & 0x00FF);
+ lvdtrear[3]=(uint8_t)(RR_LVDT>>8);
+ lvdtrear[4]=0;
+ lvdtrear[5]=0;
+ lvdtrear[6]=0;
+ lvdtrear[7]=0;
+
+ send(LVDT_REAR,lvdtrear);
+ }
+
+ void EnterBRAKES()
+ {
+ pc.printf("Enter Brakes from 0 to 100 [%] : ");
+ pc.scanf("%d", &Brakes);
+
+ if((Brakes/10)%2)
+ {
+ brakes[0]=0xFF;
+ brakes[1]=0xFF;
+ brakes[2]=0;
+ brakes[3]=0;
+ brakes[4]=0;
+ brakes[5]=0;
+ brakes[6]=0;
+ brakes[7]=0;
+ }
+ else
+ {
+ brakes[0]=0;
+ brakes[1]=0;
+ brakes[2]=0;
+ brakes[3]=0;
+ brakes[4]=0;
+ brakes[5]=0;
+ brakes[6]=0;
+ brakes[7]=0;
+ };
+
+ send(BRAKES,brakes);
+ }
+
+ void EnterDISTANCE_ID()
+ {
+ pc.printf("Enter distance from 0 to 100000 [km] : ");
+ pc.scanf("%d", &Distance);
+
+ distance[0]=(uint8_t) (Distance & 0x000000FF);
+ distance[1]=(uint8_t)((Distance & 0x0000FF00)>>8);
+ distance[2]=(uint8_t)((Distance & 0x00FF0000)>>16);
+ distance[3]=(uint8_t)((Distance & 0xFF000000)>>24);
+ distance[4]=0;
+ distance[5]=0;
+ distance[6]=0;
+ distance[7]=0;
+
+ send(DISTANCE_ID,distance);
+ }
+};
+
\ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Mon Mar 25 17:58:32 2019 +0000
@@ -0,0 +1,8 @@
+#include "mbed.h"
+#include "functions.h"
+
+int main()
+{
+ Simulator S;
+ return 0;
+}
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Mon Mar 25 17:58:32 2019 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mbed_official/code/mbed/builds/65be27845400 \ No newline at end of file