from numpy.linalg import pinv,norm
from pinocchio import neutral
from pinocchio.explog import exp,log
from display import Display
import eigenpy
from ball import Ball
import eigenpy
import numpy as np
import time

# Create a 7DOF robot.
robot = Ball()