원료불출기의 역기구학: 여유자유도와 구속조건을 이용한 닫힌 형태의 해

Inverse kinematics of a Reclaimer: Redundancy and a Closed- Form Solution by Exploiting Geometric Constraints

The inverse kinematics problem of a reclaimer which excavates and transports raw materials in a raw yard is investigated. Because of the geometric feature of the equipment in which scooping buckets are attached around the rotating disk, kinematic redundancy occurs in determining joint variable. Link coordinates are introduced following the Denavit-Hartenbery representation. For a given excavation point the forward kinematics yields 3 equations, however the number of involved joint variables in the equations is four. It is shown that the rotating disk at the end of the boom provides an extra passive degree of freedom. Two approaches are investigated in obtaining inverse kinematics solutions. The first method pre-assigns the height of excavation point which can be determined through path planning. A closed form solution is obtained for the first approach. The second method exploits the orthogonality between the normal vector at the excavation point and the z axis of the end-effector coordinate system. The geometry near the reclaiming point has been approximated as a plane, and the plane equation has been obtained by the least square method considering 8 adjacent points near the point. A closed form solution is not found for the second approach, however a linear approximate solution is provided.