LAB 2_instruction

pdf

School

Drexel University *

*We aren’t endorsed by this school

Course

455

Subject

Mechanical Engineering

Date

Dec 6, 2023

Type

pdf

Pages

5

Uploaded by Ostree

Report
LAB 2 _ Trajectory Planning of 3R manipulator Professor: Euisun Kim Spring 2022 Lab Objectives 1. Understand Forward Kinematics and Inverse Kinematics 2. Familiarize yourself with MATLAB Simscape Multibody 3. Create Forward and Inverse Kinematics using MATLAB Simscape 3R manipulator model %%This lab requires completed code from LAB1%% Part A: Create Inverse Kinematic Function Open IK.m matlab function file. You will complete this function IK.m so that this function calculates inverse kinematic solutions for 3R manipulator. This function takes end effector position & orientation ( ࠵? ! , ࠵? ! , ࠵? ! ) and manipulator link lengths ( ࠵? " , ࠵? # , ࠵? $ ) as inputs and results in joint angles ࠵? = [࠵? " , ࠵? # , ࠵? $ ] as outputs. Copy & paste a portion of your LAB01_planar3Rrobot_inversekinematics.m into IK.m so that this function calculates joint angles ( ࠵? = [࠵? " , ࠵? # , ࠵? $ ] ) from given information ( ࠵? ! , ࠵? ! , ࠵? ! , ࠵? " , ࠵? # , ࠵? $ ). % Make sure you are using the same variable names for input and output as written in the matlab code ( xe,ye,phie, L1, L2, L3, q ) % For simplicity, choose elbow minus solution.
Part B: Create Function that Plots Manipulator’s Trajectory Open plotManipulator.m matlab function file. You will complete this function so that this plots the Manipulator’s Trajectory with given joint angles. This function takes joint angles ( ࠵? = [࠵? " , ࠵? # , ࠵? $ ] ) and manipulator link lengths ( ࠵? " , ࠵? # , ࠵? $ ) as inputs and plots the manipulator’s trajectory. Copy & paste a portion of your LAB01_planar3Rrobot_inversekinematics.m into plotManipulator.m so that this function plots the 3R manipulator configuration given information ( ࠵?, ࠵? " , ࠵? # , ࠵? $ ). Part C: End Effector Trajectory Planning - Arc Now you will make the 3R manipulator’s end effector follow a 90 degree arc with the center of the circle (࠵? % , ࠵? % ) = (0.1, 0.2) and the radius ࠵? = 0.25 . - Open ‘LAB02_ArcTrajectory.m’ - Fill out the blank portion of the code to complete the code. - If your code runs successfully, following two figures below will be appeared. Left one is manipulator configuration trajectory and the right one is joint angles changes during the simulation time(0-2s)
Part D: Simscape Model Modification and Simulation -Open ‘Lab02_planar3Rrobot.slx’ file. This file is the same one as the ‘Lab01_plana3Rrobot.slx’, just a different name. - Now we will replace inputs to three joint angles with ‘from workspace’ block by searching it from the Library Browser. - Search ‘from workspace’ and click and drag the block to ‘LAB02_planar3Rrobot’. Connect each to joint angles and rename them to ‘theta1dsim’, ‘theta2dsim’ and ‘theta3dsim’.
Your preview ends here
Eager to read complete document? Join bartleby learn and gain access to the full version
  • Access to all documents
  • Unlimited textbook solutions
  • 24/7 expert homework help
- The result would be look like this below. Now this Simscape model refers to joint angles from the ‘theta1dsim’, ‘theta2dsim’ and ‘theta3dsim’ in the workspace for simulation. - Run ‘LAB02_ArcTrajectory’ first and make sure ‘theta1dsim’, ‘theta2dsim’ and ‘theta3dsim’ are in the workspace. Then run ‘LAB02_planar3Rrobot.slx’ - Use the tools highlighted in red box to adjust your simulation model so that you can clearly observe the motion of the end effector and also the whole manipulator. - Check if the end effector follows the arc as we planned. If it follows the arc, click the ‘record’ button on the far right and save the simulation video.
Part E. Create another trajectory that makes the end effector follow straight line that you determine. - Repeat Part C & Part D with this new trajectory Submission 1) IK.m matlab function from Part A 2) plotmanipulator.m matlab function from Part B 3) Two plots (manipulator trajectory, joint angles) from Part C 4) LAB02_ArcTrajectory.m matlab script from Part C 5) LAB02_planar3Rrobot.slx from Part D 6) Simulation video from Part D 7) Simulation video from Part E