Mechatronics Robot Code