The invention belongs to the technical field of
robot control, and discloses a control method for controlling an over-constrained
robot by calculating
branch force based on six-dimensional force feedback and a shaft hole
assembly system.The control method comprises the steps that an
assembly system is built, and the mapping relation between generalized external force of an over-constrained six-dimensional
force sensor and the
branch force of the over-constrained six-dimensional
force sensor is built; a
branch force
signal of the over-constrained six-dimensional
force sensor is collected in real time, generalized external force borne by a shaft part at the
tail end of the over-constrained six-dimensional force sensor is calculated, the calculated generalized external force of the shaft part is transmitted to a hole part, and then the hole part transmits the generalized external force to the
tail end of the over-constrained
robot. And the mapping relation between the over-constrained robot
tail end stress and the branch driving force of the over-constrained robot is established, the generalized external force borne by the over-constrained robot serves as an input parameter, the branch driving force of the over-constrained robot is calculated, and the over-constrained robot is controlled to complete shaft hole assembling according to the calculated branch driving force. The shaft hole assembling
system comprises an over-constrained six-dimensional force sensor used for fixing the shaft part and an over-constrained robot used for fixing the hole part. According to the method, the
statically indeterminate branch internal force can be accurately solved, universal and efficient
feedback control is achieved, and the method can be widely applied to high-precision force control scenes such as
spacecraft docking devices and precision
assembly robots.