|
|
@@ -77,10 +77,17 @@ Walk \ |
|
|
|
|
|
|
|
Repeat 4 |
|
|
|
If legDirections.cnt.p_insId = LEG_DIRECTION_FRONT { |
|
|
|
legArgs.cnt.p_insId -= Deg2Rad (1) |
|
|
|
legArgs.cnt.p_insId += Deg2Rad (1) |
|
|
|
} |
|
|
|
Else { |
|
|
|
legArgs.cnt.p_insId += Deg2Rad (1) |
|
|
|
legArgs.cnt.p_insId -= Deg2Rad (1) |
|
|
|
} |
|
|
|
|
|
|
|
If legArgs.cnt.p_insId > Deg2Rad (15) { |
|
|
|
legDirections.cnt.p_insId = LEG_DIRECTION_HIND |
|
|
|
} |
|
|
|
Else: If legArgs.cnt.p_insId < Deg2Rad (-15) { |
|
|
|
legDirections.cnt.p_insId = LEG_DIRECTION_FRONT |
|
|
|
} |
|
|
|
Loop |
|
|
|
|
|
|
|