|
|
@ -93,6 +93,10 @@ static void init_arm_motors() |
|
|
|
if(home_is_set) |
|
|
|
if(home_is_set) |
|
|
|
init_home(); |
|
|
|
init_home(); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// all I terms are invalid |
|
|
|
|
|
|
|
// ----------------------- |
|
|
|
|
|
|
|
reset_I_all(); |
|
|
|
|
|
|
|
|
|
|
|
if(did_ground_start == false){ |
|
|
|
if(did_ground_start == false){ |
|
|
|
did_ground_start = true; |
|
|
|
did_ground_start = true; |
|
|
|
startup_ground(); |
|
|
|
startup_ground(); |
|
|
|