beautypg.com

Figure 6-9: pt auto-increment mode flowchart – ElmoMC SimplIQ Digital Servo Drives-Bell Command Reference User Manual

Page 263

background image

The PDO does not specify the QP vector elements to be programmed; instead, a write
pointer specifies them. The parameter MP[6] sets the value of the write pointer, which
may be set once for the entire motion. The write pointer is incremented automatically by
2 each time the drive receives a new PT motion-programming message. The CANopen
auto-increment mode is described in the following flowchart:

Motion

segment

completed

?

N >= MP[2]-1

Increment

read pointer

Read the read pointer to the

QP vector and calculate the

parameters of the next motion

segment

Initial

conditions:

PT read

pointer equals

N

Interpolate

position

command

Go to

position

controller

Exit PT mode:

Set Stop motion,

using the SD

deceleration

Set the read

pointer to

MP[1]

Yes

No

No

EMERGENCY:

QUEUE

UNDERFLOW

MP[4]>0 and

(Write pointer ==

N+1 or

left time < MP[4])

EMERGENCY:

QUEUE LOW

Yes

No

Read pointer ==

Write pointer

Yes

Yes

Figure 6-9: PT Auto-increment Mode Flowchart

This flow differs from the basic mode because:

The read pointer reaching the write pointer identifies motion queue underflow.
Emergency objects are issued for the queue low and queue underflow events.

d. Programming Sequence for Auto-increment PVT Mode

SimplIQ for Steppers Application Note

The Position Reference Generator

MAN-STECR (Ver. 1.1)

64