Добавил:
Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:
(EOD).Mechatronics.pdf
Скачиваний:
82
Добавлен:
23.08.2013
Размер:
5.07 Mб
Скачать

page 752

θ ,ω α,

CG, M, J

• If multiple joints move at the same time, the model becomes non-linear, in this case there are two approaches taken,

1.Develop a full non-linear controller (can be very complicated).

2.Develop linear approximations of the model/control system in the middle of the normal workspace.

41.4 PATH PLANNING

• Basic - “While moving the robot arm from point A to B, or along a continuous path, the choices are infinite, with significant differences between methods used.”

41.4.1 Slew Motion

The simplest form of motion. As the robot moves from point A to point B, each axis of the manipulator travels as quickly as possible from its initial position to its final position. All axis begin moving at the same time, but each axis ends it motion in a length of time that is proportional to the product of its distance moved and its top speed (allowing for acceleration and deceleration)

Note: slew motion usually results in unnecessary wear on the joints and often leads to unanticipated results in the path taken by the manipulator.

Example - A three axis manipulator with revolute joints starts with joint angles (40, 80, - 40)degrees, and must move to (120, 0, 0)degrees. Assume that the joints have maximum absolute accelerations/decelerations of (50, 100, 150) degrees/sec/sec, and the maximum velocities of (20, 40, 50) degrees/sec. Using slew motion, what is the travel time for each joint?

page 753

Joint angle (degrees)

180

90

 

 

 

 

 

 

 

 

 

 

time(sec)

θ

3

θ

2

 

 

-90

 

θ

1

 

 

 

Joint velocity (degrees/sec)

ω

max

 

α

max

 

tacc

tmax

tdec

 

The area under the velocity curve is the distance (angle in this case) travelled. First we can determine the distance covered during acceleration, and deceleration and the time during acceleration, and deceleration.

tacc = tdec =

ω

max

20

40

50

= ( 0.4, 0.4, 0.333) sec.

----------- =

-----, --------, --------

 

α

max

50

100

150

 

θ

acc.

= θ

dec. =

taccω

max.vel.

 

0.4( 20) 0.4( 40)

0.333( 50)

= ( 4, 8, 8.33) deg.

--------------------------- =

 

------------------, ------------------,

------------------------

 

 

 

 

 

2

2

2

2

 

 

The next step is to examine the moves specified,

 

 

 

θ

move

= θ

end θ

start

= ( 120 – 40, 0 – 80, 0 – ( –40) ) = ( 80, –80, 40) deg.

Remove the angles covered during accel./deccel., and find the travel time at maximum velocity.

 

 

 

θ move

– 2θ acc

 

80 – 2( 4)

80 – 2( 8)

40 – 2( 8.333)

 

 

 

tmax

=

 

---------------------------------- =

 

----------------------, ----------------------, ---------------------------------

 

 

 

ω max

20

40

50

 

tmax

=

( 3.6, 1.6, 0.46668) sec.

 

Note: below zero the speeds will

 

never reach maximum velocity

 

 

 

 

 

 

 

 

ttotal

=

tacc + tmax + tdec

=

( 4.4, 2.4, 1.13) s

before starting to decelerate.

page 754

41.4.1.1 - Joint Interpolated Motion

Similar to slew motion, except all joints start, and stop at the same time. In the last example for slew motion, all of the joints would have moved until all stopping simultaneously at 4.4 seconds.

This method only demands needed speeds to accomplish movements in least times.

41.4.1.2 - Straight-line motion

In this method the tool of the robot travels in a straight line between the start and stop points. This can be difficult, and lead to rather erratic motions when the boundaries of the workspace are approached.

NOTE: straight-line paths are the only paths that will try to move the tool straight through space, all others will move the tool in a curved path.

The basic method is,

1.Develop a set of points from the start and stop points that minimize acceleration.

2.Do the inverse kinematics to find the joint angles of the robot at the specified points.

Consider the example below,

Соседние файлы в предмете Электротехника