The system responses for trajectory and force control have been obtained as results.
The terminologies involved in the system response curve are as follows:
Peak-Time: The time required for the response to reach the first peak of the overshoot.
Settling-Time: The time required for the response curve to reach and stay within a range of about 2% or 5% the setpoint value.
Rising Time: The time required for the response to rise from 10% to 90% of the setpoint value.
The responses of the position of the slider-nut to step and sinusoidal inputs are recorded at different PID control gains (Kp, Ki, and Kd) to ensure the system responds in a desired (tuned) manner.
Perfect Tuning implies:
Zero Overshoot
No Oscillations
Fast Response (small Rising Time)
Small Settling Time
The system block diagram for position control is shown as follows:
To tune the PID controller, the following steps were used:
Set all gains to zero.
Increase the P gain (Kp) until the response to a disturbance is a steady oscillation.
Increase the D gain (Kd) until the oscillations go away (i.e., it's critically damped).
Repeat steps 2 and 3 until increasing the D gain (Kd) no longer stops the oscillations.
Set Kp and Kd to the last stable values.
Increase the I gain (Ki) until it brings you to the setpoint with the number of oscillations desired (normally zero, but a quicker response can be had if you don't mind a couple of oscillations or overshoot).
The system block diagram for force control is shown below:
One end of the spring is attached to the tendon wire (which is connected with the slider nut of the leadscrew mechanism), and the other end of the spring is fixed to the fixed end of the setup. So, the deflection of the spring will be the same as the distance the tendon tip (or the slider nut) moves.
The deflection of the spring is proportional to the force. The spring used has a stiffness of 20 N/m. Therefore, the force on the tendon (attached to the spring) can be written as: F (N) = 20 (N/m) x Deflection (mm) / 1000
Force Control System Response in 2 stages is shown as follows: