{"id":10533,"date":"2023-11-20T09:38:59","date_gmt":"2023-11-20T14:38:59","guid":{"rendered":"https:\/\/blogs.mathworks.com\/student-lounge\/?p=10533"},"modified":"2023-11-20T15:47:54","modified_gmt":"2023-11-20T20:47:54","slug":"an-autonomous-quadruped-manipulator-for-pick-and-place-applications","status":"publish","type":"post","link":"https:\/\/blogs.mathworks.com\/student-lounge\/2023\/11\/20\/an-autonomous-quadruped-manipulator-for-pick-and-place-applications\/","title":{"rendered":"An Autonomous Quadruped Manipulator for Pick and Place Applications"},"content":{"rendered":"
\n
<\/div>\n

For today’s post Roberto Valenti, who leads the MathWorks Challenge Project program will talk about a senior design class project at University of Sheffield. Over to you, Roberto…<\/em><\/p>\n

<\/div>\n<\/div>\n
<\/div>\n
\n
<\/div>\n
At the University of Sheffield’s campus, a team of eight motivated students enthusiastically embraced a real-world project as part of their senior design class. Motivated by their shared interest in robotics and a desire for gaining practical experience, they tackled an ambitious challenge project that would not only push the boundaries of their technical skills but also prepare them for promising careers in the field of autonomous robotics. The project is from the MATLAB and Simulink Challenge Project Hub<\/span><\/a>, a platform that aims to bring together academia and industry to encourage innovation and bridge the gap between academic education and real-world applications.<\/div>\n
\"team0.jpg\"<\/div>\n
Figure 1:<\/span> The Team. From left to right: Serena Cicin-Sain, Olivia Organ, Will Foster, Joseph Moore, and Sherif Sawwaf. Not present in the picture: Harry Armstrong, Oluwaseun Adewola,and Josh Orme-Herbert<\/span><\/div>\n<\/div>\n
<\/div>\n
<\/div>\n
\n
\n<\/div>\n
“This project has proven to be immensely valuable as it allowed us to comprehensively navigate an entire project lifecycle, engaging in all facets, including research, design, integration, and project management, all while adhering to a Systems Engineering approach. The endeavor presented significant challenges, necessitating the group to proactively demonstrate initiative through extensive research and innovative problem-solving. <\/span>A team member capitalized on this experience to demonstrate their skills to potential employers, securing a job in an engineering role<\/span>. The project, marked by its challenges, has also been enjoyable and rewarding, particularly given the positive feedback we have received. Our group takes considerable pride in our collective accomplishments, recognizing that it was our unwavering determination and seamless teamwork that made it all possible. We extend our sincere gratitude to our supervisor, Payam Soulatiantork, and Roberto Valenti from MathWorks, both of whose invaluable knowledge and guidance were indispensable to the project’s success”.<\/span><\/div>\n
\n
\n<\/div>\n
<\/div>\n
Take a look at the students’ submission GitHub repository<\/a> \"open-in-matlab-online.gif\"<\/a>.<\/div>\n

Introduction<\/h2>\n
The selected challenge project required the team to design, model, and simulate an autonomous quadruped robot equipped with a robotic manipulator to perform sophisticated pick and place tasks. To effectively accomplish this challenge the team organized itself into four sub-teams, each working on one of the four subsystems: quadruped, manipulator, navigation, and perception. Work done on each subsystem by a specific team was integrated into a single autonomous robotic system in which a high-level state machine commands each task of the robot while keeping track of the system state. During the project development phase, efforts were coordinated and supervised to ensure timely completion while prioritizing tasks and member responsibilities to meet the predefined requirements. Risk assessments were also factored in to mitigate potential challenges.<\/div>\n

Quadruped modeling and simulation<\/h2>\n
The quadruped sub-team designed a robot replicating animal gaits, focusing on a diagonal advanced placement akin to dogs and horses. Their design featured four legs with three links and joints, ensuring coordinated movement within a one-cubic-meter volume. This design allowed efficient locomotion and balance, including a stable stationary gait. The team’s inspiration from animal locomotion principles enabled effective movement of the robot and led to successful implementation. The team began with a<\/div>\n
Simscape\u2122 Multibody\u2122<\/span><\/a> model of a quadruped limited to forward motion in the horizontal plane. Their goals included: adding a shoulder joint for omnidirectional movement, designing control systems for joint actuation, and creating a walking plan with tailored gait phases for complex turning maneuvers.<\/div>\n
The team explored different motion control strategies, including the Inverse Kinematic strategy and the Raibert strategy. The Raibert strategy uses a dynamic quadruped motion control model that splits the robot’s control into velocity, body rotation, and hopping height components, resulting in a dynamic trotting gait model. This approach was adopted due to its simplicity and functionality and implemented using a high-level Stateflow<\/span>\u00ae<\/span><\/a> controller that integrates various walking and turning states of the quadruped into the final system.<\/div>\n
Once the quadruped successfully achieved turning movements while maintaining stability, the team implemented a high-level Stateflow task planner for enhanced navigation. This task planner determines the quadruped’s movement mode (stationary, walking straight, turning left, or turning right) based on the relative angle and distance to the target coordinates, enabling effective navigation and obstacle avoidance. A demonstration of the quadruped locomotion including a visual of the walking controller and the high-level task planner is shown in Figure 2.<\/div>\n
The successful implementation of a stable walking and turning control algorithm, was a critical achievement for the quadruped project and served as a foundation for integrating the other subsystems.<\/div>\n
\"quadrupedLocomotion.gif\"<\/div>\n
Figure 2<\/span>:<\/span> Quadruped walking gait demonstration. (Top) High-Level Stateflow diagram for motion mode transition and execution, (Bottom Left) Stateflow walk cycle for the Raibert strategy mode, <\/span>(Bottom Right) Quadruped 3D visualization. <\/span><\/div>\n

Manipulation<\/h2>\n
The manipulator sub-team adopted a Kinova Gen3 robotic manipulator for this project. The manipulator model was scaled using CAD software to meet the project requirements and the URDF files were then loaded into MATLAB<\/span>\u00ae<\/span><\/a> for creating a Simscape model with bodies and revolute joints. A closed-loop control system with PI control was implemented for each joint to ensure smooth and precise movement.<\/div>\n
\"manipulatorModel.png\"<\/div>\n
Figure 3<\/span>: The end effector. (Left) Simscape<\/span> model, (Right) full manipulator with attached the end effector.<\/span><\/div>\n
<\/div>\n
To enable object interaction, an end effector with three fingers was attached to the manipulator. The end effector has two revolute joints per finger, as shown in Figure 2, allowing it to mimic human fingers and securely grasp objects. Inverse kinematics calculations were performed using a rigid body tree and forward kinematics models. A forward kinematics model was generated to determine the position and rotation of the end effector based on the joint angles. An inverse kinematics solver utilizing the Broyden-Fletcher-Goldfarb-Shanno (BFGS) Gradient Projection algorithm was implemented to find the joint angles required to reach a given transform.<\/div>\n
A high-level controller facilitates object picking within the defined environment. The manipulator subsystem (Figure 4) includes a state variable for communication between the quadruped and manipulator. This variable determines when the quadruped is positioned next to the object or the desired end position.<\/div>\n
The manipulator task planner manages the order of operations and ensures that the manipulator reaches the correct position before proceeding. It coordinates the movements of the manipulator joints and monitors the states of all subsystems.<\/div>\n
\"fullManipulatorModel.png\"<\/div>\n
Figure 4:<\/span> The full manipulation subsystem model.<\/span><\/div>\n
<\/div>\n
With the manipulator subsystem implemented, the manipulator is able to pick up objects within the environment. The end effector, equipped with three fingers, curls around an object to secure it in place. Contact forces between the floor, object, and manipulator were simulated for realistic interactions. A complete pick and place task of the manipulator subsystem is shown in Figure 5. The manipulator subsystem was integrated with the quadruped, allowing communication between them.<\/div>\n
\"Manipulator.gif\"<\/div>\n
Figure 5<\/span>: A ball picking demonstration.<\/span><\/div>\n

Navigation<\/h2>\n
The navigation sub-team adopted the RRT* algorithm for path planning, enabling the quadruped to navigate through user-defined environments. The RRT* algorithm optimized paths for efficiency, combining two planned paths, namely start to pick-up and pick-up to drop-off, into one array as shown Figure 6.<\/div>\n
\"GUIandPath.png\"<\/div>\n
Figure 6<\/span>: (left): Functional GUI with start, pick up and place locations, and obstacle blocks, (middle): occupancy grid path from start to object pick-up position, (right): occupancy grid path from pick-up to end place.<\/span><\/div>\n
<\/div>\n
The environment model was constructed in Simulink\u00ae<\/a> based on a Graphical User Interface (GUI) input. The GUI allows intuitive placement of start and end points, obstacles, and pick-up locations, forming a visual representation of the environment. Rigid transform blocks position the quadruped, ball, and podium accurately based on this environment model. Figure 7 demonstrates the user’s interaction with the GUI, illustrating the creation of an environment map and object placement, followed by automatic generation of the 3D scenario and a navigation path.<\/div>\n
Controller optimizations included replacing PID controllers with 1-D lookup tables for manipulator joints, ensuring smoother manipulative actions, and implementing a feedback-based braking system to fix the ball securely to the manipulator’s palm. The high-level control logic was managed by the task planner implemented in Stateflow, which orchestrates tasks such as path following, ball pick-up, placement, and simulation termination.<\/div>\n
\"GUIInteraction.gif\"<\/div>\n
Figure 7<\/span>: A demonstration of a user interaction with the GUI: Creating an environment map, placing objects, and triggering automatic generation of a 3D scenario and navigation path.<\/span><\/div>\n
<\/div>\n

Integration<\/h2>\n
In the final stages of the project, the team achieved seamless integration of various subsystems to create a functioning autonomous robotic system. The Simulink model illustrating this integration is presented in Figure 8. The GUI played a pivotal role in generating intricate maps and setting waypoints. The Path Planning subsystem, coupled with a Target Selector, enables the quadruped to navigate precisely, ensuring it follows the designated path accurately.<\/div>\n
The Path Follower Stateflow module makes real-time decisions based on inputs from the Target Selector and the Angle and Distance Finder. It orchestrates intricate movements, including turns, halts, and forward strides, ensuring the quadruped’s adherence to the predefined route.<\/div>\n
At the core of this integration, the Task Controller Stateflow oversees the entire process. It monitors the position index, ensuring the quadruped reaches each waypoint as planned. Additionally, it manages the initiation of complex tasks like picking up and dropping off the ball, synchronizing these actions seamlessly within the overall movement plan.<\/div>\n
The Quadruped Movement Controller plays a crucial role in executing precise joint movements. These movements are meticulously calculated to maintain balance and stability, ensuring the quadruped’s movements are both accurate and secure.<\/div>\n
The strategic placement of the manipulator at the quadruped’s enables a balance between stability and functionality, allowing the manipulator to perform tasks efficiently without compromising the quadruped’s stability during locomotion.<\/div>\n
This detailed integration process highlights the team’s technical expertise, showcasing their learnings in system integration that turns subsystem elements into a unified and operational robotic system. Figure 9 shows a simulation of the final integrated model of the full system in action.<\/div>\n
\"fullModel.png\"<\/div>\n
Figure 8<\/span>: The full system Simulink model<\/span><\/div>\n
<\/div>\n
<\/div>\n
\"FullTask.gif\"<\/div>\n
Figure 9<\/span>: The full system in action.<\/span><\/div>\n
<\/div>\n

Conclusion<\/h2>\n
Working on this Challenge Problem provided the team with an opportunity to learn several real-world skills. They learned how to break down a large complex robotics problem into smaller subsystems, design and implement those subsystems, and integrate them into an overall functioning system. Throughout this approach, modeling and simulation enabled them to design their functionality in such a way that met the high-level requirements.<\/div>\n
<\/div>\n
<\/div>\n