Skip to content

duken72/ControlSystemForTwoRobotArms

Repository files navigation

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).

About

My Final Graduation Bachelor Thesis

Topics

Resources

License

Stars

Watchers

Forks

Releases

No releases published

Packages

No packages published