초록 ▼

A path is generated for an end effector arranged at a top of links of a multiaxial robot, where the end effector is moved along the path from a start point thereof to an end point thereof. In generating the path, the start and end points are positionally specified in the real space, and initial pass

A path is generated for an end effector arranged at a top of links of a multiaxial robot, where the end effector is moved along the path from a start point thereof to an end point thereof. In generating the path, the start and end points are positionally specified in the real space, and initial pass points are also generated between the start and end points. Coordinate positions of both specified start and end points and generated initial pass points are converted to angles of the respective axes of the joints. Based on the start and end points and initial pass points, which have been converted to the joint angle space, the path is generated which enables the end effector to be moved in the shortest time from its start point to its end point, during the initial pass points are changed repeatedly for generating the path.

대표청구항 ▼

1. A method of generating a path for multiaxial robot provided with a plurality of movable axes composed of a plurality of links and a plurality of joints, an end effector being arranged at a top of the links connected with the joints and being moved along the path, the method being performed by a c

1. A method of generating a path for multiaxial robot provided with a plurality of movable axes composed of a plurality of links and a plurality of joints, an end effector being arranged at a top of the links connected with the joints and being moved along the path, the method being performed by a control unit and comprising steps of: reading a start point and an end point in a three-dimensional space, the start point and the end point being given to the robot;generating a pass point between the start point and the end point in the space;producing a path connecting the start point, the pass point and the end point;calculating, based on the path, a velocity pattern of the end effector under a Bobrow's method, the path being accompanied by a parameter indicting the path;producing a time duration which is necessary for the end effector to move along the path; andcomparing a currently produced time duration with a previously produced time duration to check that a difference between the time durations is below a determined threshold;wherein when the difference is not below the threshold in the comparing step, updating the pass point; andrepeating the step of producing the pass, the calculating step, the step of producing the time duration, and the comparing step until the difference becomes lower than the threshold; andwhen the difference is below the predetermined threshold in the comparing step, a current path is for use of the robot,wherein the calculating step comprises,converting the parameter showing the path into a position of the end effector in the space, andconverting the position of the end effector in the space into an angle of each of the joints used for controlling each joint. 2. The method of claim 1, wherein the initial pass points are three in number. 3. The method of claim 2, wherein the step of generating the path point generates velocity patterns of first and second joints to drive respectively the first and second joints among the plurality of joints on the basis of the start and end points which have been subjected to the angle conversion, the second link being positioned closer to the end effector than the first link, the velocity patterns enabling a movement of the second link to cause i) a reaction for increasing an acceleration force generated by the first joint when the end effector is started to be moved from the start point toward the end point, and ii) a reaction for increasing a deceleration force generated by the first joint when the end effector is stopping to the end point. 4. An apparatus for controlling drive of a multiaxial robot provided with a plurality of movable axes composed of a plurality of links and a plurality of joints, comprising: reading means for reading a start point and an end point in a three-dimensional space, the start point and end the point being given to the robot;first generating means for generating a pass point between the start point and the end point in the space;first producing means for producing a path connecting the start point, the pass point and the end point;calculating means for calculating, based on the path, a velocity pattern of the end effector under a Bobrow's method, the path being accompanied by a parameter indicting the path;second producing means for producing a time duration which is necessary for the end effector to move along the path;comparing means for comparing a currently produced time duration with a previously produced time duration to check that a difference between the time durations is below a determined threshold;updating means for updating the pass point when the difference is not below the threshold;repeating means for repeating the first producing means, the calculating means, the second producing means, and the comparing means until the difference becomes lower than the threshold;providing means for providing a current path to the robot when the difference is below the predetermined threshold; andcontrolling means for controlling drive of the plurality of movable axes based on the generated path,wherein the calculating means comprises,first converting means for converting the parameter showing the path into a position of the end effector in the space, andsecond converting means for converting the position of the end effector in the space into an angle of each of the joints used for controlling each joint.