×

Collision avoidance method, control device, and program

  • US 9,827,675 B2
  • Filed: 11/27/2015
  • Issued: 11/28/2017
  • Est. Priority Date: 12/09/2014
  • Status: Active Grant
First Claim
Patent Images

1. A collision avoidance method of a robot arm that avoids collision of the robot arm with an obstacle, the robot arm including a first arm and a second arm connected to each other via a joint part, the method comprising:

  • calculating, as movable areas of the first arm and the second arm, trajectories drawn by the first arm and the second arm in an XYZ coordinate system when the first arm and the second arm are rotated in a state in which positions of both a first end and a second end of the robot arm have been fixed;

    calculating intersections that are points, in the XYZ coordinate system, in which the movable areas and a first line intersect, wherein the first line is set on a boundary surface of an obstacle area that is coordinate data including positions of the obstacle, and wherein the first line is used for determining a collision of the robot arm with the obstacle; and

    determining boundary angles of an arm angle of the robot arm based on the intersections that have been calculated, and determining, when the movable areas are separated by the boundary angles, a side of the separated movable areas which does not collide against the obstacle area, as a collision avoidance range in which the robot arm does not collide against the obstacle area in the movable areas.

View all claims
  • 1 Assignment
Timeline View
Assignment View
    ×
    ×