Added calculateRobitToIMU to mockrobot.