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