Code for working with the Mechatrons robots