dynamical_model.py: motor_inversion function completed.
Motor parameters need still to be completed.