diff --git a/quad/sw/modular_quad_pid/src/initialize_components.c b/quad/sw/modular_quad_pid/src/initialize_components.c index e00a27b8cb45265863b68d4b2e2e8879a88651bc..913141be7603664f135818894db8e4589e593adf 100644 --- a/quad/sw/modular_quad_pid/src/initialize_components.c +++ b/quad/sw/modular_quad_pid/src/initialize_components.c @@ -8,7 +8,7 @@ #include "initialize_components.h" #include "communication.h" -#define BENCH_TEST +//#define BENCH_TEST extern int Xil_AssertWait; @@ -34,6 +34,7 @@ int protection_loops(modular_structs_t *structs) while (!structs->user_input_struct.receivedBeginUpdate) { send_data(MessageTypes[4].ID, MessageTypes[4].subtypes[1].ID, 0, buf, length); + process_received(structs); usleep(10000); } diff --git a/quad/sw/modular_quad_pid/src/util.h b/quad/sw/modular_quad_pid/src/util.h index d14ae4da41a1c3481e1f5bf93ad3dac5f9762687..285db6085f1804ebca654ec969958adf3abd9955 100644 --- a/quad/sw/modular_quad_pid/src/util.h +++ b/quad/sw/modular_quad_pid/src/util.h @@ -23,8 +23,8 @@ #define clock_rate 100000000 #define frequency 450 #define period_width clock_rate/frequency -#define pulse_throttle_low clock_rate / 1000 -#define pulse_throttle_high clock_rate / 500 +#define pulse_throttle_low clock_rate / 1000 // 1ms +#define pulse_throttle_high clock_rate / 500 // 2ms #define MOTOR_0_PERCENT 115000