Maneuvering system having inner force sense presenting function
A compact, lightweight manipulation system that excels in operability and has a force feedback capability is provided. When automatic operation of a slave manipulator 105 that follows manual operation of a master manipulator 101 is bilaterally controlled by means of communication, the force acting on the slave manipulator is fed back to the master manipulator by operating the master manipulator primarily under electrically-driven speed control and the slave manipulator primarily under pneumatically-driven force control. Therefore, in the master manipulator, it is not necessary to compensate for the dynamics and the self-weight of the master manipulator in the motion range of a user, allowing highly accurate, broadband positional control, which is specific to an electrically-driven system, and in the slave manipulator, nonlinearity characteristics specific to a pneumatically-driven system presents passive softness, provides a high mass-to-output ratio, and produces a large force.
1. A manipulation system having a force feedback capability in which automatic operation of a slave manipulator that follows manual operation of a master manipulator is bilaterally controllable by means of communication, the manipulation system characterized in that the force acting on the slave manipulator is fed back to the master manipulator by operating the master manipulator under electrically-driven speed control and the slave manipulator under pneumatically-driven force control,
the master manipulator includes a 3-DOF translation unit and a 4-DOF orientation unit connected to the translation unit, and the slave manipulator includes a 3-DOF holding unit and a 4-DOF grip unit held by the holding unit.
2. The manipulation system having a force feedback capability according to claim 1 , characterized in that the translation unit is a delta mechanism, the orientation unit is a gimbal mechanism, the holding unit is a combination of a parallel link mechanism and a gimbal mechanism and the grip unit is a wire mechanism.
3. The manipulation system having a force feedback capability according to claim 2 , characterized in that the grip unit includes pneumatic rotary actuators and wires connected to the pneumatic actuators, and the grip unit is driven by pulling motions of the wires in response to the motions of the pneumatic actuators.
4. The manipulation system having a force feedback capability according to any one of claims 1 to 3 , characterized in that compliance-based control is applied to the slave manipulator.
5. The manipulation system having a force feedback capability according to any one of claims 1 to 3 , characterized in that position-based impedance control in which a force control loop includes a motion control loop is applied to the master manipulator, and force-based impedance control in which a motion control loop includes a force control loop is applied to the slave manipulator.
6. The manipulation system having a force feedback capability according to any one of claims 1 to 3 , characterized in that automatic operation of the slave manipulator that follows manual operation of the master manipulator is bilaterally controlled by means of wired communication.
7. The manipulation system having a force feedback capability according to claim 1 , characterized in that the slave manipulator is controlled by means of (1) and (2):
(1) the force fdr that the tip of the slave manipulator should produce is calculated as follows:
fdr=Kd ( xs−xm )+ Bd dxs/dt
wherein,
Kd: the set stiffness of the slave manipulator
xs: the position and orientation of the tip of the slave manipulator
xm: the position and orientation of the tip of the master manipulator
Bd: the set viscosity of the slave manipulator
(2) the target value Σdrref of the drive torque of the pneumatically-driven system is calculated as follows:
τ dr ref=− Js (transposition) fdr+Z ( qs, dqs/dt, d 2 qs/dt 2 )
wherein,
Js: the Jacobi matrix representing the transition from the displacements of the joints to the displacement of the tip position of the slave manipulator
Z: the inverse dynamics function for the slave manipulator
qs: the displacement of each joint of the slave manipulator
dqs/dt, d 2 qs/dt 2 : the speed and acceleration are determined from a target value of the trajectory of the master manipulator.
8. The manipulation system having a force feedback capability according to claim 7 , characterized in that the master manipulator is controlled as follows:
dxm/dt is calculated as follows:
dxm/dt =( fm−fs )/ Cd
wherein,
fm: the force that the operator applies to the tip of the master manipulator
fs: fs is determined from the force fdr that the tip of the slave manipulator should produce
Cd: the set viscosity of the master manipulator.
9. The manipulation system having a force feedback capability according to claim 1 , characterized in that the slave manipulator is controlled as follows:
the target value Σdrref of the drive torque of the pneumatically-driven system is calculated as follows:
τ dr ref=− Js (transposition) fdr+Z ( qs, dqs/dt, d 2 qs/dt 2 )
wherein,
Js: the Jacobi matrix representing the transition from the displacements of the joints to the displacement of the tip position of the slave manipulator
fdr: the force that the tip of the slave manipulator should produce
Z: the inverse dynamics function for the slave manipulator
qs: the displacement of each joint of the slave manipulator
dqs/dt, d 2 qs/dt 2 : the speed and acceleration are determined from a target value of the trajectory of the master manipulator.
10. The manipulation system having a force feedback capability according to claim 1 , characterized in that the slave manipulator is controlled as follows:
the target value of the drive torque of the pneumatically-driven system is calculated by using an equation comprising an inverse dynamics function of [Z(qs, dqs/dt, d 2 qs/dt 2 )]:
wherein,
qs: the displacement of each joint of the slave manipulator
dqs/dt, d 2 qs/dt 2 : the speed and acceleration are determined from a target value of the trajectory of the master manipulator.
11. The manipulation system having a force feedback capability according to claim 1 , characterized in that the slave manipulator is controlled as follows:
the target value of the drive torque of the pneumatically-driven system is calculated by using an equation comprising dqs/dt and d 2 qs/dt 2 :
wherein,
qs: the displacement of each joint of the slave manipulator
dqs/dt, d 2 qs/dt 2 : the speed and acceleration are determined from a target value of the trajectory of the master manipulator.