06 Control Mode
Basic Setting
Check Before Running
NO. | Activity |
---|---|
Wiring | |
1 | The servo drive’s control circuit power input terminals (L1C, L2C) and main circuit power input terminals(L1, L2, L3) are connected correctly. |
2 | The main circuit output terminals U, V, W of the servo drive are properly connected to the power cables U, V, W of the servo motor in correct phase sequence |
3 | No short circuit exists in the main circuit power input terminals (L1, L2, L3) and output terminals (U, V, W) of the servo drive. |
4 | The signal wires of the servo drive are connected correctly. The external signal wires such as brake and limit switch are connected reliably. |
5 | The servo drive and motor are grounded reliably. |
6 | The jumper between terminals C and D has been removed when the external regenerative resistor is used. |
7 | The cable tension is within the permissible range. |
8 | The wiring terminals have been insulated. |
Environment and mechanical conditions | |
1 | No foreign objects, such as wire end or metal powder, which may cause short circuit of the signal wire and power cables, exist inside and outside of the servo drive. |
2 | The servo drive or external regenerative resistor is not placed on flammable objects. |
3 | Installation and shaft and mechanical connection are reliable. |
Power Supply Connection
Connect the power supply of the control circuit (L1C, L2C) and main circuit:
The main circuit power terminals are L1, L2, L3 for the 3-phase220 V and three-phase 380 V models.
- After connecting the power supply of the control circuit and main circuit, if the bus voltage indicator is in normal display and the keypad displays "rdy", it indicates that the servo drive is ready for running and waiting for the S-ON signal from the host controller.
- If the keypad displays the fault code, please refer to the “Fault and alarm table”
Turn off the S-ON signal
Jogging
Jog operation could be realized in two ways, one is panel jog operation, and the jog operation could be realized through the buttons on the servo panel. the other is jog operation through the debug tool running on pc.
Jogging via the Keypad
Switch to [P10-1] on the keypad to enter the jogging mode, and the keypad displays the default jogging speed.
Press key UP/DOWN to set the jogging speed, after that press enter key.
The keypad displays "JOG" and blinks. Then, press enter key again to access the jog mode.
Long press the up/down key to achieve forward and reverse rotation, press key MODE to exit the jogging mode.
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P10-1 | JOG speed | During running | Immediate | 0-3000 | Set the jogging speed value | rpm | 100 |
Jogging via debug tool
Open We-con servo debugging tool, set the speed value of the jog in the "Set Speed" in the "Manual Operation" column, and then click the "Servo On" button on the interface. Click "Forward" or "Reverse" button to realize forward/reverse jogging. When the "servo off" button is clicked, the jog mode is exited.
Selection of Rotating Direction
Set [P0-4] to change the motor rotating direction without changing the polarity of the input reference.
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P0-4 | Rotating direction selection | At stop | Power-on again | 0-1 | Forward direction:viewed from the motor shaft. 0: CW direction as the forward direction 1: CCW direction as the forward direction | - | 0 |
Limit switches (positive over travel POT and reverse over travel NOT), POT has the same direction set in [P0-4](Rotating direction selection).
Braking resistor
When the servo motor is in the generator state when decelerating or stopping, the motor would transfer the energy back to the driver, which would increase the bus voltage. When the bus voltage exceeds the braking point, the driver could use the braking resistor to consume the energy. The braking resistor could be built-in or external, but it couldnot be used at the same time. When the external braking resistor is connected, the jumper on the servo drive needs to be removed.
The judge whether to use a built-in braking resistor or an external braking resistor
(1) The calculated maximum braking energy> the maximum braking energy that the capacitor could absorb, and the calculated braking power ≤ the power of the built-in braking resistor, then use the internal braking resistance.
(2) When the calculated value of the maximum braking energy> the maximum braking energy that the capacitor could absorb, and the calculated value of the braking power> the power of the built-in braking resistor, then we should use an external braking resistor.
Relevant function code:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P0-9 | Braking resistance | At stop | Immediate | 0-3 | 0- Use built-in braking resistor. 1- Use external braking resistor and natural cooling. 2- Use external braking resistor and forced air cooling. 3- No braking resistors are used, all rely on capacitor absorption. | - | 0 |
P0-10 | External braking resistance | At stop | Immediate | 0-65535 | set the resistance value of the external braking resistor. | Ω | 50 |
P0-11 | External braking resistor power | At stop | Immediate | 0-65535 | Used to set the power of external braking resistor. | W | 100 |
Braking resistor selection process
VD1 750W drive brake resistance calculation formula
750W motor inertia: 1.82*10-4 kg m2
Total load inertia JL = load inertia ratio * 1.82*10-4
Single deceleration energy Eo = JL ω2
ω= (N: motor speed rpm)
The energy that the VD1 capacitor can absorb is 22.7J (EC)
The required braking resistor power is
(T is the acceleration and deceleration cycle)
which is:
Servo Running
- Turn on the S-ON signal
When the servo drive is ready for running, the keypad displays "Run". but if there is no reference input, the servo motor is in locked state.
S-ON could be configured and selected through DI terminal function selection.
- After a reference is input, the servo motor starts to rotate
Enter the appropriate command during operation, running the motor at low speed firstly, and observe whether the rotation is in accordance with the set rotation direction. Observe the actual motor speed, bus voltage and other parameters through the debug tool running on pc. It could be adjusted according to Chapter 7 to make the motor work in its expected condition.
- Power-on time sequence
Figure 6-1 Power-on time sequence
Servo Stop
Servo stop includes coast to stop and zero-speed stop based on the stop mode, and de energized state and position lock based on the stop state.
Stop mode | Coast to stop | Stop at zero speed |
---|---|---|
Description | The servo motor is de-energized and decelerates to stop gradually. The deceleration time is affected by the friction inertia and mechanical. | The servo drive outputs the reverse braking torque and the motor decelerates to 0 quickly. |
Characteristic | This mode features smooth deceleration and small mechanical impact, but the deceleration process is long. | This mode features quick deceleration but a larger impact. |
- Stop at S-ON Signal Off
Relevant function code:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P0-5 | Stop mode at S-ON OFF | At stop | Immediate | 0~1 | 0: Coast to stop, keeping de-energized state 1: Stop at zero speed, keeping de-energized state | - | 0 |
- Emergency Stop
The default is the free stop mode, the motor shaft remains free, and the corresponding configuration and selection could be made by configuring the DI terminal function selection.
- Stop at Limit Switch Signal Active
Over travel means that the movable part of the machine exceeds the setting area. In some horizontal or vertical movements, the servo needs to limit the movement range of the work piece. Over travel generally uses limit switches, photoelectric switches or multiple turns of the encoder for detection, that is, hardware over travel or software over travel.
Once the servo drive detects the action of the limit switch signal, it would immediately force the speed in the current running direction to 0 to prevent the forward movement, which would not affect the reverse operation. Over travel stop is fixed as zero speed stop, and the motor shaft keeps the position locked.
The corresponding configuration and selection could be made through the DI terminal function selection. The default setting of DI3 is POT, DI4 is NOT.
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P6-08 | DI_3 function | During running | Power-on again | 0~16 | 1: SON, Servo ON 2: A-CLR, Fault and warning clear 3: POT, Forward limit switch 4: NOT, Reverse limit switch 5: ZCLAMP, Zero speed clamp 6: CL, Clear the position deviation 7: C-SIGN, Instruction negation 8: E-STOP, Emergency stop 9: GEAR-SEL, Electronic gear switching 1 10: GAIN-SEL, Gain switch 11: INH, Position reference inhibited 12: VSSEL, Damp control switch(Not implemented yet) 13: INSPD1, Internal speed command selection 1(Not implemented yet) 14: INSPD2, Internal speed command selection 2(Not implemented yet) 15: INSPD3, Internal speed command selection 3(Not implemented yet) 16: J-SEL, Inertia ratio switch(Not implemented yet) | - | 03-POT |
P6-9 | DI_3 logic selection | During running | Power-on again | 0~1 | DI port input logic validity function selection. 0: Normal open input. Active when off (Switch closed). 1: Normal closed input. Active when on (Switch open). | - | 0 |
P6-10 | DI_3 input source selection | During running | Power-on again | 0~1 | 0-hardware DI3 1-VDI3 | - | 0 |
P6-11 | DI_4 function | During running | Power-on again | 0~16 | 1: SON, Servo ON 2: A-CLR, Fault and warning clear 3: POT, Forward limit switch 4: NOT, Reverse limit switch 5: ZCLAMP, Zero speed clamp 6: CL, Clear the position deviation 7: C-SIGN, Instruction negation 8: E-STOP, Emergency stop 9: GEAR-SEL, Electronic gear switching 1 10: GAIN-SEL, Gain switch 11: INH, Position reference inhibited 12: VSSEL, Damper control switch(not implemented yet) 13: INSPD1, Internal speed command selection 1(not implemented yet) 14: INSPD2, Internal speed command selection 2(not implemented yet) 15: INSPD3, Internal speed command selection 3(not implemented yet) 16: J-SEL, Inertia ratio switch(not implemented yet) | - | 04-NOT |
P6-12 | DI_4 logic selection | During running | Power-on again | 0~1 | DI port input logic validity function selection. 0: Normal open input. Active when off (switch closed). 1: Normal closed input. Active when on (switch open). | - | 0 |
P6-13 | DI_4 input source selection | During running | Power-on again | 0~1 | 0-hardware DI3 1-VDI3 | - | 0 |
- Stop at Fault Occurrence
If the machine breaks down, the servo would perform fault shutdown operation. The current shutdown mode is fixed to free stop mode, and the motor shaft remains free.
Position mode
Position control mode is the most important and commonly used control mode of servo system. Position control refers to controlling the position of the motor through position commands, determining the target position of the motor based on the total number of position commands, and the frequency of the position command determines the rotation speed of the motor. The servo drive could achieve fast and accurate control of the position and speed of the machine. Therefore, the position control mode is mainly used in applications requiring positioning control, such as manipulators, chip mounters, engraving machines, CNC machine tools, etc.
The block diagram of position control is as follows:
Figure 6-2 Position control diagram
Position Reference Input Setting
The servo drive has 1 set of pulse input terminals for receiving position pulse input (through the CN2 terminal of the drive)
The reference from the host controller could be differential output or open collector output. The maximum input frequency is shown in the following table:
Pulse Type | Differential | Open collector |
---|---|---|
Max. frequency | 500k | 200k |
Voltage | 5V | 24V |
- Low-speed Pulse Input Differential drive mode
- OC mode
- Position pulse selection
The servo drive supports three pulse input formats:
Direction + pulse (positive logic),Phase A + phase B quadrature pulse (4-frequency multiplication), CW + CCW
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P0-12 | Position pulse type selection | At stop | Power-on again | 0~2 | 0: Direction + pulse (positive logic) 1: CW/CCW 2: Phase A + phase B quadrature pulse (4-frequency multiplication) | - | 0 |
The corresponding pulse waveform is as follows:
[P0-12]=0 (Direction + pulse(positive logic))
PULSE: Pulse SIGN: Signal
Positive pulse waveform | Negative pulse waveform |
---|---|
![]() | ![]() |
(b) [P0-12]=1(CW/CCW)
PULSE: Pulse SIGN: Signal
Diagram |
---|
![]() |
(c) [P0-12]=2(Phase A + phase B quadrature pulse (4-frequency multiplication))
PULSE(A phase): pulse SIGN(B phase): signal
Positive pulse waveform | Negative pulse waveform |
---|---|
A advances B by 90° | B advances A by 90° |
Position pulse frequency and anti-interference level
Filtering time is necessary for the reference input pin to prevent external interference input to the driver and affect the control of the motor. The signal input and output waveforms with filtering enabled are shown in the following figure:
Figure 6-3 Filtering signal waveform
The input pulse frequency refers to the frequency of the input signal, and the frequency of the input pulse command could be modified through the function code [P0-13]. If the actual input frequency is greater than [P0-13], it may cause pulse loss or alarm. The function code [P0-14] could adjust the position pulse anti-interference level, the greater the value, the greater the depth of the filter.
Relevant function code:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P0-13 | Position pulse frequency | At stop | Power-on again | 1~500 | Set the maximum pulse frequency | kHz | 300 |
P0-14 | Position pulse anti-interference level | At stop | Power-on again | 1~3 | Set the pulse anti-interference level. 1:Low anti-interference level. (0.1) 2: Medium (0.25) 3: High (0.4) | - | 2 |
Electronic Gear Ratio
[Glossary]
Reference unit: It means the minimum value the host controller input to the servo drive.
Encoder unit: It means that the value from the input reference processed with the electronic gear ratio.
[Electronic gear ratio definition]
In position control mode, the input position reference (reference unit) defines the load displacement. the motor position reference (encoder unit) defines the motor displacement. The electronic gear ratio is used to indicate the relationship between input position reference and motor position reference. By dividing (electronic gear ratio < 1) or multiplying (electronic gear ratio > 1) the electronic gear ratio, the actual motor rotating or moving displacement within the input
position reference of one reference unit could be set.
[Setting range of electronic gear ratio]
The setting range of the electronic gear ratio should meet the following conditions:
Otherwise, it would display [Er. 35] "Electronic gear ratio setting over limit" fault.
Electronic gear ratio setting Flowchart:
Figure 6-4 Electronic gear ratio setting flowchart
Firstly, confirm the mechanical parameters, including confirming the reduction ratio, ball screw lead, gear diameter in gear transmission, pulley diameter in pulley transmission, etc. Confirm the resolution of the servo motor encoder used.
Confirm the parameters such as machine specifications and positioning accuracy, and determine the load displacement corresponding to the position command output by the host computer. Combine information including the mechanical parameters and the load displacement corresponding to one position command to calculate the position command value required for one rotation of the load shaft.
Electronic gear ratio = encoder resolution / position command (command unit) required for one revolution of the load shaft × reduction ratio, Set the function code parameters according to the calculated electronic gear ratio value.
In addition to use the electronic gear ratio function, you could also use [P0-16] (the number of command pulses for one rotation of the motor). Both gear ratio 1 and electronic gear ratio 2 are invalid when [P0-16] is not zero.
Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P0-16 | pulse number per revolution | At stop | Power-on again | 0~10000 | Set the pulse number of per rotation Only when P0-16=0 then P0-17,P0-18,P0-19,P0-20 would take effect | pulse | 10000 |
P0-17 | Electronic gear 1 numerator | During running | Immediate | 1~32767 | Set the numerator of the first group electronic gear ratio. It is valid when P0-16=0 | - | 1 |
P0-18 | Electronic gear 1 denominator | During running | Immediate | 1~32767 | Set the denominator of the first group electronic gear ratio. It is valid when P0-16=0 | - | 1 |
P0-19 | Electronic gear 2 numerator | During running | Immediate | 1~32767 | Set the numerator of the first group electronic gear ratio. It is valid when P0-16=0 | - | 1 |
P0-20 | Electronic gear 2 denominator | During running | Immediate | 1~32767 | Set the denominator of the first group electronic gear ratio. It is valid when P0-16=0 | - | 1 |
Position Reference Filter
This function filters the position references (encoder unit) divided or multiplied by the electronic gear ratio. It involves the first-order filter and average filter.
It is applicable to the following conditions:
- Acceleration/Deceleration is absent on the position references from the host controller.
- The pulse frequency is too low.
- The electronic gear ratio is larger than 10.
Properly setting the position loop filter time constant could run the motor more smoothly, so that the motor speed would not overshoot before it stabilizes. This setting has no effect on the number of command pulses.
The filter time is not as long as possible. The longer the filter time, the longer the delay time and the longer the response time.
Figure 6-5 position reference filter
Relevant parameters:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P4-1 | Pulse command filtering mode | At stop | Immediate | 0~1 | 0: first-order low-pass filtering 1: average filter | - | 0 |
P4-2 | Position command first-order low-pass filter | At stop | Immediate | 0~128 | For pulse command input filtering | ms | 0 |
P4-3 | Position command average filtering time constant | At stop | Immediate | 0~1000 | For pulse command input filtering | ms | 20 |
Position Deviation Clear
Position deviation = Position reference – Position feedback (encoder unit)
The position deviation clear function refers to the function that the drive clears the deviation register in the position mode. The function of clearing position deviation could be realized through DI terminal.
Frequency-Division Output
The encoder pulse is output as a quadrature differential signal after divided by the internal circuit of the servo driver. The phase and frequency of the frequency-divided signal could be set by parameters. The source of frequency division output could be set by function code, and the setting of different sources makes the function of frequency division output more widely used.
Figure 6-6 diagram of frequency division output wiring
The frequency-division output is a differential signal output:
Phase A pulse: PAO +, PAO-, differential output, the maximum output pulse frequency is 2Mpps
Phase B pulse: PBO +, PBO-, differential output, the maximum output pulse frequency is 2Mpps
Phase Z pulse: PZO +, PZO-, differential output, the maximum output pulse frequency is 2Mpps
The frequency division pulse output direction could be set through the function code [P0-21]. The waveform diagram of the encoder frequency division pulse output is as follows:
P0-21 | Forward rotation, pulse output waveform | Reverse rotation, pulse output waveform |
---|---|---|
0 | ![]() | ![]() |
1 | ![]() | ![]() |
In addition, the Z pulse output polarity could be set through function code P0-23, as shown in the following figure:
P0-23(Z pulse output polarity) | pulse waveform (forward / reverse) |
---|---|
0 | ![]() |
1 | ![]() |
Function code P0-22(the number of output pulses per revolution of the motor) is used to set the number of output pulses of the A and B phases of the motor, and changing the function code could set the frequency division of the output.
Relevant parameters:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P0-21 | frequency-dividing output direction | At stop | Power-on again | 0~1 | Quadrature pulse output. 0: When the motor rotation direction is CW, A advances B 1: When the motor rotation direction is CCW, B advances A | - | 0 |
P0-22 | Encoder ppr | At stop | Power-on | 10~10000 | Quadrature output. Set the number of output pulses of phase A and phase B for each rotation of the motor | Pulse | 2500 |
P0-23 | Z pulse output OZ polarity | At stop | again | 0~1 | 0-Z Active when pulse is high 1-Z Active when pulse is low | - | 0 |
Position-relevant DO output function
The feedback value of the position command is compared with different thresholds, and the DO signal could be output for the host controller to use.
(1)Positioning completed/near output
The internal command completion function means that when the multi position reference within the servo is zero, it could be considered that the command transmission is completed. At this time, the servo drive could output the internal command completion signal, and the host computer could confirm that the multi-segment position command within the servo drive has been sent.
The positioning completion function means that the position deviation meets the conditions set by the [P5-12], and it could be considered that the positioning is completed in the position control mode. At this time, the servo driver could output the positioning completion signal, and the host controller could confirm that the positioning of the servo driver is completed after receiving this signal.
The functional schematic diagram is as follows:
Figure 6-7 positioning completed diagram
When using the positioning completion / proximity function, you could also set positioning completion, positioning proximity conditions, window, and hold time. The diagram of window filtering time is shown in the figure below:
Figure 6-8 diagram of positioning completion signal output with window filtering time
Relevant parameters:
Code | Parameter Name | Property Effective Time | Range | Function | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P5-11 | Positioning completed, positioning near setting | During running | Immediate | 1~3 | Output signal judging conditions for positioning completed and positioning near 0:The output is valid when the absolute value of the position deviation is less than the positioning completion threshold / location near threshold. 1:The absolute value of the position deviation is less than the positioning completion threshold / positioning near threshold, and the input position command is 0 then the output is valid 2:The absolute value of the position deviation is smaller than the positioning completion threshold / positioning approach threshold, and the input position command filter value is 0 then the output is valid 3:The absolute value of the position deviation is less than the positioning completion threshold / positioning approach threshold, the input position command filter value is 0, and the positioning detection time window is continued then the output is valid | - | 0 |
P5-12 | Positioning completed threshold | During running | Immediate | 1~65535 | Positioning completion threshold | Pulse | 800 |
P5-13 | Positioning approach threshold | During running | Immediate | 1~65535 | Positioning near threshold | Pulse | 5000 |
P5-14 | Positioning detection time window | During running | Immediate | 0~20000 | Set the positioning completion detection time window | ms | 10 |
P5-15 | Positioning signal hold time | During running | Immediate | 0~20000 | Set the hold time of positioning completion output | ms | 100 |
To use the positioning completion function, the DO terminal of the servo drive should be assigned as the positioning completion function and determine the valid logic. Take the DO1 terminal as an example, the relevant function code:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P6-26 | DO_1 function selection | During running | Power-on again | 128~142 | 129-RDY Servo Ready 130-ALM Alarm 131-WARN Warning 132-TGON Motor rotation output 133-ZSP Zero speed signal 134-P-COIN Positioning completed 135-P-NEAR Positioning near 136-V-COIN Speed consistent 137-V-NEAR Speed near 138-T-COIN Torque reached 139-T-LIMIT Torque limit 140-V-LIMIT Speed limit 141-BRK-OFF Solenoid brake (not implemented yet) 142-SRV-ST Enable Servo status output | - | 131 |
P6-27 | DO_1 logic selection | During running | Power-on again | 0~1 | Output logic function selection. ★ 1. Set to 0: When the signal is valid, the output transistor is on. When the signal is invalid, the output transistor is off. 2. Set to 1: When the signal is valid, the output transistor is off. When the signal is invalid, the output transistor is on. | - | 0 |
Servo position control case
Introduction
This case uses three commonly used PLC positioning instructions to implement the servo position control mode actions.
I/O wiring
Servo parameter setting
Step 1:Power on the servo, set the M key on the panel of the servo drive, set the value of function code P0-1 to 1, and 1 is the position control mode;
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P0-1 | Control mode (default setting) | At stop | Power-on again | 1-10 | 1: Position control mode 2: Speed control mode 3: Torque control mode | - | 1 |
Step 2:Set the value of function code P0-4, 0 is forward rotation, 1 is reverse rotation
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P0-4 | Rotating direction selection | At stop | Power-on again | 0-1 | Forward direction:viewed from the motor shaft. 0: CW direction as the forward direction 1: CCW direction as the forward direction | - | 0 |
Step 3:Set the value of function code P6-04 to 1. 0 is the hardware DI_1 channel, which requires wiring; 1 is the virtual DI_1 channel,no wiring is required.
Code | Function | Effective time | Default | Range | Description |
---|---|---|---|---|---|
P13-1 | Virtual VDI_1 input value | ▲ | 0 | 0-1 | VDI1 input level: 0: low level. 1: high level. |
Step 4:Set the value of the function code P13-1 to choose whether VDI1 is valid at high or low levels.
Code | Function | Effective time | Default | Range | Description | Unit |
---|---|---|---|---|---|---|
P6-02 | DI_1 function selection | △ | 1 | 0-16 | 1: SON, Servo ON 2: A-CLR, Fault and warning clear 3: POT, Forward limit switch 4: NOT, Reverse limit switch 5: ZCLAMP, Zero speed clamp 6: CL, Clear the position deviation 7: C-SIGN, Instruction negation 8: E-STOP, Emergency stop 9: GEAR-SEL, Electronic gear switching 1 10: GAIN-SEL, Gain switch 11: INH, Position reference inhibited 12: VSSEL, Damer control switch(not implemented yet) 13: INSPD1, Internal speed command selection 1(not implemented yet) 14: INSPD2, Internal speed command selection 2(not implemented yet) 15: INSPD3, Internal speed command selection 3(not implemented yet) 16: J-SEL, Inertia ratio switch(not implemented yet) |
PLC Project
Explanation
The program uses M0,M1,M2 as the switch button of three modes of actions.
When M0 is turned on, the Y0 servo motor rotates 5000 pulses in the direction of Y3.
When M1 is turned on, the Y0 servo motor rotates 20,000 pulses at the speed of 4,000 pulses, and Y3 represents the direction of the motor.
When M2 is turned on, the Y0 servo motor moves to the absolute position of 2000 at the speed of 4000 pulses, and Y3 represents the direction of the motor.
Speed mode
Speed control refers to control the speed of the machine through the speed reference. Through internal digital setting, analog voltage or communication, the servo drive could achieve fast and precise control of the mechanical speed. Therefore, the speed control mode is mainly used to control the rotation speed, or use the host controller to realize the position control, and the host controller output is used as the speed reference, such as analog engraving and milling machine.
The speed control block diagram is as follows:
Figure1 speed control diagram
Set the parameter P0-1 to 2 through the panel or debugging tool on PC to make the servo drive work in speed control mode.
Relevant function code:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P0-1 | Control mode (default setting) | At stop | Power-on again | 1~10 | 1: Position control mode 2: Speed control mode 3: Torque control mode | - | 1 |
Speed Reference Input Setting
Speed Reference Source
There are two sources of speed reference in speed control mode, which could be set by [P1-1].
Relevant function code:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default | |
---|---|---|---|---|---|---|---|---|
P1-1 | Speed command source | At stop | Immediate | 0~1 | 0: Internal speed command (set in P1-3). 1: AI_1 analog input. | - | 0 |
Internal speed reference
Set the speed value through the function code [P1-2] as the speed reference.
Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P1-2 | Internal speed command | During running | Immediate | -3000~3000 | Internal speed command | rpm | 100 |
Analog voltage input as a reference
Take the analog voltage signal output by the host controller or other equipments, processed as a speed reference.
Analog voltage setting method:
Figure 2 flowchart of setting speed reference by analog voltage
Glossary:
Zero drift: Value of the servo drive sampling voltage relative to GND when the input
voltage of the analog channel is zero.
Offset: Input voltage value of the analog channel when the sampling voltage is zero after
zero drift correction.
Dead zone: Input voltage range of the analog channel when the sampling voltage is zero.
Figure 3 Analog signal after-offset
After completing the correct settings, you could view the input voltage values of AI_1 and AI_2 through U0-21 and U0-22
Code | Function | Unit | Format |
---|---|---|---|
U0-21 | AI1 input voltage value | V | decimal(3 decimal digits) |
U0-22 | AI2 input voltage value | V | decimal(3 decimal digits) |
Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P5-1 | AI_1 input bias | During running | Immediate | -5000~5000 | Set AI_1 channel analog offset value | mv | 0 |
P5-2 | AI_1 Input filter constant | During running | Immediate | 0~65535 | AI_1 channel input first-order low-pass filtering time constant | ms | 200 |
P5-3 | AI_1 dead zone | During running | Immediate | 0~1000 | Set AI_1 channel analog dead zone value | mv | 20 |
P5-4 | AI_1 zero drift | During running | Immediate | -500~500 | Automatic calibration zero drift inside the driver. | mv | 0 |
P5-5 | AI_2 input bias | During running | Immediate | -5000~5000 | Set AI_2 channel analog offset value | mv | 0 |
P5-6 | AI_2 Input filter constant | During running | Immediate | 0~60000 | AI_2 channel input first-order low-pass filtering time constant | ms | 200 |
P5-7 | AI_2 dead zone | During running | Immediate | 0~1000 | Set AI_1 channel analog dead zone value | mv | 20 |
P5-8 | AI_2 zero drift | During running | Immediate | -500~500 | Automatic calibration zero drift value inside the driver | mv | 0 |
P5-9 | Analog 10V for speed value | At stop | Immediate | 1000~4500 | Set the speed value corresponding to analog 10V | rpm | 3000 |
P5-10 | Analog 10V for torque value | At stop | Immediate | 0~3000 | Set the torque value corresponding to analog 10V | 0.1% | 1000 |
Acceleration and deceleration time setting
The acceleration/deceleration time setting refers to convert a speed command with a relatively high acceleration into a speed command with a relatively gentle acceleration, so as to achieve the purpose of controlling the acceleration.
In the speed control mode, excessive acceleration of the speed command would cause the vibration. At this time, increase the acceleration or deceleration time to achieve a smooth speed change of the motor and avoid mechanical damage caused by the above situation.
Figure 4 diagram of acc. and dec. time
Actual acceleration time T1 = speed reference / 1000 * acceleration time
Actual deceleration time T2 = speed reference / 1000 * deceleration time
Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P1-3 | Acc. time | During running | Immediate | 0~65535 | Acceleration time from 0 to 1000rpm in speed command mode | ms | 50 |
P1-4 | Dec. time | During running | Immediate | 0~65535 | Deceleration time from 1000 to 0 rpm in speed command mode | ms | 50 |
Speed Reference Limitation
The servo drive could display the value of the speed reference in speed mode.
Sources of speed instruction limits include:
[P1-10]: Set the maximum speed limit value
[P1-12]: Set forward speed limit value
[P1-13]: Set the reverse speed limit value
Maximum motor speed: determined according to the model of the motor
| The amplitude of the forward speed reference | ≤ min {Max. motor speed, P1-10, P1-12}
| The amplitude of the negative speed reference | ≤ min {Max. speed of the motor, P1-10, P1-13}
Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P1-10 | Max speed threshold | During running | Immediate | 0~5000 | Set the maximum speed limit value. | rpm | 3600 |
P1-12 | Forward speed threshold | During running | Immediate | 0~3000 | Set forward speed limit | rpm | 3000 |
P1-13 | Reverse speed threshold | During running | Immediate | 0~3000 | Set reverse speed limit | rpm | 3000 |
Zero Speed Clamp Function
Zero speed clamping function means that when the zero speed clamping signal (ZCLAMP) is valid, when the absolute value of the speed reference is lower than the zero speed clamping speed value, the servo motor is in the locked state. At this time, the servo drive is in position lock mode, and the speed reference is invalid.
Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P1-21 | Zero speed clamp function selection | During running | Immediate | 0~3 | Set the zero speed clamp function. In speed mode: 0: Force speed to 0. 1: Force the speed to 0, and keep the position locked when the actual speed is less than [P1.22]. 2: When the speed reference is less than [P1-22], force the speed to 0 and keep the position locked. 3: Invalid, ignore the zero speed clamp input. | - | 0 |
P1-22 | Speed threshold for zero | During running | Immediate | 0~1000 | Set the speed threshold of the zero speed clamp function | rpm | 20 |
Figure 5 Zero Speed Clamp waveform
Speed-relevant DO Signals
Different DO signals are output to the host controller based on comparison between the speed feedback after filter and different thresholds. We need to assign different function for the DO terminals and set the valid logic.
Motor Rotation DO Signal
After the speed reference is filtered, the absolute value of the actual speed of the servo motor reaches [P5-16] (rotation detection speed threshold), then the motor is considered to be rotating. At this time, the DO terminal of the servo drive could output a rotation detection signal. Conversely, when the actual rotation speed of the servo motor does not reach [P5-16], it is considered that the motor is not rotating.
Figure 6-14 motor rotation DO signal
Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P5-16 | Rotation detection speed threshold | During running | Immediate | 0~1000 | Set motor rotation signal judgment threshold | rpm | 20 |
P6-26 | DO_1 function selection | During running | Immediate | 128~142 | 132-TGON rotation detection | - | 131 |
Zero speed signal
The absolute value of the actual speed of the servo motor is less than a certain threshold [P5-19], it is considered that the servo motor stops rotating, and the DO terminal of the servo drive could output a zero speed signal at this time. Conversely, if the absolute value of the actual speed of the servo motor is not less than this value, it is considered that the motor is not at a standstill and the zero speed signal is invalid.
Figure 6 zero speed signal waveform
Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P5-19 | Zero speed output signal threshold | During running | Immediate | 0~6000 | Zero speed output signal threshold | rpm | 10 |
P7-18 | DO_1 function selection | During running | Power on again | 128~142 | 133-ZSP zero speed signal | - | 132 |
Speed Consistent DO Signal
In speed control, when the absolute value of the difference between the motor speed after filter and the speed reference satisfies the setting of [P5-17], the actual motor speed is considered to reach the speed reference. At this moment, the servo drive outputs the speed consistent signal. When the absolute value of the difference between the motor speed after filter and the speed reference exceeds the setting of [P5-17], the speed consistent signal is inactive.
Figure 7 Speed Consistent Waveform
Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P5-17 | Speed consistent signal threshold | During running | Immediate | 0~100 | Set the speed consistent signal threshold | rpm | 10 |
P7-18 | DO_1 function selection | During running | Immediate | 128~142 | 135-V-COIN speed consistent | - | 135 |
Speed Reached DO Signal
When the absolute value of the motor speed after filter exceeds the setting of[P4-16],the motor speed is considered to reach the desired value. At this moment, the servo drive outputs the speed reached signal. When the absolute value of the motor speed after filter is smaller than or equal to the setting of[P4-16], the speed reached signal is inactive.
Figure 6-17 Speed reached signal waveform
Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P5-18 | Speed approaching signal threshold | During running | Immediate | 10~6000 | Speed reached signal threshhold | rpm | 100 |
P7-18 | DO_1 function selection | During running | Power on again | 128~142 | 136-V-NEAR speed near | - | 136 |
Torque mode
The current of the servo motor has a linear relationship with the torque. Therefore, the control of the current could achieve the control of the torque. Torque control refers to controlling the output torque of the motor through a torque reference. Torque reference could be given by internal command and analog voltage.
The torque control block diagram is as follows:
Torque Reference Input Setting
Torque reference source
In the torque control mode, there are two sources of torque reference, which could be set through [P1-7]. Relevant function codes:
Code | Parameter Name | Property | Effective Time
| Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P1-7 | Torque reference source | At stop | Immediate | 0~1 | 0: Internal torque command. 1: AI_1 analog input. | - | 0 |
Digital setting
The source of the torque reference is an internal command, which is set through function code [P1-8]. Relevant function codes:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P1-8 | Torque reference keyboard set value | During running | Immediate | -3000~3000 | -300.0%~300.0% | 0.1% | 0 |
Analog voltage setting
Code | Function | Unit | Format |
---|---|---|---|
U0-21 | AI1 input voltage value | V | decimal(3 decimal digits) |
U0-22 | AI2 input voltage value | V | decimal(3 decimal digits) |
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P5-1 | AI_1 input bias | During running | Immediate | -5000~5000 | Set AI_1 channel analog offset value | mv | 0 |
P5-2 | AI_1 Input filter constant | During running | Immediate | 0~65535 | AI_1 channel input first-order low-pass filtering time constant | ms | 200 |
P5-3 | AI_1 dead zone | During running | Immediate | 0~1000 | Set AI_1 channel analog dead zone value | mv | 20 |
P5-4 | AI_1 zero drift | During running | Immediate | -500~500 | Automatic calibration zero drift inside the driver. | mv | 0 |
P5-5 | AI_2 input bias | During running | Immediate | -5000~5000 | Set AI_2 channel analog offset value | mv | 0 |
P5-6 | AI_2 Input filter constant | During running | Immediate | 0~60000 | AI_2 channel input first-order low-pass filtering time constant | ms | 200 |
P5-7 | AI_2 dead zone | During running | Immediate | 0~1000 | Set AI_1 channel analog dead zone value | mv | 20 |
P5-8 | AI_2 zero drift | During running | Immediate | -500~500 | Automatic calibration zero drift value inside the driver | mv | 0 |
P5-9 | Analog 10V for speed value | At stop | Immediate | 1000~4500 | Set the speed value corresponding to analog 10V | rpm | 3000 |
P5-10 | Analog 10V for torque value | At stop | Immediate | 0~3000 | Set the torque value corresponding to analog 10V | 0.1% | 1000 |
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P4-4 | Torque filter time constant | During running | Immediate | 10~2500 | When [Auto-tuning mode] is set as 1, or 2, this parameter is set automatically | 0.01 | 0.5 |
Take the analog voltage signal outputs by the host controller or other equipment as a speed reference.
Operation flowchart of setting torque reference by analog voltage:
flowchart of setting torque reference by analog voltage
Zero drift: value of the servo drive sampling voltage relative to GND when the input voltage of the analog channel is zero
Offset: input voltage value of the analog channel when the sampling voltage is zero after zero drift correction
Dead zone: input voltage range of the analog channel when the sampling voltage is zero
Analog signal waveform after-offset
After completing the correct settings, user could view the input voltage values of AI_1 and AI_2 through [U0-21] and [U0-22]
Relevant function codes:
Torque Reference Filter
In the torque mode, the servo drive could realize low-pass filtering of the torque command, which reduces the vibration of the servo motor.
Relevant function codes:
Diagram of torque reference first-order filter
If the setting value of the filter time constant is too large, the responsiveness would be reduced. Please set it while confirming the responsiveness.
Torque Reference Limit
When the absolute value of the torque reference input from the host controller or output by the speed regulator is larger than the absolute value of the torque reference limit, the actual torque reference of the servo drive is restricted to the torque reference limit. Otherwise, the torque reference input from the host controller or output by the speed regulator is used.
Only one torque reference limit is valid at a moment. Both positive and negative torque limits does not exceed the maximum torques of the servo drive and motor and ±300.0% of the rated torque.
Torque setting and limit
Torque Limit Source
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P1-14 | Torque limit source | At stop | Immediate | 0~1 | 0: Internal value 1: AI_2 analog input | - | 0 |
The torque limit source is set in[P1-14]. After the torque limit is set, the servo drive torque reference is restricted to be within the torque limit. After the torque reference reaches the limit, the motor runs according to the torque limit. The torque limit must be set according to the load conditions. If the setting is very small, it may cause longer acceleration/decelleration time of the motor, and the actual motor speed may not reach the required value at constant speed running.
Relevant code:
When [P1-14]= 0: internal torque limit
The torque reference limit value is determined by the internal function codes [P1-15] and [P1-16]
Relevant code:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P1-15 | Forward rotation torque limit | during | Immediate | 0~3000 | When [P1-14] selects internal torque limit, this function code value is used as the forward torque limit value | 0.1% | 3000 |
P1-16 | Reverse torque limit | during | Immediate | 0~3000 | When [P1-14] selects internal torque limit, this function code value is used as the reverse torque limit value | 0.1% | 3000 |
Torque Limit DO Signal
When the torque reference reaches the torque limit value, the driver outputs a torque limit signal (138-T-LIMIT torque limit) to the host controller and determines the DO terminal logic.
Relevant code:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P6-26 | DO_1 function selection | During running | Power on again | 128~142 | 138-T-LIMIT torque limit | - | 138 |
Torque related DO output function
The feedback value of the torque reference is compared with different thresholds, and the DO signal could be output to the host controller to use. Assign the DO terminals of the servo drive to different functions and set the valid logic.
Torch reach signal
Torch reach signal waveform
Relevant function code:
Code | Parameter Name | Property | Effective Time | Range | Function | Unit | Default |
---|---|---|---|---|---|---|---|
P5-20 | Torque reached threshold | During running | Immediate | 0~300 | The torque reached threshold needs to be used in conjunction with [torque reached hysteresis value]: When the actual torque reaches [torque reached threshold] + [torque reaches hysteresis], the torque reached DO becomes effective. When the actual torque decreases below [Torque reached threshold] + [Torque reached hysteresis], the torque reached DO becomes invalid. | % | 100 |
P5-21 | Torque reached hysteresis | During running | Immediate | 10~20 | [Torque reached hysteresis value] Need to be used together with [Torque reached threshold] | % | 10 |
P6-26 | DO_1 function selection | During running | Immediate | 128~142 | 138-T-COIN Torch reach | - | 138 |