engine-software/simulation/controllers/olympian/olympian.py
Aditya Vasantharao 0409e5a3b7 Add shoulder joint
2021-01-29 23:07:56 -05:00

31 lines
765 B
Python

"""olympian controller."""
# You may need to import some classes of the controller module. Ex:
# from controller import Robot, Motor, DistanceSensor
from controller import Robot
def main():
# create the Robot instance.
print("Initializing world...")
robot = Robot()
head_motor = robot.getDevice("shoulder_pitch")
head_motor.setVelocity(0.5)
pos = 0
# get the time step of the current world.
timestep = int(robot.getBasicTimeStep())
# Main loop:
# - perform simulation steps until Webots is stopping the controller
while robot.step(timestep) != -1:
head_motor.setPosition(pos)
pos += 3.141
# Enter here exit cleanup code.
if __name__ == '__main__':
main()