Skip to main content
. 2023 Mar 22;8(1):131. doi: 10.3390/biomimetics8010131
Algorithm 1 Attitude control strategy for slope traversing.
  •  1:

    Input: threshold max(θb), and the max wheel-soil contact force max(Fy) along the y(B) axis.

  •  2:

    Output: servo rotation angle φSij and φRij

  •  3:

    Initialization:

  •  4:

    acquire the slope angle α

  •  5:

    if αmax(θb) then

  •  6:

       choose operation state “Mode I”

  •  7:

    else

  •  8:

       choose operation state “Mode II”

  •  9:

    end if

  • 10:

    calculate the φSij based on Algorithm 2

  • 11:

    adjust the servos of the sliding-part φSij

  • 12:

    if W(i,j)sinαmax(Fy) 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 φRij

  • 18:

    return current φSij and φRij