Collision position sensing for manipulator using force/torque sensor

Force sensing including collision position, force direction and force size makes robots smoothly interact with environment to strongly adapt to outside world. Skin sensing imitates principle of human skin using special material and physical structure with disadvantages of complex design, low sampling rate, and poor generality and so on. In this paper, the method of using fore/torque sensor to calculate collision position, force direction and force size is provided. We detail elaborate algorithm based on physical principle, and unified modeling method for basic geometric surface. Considering algorithm solvability and uniqueness, three constraints are proposed, which are joint constraint, contour constraint and force direction constraint. In order to solve conflict solution of algorithm in redundant constraints, we propose compatibility and method. In addition, gravity compensation and dynamic compensation are also described for working manipulator in gravity and dynamic environment. As a result of our simulation experiment, we would find that this method is effective for manipulator to measure collision position.