Remove unneeded commented code

Author: rdaruwala

embedded/app/main/badgerloop_HV.cpp

@@ -45,8 +45,10 @@ int init() {
     initHVIox(true);
 
     SetupMotor();
+
     /*    initMotor();   */
-/*    initPressureSensors();*/
+    /*    initPressureSensors();*/
+
     /* Allocate needed memory for state machine and create graph */
 	buildStateMachine();
 
@@ -58,6 +60,7 @@ int init() {
 	struct sigaction sig;
     sig.sa_sigaction = emergQuitter;
     sigaction(SIGINT, &sig, NULL);
+
     /* Start 'black box' data saving */
     SetupDataDump();
 
@@ -106,7 +109,7 @@ int main() {
         } else {
             i += 1;
         }
-//	fprintf(stderr, "%d,%d,%d\n", data->rms->actualTorque, data->rms->motorSpeed, getuSTimestamp());
+	    // fprintf(stderr, "%d,%d,%d\n", data->rms->actualTorque, data->rms->motorSpeed, getuSTimestamp());
         usleep(10000);
 
 		// Control loop

embedded/app/main/badgerloop_LV.cpp

@@ -13,7 +13,7 @@ extern "C"
     #include "nav.h"
     #include "braking.h"
     extern void csvFormatShow();    
-#include "connStat.h"
+    #include "connStat.h"
     #include "proc_iox.h"
 	#include "imu.h"
     #include <data.h>

embedded/app/src/states.c

@@ -34,7 +34,7 @@
         pow(35181.0     * (x), 3) - \
         pow(303240.0    * (x), 2) - (1000000.0 * (x)))
 
-#define MAX_RETRO 1
+#define MAX_RETRO 3
 #define MAX_PACKET_LOSS 500
 /* Imports/Externs */
 extern int internalCount;
@@ -149,7 +149,7 @@ stateTransition_t * propulsionAction() {
         rErrs += 1;
     } rErrs = 0;
 
-    if (getuSTimestamp() - data->timers->startTime > 7000000/*MAX_RUN_TIME*/){
+    if (getuSTimestamp() - data->timers->startTime > 3000000/*MAX_RUN_TIME*/){
         fprintf(stderr, "Prop timeout\n");
         return stateMachine.currState->next;
     }

embedded/data/include/data.h

@@ -142,7 +142,6 @@ typedef struct motion_t {
  *
  */
 typedef struct bms_t {
-  //  float packCurrent;
     int64_t packCurrent;
     float packVoltage;
     int imdStatus;

embedded/peripherals/src/bms.c

@@ -41,10 +41,6 @@ int bmsParseMsg(uint32_t id, uint8_t *msg) {
 	switch(id) {
 		case 0x6B0:		
             bms->packCurrent = (msg[1] | msg[0] << 8)/10;
-		//printf("0x6B0 Pack Current 1\ 0: %f\n", bms->packCurrent);
-		//int64_t tryTwo = (((int16_t) msg[1]) |((int16_t) msg[0]) << 8)/10;
-		//printf("0x6B0 Pack Current hepl: %lld\n", tryTwo);
-
 			bms->packVoltage = (msg[3] | msg[2] << 8)/10;
 			bms->Soc = msg[4]/2;
 			bms->relayStatus = msg[6] | msg[5] << 8;
@@ -121,19 +117,6 @@ int bmsParseMsg(uint32_t id, uint8_t *msg) {
 #endif
             break;
 		case 0x150:
-		//	printf("");
-		//	float twoTrye = (msg[0] | (msg[1] << 8))/10;
-		//	printf("0x150 Pack Current 0/1: %f\n", twoTrye);
-
-		//	float twoTry2 = (msg[1] | (msg[0] << 8))/10;
-                       // printf("0x150 Pack Current 1/ 0: %f\n", twoTry2); 
-
-
-/*			bms->avgTemp = msg[0];*/
-		//	bms->packCurrent /= 10;
-/*            bms->cellMinVoltage = ((msg[3] << 8) | msg[4]) / 10000.0;*/
-/*			bms->packVoltage = msg[2] | (msg[3] << 8);*/
-/*			bms->packVoltage /= 10;*/
 			bms->packAh = msg[4] | (msg[5] << 8);
 			bms->highTemp = msg[6];
 			bms->lowTemp = msg[7];

middleware/src/LVTelemetry_Loop.cpp

@@ -80,10 +80,6 @@ void *LVTelemetryLoop(void *arg)
 			Value pos;
 			//pos.SetFloat(getPosX());
             pos.SetFloat(0);
-		
-            
-           // printf("%f %f %f\n", getAccelX(), getAccelY(), getAccelZ());
-
 
 			// RETRO
 			Value retro;