TMC 188/40 Motion Control Module
Appendix A: Maps, Tips, and Commands
Delta Computer Systems, Inc. 360/254-8688
73
Control Equations
These are the main equations that are used for target position calculations:
2000 x Distance
Ramp Time =
Speed
Speed x Speed
A =
2000 x Distance
Ramp Time in milliseconds
Speed in thousandths of an inch per second
Distance is acceleration or deceleration distance in thousandths of inches
A is acceleration or deceleration rate in inches per second per second
ACTUAL POSITION = ((COUNTS X SCALE /32768) XOR DIRECTION) + OFFSET
RAMP DIST = SPEED x SPEED /(ACCEL RATE x 2000)
DRIVE OUTPUT = Proportional Drive + Feed Forward Drive + Integral Drive
+ Differential Drive
Where:
Proportional Drive = (TARGET POSITION - ACTUAL POSITION) x PROPORTIONAL GAIN
100
Feed Forward Drive = TARGET SPEED x FEED FORWARD
10000
Integral Drive = INTEGRAL GAIN x Accumulated error
10000
Differentiator Drive = (TARGET SPEED - ACTUAL SPEED) x DIFFERENTIAL GAIN
100