Patent classifications
G05B2219/42326
FORCE CONTROL DEVICE, FORCE CONTROL METHOD, AND FORCE CONTROL PROGRAM
Provided is a force control device and the like that can, even in the case of torque saturation, reduce positional deviation between a virtual object and a control target by using an algebraic loop to feedback a position of the virtual object, and improve stability while improving followability. The force control device includes: a position detector that detects a position of the control target; a force sensor 11 that detects a force by which the control target is in contact with an object; a moving mechanism 41 that movably holds the control target; a driving unit 42 that includes a motor that uses a torque command value as an input to operate the moving mechanism 41; and a computing unit 40 that determines the torque command value. The computing unit 40 stores a virtual object 12 having predetermined dynamic characteristics, and a position controller 13, and is configured to: calculate a position at a next time, the position being calculated by simulating a motion of the virtual object when a target force exerted on the control target and a measured value of the force sensor 11 are given to the virtual object; obtain a torque calculated when the calculated position is given to the position controller 13 as a target position at the next time; and, when the obtained torque is outside the predetermined range set previously, determine the position of the virtual object 12 at the next time based on a boundary value of the predetermined range and the obtained torque.