#!/usr/bin/env python
"""Load the e.Do robot.
"""

from itertools import count
from pyrobolearn.simulators import BulletSim
from pyrobolearn.worlds import BasicWorld
from pyrobolearn.robots import Edo

# Create simulator
sim = BulletSim()

# create world
world = BasicWorld(sim)

# create robot
robot = Edo(sim)

# print information about the robot
robot.print_info()
# H = robot.get_mass_matrix()
# print("Inertia matrix: H(q) = {}".format(H))

for i in count():
    # step in simulation
    world.step(sleep_dt=1./240)