Once the robot was prepared, our next step was to program it. Numerous discussions took place regarding how to implement the robot's control system. We debated which buttons to assign for movement, how to raise and lower the manipulator, and the possibility of incorporating additional functions to enhance the robot's capabilities.
Initially, we decided to control the robot using buttons L1, L2, R1, and R2. However, as we delved deeper into the programming phase, we realized that this control scheme was not as user-friendly and intuitive as we had hoped. As a result, we made a crucial decision to switch the robot's control mechanism to joysticks, which ultimately proved to be a wise choice. The joysticks offered a more seamless and natural control experience, enabling precise and effortless manipulation of the robot's movements.
With the control scheme resolved, we shifted our focus to programming the manipulator. Since many buttons were already allocated for other functions, we opted to utilize the UP and DOWN buttons for controlling the manipulator's lifting mechanism. This decision allowed us to streamline the control interface and maximize the available resources.
After extensive programming efforts and fine-tuning, our hard work paid off. The robot was successfully programmed to execute movement commands and effectively lift objects. This achievement marked a significant milestone in our project, as we witnessed the culmination of our efforts come to fruition.
You can download code below