This code prevent from the robot to reach an acceleration which will cause him to fall, by first off all calculate the max acceleration he can reach , and decrease it's if the acceleration is to high.
it's also calculate the mass center compare to the roll axis to secure that the robot doesn't fall
This code prevent from the robot to reach an acceleration which will cause him to fall, by first off all calculate the max acceleration he can reach , and decrease it's if the acceleration is to high. it's also calculate the mass center compare to the roll axis to secure that the robot doesn't fall