Contact force Estimation in 2-link Robot Manipulator Using Extended Kalman Filters

확장된 칼만필터를 이용한 2축 로봇 매니퓰레이터의 접촉힘 추정

Recent requirements for the fast and accurate motion in industrial robot manipulator need more advanced control techniques. To satisfy the requirements, importance of the force control is being continuously increased and the expensive force sensor is usually installed to obtain the contact force information in practice. This information is indispensable for the force control of maintaining the desired contact force. However the sensor cost is too high to be used in industrial applications. In this paper, it is proposed to estimate the contact force occurred between the end-effector of 2 DOF robots and environment. The contact force estimation system is developed based on the static and dynamic models of 2 DOF robot manipulators, where the contact force is described with respect to the link torque. The Extended Kalman Filter is designed and its performance is verified in simulations.