mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-05-09 14:18:00 +08:00
file logger independent of firmware
Removing ugly fix from openuas
This commit is contained in:
@@ -22,7 +22,6 @@
|
||||
|
||||
/** @file modules/loggers/file_logger.c
|
||||
* @brief File logger for Linux based autopilots
|
||||
* This module purpose is for debugging airframest
|
||||
*/
|
||||
|
||||
#include "file_logger.h"
|
||||
@@ -31,17 +30,7 @@
|
||||
#include "std.h"
|
||||
|
||||
#include "subsystems/imu.h"
|
||||
|
||||
/* Ugly fix until Fixedwing and rotorcraft are uniofied in a nice way
|
||||
* COMMAND_THRUST only and always defined in ROTORCRAFT
|
||||
* A gliding Rotorcraft is an ecxeption ;) */
|
||||
#ifdef COMMAND_THRUST
|
||||
#include "firmwares/rotorcraft/stabilization.h"
|
||||
#else
|
||||
/* adaptive also an option */
|
||||
#include "firmwares/fixedwing/stabilization/stabilization_attitude.h"
|
||||
#endif
|
||||
|
||||
#include "state.h"
|
||||
|
||||
/** Set the default File logger path to the USB drive */
|
||||
@@ -72,12 +61,7 @@ void file_logger_start(void)
|
||||
if (file_logger != NULL) {
|
||||
fprintf(
|
||||
file_logger,
|
||||
/* Add and removed values here as wished to log */
|
||||
#ifdef COMMAND_THRUST
|
||||
"counter,gyro_unscaled_p,gyro_unscaled_q,gyro_unscaled_r,accel_unscaled_x,accel_unscaled_y,accel_unscaled_z,mag_unscaled_x,mag_unscaled_y,mag_unscaled_z,COMMAND_THRUST,COMMAND_ROLL,COMMAND_PITCH,COMMAND_YAW,qi,qx,qy,qz\n"
|
||||
#else
|
||||
"counter,gyro_unscaled_p,gyro_unscaled_q,gyro_unscaled_r,accel_unscaled_x,accel_unscaled_y,accel_unscaled_z,mag_unscaled_x,mag_unscaled_y,mag_unscaled_z,qi,qx,qy,qz\n"
|
||||
#endif
|
||||
);
|
||||
}
|
||||
}
|
||||
@@ -91,7 +75,7 @@ void file_logger_stop(void)
|
||||
}
|
||||
}
|
||||
|
||||
/** Log the values to a CSV file */
|
||||
/** Log the values to a csv file */
|
||||
void file_logger_periodic(void)
|
||||
{
|
||||
if (file_logger == NULL) {
|
||||
@@ -100,9 +84,7 @@ void file_logger_periodic(void)
|
||||
static uint32_t counter;
|
||||
struct Int32Quat *quat = stateGetNedToBodyQuat_i();
|
||||
|
||||
/* Add and removed values here as wished to log */
|
||||
#ifdef COMMAND_THRUST
|
||||
fprintf(file_logger, "%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d\n",
|
||||
fprintf(file_logger, "%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d\n",
|
||||
counter,
|
||||
imu.gyro_unscaled.p,
|
||||
imu.gyro_unscaled.q,
|
||||
@@ -122,36 +104,5 @@ void file_logger_periodic(void)
|
||||
quat->qy,
|
||||
quat->qz
|
||||
);
|
||||
#else
|
||||
fprintf(file_logger, "%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d\n",
|
||||
counter,
|
||||
imu.gyro_unscaled.p,
|
||||
imu.gyro_unscaled.q,
|
||||
imu.gyro_unscaled.r,
|
||||
imu.accel_unscaled.x,
|
||||
imu.accel_unscaled.y,
|
||||
imu.accel_unscaled.z,
|
||||
imu.mag_unscaled.x,
|
||||
imu.mag_unscaled.y,
|
||||
imu.mag_unscaled.z,
|
||||
/* imu.gyro_scaled.p,
|
||||
imu.gyro_scaled.q,
|
||||
imu.gyro_scaled.r,
|
||||
imu.accel_scaled.x,
|
||||
imu.accel_scaled.y,
|
||||
imu.accel_scaled.z,
|
||||
imu.mag_scaled.x,
|
||||
imu.mag_scaled.y,
|
||||
imu.mag_scaled.z, */
|
||||
//stabilization_cmd[COMMAND_THROTTLE],
|
||||
//stabilization_cmd[COMMAND_ROLL],
|
||||
//stabilization_cmd[COMMAND_PITCH],
|
||||
////stabilization_cmd[COMMAND_PITCH], //for time being...
|
||||
quat->qi,
|
||||
quat->qx,
|
||||
quat->qy,
|
||||
quat->qz
|
||||
);
|
||||
#endif
|
||||
counter++;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user