mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-04 13:55:40 +08:00
fix some more test progs, etc. for new systime
This commit is contained in:
@@ -47,7 +47,7 @@ int main(void) {
|
|||||||
main_init();
|
main_init();
|
||||||
|
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task();
|
main_event_task();
|
||||||
}
|
}
|
||||||
@@ -57,7 +57,7 @@ int main(void) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
booz2_analog_init();
|
booz2_analog_init();
|
||||||
baro_init();
|
baro_init();
|
||||||
mcu_int_enable();
|
mcu_int_enable();
|
||||||
|
|||||||
@@ -33,6 +33,8 @@
|
|||||||
#include "mcu_periph/sys_time.h"
|
#include "mcu_periph/sys_time.h"
|
||||||
#include "mcu_periph/uart.h"
|
#include "mcu_periph/uart.h"
|
||||||
|
|
||||||
|
#include "led.h"
|
||||||
|
|
||||||
#include "subsystems/datalink/downlink.h"
|
#include "subsystems/datalink/downlink.h"
|
||||||
|
|
||||||
#include "subsystems/sensors/baro.h"
|
#include "subsystems/sensors/baro.h"
|
||||||
@@ -50,7 +52,7 @@ int main(void) {
|
|||||||
main_init();
|
main_init();
|
||||||
|
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task();
|
main_event_task();
|
||||||
}
|
}
|
||||||
@@ -60,7 +62,7 @@ int main(void) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
baro_init();
|
baro_init();
|
||||||
|
|
||||||
// DEBUG_SERVO1_INIT();
|
// DEBUG_SERVO1_INIT();
|
||||||
|
|||||||
@@ -51,7 +51,7 @@ static inline void main_event_task( void );
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task();
|
main_event_task();
|
||||||
}
|
}
|
||||||
@@ -60,7 +60,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
mcu_int_enable();
|
mcu_int_enable();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -45,7 +45,7 @@ static inline void on_imu_event(void);
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task();
|
main_event_task();
|
||||||
}
|
}
|
||||||
@@ -54,7 +54,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
|
|
||||||
/* LED_ON(4); */
|
/* LED_ON(4); */
|
||||||
|
|||||||
@@ -39,7 +39,7 @@ static void on_gps_sol(void);
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task();
|
main_event_task();
|
||||||
}
|
}
|
||||||
@@ -48,7 +48,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
gps_init();
|
gps_init();
|
||||||
mcu_int_enable();
|
mcu_int_enable();
|
||||||
|
|||||||
@@ -48,7 +48,7 @@ static void SSP_ISR(void) __attribute__((naked));
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task();
|
main_event_task();
|
||||||
}
|
}
|
||||||
@@ -57,7 +57,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
|
|
||||||
main_init_ssp();
|
main_init_ssp();
|
||||||
max1168_init();
|
max1168_init();
|
||||||
|
|||||||
@@ -50,7 +50,7 @@ static void SSP_ISR(void) __attribute__((naked));
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task();
|
main_event_task();
|
||||||
}
|
}
|
||||||
@@ -59,7 +59,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
|
|
||||||
uart1_init_tx();
|
uart1_init_tx();
|
||||||
|
|||||||
@@ -43,7 +43,7 @@ static inline void main_event_task( void );
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task();
|
main_event_task();
|
||||||
}
|
}
|
||||||
@@ -52,7 +52,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
|
|
||||||
VCOM_init();
|
VCOM_init();
|
||||||
|
|||||||
@@ -142,7 +142,7 @@ static void on_gpspos_cmd( struct CscGPSPosMsg *msg )
|
|||||||
static void csc_main_init( void ) {
|
static void csc_main_init( void ) {
|
||||||
|
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
|
|
||||||
Uart0Init();
|
Uart0Init();
|
||||||
@@ -213,7 +213,7 @@ static void csc_main_event( void )
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
csc_main_init();
|
csc_main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
csc_main_periodic();
|
csc_main_periodic();
|
||||||
csc_main_event();
|
csc_main_event();
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -67,7 +67,7 @@ struct NedCoor_i booz_ins_gps_speed_cm_s_ned;
|
|||||||
static void csc_main_init( void ) {
|
static void csc_main_init( void ) {
|
||||||
|
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
|
|
||||||
#ifdef USE_UART0
|
#ifdef USE_UART0
|
||||||
@@ -219,7 +219,7 @@ static inline void on_motor_cmd(struct CscMotorMsg *msg)
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
csc_main_init();
|
csc_main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
csc_main_periodic();
|
csc_main_periodic();
|
||||||
csc_main_event();
|
csc_main_event();
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -81,7 +81,7 @@ static uint32_t can_msg_count = 0;
|
|||||||
static void csc_main_init( void ) {
|
static void csc_main_init( void ) {
|
||||||
|
|
||||||
hw_init();
|
hw_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
|
|
||||||
actuators_init();
|
actuators_init();
|
||||||
@@ -252,7 +252,7 @@ int main( void ) {
|
|||||||
csc_main_init();
|
csc_main_init();
|
||||||
// Uart0PrintString("Hello");
|
// Uart0PrintString("Hello");
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic()) {
|
if (sys_time_check_and_ack_timer(0)) {
|
||||||
csc_main_periodic();
|
csc_main_periodic();
|
||||||
}
|
}
|
||||||
csc_main_event();
|
csc_main_event();
|
||||||
|
|||||||
@@ -74,7 +74,7 @@ static inline void csc_main_event( void );
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
csc_main_init();
|
csc_main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
csc_main_periodic();
|
csc_main_periodic();
|
||||||
csc_main_event();
|
csc_main_event();
|
||||||
}
|
}
|
||||||
@@ -106,7 +106,7 @@ static void on_rc_cmd(struct CscRCMsg *msg)
|
|||||||
static inline void csc_main_init( void ) {
|
static inline void csc_main_init( void ) {
|
||||||
|
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
|
|
||||||
Uart0Init();
|
Uart0Init();
|
||||||
|
|||||||
@@ -53,7 +53,7 @@ static uint16_t cpu_time = 0;
|
|||||||
static void csc_main_init( void ) {
|
static void csc_main_init( void ) {
|
||||||
|
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
|
|
||||||
Uart0Init();
|
Uart0Init();
|
||||||
@@ -123,7 +123,7 @@ static void csc_main_event( void )
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
csc_main_init();
|
csc_main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
csc_main_periodic();
|
csc_main_periodic();
|
||||||
csc_main_event();
|
csc_main_event();
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -17,7 +17,7 @@ static inline void main_on_bench_sensors( void );
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
}
|
}
|
||||||
return 0;
|
return 0;
|
||||||
@@ -25,7 +25,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
mcu_int_enable();
|
mcu_int_enable();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -64,7 +64,7 @@ int main(void) {
|
|||||||
servos[3] = 4;
|
servos[3] = 4;
|
||||||
|
|
||||||
while (1) {
|
while (1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic();
|
main_periodic();
|
||||||
main_event();
|
main_event();
|
||||||
}
|
}
|
||||||
@@ -74,7 +74,7 @@ int main(void) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
main_init_adc();
|
main_init_adc();
|
||||||
bench_sensors_init();
|
bench_sensors_init();
|
||||||
mcu_int_enable();
|
mcu_int_enable();
|
||||||
|
|||||||
@@ -54,7 +54,7 @@ int main(void) {
|
|||||||
main_init();
|
main_init();
|
||||||
|
|
||||||
while (1) {
|
while (1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic();
|
main_periodic();
|
||||||
main_event();
|
main_event();
|
||||||
}
|
}
|
||||||
@@ -63,7 +63,7 @@ int main(void) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
actuators_init();
|
actuators_init();
|
||||||
//radio_control_init();
|
//radio_control_init();
|
||||||
imu_init();
|
imu_init();
|
||||||
|
|||||||
@@ -48,7 +48,7 @@ void dl_parse_msg( void ) {
|
|||||||
|
|
||||||
void init_fbw( void ) {
|
void init_fbw( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
|
|
||||||
PprzUartInit();
|
PprzUartInit();
|
||||||
|
|||||||
@@ -30,7 +30,7 @@ uint16_t datalink_time;
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task( );
|
main_event_task( );
|
||||||
}
|
}
|
||||||
@@ -39,7 +39,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
uart0_init();
|
uart0_init();
|
||||||
|
|
||||||
|
|||||||
@@ -29,7 +29,7 @@ uint16_t datalink_time;
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task( );
|
main_event_task( );
|
||||||
}
|
}
|
||||||
@@ -38,7 +38,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
uart0_init();
|
uart0_init();
|
||||||
|
|
||||||
|
|||||||
@@ -42,7 +42,7 @@ static void SPI0_ISR(void) __attribute__((naked));
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task();
|
main_event_task();
|
||||||
}
|
}
|
||||||
@@ -51,7 +51,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
main_spi_init();
|
main_spi_init();
|
||||||
mcu_int_enable();
|
mcu_int_enable();
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -26,7 +26,7 @@ uint16_t datalink_time;
|
|||||||
int main( void ) {
|
int main( void ) {
|
||||||
main_init();
|
main_init();
|
||||||
while(1) {
|
while(1) {
|
||||||
if (sys_time_periodic())
|
if (sys_time_check_and_ack_timer(0))
|
||||||
main_periodic_task();
|
main_periodic_task();
|
||||||
main_event_task( );
|
main_event_task( );
|
||||||
}
|
}
|
||||||
@@ -35,7 +35,7 @@ int main( void ) {
|
|||||||
|
|
||||||
static inline void main_init( void ) {
|
static inline void main_init( void ) {
|
||||||
mcu_init();
|
mcu_init();
|
||||||
sys_time_init();
|
sys_time_register_timer((1./PERIODIC_FREQUENCY), NULL);
|
||||||
led_init();
|
led_init();
|
||||||
Uart0Init();
|
Uart0Init();
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user