Skip to content

Latest commit

 

History

History
72 lines (56 loc) · 3.25 KB

README.md

File metadata and controls

72 lines (56 loc) · 3.25 KB

Control System for Two Robot Arms

My Final Graduation Bachelor Thesis

NEWS


How to run on Matlab

1. Clone the repository

2. Open and run initDuckWPT.m

  • Addpath
  • Add Error Tolerance for End-Effector Position and Angle
  • Add desired trajectory position
  • Import robot .urdf
  • Settings for desired grabbing pose.

3. Open and run startup_Contact_Forces.m

  • Initlize the Contact_Forces library

4. Open and run FINAL.slx simulation


Introduction

1. Design and Creation of 3D Models

Robot parts are designed and assembled with SOLIDWORKS

SolidWorks

Simple ED7220C robot arm

ED7220C

Then, moving to more complex robot arms to have more flexibility, so that the robot arms can actually able to cooperate with each others. The NTU iCeiRA robot models are mirrored. The single arm is for simulation of tracking trajectory, then the duo-arms model is for control design and simulation of cooperation.

NTU iCeiRA

NTU iCeiRA Duo

The final model is then imported into Simscape, MATLAB, and could be visualize with Mechanic Explorers.

3D models

2. Design Hierarchical Control Structure

The Control Structure with 3 level: Control Structure

1. Supervisory Controller

Based on Discrete Event System, the state flow is designed for each stage of grabbing and moving State Flow

2. Inverse Kinematics

3. PD Controller with Fuzzy Control

PD Controller


Comment

  • The simulation was insanely slow due to the complexity of the contact force interaction, unlike the trajectory tracking simulation.
  • At the time of research, I was unfamiliar enough with Multibody Dynamics in general, and specific for the Dynamics Formulation for robotic systems this complicate. Thus, I was solely focusing on using inverse kinematics.
  • In addition, I did not have the oppotunity to work with real models, parameters were estimated, not accurately measured.

License

See the LICENSE file for license rights and limitations (MIT).