|
Algorithm 1 Attitude control strategy for slope traversing. |
-
1:
Input: threshold , and the max wheel-soil contact force along the axis.
-
2:
Output: servo rotation angle and
-
3:
Initialization:
-
4:
acquire the slope angle
-
5:
if then
-
6:
choose operation state “Mode I”
-
7:
else
-
8:
choose operation state “Mode II”
-
9:
end if
-
10:
calculate the based on Algorithm 2
-
11:
adjust the servos of the sliding-part
-
12:
if then
-
13:
to optimize wheel-slope contact pose
-
14:
else
-
15:
to optimize wheel-slope contact force
-
16:
end if
-
17:
adjust the servos of the rolling-part
-
18:
return current and
|