Gantry Issues
In several MANZ's applications, gantry systems (pair of parallel axes) are implemented as master slave pairs. Where master is a part of a bigger (XYZ) group and each of the group's axis can be a master to a different slave axis. The whole issue can be exteneded to any group of geared axes that are moving together one physical object.
Contents
Problems:
Problems occur when due to asymmetrical engagement of the system either by different stopping starting or mechanical non-symmetries.
1.) Motors are directly working against mechanic and possible mechanical breakage/damage can occur.
2.) The systems forms a mechanical feedback loop and instability in form of axis runway can occur.
3.) Load is distributed not equally, therefore dynamic behavior of one axis differs from the other.
Prevention features:
- Slave deviation: difference in position between master's and slave's feedback is monitored if it exceeds certain threshold an error is generated and the system stopped. MC-BASIC: <slave>.SlaveDeviation .
- Slave disconnect: when slave is disabled either due to explicit user command or as a result of an error it's master is automatically disabled. MC-BASIC: <slave>.SlaveDisconnect .
- The master is "aware" of its slaves. Keeping slave in enabled state when master is disabled can introduce a feedback loop (mechanical linkage between slave and master) resulting in a system that is not always stable i.e. we have a runaway. This can be prevented using SlaveDisable flag, each time a master is disabled due to whatever reason all its slaves will be disabled too. MC-BASIC: <master>.SlaveDisable .
- In order to keep the delay between master and slave minimal it is imporrtant to take care about the order of calling of axis RTK. Connecting slave to a master automaticaly re-orders their RTK by changing their priorities.
Table of Actions
General Axis Deviation (GAD) is defined as one of the follwing:
- position follwing error (Pe > PeMax)
- velocity overspeed (Vfb > Vospd)
- slave deviation (SlaveDeviation > SlaveMaxDeviation)
Action: | (or master is PEXT) |
|
|
|
Slave GAD | Stopping master axis Stopping slave axis |
else disabling the master |
| |
Slave GAD (when slave is stopped) |
| |||
Slave GAD (when master is stopped) |
Disabling slave | |||
Master GAD | | |||
Master GAD (wnen master is stopped) |
|
| ||
Error on slave axis | Stopping slave axis |
|
| |
Error on master axis | | |||
Disabling master: (max.en: 1→0) |
|
| ||
Disabling slave: (sax.en: 1→0) |
No disconnection. |
Disable all master axes connected directly or indirectly. |
|
Re-ordering the master-slave sequence.
In AMCS the sequence of calling different RTK's is assured by giving them different priorities (starting from 20), by default the first axis (the one with lowest ID) has the starting priority (20) , the next has 21 and so on. IF the group's RTK is activated, it gets the priority number of it's first axis. In this way we assure that no RTK interrupts execution of the other one.
Once the new master slave pair is given, the system should check the priorities of their RTK tasks, if prio(RTK_Slave) > prio(RTK_Master) then everything is OK, if not they should be exchanged but before that we must check if the specified master is a slave to another axis, if yes then this pair should be checked also.
Slave-Disable.
- Name: <axis>.SlaveDisable
- Type: long
- Values: 0 or 1
- Default: 0
- Limitations: Modal-Only, Read/Write
- Context: Task or Terminal
See Also: SlaveDisable
Once the <master>.SlaveDisable is on, each time the axis is disabled (due to an error, or by direct assignment i.e., ”en=0”) all of it's slave axes will be disabled:
If the user directly enters:
master_axis.en = 0
- If the default error handler disables the axis
- It the axis is disabled by an automatic disable due to a position error on a stopped axis
- If the torque threshold is exceeded on a stopped axis.
- If the VOSPD is exceeded on a stopped axis
- If the master is disabled because it is a part of the group that is being disabled (or some axes of it are).
- If the master is disabled because being master of another axis having <axis>.SlaveDisconnect flag set to 0(This is when this feature is on).
NOTE | |
Special care must be taken to avoid loops i.e. if the master disables the slave and the slave disables the master there must be a way that explicit enabling of master-slave pair succeeds. |
Issue 0997 B/F: Runaway with ActiveDisable switched off in gantry / missing synchronization
Issue 1681 F:Runaway with axis enable of gantry slave axis
Issue 0917 B: Slave jumps with following mode transitions on master
Issue 1003 B/F: Master-Slave order affects PCMD synchronization