Unit IV Robot Kinematics AND Robot Programming: Prepared by
Unit IV Robot Kinematics AND Robot Programming: Prepared by
ROBOT KINEMATICS
AND
ROBOT PROGRAMMING
Prepared by
B.Balasubramanian
AP/MECH
CCET
Syllabus
Forward Kinematics, Inverse Kinematics and Difference;
Forward Kinematics and Reverse Kinematics of
manipulators with Two, Three Degrees of Freedom (in 2
Dimension), Four Degrees of freedom (in 3 Dimension)
Jacobians, Velocity and Forces-Manipulator Dynamics,
Trajectory Generator, Manipulator Mechanism Design-
Derivations and problems. Lead through Programming,
Robot programming Languages-VAL Programming-
Motion Commands, Sensor Commands, End Effector
commands and simple Programs.
Methods of Robot programming (Industrial
Practice)
• Lead through method or Teach-by-showing:
It require the programmer to move the manipulator
through the desired motion path and that the path
be committed to memory by the robot controller.
• Textual robot language:
It is accomplished somewhat like computer
programming. The programmer types in the
program on a CRT monitor using a high-level english
like language
Levels of Robot programming languages
• SET
• HERE
Program control, interlock commands and
input/output controls
• SETI sets the value of an integer variable to the result of an
expression
• TYPEI displays the name and value of an integer variable
• PROMPT
• GOTO performs an unconditional branch to the program step
identified by a given level
• GOSUB and RETURN are necessary to transfer control to a
subroutine and back to the calling program respectively
• IF…THEN ELSE END transfers control to a program step
depending on a relationship being true or false
• PAUSE terminates the execution of a user program
Cont..
• PROCEED resumed from the point
• SIGNAL turns the signals ON or OFF at the specified output
channels
• IFSIG and WAIT test the states of one or more external signals
• RESET turns OFF all external output signals
• REACT indicates that the reactions
• REACTI interrupts robot motion immediately
• IOPUT and IOGET are the commands that are used either to
send or receive output respectively to a digital I/O module
• ADC and DAC
Simple VAL program
Program DEMO. A
1. APPRO PART, 50
2. MOVES PART
3. CLOSEI
4. DEPARTS 150
5. APPROS BOX, 200
6. MOVE BOX
7. OPENI
8. DEPART 75
END
Meaning of the program
The name of the program is DEMO. A
1. Move to a location, 50mm above the location PART (PART is a
location to be defined)
2. Move along a straight line to PART
3. Qose the gripper jaws to grip the object immediately
4. Withdraw 150mm from PART along a straight line path
5. Approach along a straight line to a location 200mm above the
location, BOX (BOX is to be defined later)
6. Move to BOX
7. Open the hand (and drop the object)
8. Withdraw 75mm from Box
• Step 1, 6 & 7 are examples of joint-
interpolated motions
• Steps 2, 4, & 5 are examples of straight line
motion
• Step 3 & 7 contain hand control instruction
• However, an optional level may be given, such
as “10 APPRO PART, 50”
• Go back to the same instruction
ROBOT KINEMATICS
• It is assumed that a robot can be regarded as a chain of
rigid links connected by revolute or prismatic joints at
which actuators, regarded as torque or force generators.
• The control of flexible structures is in its infancy and will
not be discussed.
• With this assumption, there is a set of important problems
in analysis and control, and most of the literature on
robot control addresses one or other of these.
• Some have accepted solutions; others are the subject of
research.
ROBOT KINEMATICS
They are as follows:
1) formulating the kinematic equations (joint coordinates to world
coordinates) ;
2) solving the kinematic equations (world coordinates to joint
coordinates);
3) the forward problem of dynamics - finding the motions resulting
from joint torques;
4) the inverse problem of dynamics - finding the torques needed to
produce a given motion;
5) specifying a trajectory between target points on the path;
6) actuator servo control - for a single actuator, how to drive it so as to
produce a specified position, velocity or torque.