Position/force control device

A position and force control device for controlling a position of an object and force on the object in response to a position command signal and a force command signal, comprising:

• (i) driving means for driving the object based on a driving signal applied thereto;
• (ii) position detection means for detecting the position of the object to output a position signal;
• (iii) reaction force detection means for estimating a reaction force undergone by the object, where the reaction force is calculated based on a the position signal outputted from the position detection means and the driving signal applied to the driving means;
• (iv) first calculation means for calculating a first difference between a the position command signal and the position signal outputted by the position detection means and converting the first difference to a first acceleration signal;
• (v) second calculation means for calculating a second difference between the reaction force calculated by the reaction force detection means and the force command signal, and converting the second difference to a second acceleration signal;
• and
• (vi) control means for adding the said first and second acceleration signals and outputting an acceleration control signal based on said first and second acceleration signals, to said driving means.

A position and force control device for controlling positions of an object on a slave side and of an operation part on a master side in response to a position difference between the operation part on the master side and the object on the slave side, and driving the object in response to an operation force on the master side, and further transmitting a reaction force on the slave side to the master side, comprising:

• (i) first driving means for driving the operation part on the master side based on a first driving signal applied thereto;
• (ii) first position detection means for detecting a first position of the operation part on the master side to output a first position signal;
• (iii) first reaction force detection means for estimating a first reaction force acting on the operation part to output a first estimated value, where the first reaction force is calculated based on the first position signal outputted from the first position detection means and the first driving signal applied to the first driving means;
• (iv) second driving means for driving the object on the slave side based on a second driving signal applied thereto;
• (v) second position detection means for detecting a second position of the object on the slave side to output a second position signal;
• (vi) second reaction force detection means for estimating a second reaction force undergone by the object to output a second estimated value, where the second reaction force is calculated based on a the second position signal outputted from the second position detection means and a the second driving signal applied to the second driving means;
• (vii) first calculation means for calculating a difference between the first position signal outputted by the first position detection means and the second position signal outputted by the second position detection means, and converting the difference to a first acceleration signal and a second acceleration signal;
• (viii) second calculation means for calculating a sum of the first estimated value and the second estimated value respectively outputted from the first and the second reaction force detection means, and converting the sum to a third acceleration signal and a fourth acceleration signal;
• (ix) first addition means for adding the first acceleration signal and the third acceleration signal to output a first added value;
• (x) second addition means for adding the second acceleration signal and the fourth acceleration signal to output a second added value;
• (xi) first control means for outputting a first generated acceleration. control signal to the first driving means on the master side, based on the first added value outputted from the first addition means;
• and
• (xii) second control means for outputting a second generated accelerated control signal to the second driving means on the slave side, based on the second added value outputted from the second addition means.