updated all Mrcore with new functions in Robotsim and fixed errors

Class Quaternion added, fixed errors, refactor in Robotsim, added new functions in Robotsim