Blockly

Servo Commands Samples

150 degrees represents the relative zero position of the servo

right_shoulder_flexion  ( + grade ) move up
right_shoulder_flexion  ( - grade ) move down
left_shoulder_flexion  ( + grade ) move up
left_shoulder_flexion  ( - grade ) move down 

servo connection diagram

Blockly

Python

# all servo zero 0 right_shoulder_flexion(0)  left_shoulder_flexion(0)  right_shoulder_rotation(0)  left_shoulder_rotation(0)  right_elbow(0)
left_elbow(0)

# arms up
Servozero()
right_shoulder_flexion(40)
left_shoulder_flexion(40)


# arms down
Servozero()
right_shoulder_flexion(-40)
left_shoulder_flexion(-40


# arms front
Servozero()
right_shoulder_rotation(80)   
left_shoulder_rotation(80)  


# arms rear
Servozero()
right_shoulder_rotation(-80)  
left_shoulder_rotation(-80)