摘要 |
There is provided a control system which controls a link structure constructed by connecting a plurality of rigid body links and driven by making a joint actuator generate an actuator force. The control system includes a mechanical model including geometric parameters and dynamical parameters of the link structure, a virtual external force calculating means for calculating a virtual force acting on the mechanical model of the link structure, a contact part detecting means for detecting contact parts between the link structure and the outside, and an actual force converting means for converting the virtual force calculated by the virtual external force calculating means into an external force capable of existing actually and the actuator force of the joint actuator, using contact information detected by the contact part detecting means. The joint actuator is made to generate the actuator force output by the actual force converting means.
|