mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-05-30 11:37:06 +08:00
temporary fix for ins_chimu module:
- use ahrs_update_gps instead of ins_periodic_task in ins_chimu All the ins modules need to be cleaned up properly.
This commit is contained in:
@@ -4,9 +4,9 @@
|
||||
<!-- <depend conflict="ins" -->
|
||||
<header>
|
||||
<file name="ins_module.h"/>
|
||||
<file name="ins_chimu.h"/>
|
||||
</header>
|
||||
<init fun="ins_init()"/>
|
||||
<periodic fun="ins_periodic_task()" freq="8"/>
|
||||
<event fun="parse_ins_msg()"/>
|
||||
<makefile>
|
||||
<define name="AHRS_TYPE_H" value="\\\"modules/ins/ins_module.h\\\""/>
|
||||
|
||||
@@ -10,6 +10,7 @@ For older CHIMU v1.0 you should define CHIMU_BIG_ENDIAN
|
||||
<!-- <depend conflict="ins" -->
|
||||
<header>
|
||||
<file name="ins_module.h"/>
|
||||
<file name="ins_chimu.h"/>
|
||||
</header>
|
||||
<init fun="ins_init()"/>
|
||||
<!--<periodic fun="ins_periodic_task()" freq="60"/>-->
|
||||
|
||||
@@ -95,18 +95,16 @@ void parse_ins_msg( void )
|
||||
}
|
||||
|
||||
|
||||
//Frequency defined in conf *.xml
|
||||
void ins_periodic_task( void )
|
||||
void ahrs_update_gps( void )
|
||||
{
|
||||
// Send SW Centripetal Corrections
|
||||
uint8_t centripedal[19] = {0xae, 0xae, 0x0d, 0xaa, 0x0b, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc2 };
|
||||
|
||||
float gps_speed = 0;
|
||||
|
||||
if (gps.fix == GPS_FIX_3D)
|
||||
{
|
||||
gps_speed = gps.speed_3d/100.;
|
||||
}
|
||||
if (gps.fix == GPS_FIX_3D) {
|
||||
gps_speed = gps.speed_3d/100.;
|
||||
}
|
||||
gps_speed = FloatSwap(gps_speed);
|
||||
|
||||
memmove (¢ripedal[6], &gps_speed, 4);
|
||||
@@ -118,3 +116,9 @@ void ins_periodic_task( void )
|
||||
|
||||
// Downlink Send
|
||||
}
|
||||
|
||||
//Frequency defined in conf *.xml
|
||||
void ins_periodic_task( void )
|
||||
{
|
||||
}
|
||||
|
||||
|
||||
@@ -97,3 +97,8 @@ void ins_periodic_task( void )
|
||||
{
|
||||
// Downlink Send
|
||||
}
|
||||
|
||||
void ahrs_update_gps( void )
|
||||
{
|
||||
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user