MAE 435 Chris Cook Jeffry Walker Joshua Beverly Miguel de Rojas

Types of Manipulators  Cartesian  Gantry  Cylindrical  Spherical  SCARA  Anthropomorphic – Make of 59% in use worldwide as of 2005 IFR report

Types of Manipulators

Welding Manipulator

Surgical Manipulator

5 Degrees of Freedom

Gripper End-Effector

Project Goals  5cm x 5cm x 5cm cube  Placed within 6 in radial position  Repeated TBD number of times

Servo Motor vs. DC Motor

Preliminary Calculations JointMass=.939; %mass of joint (kg) ShaftMass=.113; %mass of shaft (kg) ShaftLength=.2032; %length of shaft (m) MotorOutput=.4862; %N-m output torque peak effective GearRation=132; %ratio of planetary gearbox LoadLifted=.34; %minimum mass to be picked up (kg) g=9.81; %gravity %effective forces jf=JointMass*g; sf=ShaftMass*g; lf=LoadLifted*g; L=ShaftLength; %Joint Torques J1torque=lf*3*L+jf*L*(3+2+1)+sf*L*( ); J2torque=lf*2*L+jf*L*(2+1)+sf*L*(1.5+.5); J3torque=lf*L+jf*L+sf*L*.5; Torque (N-m) Joint Joint Joint

Selected Motor

Cost Considerations

Midterm Status Update  Machining and assembly complete unless modifications become necessary  Inventor solid model complete unless modifications become necessary  Wiring is complete pending testing  Computer code for the microcontroller is in development  Dynamics/Kinematics in development

Machining

Assembly

Assembly Complete

Solid Model

Forward Kinematics Denavit-Hartenberg Parameters 3 fixed-link parameters α i and a i : describe the Link i d i and θ i : describe the Link’s connection

Forward Kinematics iα i-1 a i-1 didi θiθi 100d1d1 θ1θ1 2900d2d2 θ2θ2 30a2a2 d3d3 θ a3a3 d4d4 θ4θ a4a4 d5d5 θ5θ5

Inverse Kinematics  Goal: determine all the joint variables for a specific end-effector position and orientation  Feed this information to the controls

Inverse Kinematics  Determine the inverse kinematics starting from this equation

Wiring/Soldering

Motor Drivers

Closed-Loop Feedback Control  PID Controller  (Proportional Integral Derivative)

Control Signal Filter

Motor Driver

Motor and Gearbox

Gantt Chart

5-DOF Manipulator  5-DOF Manipulator in Action 5-DOF Manipulator in Action  2:08

References  1.Siciliano, B., et al., Robotics Modeling, Planning and Control. Advanced Textbooks in Control and Signal Processing2009: Springer.  2.Lee, C.S.G., Robot Arm Kinematics, Dynamics, and Control. Computer, (12): p  3. MathWorks MATLAB  4. Autodesk Inventor  5. Microsoft Office Suite