A teaching method of driving a robot arm by a drive unit based on a detection result of a force detection unit and storing a position and a posture of the driven robot arm in a memory unit, includes determining whether or not the posture of the robot arm is close to a singular posture, and, when determining that the posture of the robot arm is close to the singular posture, selecting and executing one escape posture from a plurality of escape posture candidates escaping from the posture close to the singular posture according to an external force detected by the force detection unit.
Legal claims defining the scope of protection, as filed with the USPTO.
1. A teaching method for a robot system including a robot arm having at least one rotatable arm, a drive unit that drives the robot arm, a force detection unit that detects an external force applied to the robot arm, and a memory unit that stores a position and a posture of the robot arm, of driving the robot arm by the drive unit based on a detection result of the force detection unit and storing the position and the posture of the driven robot arm in the memory unit, the teaching method comprising: determining whether or not the posture of the robot arm is close to a singular posture; and when determining that the posture of the robot arm is close to the singular posture, selecting and executing one escape posture from a plurality of escape posture candidates escaping from the posture close to the singular posture according to the external force detected by the force detection unit.
2. The teaching method according to claim 1 , wherein the robot system includes an angle detection unit that detects a rotation angle of the arm, and the determination is made based on whether or not a detection result of the angle detection unit is within a predetermined range or a position of a control point obtained from the detection result is within a predetermined range.
3. The teaching method according to claim 1 , wherein when the escape posture is selected, a direction of the external force applied to the robot arm is specified according to a direction of the force detected by the force detection unit and the escape posture in which a control point is moved forward in the specified direction is selected.
4. The teaching method according to claim 1 , wherein when the determination that the posture of the robot arm is close to the singular posture is made, motion of the robot arm is stopped and the external force is detected by the force detection unit before the robot arm is displaced to the escape posture.
5. The teaching method according to claim 1 , wherein the memory unit stores at least the single singular posture specific to the robot arm and a plurality of the escape postures corresponding to the singular posture.
6. The teaching method according to claim 1 , wherein the robot system includes a reporting unit, and when the determination that the posture of the robot arm is close to the singular posture is made, the reporting unit is actuated and reports that the posture of the robot arm is close to the singular posture before the robot arm is displaced to the escape posture.
Cooperative Patent Classification codes for this invention. Click any code to explore related patents in that topic.
October 9, 2020
July 19, 2022
Browse 5M+ US patents with plain-English claim translations and AI-generated analysis.