#include <stdio.h>
|
|
#include "types.h"
|
|
#include "io.h"
|
|
|
|
#define FMTREAL "%5.15f"
|
|
#define BASE_FREQUENCY 200.0
|
|
|
|
extern REAL_TYPE h_c;
|
|
|
|
void ROSACE_update_altitude_command(REAL_TYPE h_cons){
|
|
h_c = h_cons;
|
|
}
|
|
|
|
void ROSACE_write_outputs(output_t* v){
|
|
static int first=1;
|
|
if (first) {
|
|
printf("# %15s, %15s, %15s, %15s, %15s, %15s, %15s, %15s\n",
|
|
"T","Va","az","q","Vz","h","delta_th_c","delta_e_c");
|
|
first = 0;
|
|
}
|
|
//printf("%3.4f, ", (v->t_simu)/BASE_FREQUENCY); // The time is already in ms here
|
|
printf("%3.4f, ", (v->t_simu)/1000.0);
|
|
printf(FMTREAL", ", v->sig_outputs.Va);
|
|
printf(FMTREAL", ", v->sig_outputs.az);
|
|
printf(FMTREAL", ", v->sig_outputs.q);
|
|
printf(FMTREAL", ", v->sig_outputs.Vz);
|
|
printf(FMTREAL", ", v->sig_outputs.h);
|
|
printf(FMTREAL", ", v->sig_delta_th_c);
|
|
printf(FMTREAL"\n", v->sig_delta_e_c);
|
|
}
|