Update main.c fix axis

sim-fail-6
Alan Johnston 4 months ago committed by GitHub
parent 0f041314d3
commit a65d574884
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194

@ -399,25 +399,25 @@ int main(int argc, char * argv[]) {
strcpy(sensor_string[TEMP], "27.0"); strcpy(sensor_string[TEMP], "27.0");
} }
char sensor_number[20]; char sensor_number[20];
sensor[ACCEL_X] = AXIS[X]; sensor[ACCEL_X] = axis[X];
sprintf(sensor_number, "%7.2f", AXIS[X]); sprintf(sensor_number, "%7.2f", axis[X]);
strcpy(sensor_string[ACCEL_X], sensor_number); strcpy(sensor_string[ACCEL_X], sensor_number);
sensor[ACCEL_Y] = AXIS[Y]; sensor[ACCEL_Y] = axis[Y];
sprintf(sensor_number, "%7.2f", AXIS[Y]); sprintf(sensor_number, "%7.2f", axis[Y]);
strcpy(sensor_string[ACCEL_Y], sensor_number); strcpy(sensor_string[ACCEL_Y], sensor_number);
sensor[ACCEL_Z] = AXIS[Z]; sensor[ACCEL_Z] = axis[Z];
sprintf(sensor_number, "%7.2f", AXIS[Z]); sprintf(sensor_number, "%7.2f", axis[Z]);
strcpy(sensor_string[ACCEL_Z], sensor_number); strcpy(sensor_string[ACCEL_Z], sensor_number);
float spin; float spin;
spin = rnd_float(-30.0, 30.0); spin = rnd_float(-30.0, 30.0);
sensor[GYRO_X] = AXIS[X] * spin; sensor[GYRO_X] = axis[X] * spin;
sprintf(sensor_number, "%7.2f", sensor[GYRO_X]); sprintf(sensor_number, "%7.2f", sensor[GYRO_X]);
strcpy(sensor_string[ACCEL_X], sensor_number); strcpy(sensor_string[ACCEL_X], sensor_number);
sensor[GYRO_Y] = AXIS[Y] * spin; sensor[GYRO_Y] = axis[Y] * spin;
sprintf(sensor_number, "%7.2f", sensor[GYRO_Y]); sprintf(sensor_number, "%7.2f", sensor[GYRO_Y]);
strcpy(sensor_string[ACCEL_Y], sensor_number); strcpy(sensor_string[ACCEL_Y], sensor_number);
sensor[GYRO_Z] = AXIS[Z] * spin; sensor[GYRO_Z] = axis[Z] * spin;
sprintf(sensor_number, "%7.2f", sensor[GYRO_Z]); sprintf(sensor_number, "%7.2f", sensor[GYRO_Z]);
strcpy(sensor_string[ACCEL_Z], sensor_number); strcpy(sensor_string[ACCEL_Z], sensor_number);

Loading…
Cancel
Save

Powered by TurnKey Linux.