bench test fixs

Author: lwaghorn

OnLand/ControlLaptop/LocalStorage/ConfigStorage.json

@@ -1 +1 @@
-{"retrieval_timeout": 60000, "pod_address": "127.0.0.1", "telemetry_port": 7000, "controlLaptopIpAddr": "192.168.0.6", "command_port": 6000, "heartbeat_timeout": 5000, "pod_driver": "Simulation"}
+{"command_port": 6000, "retrieval_timeout": 60000, "pod_address": "127.0.0.1", "pod_driver": "Simulation", "controlLaptopIpAddr": "192.168.0.6", "telemetry_port": 7000, "heartbeat_timeout": 5000}

OnPod/FlightComputer/src/Communication/CanManager.cpp

@@ -183,7 +183,7 @@ void processFrame(const struct can_frame &frame, TelemetryManager &pod) {
             auto cellId = extractCanValue<int32_t >(frame.data, indices, 1 );
 
             if(cellId > 96){
-                cellId-=11;
+                cellId-=12;
             }
             indices = {1,2};
             auto voltage = extractCanValue<float>(frame.data, indices, 10000);

OnPod/FlightComputer/src/Constants/SensorConfig.h

@@ -84,7 +84,7 @@ namespace LV_LIMITS
     static int32_t PRESSURE_TEMP_MAX = 60; //C
 
     static int32_t COOLING_TEMP_MIN = 10;
-    static int32_t COOLING_TEMP_MAX = 30;
+    static int32_t COOLING_TEMP_MAX = 40;
 };
 
 #endif //FLIGHTCOMPUTER_SENSORCONFIG_H

OnPod/FlightComputer/src/States.cpp

@@ -386,7 +386,7 @@ bool PreFlight::testTransitions() {
         this->setupTransition(psBraking, "Emergency Stop. Pod --> Braking");
         return true;
     }
-    if(this->timeInStateSeconds() < 2 ){ //Allow nodes
+    if(this->timeInStateSeconds() < 3 ){ //Allow nodes
         return false;
     }
     try {
@@ -419,7 +419,7 @@ Acceleration::Acceleration(TelemetryManager * pod) : PodState(pod) {
 }
 
 Acceleration::~Acceleration() {
-
+    this->pod->telemetry->motorTorque = 0;
 }
 
 bool Acceleration::testTransitions() {

OnPod/FlightComputer/src/TelemetryManager.cpp

@@ -267,7 +267,7 @@ void TelemetryManager::setHighPressure(float value){
 
     if(currentState == psStandby){
         status = inRange<float>(value, GENERAL_CONSTANTS::VACUUM, PNEUMATICS_LIMITS::HIGHPRESSURE_ARMED_MAX);
-    } else if(currentState == psArming || currentState == psArmed || currentState == psAcceleration || currentState == psCoasting){
+    } else if(currentState == psArming || currentState == psArmed || currentState == psAcceleration || currentState == psCoasting || currentState == psPreFlight){
         status = inRange<float>(value, PNEUMATICS_LIMITS::HIGHPRESSURE_ARMED_MIN, PNEUMATICS_LIMITS::HIGHPRESSURE_ARMED_MAX);
     }else if( currentState == psBraking ){
         status = inRange<float>(value, GENERAL_CONSTANTS::VACUUM, PNEUMATICS_LIMITS::HIGHPRESSURE_ARMED_MAX); //TODO confirm this

OnPod/FlightComputer/src/Threads/NavigationThread.cpp

@@ -90,7 +90,7 @@ void readNavigationNode(int serialPort, TelemetryManager &pod){
     std::stringstream().swap(dataStream);
     if(stripCount == "aa"){  //strip count    velocity   pressure
         pod.countIrTape();
-        LOG(INFO)<<"strip : "<< stripCount << " velocity : "<< velocity << "  pressure : " << tubePressure;
+        //LOG(INFO)<<"strip : "<< stripCount << " velocity : "<< velocity << "  pressure : " << tubePressure;
     }
     pod.telemetry->tubePressure = tubePressure;
     pod.telemetry->stripVelocity = velocity;