This paper proposes a method to determine a contact point location by a 6D force sensor with noise on force/moment signals. In the noiseless case, it is well known that candidates of the contact point are represented by a line parallel to the acting force, and the contact point can be determined from the intersection of the line and the robot surface. However, if the line is constructed from actual force/moment sensor signals directly, the candidates of the contact point may be unreliable because of the measurement noise. In this paper, we propose a method to determine the contact point from an optimization problem, in which the cost function represents the error of the force/moment balances. Candidates of the contact point are also represented by a line, which is parallel to the estimated acting force in this case. As in the noiseless case, the contact point can be determined from the intersection of the line and the robot surface. Numerical examples and experimental results are shown to prove efficiency of the proposed method.
View full abstract