7 jul
Dependencies: BSP_DISCO_F469NIa EEPROM_DISCO_F469NI LCD_DISCO_F469NIa SD_DISCO_F469NI mbed
Fork of IntegrationCAN_7jul by
main.cpp@3:a06e417a5a2c, 2018-07-05 (annotated)
- Committer:
- nemanja1994
- Date:
- Thu Jul 05 20:18:32 2018 +0000
- Revision:
- 3:a06e417a5a2c
- Parent:
- 2:f54f01527ebb
- Child:
- 4:0e8413277df8
fhgj;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
formulas | 0:38c3afd99aeb | 1 | #include "CAN_library.h" |
formulas | 0:38c3afd99aeb | 2 | #include "screen_library.h" |
formulas | 2:f54f01527ebb | 3 | #include "EEPROM_DISCO_F469NI.h" |
formulas | 2:f54f01527ebb | 4 | |
formulas | 0:38c3afd99aeb | 5 | |
formulas | 0:38c3afd99aeb | 6 | LCD_DISCO_F469NI lcd; //Initialize LCD Display |
formulas | 0:38c3afd99aeb | 7 | SD_DISCO_F469NI sd; //Initialize SD Card |
formulas | 2:f54f01527ebb | 8 | //EEPROM_DISCO_F469NI eep; //Initialize EEPROM Internal memory |
formulas | 2:f54f01527ebb | 9 | Serial pc(USBTX, USBRX); //Initialize Serial. This is used only while debuging code. |
nemanja1994 | 3:a06e417a5a2c | 10 | CAN can(PB_5, PB_13,1000000); //Initialize CAN. |
nemanja1994 | 3:a06e417a5a2c | 11 | I2C i2c(D14, D15); |
nemanja1994 | 3:a06e417a5a2c | 12 | DigitalOut reset(D8); |
formulas | 0:38c3afd99aeb | 13 | InterruptIn change_screen_input(D0); //Initialize Digital input for Change screen button |
formulas | 2:f54f01527ebb | 14 | Timer t_int,t_store; |
formulas | 0:38c3afd99aeb | 15 | |
formulas | 0:38c3afd99aeb | 16 | // Variables received from DTA, LVDTs and brakes |
formulas | 0:38c3afd99aeb | 17 | uint16_t Rpm0=0,Speed0=0,Gear0=0,Water_Temp0=0,Oil_Temp0=0,TPS0=0,Brakes0=0,Oil_P0=0,MAP0=0,Air_Temp0=0,Lambda0=0,Volts0=0,Crank0=0; |
formulas | 0:38c3afd99aeb | 18 | uint16_t Rpm=0,Speed=0,Gear=0,Water_Temp=0,Oil_Temp=0,TPS=0,Brakes=0,Oil_P=0,MAP=0,Air_Temp=0,Lambda=0,Volts=0,Crank=0; |
formulas | 0:38c3afd99aeb | 19 | int FL_LVDT0=0,FR_LVDT0=0,RL_LVDT0=0,RR_LVDT0=0,FL_LVDT=0,FR_LVDT=0,RL_LVDT=0,RR_LVDT=0; |
formulas | 0:38c3afd99aeb | 20 | //Referrent LVDT values. First received value is referrent. |
formulas | 0:38c3afd99aeb | 21 | int FL_LVDT_Ref,FR_LVDT_Ref,RL_LVDT_Ref,RR_LVDT_Ref; |
formulas | 2:f54f01527ebb | 22 | float Meter_counter=0,Meter_counter0=0; |
formulas | 0:38c3afd99aeb | 23 | |
formulas | 0:38c3afd99aeb | 24 | uint8_t change_flag=0; |
formulas | 0:38c3afd99aeb | 25 | uint16_t rx_flag=0x0000; // Receive specific CAN data message |
formulas | 2:f54f01527ebb | 26 | uint8_t distance_flag=0; |
formulas | 2:f54f01527ebb | 27 | uint8_t lvdtref=0x0F; // Flag if refferent LVDT value is received (first received LVDT value, 1=no, 0=yes). From highest to lowest bit: LL,LR,RL,RR. |
formulas | 0:38c3afd99aeb | 28 | uint8_t screen_flag=0x01; // Current screen flag. 1=Main, 2=First Aux, 3=Second Aux. |
formulas | 0:38c3afd99aeb | 29 | uint8_t ft_main_flag=1; // Detect first time Main screne in loop |
formulas | 0:38c3afd99aeb | 30 | uint8_t ft_2aux_flag=1; // Detect first time Second Aux screne in loop |
formulas | 0:38c3afd99aeb | 31 | |
formulas | 0:38c3afd99aeb | 32 | // CAN Message variables, one variable for each ID |
formulas | 0:38c3afd99aeb | 33 | // If new IDs are added, add variables for them |
formulas | 0:38c3afd99aeb | 34 | CANMessage msgDTA1; // RPM, TPS %, Water temp C, Air temp C |
formulas | 0:38c3afd99aeb | 35 | CANMessage msgDTA2; // MAP Kpa, Lambda x1000, KPH x10, Oil P Kpa |
formulas | 0:38c3afd99aeb | 36 | CANMessage msgDTA3; // Fuel P Kpa, Oil temp C, Volts x10, Fuel Con. L/Hr x10 |
formulas | 0:38c3afd99aeb | 37 | CANMessage msgDTA4; // Gear, Advance Deg x10, Injection ms x100, Fuel Con L/100km x10 |
formulas | 0:38c3afd99aeb | 38 | CANMessage msgDTA5; // Ana1 mV, Ana2 mV, Ana3 mV, Cam Advance x10 |
formulas | 0:38c3afd99aeb | 39 | CANMessage msgDTA6; // Cam Targ x10, Cam PWM x10, Crank Errors, Cam Errors |
formulas | 0:38c3afd99aeb | 40 | CANMessage msgLVDTFront; // Left, Right, Steering Wheel |
formulas | 0:38c3afd99aeb | 41 | CANMessage msgLVDTRear; // Left, Right |
formulas | 0:38c3afd99aeb | 42 | CANMessage msgBrakes; // Brake system preassure, Braking On/Off |
formulas | 2:f54f01527ebb | 43 | CANMessage msgDistance; // Total distance |
formulas | 0:38c3afd99aeb | 44 | |
nemanja1994 | 3:a06e417a5a2c | 45 | // LED Bar for RPM |
formulas | 0:38c3afd99aeb | 46 | |
nemanja1994 | 3:a06e417a5a2c | 47 | char cmd[3]; |
nemanja1994 | 3:a06e417a5a2c | 48 | int addr = 0x74<<1; |
nemanja1994 | 3:a06e417a5a2c | 49 | |
nemanja1994 | 3:a06e417a5a2c | 50 | void LEDInitialize(){ |
nemanja1994 | 3:a06e417a5a2c | 51 | reset.write(1); |
nemanja1994 | 3:a06e417a5a2c | 52 | wait(1); |
nemanja1994 | 3:a06e417a5a2c | 53 | // set port as output |
nemanja1994 | 3:a06e417a5a2c | 54 | cmd[0]=0x06; |
nemanja1994 | 3:a06e417a5a2c | 55 | cmd[1]=0x00; |
nemanja1994 | 3:a06e417a5a2c | 56 | cmd[2]=0x00; |
nemanja1994 | 3:a06e417a5a2c | 57 | i2c.write(addr,cmd,3); |
nemanja1994 | 3:a06e417a5a2c | 58 | pc.printf( "cao\n"); |
nemanja1994 | 3:a06e417a5a2c | 59 | } |
nemanja1994 | 3:a06e417a5a2c | 60 | |
nemanja1994 | 3:a06e417a5a2c | 61 | void showLedRpm(int RPM){ |
nemanja1994 | 3:a06e417a5a2c | 62 | pc.printf("%d\n",RPM); |
nemanja1994 | 3:a06e417a5a2c | 63 | if(RPM<1000) { |
nemanja1994 | 3:a06e417a5a2c | 64 | cmd[1]=0xFF; |
nemanja1994 | 3:a06e417a5a2c | 65 | cmd[2]=0xFF; |
nemanja1994 | 3:a06e417a5a2c | 66 | } |
nemanja1994 | 3:a06e417a5a2c | 67 | else if (RPM<2000) { |
nemanja1994 | 3:a06e417a5a2c | 68 | cmd[1]=0xFF; |
nemanja1994 | 3:a06e417a5a2c | 69 | cmd[2]=0xDF; |
nemanja1994 | 3:a06e417a5a2c | 70 | } |
nemanja1994 | 3:a06e417a5a2c | 71 | else if (RPM <3000) { |
nemanja1994 | 3:a06e417a5a2c | 72 | cmd[1]=0xFF; |
nemanja1994 | 3:a06e417a5a2c | 73 | cmd[2]=0xCF; |
nemanja1994 | 3:a06e417a5a2c | 74 | } |
nemanja1994 | 3:a06e417a5a2c | 75 | else if (RPM <4000) { |
nemanja1994 | 3:a06e417a5a2c | 76 | cmd[1]=0xFF; |
nemanja1994 | 3:a06e417a5a2c | 77 | cmd[2]=0xC7; |
nemanja1994 | 3:a06e417a5a2c | 78 | } |
nemanja1994 | 3:a06e417a5a2c | 79 | else if (RPM <5000) { |
nemanja1994 | 3:a06e417a5a2c | 80 | pc.printf("tu sam %d\n", RPM); |
nemanja1994 | 3:a06e417a5a2c | 81 | cmd[1]=0xFF; |
nemanja1994 | 3:a06e417a5a2c | 82 | cmd[2]=0xC3; |
nemanja1994 | 3:a06e417a5a2c | 83 | } |
nemanja1994 | 3:a06e417a5a2c | 84 | else if (RPM <6000) { |
nemanja1994 | 3:a06e417a5a2c | 85 | cmd[1]=0xFF; |
nemanja1994 | 3:a06e417a5a2c | 86 | cmd[2]=0xC1; |
nemanja1994 | 3:a06e417a5a2c | 87 | } |
nemanja1994 | 3:a06e417a5a2c | 88 | else if (RPM <7000) { |
nemanja1994 | 3:a06e417a5a2c | 89 | cmd[1]=0xFF; |
nemanja1994 | 3:a06e417a5a2c | 90 | cmd[2]=0xC0; |
nemanja1994 | 3:a06e417a5a2c | 91 | } |
nemanja1994 | 3:a06e417a5a2c | 92 | else if (RPM <8000) { |
nemanja1994 | 3:a06e417a5a2c | 93 | cmd[1]=0xBF; |
nemanja1994 | 3:a06e417a5a2c | 94 | cmd[2]=0xC0; |
nemanja1994 | 3:a06e417a5a2c | 95 | } |
nemanja1994 | 3:a06e417a5a2c | 96 | else if (RPM <9000) { |
nemanja1994 | 3:a06e417a5a2c | 97 | cmd[1]=0x9F; |
nemanja1994 | 3:a06e417a5a2c | 98 | cmd[2]=0xC0; |
nemanja1994 | 3:a06e417a5a2c | 99 | } |
nemanja1994 | 3:a06e417a5a2c | 100 | else if (RPM <10000) { |
nemanja1994 | 3:a06e417a5a2c | 101 | cmd[1]=0x8F; |
nemanja1994 | 3:a06e417a5a2c | 102 | cmd[2]=0xC0; |
nemanja1994 | 3:a06e417a5a2c | 103 | } |
nemanja1994 | 3:a06e417a5a2c | 104 | else if (RPM <11000) { |
nemanja1994 | 3:a06e417a5a2c | 105 | cmd[1]=0x87; |
nemanja1994 | 3:a06e417a5a2c | 106 | cmd[2]=0xC0; |
nemanja1994 | 3:a06e417a5a2c | 107 | } |
nemanja1994 | 3:a06e417a5a2c | 108 | else if (RPM <12000) { |
nemanja1994 | 3:a06e417a5a2c | 109 | cmd[1]=0x83; |
nemanja1994 | 3:a06e417a5a2c | 110 | cmd[2]=0xC0; |
nemanja1994 | 3:a06e417a5a2c | 111 | } |
nemanja1994 | 3:a06e417a5a2c | 112 | else if (RPM <13000) { |
nemanja1994 | 3:a06e417a5a2c | 113 | cmd[1]=0x81; |
nemanja1994 | 3:a06e417a5a2c | 114 | cmd[2]=0xC0; |
nemanja1994 | 3:a06e417a5a2c | 115 | } |
nemanja1994 | 3:a06e417a5a2c | 116 | else { |
nemanja1994 | 3:a06e417a5a2c | 117 | cmd[1]=0x80; |
nemanja1994 | 3:a06e417a5a2c | 118 | cmd[2]=0xC0; |
nemanja1994 | 3:a06e417a5a2c | 119 | } |
nemanja1994 | 3:a06e417a5a2c | 120 | cmd[0]=0x02; |
nemanja1994 | 3:a06e417a5a2c | 121 | i2c.write(addr, cmd, 3); |
nemanja1994 | 3:a06e417a5a2c | 122 | } |
nemanja1994 | 3:a06e417a5a2c | 123 | |
nemanja1994 | 3:a06e417a5a2c | 124 | |
nemanja1994 | 3:a06e417a5a2c | 125 | int main(){ |
nemanja1994 | 3:a06e417a5a2c | 126 | LEDInitialize(); |
formulas | 0:38c3afd99aeb | 127 | can.attach(&CANMsgReceive,CAN::RxIrq); // Attach interrupt function to CAN RX |
formulas | 0:38c3afd99aeb | 128 | change_screen_input.rise(&ChangeCommand); //Attach interrupt function to rising edge of DigitalIn for changing screen. |
formulas | 0:38c3afd99aeb | 129 | SetIntro(); // Display logo when starting display |
formulas | 0:38c3afd99aeb | 130 | SetMain(); // First screen is main by default |
nemanja1994 | 3:a06e417a5a2c | 131 | sd.Init(); |
nemanja1994 | 3:a06e417a5a2c | 132 | |
formulas | 0:38c3afd99aeb | 133 | while(1){ |
formulas | 0:38c3afd99aeb | 134 | if(change_flag){ // Check if screen is changed |
formulas | 0:38c3afd99aeb | 135 | ChangeScreen(); |
formulas | 0:38c3afd99aeb | 136 | }; |
formulas | 0:38c3afd99aeb | 137 | UpdateInfo(); // Update info for DTA values in every iteration |
formulas | 0:38c3afd99aeb | 138 | switch(screen_flag){ // Display only changes visible on current screen |
formulas | 0:38c3afd99aeb | 139 | case(1): |
formulas | 0:38c3afd99aeb | 140 | MainUpdate(); |
formulas | 0:38c3afd99aeb | 141 | break; |
formulas | 0:38c3afd99aeb | 142 | case(2): |
formulas | 0:38c3afd99aeb | 143 | FirstAuxUpdate(); |
formulas | 0:38c3afd99aeb | 144 | break; |
formulas | 0:38c3afd99aeb | 145 | case(3): |
formulas | 0:38c3afd99aeb | 146 | SecondAuxUpdate(); |
formulas | 0:38c3afd99aeb | 147 | break; |
formulas | 0:38c3afd99aeb | 148 | }; |
formulas | 0:38c3afd99aeb | 149 | }; |
nemanja1994 | 3:a06e417a5a2c | 150 | |
formulas | 0:38c3afd99aeb | 151 | }; |