Axis angle determination method for six-axis robot and control apparatus for six-axis robot
In an axis angle determination method, an angle or a position of each axis of a six-axis robot is determined. The robot is capable of taking an attitude of a singular point being a state in which rotation axes of fourth and sixth axes match. Based on teaching results of a position and attitude of a hand by point-to-point teaching, the method judges whether an attitude of the robot in which the angle or the position of each angle is to be determined next is a singular point. If judged that the attitude is the singular point, angles of the fourth and sixth axes required for the six-axis robot to move to the singular point are determined such that an angle of one of the fourth and sixth axes is fixed to a current value and an angle of the other axis is determined based on the fixed angle.
1. An axis angle determination method for determining an angle or a position of each axis of a six-axis robot that has first to sixth axes and a hand, the six-axis robot being capable of taking an attitude of a singular point that is a state in which a rotation axis of the fourth axis and a rotation axis of the sixth axis match,
the axis angle determination method comprising:
judging, based on teaching results of a position and an attitude of the hand obtained by point-to-point teaching of the six-axis robot, whether an attitude of the six-axis robot in which the angle or the position of each angle is to be determined next is a singular point; and
if judged that the attitude is a singular point, determining an angle of the fourth axis and an angle of the sixth axis required for the six-axis robot to move to the singular point such that an angle of one of the fourth axis and the sixth axis is determined to be fixed to a current value and an angle of the other of the fourth axis and the sixth axis is determined based on the fixed angle of one of the fourth axis and the sixth axis.
2. The axis angle determination method according to claim 1 , wherein
the first axis, the second axis, and the third axis are configured by linear-motion axes that are perpendicular to one another.
3. The axis angle determination method according to claim 1 , wherein
the axis of which the angle is to be fixed to the current value is the fourth axis.
4. The axis angle determination method according to claim 2 , wherein
the axis of which the angle is to be fixed to the current value is the fourth axis.
5. A control apparatus for determining an angle or a position of each axis of a six-axis robot that has first to sixth axes and a hand, the six-axis robot being capable of taking an attitude of a singular point that is a state in which a rotation axis of the fourth axis and a rotation axis of the sixth axis match,
the control apparatus comprising:
a singular point judging means that judges, based on teaching results of a position and an attitude of the hand obtained by point-to-point teaching of the six-axis robot, whether an attitude of the six-axis robot in which the angle or the position of each angle is to be determined next is a singular point; and
an angle determining means that, if judged that the attitude is a singular point, determines an angle of the fourth axis and an angle of the sixth axis required for the six-axis robot to move to the singular point such that an angle of one of the fourth axis and the sixth axis is determined to be fixed to a current value and an angle of the other of the fourth axis and the sixth axis is determined based on the fixed angle of one of the fourth axis and the sixth axis.
6. The control apparatus according to claim 5 , wherein
the first axis, the second axis, and the third axis are configured by linear-motion axes that are perpendicular to one another.
7. The control apparatus according to claim 5 , wherein
the axis of which the angle is to be fixed to the current value is the fourth axis.
8. The control apparatus according to claim 6 , wherein
the axis of which the angle is to be fixed to the current value is the fourth axis.