Update main.c add sim sensors

main.c

@@ -356,7 +356,9 @@ int main(int argc, char * argv[]) {
     if (axis[X] == 0)
       axis[X] = rnd_float(-0.2, 0.2);
     axis[Y] = rnd_float(-0.2, 0.2);
-    axis[Z] = (rnd_float(-0.2, 0.2) > 0) ? 1.0 : -1.0;
+	float axis_z;
+	axis_z  = sqrt(1 - axis[X] * axis[X] - axis[Y] * axis[Y]);  
+    axis[Z] = (rnd_float(-0.2, 0.2) > 0) ? axis_z : -1.0 * axis_z;
 
     angle[X] = (float) atan(axis[Y] / axis[Z]);
     angle[Y] = (float) atan(axis[Z] / axis[X]);
@@ -375,6 +377,50 @@ int main(int argc, char * argv[]) {
     batt = rnd_float(3.8, 4.1);
     speed = rnd_float(1.0, 2.5);
     eclipse = (rnd_float(-1, +4) > 0) ? 1.0 : 0.0;
+	atmosphere = (rnd_float(-1, +4) > 0) ? 0.0 : 1.0;
+
+	if (atmosphere == 0) {
+		sensor[PRES] = 0;
+		strcpy(sensor_string[PRES], "0.0");
+		sensor[ALT] = 109343;
+		strcpy(sensor_string[ALT], "109343");
+		sensor[HUMI] = 0;
+		strcpy(sensor_string[HUMI], "0.0");
+		sensor[TEMP] = 0;	
+		strcpy(sensor_string[TEMP], "0.0");
+	} else {
+		sensor[PRES] = 1015;
+		strcpy(sensor_string[PRES], "1015");
+		sensor[ALT] = 175;
+		strcpy(sensor_string[ALT], "175");
+		sensor[HUMI] = 48;
+		strcpy(sensor_string[HUMI], "48");
+		sensor[TEMP] = 27;
+		strcpy(sensor_string[TEMP], "27.0");
+	}
+   char sensor_number[20];	  
+   sensor[ACCEL_X] = AXIS[X];
+   sprintf(sensor_number, "%7.2f", AXIS[X]);	  
+   strcpy(sensor_string[ACCEL_X], sensor_number);	  
+   sensor[ACCEL_Y] = AXIS[Y];
+   sprintf(sensor_number, "%7.2f", AXIS[Y]);	  
+   strcpy(sensor_string[ACCEL_Y], sensor_number);	  	  
+   sensor[ACCEL_Z] = AXIS[Z];
+   sprintf(sensor_number, "%7.2f", AXIS[Z]);	  
+   strcpy(sensor_string[ACCEL_Z], sensor_number);	  
+	  
+   float spin;
+   spin = rnd_float(-30.0, 30.0);	  
+   sensor[GYRO_X] = AXIS[X] * spin;
+   sprintf(sensor_number, "%7.2f", sensor[GYRO_X]);	  
+   strcpy(sensor_string[ACCEL_X], sensor_number);	  	  
+   sensor[GYRO_Y] = AXIS[Y] * spin;
+   sprintf(sensor_number, "%7.2f", sensor[GYRO_Y]);	  
+   strcpy(sensor_string[ACCEL_Y], sensor_number);		  
+   sensor[GYRO_Z] = AXIS[Z] * spin;
+   sprintf(sensor_number, "%7.2f", sensor[GYRO_Z]);	  
+   strcpy(sensor_string[ACCEL_Z], sensor_number);		  
+	  
 //    eclipse = 1;	  
     period = rnd_float(150, 300);
     tempS = rnd_float(20, 55);
@@ -685,6 +731,7 @@ int main(int argc, char * argv[]) {
 			printf("Simulated Payload Failure.\n");
 		}
 
+	    if (!sim_mode) {
         if ((sensor_payload[0] == 'O') && (sensor_payload[1] == 'K')) // only process if valid payload response
         {
 //		  printf("Valid Payload!\n");  	
@@ -706,6 +753,7 @@ int main(int argc, char * argv[]) {
             }
           }
 	  
+
           printf("\n");
 //	  if (sensor[GPS1] != 0) {     		
 	  if ((sensor[GPS1] > -90.0) && (sensor[GPS1] < 90.0) && (sensor[GPS1] != 0.0))  { 
@@ -724,8 +772,9 @@ int main(int argc, char * argv[]) {
 		}
 	  }
     }
-	else
-		; //payload = OFF;  // turn off since STEM Payload is not responding
+  	} 
+//	else
+//		; //payload = OFF;  // turn off since STEM Payload is not responding
       
       if ((millis() - newGpsTime) > 60000) {
 		longitude += rnd_float(-0.05, 0.05) / 100.0;  // was .05
@@ -763,7 +812,7 @@ int main(int argc, char * argv[]) {
 		    printf("Simulated MPU Failure!\n");
 	  }
 
-		if ((failureMode == FAIL_BME) || (failureMode == FAIL_MPU)) // recreaate sensor_payload string	
+		if ((failureMode == FAIL_BME) || (failureMode == FAIL_MPU) || sim_mode) // recreaate sensor_payload string	
 		{  
 		  sensor_payload[0] = 0;
           for (count1 = 0; count1 < SENSOR_FIELDS; count1++) {