diff --git a/conf/airframes/examples/microjet_lisa_m.xml b/conf/airframes/examples/microjet_lisa_m.xml index 971184dc8f..d1c626065b 100644 --- a/conf/airframes/examples/microjet_lisa_m.xml +++ b/conf/airframes/examples/microjet_lisa_m.xml @@ -59,6 +59,7 @@ + diff --git a/conf/flight_plans/nav_modules.xml b/conf/flight_plans/nav_modules.xml index 6cb4ceca03..0ad8e95a46 100644 --- a/conf/flight_plans/nav_modules.xml +++ b/conf/flight_plans/nav_modules.xml @@ -118,6 +118,10 @@ + + + + diff --git a/sw/airborne/modules/nav/nav_spiral.c b/sw/airborne/modules/nav/nav_spiral.c index 585c888a5c..62624fd6ca 100644 --- a/sw/airborne/modules/nav/nav_spiral.c +++ b/sw/airborne/modules/nav/nav_spiral.c @@ -79,7 +79,7 @@ bool_t nav_spiral_setup(uint8_t center_wp, uint8_t edge_wp, float radius_start, nav_spiral.fly_from.y = stateGetPositionEnu_f()->y; if(nav_spiral.dist_from_center > nav_spiral.radius) - nav_spiral.status = Outside; + nav_spiral.status = SpiralOutside; return FALSE; } @@ -96,7 +96,7 @@ bool_t nav_spiral_run(void) switch(nav_spiral.status) { - case Outside: + case SpiralOutside: //flys until center of the helix is reached an start helix nav_route_xy(nav_spiral.fly_from.x, nav_spiral.fly_from.y, nav_spiral.center.x, nav_spiral.center.y); // center reached? @@ -105,24 +105,24 @@ bool_t nav_spiral_run(void) #ifdef DIGITAL_CAM dc_send_command(DC_SHOOT); #endif - nav_spiral.status = StartCircle; + nav_spiral.status = SpiralStartCircle; } break; - case StartCircle: + case SpiralStartCircle: // Starts helix // storage of current coordinates - // calculation needed, State switch to Circle + // calculation needed, State switch to SpiralCircle nav_circle_XY(nav_spiral.center.y, nav_spiral.center.y, nav_spiral.radius_start); if(nav_spiral.dist_from_center >= nav_spiral.radius_start){ VECT2_COPY(nav_spiral.last_circle, pos_enu); - nav_spiral.status = Circle; + nav_spiral.status = SpiralCircle; // Start helix #ifdef DIGITAL_CAM dc_Circle(360/nav_spiral.segments); #endif } break; - case Circle: { + case SpiralCircle: { nav_circle_XY(nav_spiral.center.x, nav_spiral.center.y, nav_spiral.radius_start); // Trigonometrische Berechnung des bereits geflogenen Winkels alpha // equation: @@ -136,11 +136,11 @@ bool_t nav_spiral_run(void) CircleAlpha = (2.0 * asin (DistanceStartEstim / (2 * nav_spiral.radius_start))); if (CircleAlpha >= nav_spiral.alpha_limit) { VECT2_COPY(nav_spiral.last_circle, pos_enu); - nav_spiral.status = IncSpiral; + nav_spiral.status = SpiralInc; } break; } - case IncSpiral: + case SpiralInc: // increasing circle radius as long as it is smaller than max helix radius if(nav_spiral.radius_start + nav_spiral.radius_increment < nav_spiral.radius) { @@ -160,7 +160,7 @@ bool_t nav_spiral_run(void) dc_stop(); #endif } - nav_spiral.status = Circle; + nav_spiral.status = SpiralCircle; break; default: break; diff --git a/sw/airborne/modules/nav/nav_spiral.h b/sw/airborne/modules/nav/nav_spiral.h index 2f52294b47..cd8b82b90e 100644 --- a/sw/airborne/modules/nav/nav_spiral.h +++ b/sw/airborne/modules/nav/nav_spiral.h @@ -32,7 +32,7 @@ #include "std.h" #include "math/pprz_algebra_float.h" -enum SpiralStatus { Outside, StartCircle, Circle, IncSpiral }; +enum SpiralStatus { SpiralOutside, SpiralStartCircle, SpiralCircle, SpiralInc }; struct NavSpiral { struct FloatVect3 trans_current;