Penn Electric Racing
/
REVO_Updated_Steering
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: CANBuffer KS0108_fork mbed-rtos mbed CAN Addresses
Fork of
REVO_Updated_Steering
by 
Penn Electric
Diff: SteeringTemp.h
- Revision:
- 0:313541d8f8be
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/SteeringTemp.h Sat Sep 27 18:43:15 2014 +0000
@@ -0,0 +1,309 @@
+#include "Steering.h"
+
+void HomeScreen()
+{
+ CANMessage Rxmsg;
+ ftc rcv,send;
+
+ send.FLOAT=45.4444;
+ Rxmsg.id=BATTERY_VOLTAGE_ID;
+ for(int i=0; i<4; i++)
+ Rxmsg.data[i]=send.C_FLOAT[i];
+ display.ClearScreen();
+ display.SelectFont(Arial12,BLACK,ReadData);
+ if(CAN_Steering.read(Rxmsg))
+ {
+ for(int i=0; i<4; i++)
+ rcv.C_FLOAT[i]=Rxmsg.data[i];
+ if(Rxmsg.id == BATTERY_VOLTAGE_ID)
+ {
+ display.GotoXY(0,0);
+ display.PrintString(" PV: ");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("V");
+ }
+ if(Rxmsg.id == BATTERY_POWER_ID)
+ {
+ display.GotoXY(0,16);
+ display.PrintString(" PP: ");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("KW");
+ }
+ if(Rxmsg.id == BATTERY_STATE_ID)
+ {
+ display.GotoXY(0,32);
+ display.PrintString(" STATE: ");
+ display.PrintString(rcv.C_FLOAT);
+ }
+ }
+ wait(2);
+ return;
+}
+
+/*
+void ShutdwnScreen()
+{
+ screen=1;
+ CANMessage Rxmsg;
+ uint16_t recv=0, temp=0, i=0;
+ //Test
+
+ //uint16_t Rxpoll=15;
+ //char Result[4]={0};
+ //Result[0]=(char)(Rxpoll&0x00ff);
+ //Result[1]=(char)((Rxpoll&0xff00)>>8);
+ //CANMessage Rxmsg(410,Result,sizeof(Result));
+
+ display.ClearScreen();
+ display.GotoXY(0,0);
+ display.SelectFont(Arial12,BLACK,ReadData);
+ display.PrintString("SHTDWN SWTCH OPEN");
+
+ if(CAN_Steering.read(Rxmsg))
+ {
+ if(Rxmsg.id == SWITCH_ID)
+ {
+ recv=(((uint16_t)Rxmsg.data[1]<<8) | (0x00ff&(uint16_t)Rxmsg.data[0]));
+ display.GotoXY(0,16);
+ while(i < 12)
+ {
+ temp=recv;
+ if(((temp & (1 << i))>>i) == 1)
+ {
+ display.GotoXY(SwitchPosition[i][0],SwitchPosition[i][1]);
+ display.PrintString(SwitchName[i]);
+ }
+ }
+ }
+ }
+ return;
+}
+
+void AMS1Screen()
+{
+ screen=2;
+ CANMessage Rxmsg;
+ ftc rcv;
+ rcv.FLOAT=0.0;
+
+ display.ClearScreen();
+ display.SelectFont(Arial12,BLACK,ReadData);
+
+ if(CAN_Steering.read(Rxmsg))
+ {
+ for(int i=0; i<4; i++)
+ rcv.C_FLOAT[i]=Rxmsg.data[i];
+ if(Rxmsg.id == BATTERY_VOLTAGE_ID)
+ {
+ display.GotoXY(0,0);
+ display.PrintString(" PV: ");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("V");
+ }
+ if(Rxmsg.id == BATTERY_POWER_ID)
+ {
+ display.GotoXY(0,16);
+ display.PrintString(" PV: ");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("KW");
+ }
+ if(Rxmsg.id == BATTERY_CURRENT_ID)
+ {
+ display.GotoXY(0,32);
+ display.PrintString(" PC: ");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("KW");
+ }
+ }
+}
+
+void AMS2Screen()
+{
+ screen=3;
+ CANMessage Rxmsg;
+ ftc rcv;
+ rcv.FLOAT=0.0;
+
+ display.ClearScreen();
+ display.SelectFont(Arial12,BLACK,ReadData);
+
+ if(CAN_Steering.read(Rxmsg))
+ {
+ for(int i=0; i<4; i++)
+ rcv.C_FLOAT[i]=Rxmsg.data[i];
+ if(Rxmsg.id == BATTERY_MIN_CELLVOLTAGE_ID)
+ {
+ display.GotoXY(0,0);
+ display.PrintString(" Min Cell V:");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("V");
+ }
+ if(Rxmsg.id == BATTERY_MAX_CELLVOLTAGE_ID)
+ {
+ display.GotoXY(0,16);
+ display.PrintString(" Max Cell V:");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("V");
+ }
+ if(Rxmsg.id == BATTERY_AVG_CELLVOLTAGE_ID)
+ {
+ display.GotoXY(0,32);
+ display.PrintString(" Max Cell V:");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("V");
+ }
+ }
+}
+
+void AMS3Screen()
+{
+ screen=4;
+ CANMessage Rxmsg;
+ ftc rcv;
+ rcv.FLOAT=0.0;
+
+ display.ClearScreen();
+ display.SelectFont(Arial12,BLACK,ReadData);
+
+ if(CAN_Steering.read(Rxmsg))
+ {
+ for(int i=0; i<4; i++)
+ rcv.C_FLOAT[i]=Rxmsg.data[i];
+ if(Rxmsg.id == BATTERY_MIN_CELLTEMPERATURE_ID)
+ {
+ display.GotoXY(0,0);
+ display.PrintString(" Min Cell T:");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("deg");
+ }
+ if(Rxmsg.id == BATTERY_MAX_CELLTEMPERATURE_ID)
+ {
+ display.GotoXY(0,16);
+ display.PrintString(" Max Cell T:");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("deg");
+ }
+ if(Rxmsg.id == BATTERY_AVG_CELLTEMPERATURE_ID)
+ {
+ display.GotoXY(0,32);
+ display.PrintString(" Avg Cell T:");
+ display.PrintNumber(rcv.FLOAT);
+ display.PrintString("deg");
+ }
+ }
+}
+
+void AMS4Screen()
+{
+ screen =5;
+ CANMessage Rxmsg;
+ ftc rcv;
+
+ display.ClearScreen();
+ display.SelectFont(Arial12,BLACK,ReadData);
+
+ if(CAN_Steering.read(Rxmsg))
+ {
+ for(int i=0; i<4; i++)
+ rcv.C_FLOAT[i]=Rxmsg.data[i];
+ if(Rxmsg.id == AMS_AIRS_ID)
+ {
+ display.GotoXY(0,0);
+ display.PrintString(" AIRS: ");
+ display.PrintString(rcv.C_FLOAT);
+ }
+ if(Rxmsg.id == AMS_PRECHARGING_ID)
+ {
+ display.GotoXY(0,16);
+ display.PrintString(" Precharging: ");
+ display.PrintString(rcv.C_FLOAT);
+ }
+ }
+}
+*/
+void ON()
+{
+ char OnData[4]="ON";
+ CANMessage Txmsg(101,OnData,sizeof(OnData));
+ wait(0.1);
+
+ display.ClearScreen();
+ display.SelectFont(Arial12,BLACK,ReadData);
+ display.GotoXY(16,16);
+ display.PrintString(" ON INITIATED");
+ //screen=0;
+ return;
+}
+
+void ResetCommand()
+{
+ char ResetData[4]="RES";
+ CANMessage Txmsg(102,ResetData,sizeof(ResetData));
+ wait(0.1);
+
+ display.ClearScreen();
+ display.SelectFont(Arial12,BLACK,ReadData);
+ display.GotoXY(16,16);
+ display.PrintString(" RESET INITIATED");
+ //screen=0;
+
+ return;
+}
+
+void Init()
+{
+ pc.baud(230400);
+ CAN_Steering.frequency(500000);
+}
+
+int main()
+{
+ Init();
+ //int flag=1;
+ wait(0.1);
+ display.GotoXY(10,16);
+ display.SelectFont(Arial_14,BLACK,ReadData);
+ display.PrintString("Penn Electric Racing");
+ display.GotoXY(20,32);
+ display.PrintString("Live The Dream");
+ screen=0;
+ wait(2);
+
+ while(1)
+ {
+ if(biSWBL.read())
+ HomeScreen();
+
+ if(biSWTR.read())
+ ON();
+
+ if(biSWTL.read())
+ ResetCommand();
+
+ printf("SCreen:%d\n\r",screen);
+ wait(0.1);
+ }
+}
+
+/*
+ else if(screen == 1)
+ ShutdwnScreen();
+ else if(screen == 2)
+ AMS1Screen();
+ else if(screen == 3)
+ AMS2Screen();
+ else if(screen == 4)
+ AMS3Screen();
+ else if(screen == 5)
+ AMS4Screen();
+ */
+ /*
+ if(biSWBR.read())
+ {
+ if(screen == maxScreen)
+ screen=0;
+ else
+ ++screen;
+ wait(1);
+ }
+ */
\ No newline at end of file