WO2021152697A1 - 制御装置、制御方法、情報処理装置及び情報処理方法 - Google Patents

制御装置、制御方法、情報処理装置及び情報処理方法 Download PDF

Info

Publication number
WO2021152697A1
WO2021152697A1 PCT/JP2020/002987 JP2020002987W WO2021152697A1 WO 2021152697 A1 WO2021152697 A1 WO 2021152697A1 JP 2020002987 W JP2020002987 W JP 2020002987W WO 2021152697 A1 WO2021152697 A1 WO 2021152697A1
Authority
WO
WIPO (PCT)
Prior art keywords
arm
correction
angle
target position
correction angle
Prior art date
Application number
PCT/JP2020/002987
Other languages
English (en)
French (fr)
Inventor
祐一郎 菊川
良 永田
信夫 大石
Original Assignee
株式会社Ｆｕｊｉ
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社Ｆｕｊｉ filed Critical 株式会社Ｆｕｊｉ
Priority to PCT/JP2020/002987 priority Critical patent/WO2021152697A1/ja
Priority to JP2021573667A priority patent/JP7351935B2/ja
Publication of WO2021152697A1 publication Critical patent/WO2021152697A1/ja

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements

Definitions

  • This specification discloses a control device, a control method, an information processing device, and an information processing method.
  • an arm robot for example, a robot arm provided with an actuator for driving each joint and a designated target position is corrected by a correction parameter to operate the robot arm has been proposed (see, for example, Patent Document 1).
  • the required work accuracy can be ensured by reflecting the correction parameters in which the spatial coordinate values and the correction values are associated with each other for a plurality of work points in the target position.
  • the present disclosure has been made in view of such a problem, and its main purpose is to provide a control device, a control method, an information processing device, and an information processing method capable of further improving the working accuracy of the arm robot.
  • control device control method, information processing device, and information processing method disclosed in the present specification have adopted the following means in order to achieve the above-mentioned main object.
  • the control device of the present disclosure is A control device that controls an arm robot equipped with an arm that rotates around a rotation axis.
  • a storage unit that stores correction information including a correction angle of the rotation axis when the arm is arranged at a target position, and a storage unit.
  • a control unit that acquires the correction angle with respect to the target position included in the correction information and rotates the arm based on the correction angle. It is equipped with.
  • correction information including the correction angle of the rotation axis when the arm of the arm robot is arranged at the target position is stored in the storage unit, and the correction angle with respect to the target position included in the correction information is acquired.
  • the arm is rotated based on the correction angle.
  • the work accuracy can be further improved as compared with, for example, a device that indirectly corrects the target position.
  • the schematic explanatory view which shows an example of the work work system 10 and the setting system 40.
  • FIG. 1 is a schematic explanatory view showing an example of the work work system 10.
  • FIG. 2 is an explanatory diagram of an example of correction information 34 stored in the storage unit 33.
  • the work work system 10 is configured to include a plurality of arm robots 20 that perform predetermined work on an article (work W) to be worked.
  • the work work system 10 includes one or more arm robots 20, a base 11 on which the arm robots 20 are arranged, a transfer unit 12 for transporting and fixing the work member 13 on which the work W is arranged to the work area, and an arm. It includes a control PC 30 that controls the robot 20.
  • the left-right direction (X-axis), front-back direction (Y-axis), and up-down direction (Z-axis) of the work work system 10 are as shown in FIG. Further, since the arm robot 20 is movable in all directions, there is no fixed direction, but for convenience of explanation, the direction shown in FIG. 1 is the left-right direction (X-axis) with respect to the arm robot 20. It will be described as the front-back direction (Y-axis) and the up-down direction (Z-axis).
  • the arm robot 20 is configured as a device that executes a predetermined work on the work W to be worked.
  • the work W include various parts such as mechanical parts, electric parts, electronic parts, and chemical parts, as well as food, bio, and biological related articles.
  • the predetermined work includes, for example, a moving work of collecting, moving, and arranging from a collecting position to a placement position, an assembling work of assembling parts, a processing work of processing, a coating work of applying a viscous material, and heating by heating. Examples include work, processing work for performing a predetermined chemical and / or physical treatment, and inspection work for performing an inspection.
  • Assembling work includes, for example, fastening work of fastening members such as screws and bolts, insertion work of connectors, wiring work, fitting work of parts, mounting work of members, and pressing work of pressing the work.
  • Examples of the processing work include grinding work, cutting work, deformation work, connection work, and joining work.
  • Examples of the viscous material include adhesives, solder pastes, and greases.
  • Examples of the inspection work include the work of inspecting one or more work results described above, and may involve the work of moving the work W.
  • This arm robot 20 is a work robot provided with an arm 21 that rotates around a rotation shaft 24.
  • the arm robot 20 includes an arm 21, an end effector 22, and a drive unit 23.
  • the arm 21 is an articulated arm and includes a first arm 21a and a second arm 21b.
  • the end effector 22 is a member that performs a predetermined work on the work W, and is rotatably connected to the tip of the arm 21.
  • the drive unit 23 is a motor that drives the arm 21.
  • the drive unit 23 rotationally drives the first rotation shaft 24a connected to the first arm 21a and the second rotation shaft 24b connected to the second arm 21b.
  • the first arm 21a and the second arm 21b are collectively referred to as an arm 21, and the first rotation shaft 24a and the second rotation shaft 24b are collectively referred to as a rotation shaft 24.
  • the control PC 30 is a computer that controls the entire arm robot 20 included in the work work system 10.
  • the control PC 30 includes a control device 31, a display unit 38, and an input device 39.
  • the control device 31 has the function of the control device of the present disclosure.
  • the control device 31 is configured as a microprocessor centered on the CPU 32, and includes a storage unit 33 for storing data.
  • the control device 31 outputs a drive signal to the drive unit 23 of the arm robot 20 and the like.
  • the display unit 38 displays a screen including information about the arm robot 20, and is, for example, a liquid crystal display.
  • the input device 39 is a mouse, a keyboard, or the like that performs various inputs.
  • the storage unit 33 is configured as a large-capacity storage device such as an HDD.
  • the storage unit 33 stores correction information 34 and the like used for controlling the arm 21.
  • the correction information 34 includes information including a correction angle of the rotation shaft 24 when the arm 21 is arranged at a designated point as a target position.
  • the designated points are coordinate points that form a three-dimensional matrix in the operating range in which the arm 21 can work.
  • the designated points are set at equal intervals in the space of the X-axis, the Y-axis, and the Z-axis.
  • the correction angles corresponding to the first arm 21a and the second arm 21b are set for each designated point. It is associated.
  • the correction information 34 defines, for example, the angle correction value of the first rotation shaft 24a is ⁇ Qj1 and the angle correction value of the second rotation shaft 24b is ⁇ Qj2.
  • the correction angle is defined as a value that reduces the difference between the tip position (actual measurement position) of the arm 21 and the target position when the rotation shaft 24 is rotated at an instruction angle for moving the arm 21 to the target position.
  • the control device 31 acquires the correction information 54 created by the setting system 40 and stores it in the storage unit 33 as the correction information 34.
  • the setting system 40 is configured as a system for adjusting the work work system 10 before shipment, and executes, for example, a process of setting a value used for controlling the arm robot 20.
  • the setting system 40 includes an information processing PC 50 and an optical tracking device 60.
  • the information processing PC 50 is a computer that measures the operation of the arm robot 20 included in the work work system 10 and sets values and the like used for controlling the arm robot 20.
  • the information processing PC 50 includes a control device 51, a display unit 58, and an input device 59.
  • the control device 51 has the function of the information processing device of the present disclosure, and also has the function of the control device 31 that controls the arm robot 20.
  • the control device 51 is configured as a microprocessor centered on the CPU 52, and includes a storage unit 53 for storing data. For example, the control device 51 sets the correction information 54 including the correction angle used by the arm robot 20, and outputs the correction information 54 to the work work system 10.
  • the control device 51 outputs a control signal to the optical tracking device 60 or the like, and inputs a measurement signal or the like from the optical tracking device 60 or the like.
  • the storage unit 53 stores correction information 54 and the like used in the arm robot 20.
  • the display unit 58 displays a screen including information about the work work system 10, and is, for example, a liquid crystal display.
  • the input device 59 is a mouse, a keyboard, or the like that performs various inputs.
  • the optical tracking device 60 is a device that obtains the three-dimensional coordinates of a measurement target by, for example, irradiating the measurement target with a laser.
  • the optical tracking device 60 is a device that obtains three-dimensional coordinates of a working point at the tip of the arm 21 when the arm 21 moves to a designated point which is a target position. With this optical tracking device 60, the amount of deviation between the designated point and the working point of the arm 21 can be grasped.
  • FIG. 3 is a flowchart showing an example of a correction information setting processing routine executed by the CPU 52 of the information processing PC 50.
  • FIG. 4 is an explanatory diagram of an indicated value and a measured value in XY coordinates.
  • FIG. 5 is an explanatory view of an example of another arm arrangement.
  • the correction information setting processing routine is stored in the storage unit 53 and executed in response to the start input of the operator. Before shipping the work work system 10, when setting the correction value of the arm robot 20, the worker connects the information processing PC 50 to the arm robot 20, arranges the optical tracking device 60, and then starts the information processing PC 50. Make an input.
  • the CPU 52 of the control device 51 sets a designated point for obtaining the correction angle (S100).
  • the designated points are set in a three-dimensional matrix of the operating range of the arm 21, and are set in a predetermined order, for example, in order from the origin.
  • the designated points a (Xa, Ya) are set (FIG. 4).
  • FIGS. 4 and 5 show the coordinates of the designated points a to d on the XY plane for convenience of explanation.
  • the CPU 52 obtains an instruction angle for rotating each arm 21 so that the work point P at the tip of the arm 21 overlaps the designated point in the arrangement of the arm 21 (S110).
  • the arm 21 is controlled at the obtained indicated angle (S120).
  • the first rotation shaft 24a has a designated angle Qj1a and the second rotation shaft 24b so that the work point P overlaps the set designated points a (Xa, Ya).
  • the designated angle Qj2a is set, and the drive unit 23 is controlled so as to have that angle.
  • the CPU 52 causes the optical tracking device 60 to measure the coordinates of the work point P, acquires the measurement coordinates of the work point P from the optical tracking device 60 (S130), and obtains the difference distance between the designated point and the work point P.
  • the correction angle of each rotating shaft 24 to be reduced is obtained (S140).
  • the CPU 52 acquires the measurement coordinates (Xa', Ya'... Xd', Yd') with respect to the designated points (Xa, Ya ... Xd, Yd), and the designated points and the measurement coordinates.
  • Qj1d, Qj2d is obtained with respect to the specified point.
  • the measurement angle (Qj1a', Qj2a' ... Qj1d', Qj2d') is obtained with respect to the measurement coordinates.
  • the difference value between the designated angle and the measurement angle is a correction angle ( ⁇ Qj1a, ⁇ Qj2a ... ⁇ Qj1d, ⁇ Qj2d) at which the measurement coordinates and the designated point overlap, respectively.
  • the correction angle ⁇ Qj1a is the correction value (Qj1a'-Qj1a) of the first rotation shaft 24a at the designated point a
  • the correction angle ⁇ Qj2a is the correction value of the second rotation shaft 24b at the designated point a (Qj1a'-Qj1a).
  • Qj2a'-Qj2a is the correction value of the first rotation shaft 24a at the designated point a
  • the CPU 52 stores the obtained correction angle in the correction information 54 in association with the designated point (S150), and determines whether or not the correction angle has been obtained for all the designated points in the current arrangement of the arm 21. (S160).
  • the CPU 52 executes the processes after S100. That is, the CPU 52 sets the next designated point, controls the arm 21 so that the work point overlaps the designated point, and sets the correction angle of the rotation shaft 24 that reduces the deviation between the actual work point P and the designated point. It is obtained and stored in the correction information 54.
  • the CPU 52 determines whether or not there is another arrangement of the arms 21 in which the designated points and the working points P overlap. Judgment (S170). When there is another arrangement of the arms 21, the CPU 52 changes the arrangement position of the arms 21 (S180) and executes the processing after S100. As shown in FIG. 5, depending on the position of the designated point, the arm 21 can superimpose the working point P on the designated point by arranging a plurality of arms 21 as in the so-called left-handed system and right-handed system. The CPU 52 also obtains the correction angle for such another pattern.
  • the CPU 52 when there is no other arm 21 arranged in S170, the CPU 52 outputs the correction information 54 to the control PC 30 (S190), and ends this routine. In this way, the CPU 52 sets a correction angle for correcting the angle of the rotation shaft 24 for each designated point, and stores the correction information 34 in the control PC 30.
  • FIG. 6 is a flowchart showing an example of a work processing routine executed by the CPU 32 of the control PC 30.
  • FIG. 7 is an explanatory diagram of the target position e existing at a point other than the designated point.
  • the work processing routine is stored in the storage unit 33 and executed in response to the start input of the worker.
  • a case where the arm robot 20 performs a process of moving the work W from the supply position to the target position e (Xe, Ye) on the work member 13 will be described as a specific example.
  • the CPU 32 of the control device 31 acquires the target position for performing the work of the arm robot 20 (S200), and the arm is set at the target position based on the inverse kinematics according to the predetermined arrangement position of the arm 21.
  • An instruction angle for rotating each arm 21 is obtained so that the work points P of 21 overlap (S210).
  • the arrangement position of the arm 21 is predetermined to be prioritized according to the working environment, such as whether to operate in the left arm system or the right arm system.
  • the CPU 32 extracts a designated point close to the target position from the correction information 34, and determines whether or not the target position has the same coordinates as the designated point (S220).
  • the correction angle of each rotation axis 24 associated with the designated point can be used as it is, so that the CPU 32 acquires the correction angle from the correction information 34 (S240).
  • the rotation shaft 24 is rotated using the value obtained by correcting the indicated angle with the acquired correction angle (S270).
  • the CPU 32 performs interpolation processing and obtains the most effective correction angle by calculation (S250 to S260). Specifically, the CPU 32 acquires the correction angle of the designated point extracted in S220 (S250), performs weighting inversely proportional to the distance between the target position and the designated point, and derives the correction angle (S260). Then, the CPU 32 rotates the rotation shaft 24 using the value obtained by correcting the indicated angle with the derived correction angle (S270).
  • the CPU 32 weights the correction angles of a plurality of designated points close to the target position in inverse proportion to the distance from the target position to the designated points as an interpolation of the correction angles for the target positions other than the designated points.
  • the correction angle is derived. That is, when the target position is between a plurality of designated points, the CPU 32 calculates a correction angle that has a stronger influence on the designated points that are closer to the target position.
  • the derivation of the correction angle will be explained using a concrete example.
  • the distances La to Ld are the distances between the designated points a to d and the target position e, respectively.
  • the angle error at the designated point a affects the target position e as much as expressed by the equations (1) and (2). That is, in the first rotation axis 24a, the term obtained by multiplying the correction angle ⁇ Qj1a associated with the designated point a by the distances La to Ld and dividing by La is added, and the rest not including the distance from one designated point.
  • the correction angle at the target position e is weighted in inverse proportion to the distance, and the equation ( The correction angle ⁇ Qj2e of the equation (4) is obtained by calculation with respect to the correction angle ⁇ Qj1e of 3) and the second rotation shaft 24b.
  • the CPU 32 acquires the target positions existing between the designated points, the CPU 32 extracts a plurality of designated points close to the target positions, and sets the correction angle of the extracted designated points to the designated points other than the designated points.
  • the value obtained by multiplying the distance from the target position is added, divided by the distance factor between the specified points, and the weighted correction angle is interpolated.
  • the CPU 32 determines whether or not all the work of the arm robot 20 has been completed (S280), and when all the work has not been completed, The processing after S200 is repeatedly executed. On the other hand, when all the work is completed in S280, the CPU 32 ends this routine.
  • FIG. 8 is an explanatory diagram of the amount of misalignment in the angle correction and the position correction.
  • FIG. 8 shows the result of obtaining the difference (distance) between the target position (true value) and the actually measured position when the yaw of the second joint J2 of the 5-axis arm robot is twisted by 0.5 °.
  • the XY plane coordinates will be used, but the description can be applied to the three-dimensional coordinates of the XYZ.
  • correction may be performed by adding a correction value to a target position (X, Y).
  • the correction value is adjusted to the target position (X, Y) to correct the XY coordinates (X', Y'), and this is applied to the indicated angle of each rotation axis 24 based on the inverse kinematics. It is a process of conversion (Qj1, Qj2). This is called position correction.
  • the angle correction of the present disclosure the indicated angles (Qj1', Qj2') of each rotation axis 24 are obtained from the target positions (X, Y) based on the inverse kinematics, and the angle corrections ( ⁇ Qj1, ⁇ Qj2) are obtained. ) Is added to obtain the indicated angles (Qj1, Qj2) of each rotation shaft 24.
  • angle correction shows higher accuracy as shown in FIG. 8 because the indicated angle, which is a direct command value, is corrected as compared with the indirect correction that converts the position to the angle. rice field. In this way, it was found that by using the correction angle, absolute accuracy can be given to the arm robot that is generally controlled by teaching.
  • the control device 31 of the present embodiment corresponds to the control device of the present disclosure
  • the arm robot 20 corresponds to the arm robot
  • the arm 21, the first arm 21a, and the second arm 21b correspond to the robot arm
  • the first rotation shaft 24a and the second rotation shaft 24b correspond to the rotation shaft
  • the storage unit 33 corresponds to the storage unit
  • the correction information 34 corresponds to the correction information
  • the CPU 32 corresponds to the control unit
  • the control device 51 corresponds to the information processing device
  • the CPU 52 corresponds to the setting unit
  • the optical tracking device 60 corresponds to the optical tracking device.
  • an example of the control method of the present disclosure is clarified by explaining the operation of the control device 31, and an example of the information processing method of the present disclosure is clarified by explaining the operation of the control device 51. Has been clarified.
  • the control PC 30 of the embodiment described above includes a control device 31 for controlling an arm robot including an arm 21 that rotates about a rotation shaft 24, and when the arm 21 is arranged at a designated point as a target position.
  • a storage unit 33 that stores correction information 34 including the correction angle of the rotation shaft 24, and a control unit that acquires the correction angle with respect to the target position included in the correction information 34 and rotates the arm 21 based on this correction angle.
  • CPU 32 is provided.
  • correction information 34 including the correction angle of the rotation shaft 24 when the arm 21 of the arm robot 20 is arranged at the target position is stored in the storage unit 33, and the correction information 34 is stored in the storage unit 33 with respect to the target position included in the correction information 34.
  • the correction angle is acquired, and the arm 21 is rotated based on this correction angle. Since the control device 31 directly corrects the angle of the rotating shaft 24 to be controlled, the work accuracy can be further improved as compared with, for example, a device that indirectly corrects the target position.
  • the storage unit 33 has correction information 34 in which the correction angle of the rotation shaft 24 set based on the angle of the rotation shaft 24 measured when the arm 21 is arranged at the designated point is associated with each designated point. Is stored, and the CPU 32 weights the correction angles of a plurality of designated points close to the target position in inverse proportion to the distance from the target position to the designated point as an interpolation of the correction angle for the target position other than the designated point.
  • the corrected correction angle is derived, and the arm 21 is rotated based on the derived correction angle.
  • weighting is performed in inverse proportion to the distance to the designated point for the target position other than the designated point where the correction angle is directly set, that is, the correction value of the closer designated point is stronger.
  • the arm robot 20 is an articulated robot including the first arm 21a and the second arm 21b as the arm 21, and the storage unit 33 corresponds to a designated point of three-dimensional coordinates including the X-axis, the Y-axis, and the Z-axis.
  • the correction information 34 including the correction angle of the attached rotation shaft 24 is stored, and when the CPU 32 acquires the target position existing between the designated points, the CPU 32 extracts and extracts a plurality of designated points close to the target position.
  • the value obtained by multiplying the correction angle of the designated point by the distance between the designated point other than the designated point and the target position is added, and the weight is divided by the distance factor between the designated points.
  • this control device 31 it is possible to derive an appropriate correction angle according to the distance in the relationship between the designated point of the three-dimensional coordinates and the target position.
  • the storage unit 33 is set for each of the plurality of arrangement positions when a plurality of arrangement positions exist in the first arm 21a and the second arm 21b.
  • the correction information 34 including the correction angle is stored, and the CPU 32 acquires the correction angle according to the target position and the arrangement position of the arm 21, and rotates the arm 21 based on the correction angle.
  • appropriate correction can be performed according to the arrangement position of the arm 21.
  • the CPU 32 acquires the indicated angle of the rotation shaft 24 based on the inverse kinematics, acquires the correction angle based on the correction information 34, and corrects the indicated angle with the correction angle. Rotate the arm at the corrected indicated angle.
  • the position of the arm 21 can be directly corrected by operating the arm 21 based on the inverse kinematics, so that the work accuracy can be further improved.
  • the information processing PC 50 is an information processing device that sets a correction value for correcting the position of the arm robot 20 provided with the arm 21 that rotates about the rotation shaft 24.
  • the control device 51 acquires the position of the arm 21 measured when the arm 21 is arranged at a designated point as a target position, obtains the correction angle of the rotation shaft 24, and includes the correction angles at a plurality of designated points.
  • a CPU 52 is provided as a setting unit for setting the correction information 54.
  • the angle of the rotation shaft 24 is acquired from the position of the arm 21 measured when the arm 21 is arranged at the designated point as the target position, and the correction angle of the rotation shaft 24 is obtained, and a plurality of correction angles are obtained.
  • the correction information 54 including the correction angle at the designated point is set.
  • the angle of the rotating shaft 24 to be controlled is directly corrected, so that the arm robot 20 is compared with the one that indirectly corrects the target position, for example. Work accuracy can be further improved.
  • the CPU 52 when arranging the arm 21 at the target position, the CPU 52 includes a correction angle corresponding to each of the plurality of arrangement positions when a plurality of arrangement positions exist in the first arm 21a and the second arm 21b.
  • the correction information 34 is set.
  • appropriate correction can be performed according to the arrangement position of the arm 21.
  • the CPU 52 obtains a correction angle for reducing the difference between the position of the arm 21 and the target position when the rotation shaft 24 is rotated at an instruction angle for moving the arm 21 to the target position.
  • a more appropriate correction angle can be obtained.
  • the CPU 52 acquires the position of the arm 21 measured by the optical tracking device 60 from the optical tracking device 60, and obtains a correction angle using the acquired position of the arm. In this information processing PC 50, a more appropriate correction angle can be obtained by using the optical tracking device 60.
  • the correction value is set by the setting system 40 at the time of shipment of the work work system 10, but the present invention is not particularly limited to this.
  • the function of the information processing PC 50 may be added to the control PC 30 so that the control PC 30 can set the correction angle.
  • the control PC 30 can periodically adjust the work robot 20.
  • control PC 30 uses a correction angle weighted according to the distance, but this process may be omitted.
  • the control device 31 may use the correction angle of the designated point having the shortest distance after storing the correction information 34 such as increasing the density of the designated points.
  • the control device 31 can also improve the work accuracy of the arm robot 20.
  • the storage unit 33 stores the correction information 34 including a plurality of correction angles corresponding to the arrangement positions in the storage unit 33.
  • the correction information 34 is not limited, and may include the correction angle only for the arrangement of the arm 21 used in the work robot 20. Also in this control device 31, the work accuracy of the arm robot 20 can be further improved by using the correction information 34.
  • the information processing PC 50 has a plurality of arrangement positions of the arms 21, a plurality of correction angles corresponding to the arrangement positions of the arms 21 are obtained, but the present invention is not particularly limited to this, and only the arrangement of the arms 21 used in the work robot 20 is obtained. The correction angle of may be obtained.
  • the information processing PC 50 acquires the position coordinates of the arm 21 from the optical tracking device 60 and sets the correction angle, but the information processing PC 50 is not particularly limited to the optical tracking device 60.
  • the information processing PC 50 may acquire the position coordinates of the arm 21 from another coordinate measuring device different from the optical tracking device.
  • control device 31 has been described as being provided by the control PC 30 connected to the outside of the arm robot 20, but the present invention is not particularly limited to this, and for example, a controller provided inside the arm robot 20 is used as the control device. May be good.
  • contents of the present disclosure have been described as the control device 31 and the control device 51, but they may also be a control method or an information processing method. Further, it may be a program that executes a control method or a program that executes an information processing method.
  • control device and the information processing device of the present disclosure may be configured as follows.
  • the storage unit sets a correction angle of the rotation axis set based on the position of the arm measured when the arm is arranged at a designated point for each designated point.
  • the associated correction information is stored, and the control unit performs the correction angle interpolation for the target position other than the designated point with respect to the correction angle of the plurality of designated points close to the target position.
  • a correction angle that is weighted inversely proportional to the distance from the target position to the designated point may be derived, and the arm may be rotated based on the derived correction angle.
  • weighting is performed in inverse proportion to the distance to the specified point for the target position other than the specified point where the correction angle is directly set, that is, the correction value of the closer specified point has a stronger effect. Since the correction angle to be performed is interpolated and obtained, the work accuracy can be further improved even for the target position other than the designated point.
  • the arm robot is an articulated robot including a first arm and a second arm as the arms
  • the storage unit is three-dimensional including an X-axis, a Y-axis, and a Z-axis.
  • the correction information including the correction angle of the rotation axis associated with the designated point of the coordinates is stored, and when the control unit acquires the target position existing between the designated points, the control unit approaches the target position.
  • a plurality of the designated points are extracted, and the value obtained by multiplying the corrected angle of the extracted designated points by the distance between the designated points other than the designated points and the target position is added to each of them, and the distance factor between the designated points is used.
  • the weighting may be performed by dividing. In this control device, it is possible to derive an appropriate correction angle according to the distance in the relationship between the designated point of the three-dimensional coordinates and the target position.
  • the arm robot is an articulated robot including a first arm and a second arm as the arm, and the storage unit is the first arm when arranging the arm at the target position.
  • the correction information including the correction angle set for each of the plurality of arrangement positions is stored, and the control unit stores the correction information including the target position and the target position.
  • the correction angle corresponding to the arrangement position of the arm may be acquired and the arm may be rotated based on the correction angle.
  • appropriate correction can be performed according to the arrangement position of the arm.
  • the arm is based on right-handed movement and left-handed movement, and the correction information includes a correction angle for right-handed movement and a correction angle for left-handed movement. good.
  • the control unit when the control unit acquires the target position, the control unit acquires the indicated angle of the rotation axis based on the inverse kinematics, and acquires the correction angle based on the correction information.
  • the indicated angle may be corrected by the correction angle, and the arm may be rotated by the corrected indicated angle.
  • the position of the arm can be directly corrected by operating the arm based on the inverse kinematics, so that the work accuracy can be further improved.
  • the control method of the present disclosure is A control method for controlling an arm robot having an arm that rotates around a rotation axis.
  • the angle of the rotating shaft to be controlled is directly corrected. Therefore, the work accuracy is further improved as compared with, for example, the one that indirectly corrects the target position. Can be done.
  • the mode of any of the above-mentioned control devices may be adopted, or the step of expressing the function of any of the above-mentioned control devices may be included.
  • the information processing device of the present disclosure is An information processing device that sets a correction value that corrects the position of an arm robot equipped with an arm that rotates around a rotation axis.
  • the position of the arm measured when the arm is arranged at a designated point as a target position is acquired, the correction angle of the rotation axis is obtained, and correction information including the correction angles at a plurality of the designated points is set. It is equipped with a setting unit.
  • the angle of the rotation axis is acquired from the position of the arm measured when the arm is arranged at the designated point as the target position, the correction angle of the rotation axis is obtained, and the correction at a plurality of designated points is performed. Set the correction information including the angle. Similar to the above control device, this information processing device directly corrects the angle of the rotating shaft to be controlled, so that the working accuracy of the arm robot is higher than that of, for example, indirectly correcting the target position. Can be further enhanced.
  • the arm robot is an articulated robot including a first arm and a second arm as the arm, and the setting unit receives the first arm when arranging the arm at the target position.
  • the correction information including the correction angles corresponding to the plurality of arrangement positions may be set. In this information processing device, appropriate correction can be performed according to the arrangement position of the arm.
  • the setting unit reduces the difference between the position of the arm and the target position when the rotation shaft is rotated at an instruction angle for moving the arm to the target position. You may find the angle. With this information processing device, a more appropriate correction angle can be obtained.
  • the setting unit may acquire the position of the arm measured by the optical tracking device from the optical tracking device and obtain the correction angle using the acquired position of the arm. ..
  • a more appropriate correction angle can be obtained by using an optical tracking device. Examples of this optical tracking device include a laser tracking device.
  • the information processing method of the present disclosure is An information processing method for setting a correction value for correcting the position of an arm robot having an arm that rotates around a rotation axis.
  • this information processing method directly corrects the angle of the rotating shaft to be controlled, so that the work of the arm robot is different from that of indirectly correcting the target position, for example.
  • the accuracy can be further improved.
  • the mode of any of the above-mentioned information processing devices may be adopted, or the step of expressing the function of any of the above-mentioned information processing devices may be included.
  • This disclosure can be used in the field of working robots equipped with a robot arm.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

制御装置は、回動軸を中心に回動するアームを備えたアームロボットを制御する制御装置であって、アームを目標位置へ配置させたときの回動軸の補正角度を含む補正情報を記憶する記憶部と、補正情報に含まれる目標位置に対する補正角度を取得しこの補正角度に基づいてアームを回動させる制御部と、を備える。

Description

制御装置、制御方法、情報処理装置及び情報処理方法
　本明細書は、制御装置、制御方法、情報処理装置及び情報処理方法を開示する。
　従来、アームロボットとしては、例えば、各関節を駆動するアクチュエータを備え、指定された目標位置を補正パラメータにより補正してロボットアームを動作させるものが提案されている（例えば、特許文献１参照）。この多関節アームロボットでは、複数の作業点に対して空間座標値と補正値とを対応付けた補正パラメータを目標位置に反映させることによって、必要な作業精度を確保することができる。
国際公開第２０１８／０９２２４３号パンフレット
　しかしながら、上述した特許文献１の装置では、目標位置を補正することによって必要な作業精度を確保することができるが、まだ十分ではなく、作業精度を更に高めることが望まれていた。
　本開示は、このような課題に鑑みなされたものであり、アームロボットの作業精度をより高めることができる制御装置、制御方法、情報処理装置及び情報処理方法を提供することを主目的とする。
　本明細書で開示する制御装置、制御方法、情報処理装置及び情報処理方法は、上述の主目的を達成するために以下の手段を採った。
　本開示の制御装置は、
　回動軸を中心に回動するアームを備えたアームロボットを制御する制御装置であって、
　前記アームを目標位置へ配置させたときの前記回動軸の補正角度を含む補正情報を記憶する記憶部と、
　前記補正情報に含まれる目標位置に対する前記補正角度を取得し該補正角度に基づいて前記アームを回動させる制御部と、
　を備えたものである。
　この制御装置では、アームロボットのアームを目標位置へ配置させたときの回動軸の補正角度を含む補正情報を記憶部に記憶し、補正情報に含まれる目標位置に対する補正角度を取得し、この補正角度に基づいてアームを回動させる。この制御装置では、制御する回動軸の角度を直接的に補正するため、例えば、間接的に目標位置を補正するものなどに比して、作業精度をより高めることができる。
ワーク作業システム１０及び設定システム４０の一例を示す概略説明図。 記憶部３３に記憶された補正情報３４の一例の説明図。 補正情報設定処理ルーチンの一例を表すフローチャート。 指示値と測定値の説明図。 別のアーム配置の一例の説明図。 作業処理ルーチンの一例を表すフローチャート。 指定点以外に存在する目標位置ｅの説明図。 角度補正と位置補正における位置ずれ量の説明図。
　本明細書で開示するワーク作業システム１０及び設定システム４０の実施形態を図面を参照しながら以下に説明する。図１は、ワーク作業システム１０の一例を示す概略説明図である。図２は、記憶部３３に記憶された補正情報３４の一例の説明図である。ワーク作業システム１０は、作業対象の物品（ワークＷ）に対して所定作業を行うアームロボット２０を複数備えて構成されている。ワーク作業システム１０は、１以上のアームロボット２０と、アームロボット２０が配設される基台１１と、ワークＷを配置する作業用部材１３を作業領域へ搬送及び固定する搬送部１２と、アームロボット２０を制御する制御ＰＣ３０とを備えている。なお、ワーク作業システム１０の左右方向（Ｘ軸）、前後方向（Ｙ軸）及び上下方向（Ｚ軸）は、図１に示した通りとする。また、アームロボット２０は全方位に可動するため固定される特定の方向はないが、説明の便宜のため、アームロボット２０に対しては、図１に示した方向を左右方向（Ｘ軸）、前後方向（Ｙ軸）及び上下方向（Ｚ軸）として説明する。
　アームロボット２０は、作業対象のワークＷに対して所定の作業を実行する装置として構成されている。ワークＷは、例えば、機械部品、電気部品、電子部品、化学部品など各種の部品のほか、食品、バイオ、生物関連の物品などが挙げられる。また、所定の作業としては、例えば、採取位置から配置位置まで採取、移動、配置する移動作業や、部品を組み付ける組付け作業、加工を施す加工作業、粘性材料を塗布する塗布作業、加熱する加熱作業、化学的及び／又は物理的な所定処理を行う処理作業及び検査を行う検査作業などが挙げられる。組付け作業としては、例えば、ネジ、ボルトなどの締結部材の締結作業や、コネクタの挿入作業、配線に関する取回し作業、部品のはめ込み作業、部材の取付作業、ワークを押さえる押さえ付け作業などが挙げられる。加工作業としては、研削作業、切削作業、変形作業、接続作業、接合作業などが挙げられる。粘性材料としては、接着剤やはんだペースト、グリスなどが挙げられる。検査作業としては、例えば、上述した１以上の作業結果を検査する作業などが挙げられ、ワークＷの移動作業を伴うものとしてもよい。
　このアームロボット２０は、回動軸２４を中心に回動するアーム２１を備えた作業ロボットである。アームロボット２０は、アーム２１と、エンドエフェクタ２２と、駆動部２３と、を備えている。アーム２１は、多関節アームであり、第１アーム２１ａと第２アーム２１ｂとを備えている。エンドエフェクタ２２は、ワークＷに対して所定の作業を行う部材であり、アーム２１の先端に回動可能に接続されている。駆動部２３は、アーム２１を駆動するモータである。この駆動部２３は、第１アーム２１ａに接続された第１回動軸２４ａや、第２アーム２１ｂに接続された第２回動軸２４ｂを回動駆動する。なお、ここでは、第１アーム２１ａや第２アーム２１ｂをアーム２１と総称し、第１回動軸２４ａや第２回動軸２４ｂを回動軸２４と総称する。
　制御ＰＣ３０は、ワーク作業システム１０に含まれるアームロボット２０の全体を制御するコンピュータである。この制御ＰＣ３０は、制御装置３１と、表示部３８と、入力装置３９とを備えている。制御装置３１は、本開示の制御装置の機能を有している。制御装置３１は、ＣＰＵ３２を中心とするマイクロプロセッサとして構成されており、データを記憶する記憶部３３を備えている。制御装置３１は、アームロボット２０の駆動部２３などへ駆動信号を出力する。表示部３８は、アームロボット２０に関する情報を含む画面を表示するものであり、例えば液晶ディスプレイである。入力装置３９は、各種入力を行うマウスやキーボードなどである。
　記憶部３３は、例えば、ＨＤＤなど、大容量の記憶装置として構成されている。記憶部３３には、アーム２１の制御に用いる補正情報３４などが記憶されている。補正情報３４には、図２に示すように、アーム２１を目標位置としての指定点へ配置させたときの回動軸２４の補正角度を含む情報である。指定点は、アーム２１が作業可能な動作範囲において３次元マトリックスを構成する座標点である。この指定点は、Ｘ軸、Ｙ軸及びＺ軸の空間内に等間隔に定められているこの補正情報３４では、各指定点ごとに第１アーム２１ａや第２アーム２１ｂに対応する補正角度が対応づけられている。各指定点には、後述する補正情報設定処理により実際に測定された補正角度が対応づけられている。図２において、補正情報３４では、説明の便宜のため、例えば、第１回動軸２４ａの角度補正値が△Ｑｊ１、第２回動軸２４ｂの角度補正値が△Ｑｊ２、のように規定され、指定点の座標に対応づけられている。補正角度は、目標位置へアーム２１を移動する指示角度で回動軸２４を回動した際のアーム２１の先端位置（実測位置）と、目標位置との差分を減じる値として規定されている。制御装置３１は、設定システム４０で作成された補正情報５４を取得し、記憶部３３に補正情報３４として記憶する。
　設定システム４０は、ワーク作業システム１０の出荷前の調整を行うシステムとして構成されており、例えば、アームロボット２０の制御に用いられる値を設定する処理を実行する。設定システム４０は、情報処理ＰＣ５０と、光学トラッキング装置６０とを備えている。
　情報処理ＰＣ５０は、ワーク作業システム１０に含まれるアームロボット２０の動作を測定し、アームロボット２０の制御に用いられる値などを設定するコンピュータである。この情報処理ＰＣ５０は、制御装置５１と、表示部５８と、入力装置５９とを備えている。制御装置５１は、本開示の情報処理装置の機能を有し、且つアームロボット２０を制御する制御装置３１の機能も有している。制御装置５１は、ＣＰＵ５２を中心とするマイクロプロセッサとして構成されており、データを記憶する記憶部５３を備えている。制御装置５１は、例えば、アームロボット２０で用いる補正角度を含む補正情報５４を設定し、ワーク作業システム１０へ出力する。制御装置５１は、光学トラッキング装置６０などへ制御信号を出力し、光学トラッキング装置６０から測定信号などを入力する。記憶部５３は、アームロボット２０で用いられる補正情報５４などを記憶する。表示部５８は、ワーク作業システム１０に関する情報を含む画面を表示するものであり、例えば液晶ディスプレイである。入力装置５９は、各種入力を行うマウスやキーボードなどである。
　光学トラッキング装置６０は、例えば、測定対象に対してレーザーを照射することによって、測定対象の３次元座標を求める装置である。この光学トラッキング装置６０は、アーム２１が目標位置である指定点へ移動した際に、アーム２１の先端にある作業点の３次元座標を求める装置である。この光学トラッキング装置６０によって、指定点とアーム２１の作業点とのずれ量を把握することができる。
　次に、こうして構成された本実施形態の設定システム４０の動作、特に、アームロボット２０のアーム２１の位置ずれを補正する補正角度を求める処理について説明する。ここでは、説明の便宜のため、第１アーム２１ａと第２アーム２１ｂとの２つのアームの回動角度を例として説明する（図４，５参照）。図３は、情報処理ＰＣ５０のＣＰＵ５２が実行する補正情報設定処理ルーチンの一例を表すフローチャートである。図４は、ＸＹ座標における指示値と測定値の説明図である。図５は、別のアーム配置の一例の説明図である。補正情報設定処理ルーチンは、記憶部５３に記憶され、作業者の開始入力に応じて実行される。作業者は、ワーク作業システム１０の出荷前において、アームロボット２０の補正値を設定する際に、情報処理ＰＣ５０をアームロボット２０に接続し、光学トラッキング装置６０を配置したのち、情報処理ＰＣ５０に開始入力を行う。
　このルーチンを開始すると、制御装置５１のＣＰＵ５２は、補正角度を求める指定点を設定する（Ｓ１００）。指定点は、アーム２１の動作範囲の３次元マトリクス状に設定されており、所定の順番、例えば、原点から順に設定される。ここでは、指定点ａ（Ｘａ，Ｙａ）が設定される（図４）。なお、図４、５では、説明の便宜のため、ＸＹ平面上の指定点ａ～ｄの座標を示している。次に、ＣＰＵ５２は、逆運動学に基づいて、所定のアーム２１の配置で指定点にアーム２１の先端の作業点Ｐが重なるよう、各アーム２１を回動する指示角度を求め（Ｓ１１０）、求めた指示角度でアーム２１を制御する（Ｓ１２０）。ＣＰＵ５２は、例えば、図４に示すように、設定された指定点ａ（Ｘａ，Ｙａ）に作業点Ｐが重なるよう、第１回動軸２４ａは指示角度Ｑｊ１ａ、第２回動軸２４ｂには指示角度Ｑｊ２ａとしその角度になるよう駆動部２３を制御する。
　次に、ＣＰＵ５２は、光学トラッキング装置６０により作業点Ｐの座標を計測させ、作業点Ｐの測定座標を光学トラッキング装置６０から取得し（Ｓ１３０）、指定点と作業点Ｐとの差分の距離を減じる各回動軸２４の補正角度を求める（Ｓ１４０）。図４に示すように、ＣＰＵ５２は、指定点（Ｘａ，Ｙａ…Ｘｄ，Ｙｄ）に対して、測定座標（Ｘａ’，Ｙａ’…Ｘｄ’，Ｙｄ’）を取得し、この指定点と測定座標との関係から、逆運動学（ｆ（Ｘ，Ｙ）＝Ｑｊ１，Ｑｊ２）を用いて回動軸２４の角度を求めると、指定点に対して指定角度（Ｑｊ１ａ，Ｑｊ２ａ…Ｑｊ１ｄ，Ｑｊ２ｄ）と測定座標に対して測定角度（Ｑｊ１ａ’，Ｑｊ２ａ’…Ｑｊ１ｄ’，Ｑｊ２ｄ’）とが得られる。この指定角度と測定角度との差分値を、それぞれ測定座標と指定点とが重なる補正角度（△Ｑｊ１ａ，△Ｑｊ２ａ…△Ｑｊ１ｄ，△Ｑｊ２ｄ）とする。なお、補正角度△Ｑｊ１ａが指定点ａでの第１回動軸２４ａの補正値（Ｑｊ１ａ’－Ｑｊ１ａ）であり、補正角度△Ｑｊ２ａが指定点ａでの第２回動軸２４ｂの補正値（Ｑｊ２ａ’－Ｑｊ２ａ）である。
　続いて、ＣＰＵ５２は、求めた補正角度を指定点に対応づけて補正情報５４へ記憶し（Ｓ１５０）、現在のアーム２１の配置におけるすべての指定点に対して補正角度を求めたか否かを判定する（Ｓ１６０）。すべての指定点に対して補正角度を求めていないときには、ＣＰＵ５２は、Ｓ１００以降の処理を実行する。即ち、ＣＰＵ５２は、次の指定点を設定し、その指定点に作業点が重なるようにアーム２１を制御し、実際の作業点Ｐと指定点とのずれを減じる回動軸２４の補正角度を求めて補正情報５４に記憶させる。
　一方、Ｓ１６０で、現在のアーム２１の配置におけるすべての指定点に対して補正角度を求めたときには、ＣＰＵ５２は、指定点と作業点Ｐとが重なる他のアーム２１の配置があるか否かを判定する（Ｓ１７０）。他のアーム２１の配置があるときには、ＣＰＵ５２は、アーム２１の配置位置を変更し（Ｓ１８０）、Ｓ１００以降の処理を実行する。図５に示すように、アーム２１は、指定点の位置によっては、いわゆる左手系、右手系のように、複数のアーム２１の配置で作業点Ｐを指定点に重ねることができる。ＣＰＵ５２は、このような別パターンについても補正角度を求めるのである。一方、Ｓ１７０で他のアーム２１の配置がないときには、ＣＰＵ５２は、補正情報５４を制御ＰＣ３０へ出力し（Ｓ１９０）、このルーチンを終了する。このようにして、ＣＰＵ５２は、各指定点に対して回動軸２４の角度を補正する補正角度を設定し、制御ＰＣ３０へ補正情報３４として記憶させる。
　次に、ワーク作業システム１０の動作、特に補正情報３４を用いてアームロボット２０を制御する処理について説明する。図６は、制御ＰＣ３０のＣＰＵ３２が実行する作業処理ルーチンの一例を表すフローチャートである。図７は、指定点以外に存在する目標位置ｅの説明図である。作業処理ルーチンは、記憶部３３に記憶され、作業者の開始入力に応じて実行される。アームロボット２０は、ワークＷを供給位置から作業用部材１３上の目標位置ｅ（Ｘｅ，Ｙｅ）へ移動させる処理を行う場合を具体例として説明する。
　このルーチンを開始すると、制御装置３１のＣＰＵ３２は、アームロボット２０の作業を行う目標位置を取得し（Ｓ２００）、アーム２１の所定の配置位置に応じ、逆運動学に基づいて、目標位置にアーム２１の作業点Ｐが重なるよう、各アーム２１を回動する指示角度を求める（Ｓ２１０）。アームロボット２０において、アーム２１の配置位置は、左腕系で動作するか右腕系で動作するかなど、その作業環境に応じて優先的なものが予め規定されているものとする。次に、ＣＰＵ３２は、目標位置に近い指定点を補正情報３４から抽出し、目標位置が指定点と同じ座標であるか否かを判定する（Ｓ２２０）。目標位置が指定点と同じ座標であるときには、指定点に対応づけられた各回動軸２４の補正角度がそのまま利用可能であるため、ＣＰＵ３２は、補正情報３４から補正角度を取得し（Ｓ２４０）、取得した補正角度で指示角度を補正した値を用いて回動軸２４を回動させる（Ｓ２７０）。
　一方、Ｓ２３０で目標位置が指定点と同じ座標でないときには、ＣＰＵ３２は、補間処理を行い、最も有効な補正角度を計算により求める（Ｓ２５０～Ｓ２６０）。具体的には、ＣＰＵ３２は、Ｓ２２０で抽出した指定点の補正角度を取得し（Ｓ２５０）、目標位置と指定点との距離に反比例した重み付けを行い、補正角度を導出する（Ｓ２６０）。そして、ＣＰＵ３２は、導出した補正角度で指示角度を補正した値を用いて回動軸２４を回動させる（Ｓ２７０）。ここでは、ＣＰＵ３２は、指定点以外の目標位置に対して、補正角度の補間として、目標位置に近接する複数の指定点の補正角度に対し目標位置から指定点までの距離に反比例した重み付けを行った補正角度を導出する。即ち、目標位置が複数の指定点の間にあるときには、ＣＰＵ３２は、目標位置から距離がより近い指定点の影響をより強く与えた補正角度を計算により求めるのである。
　補正角度の導出について具体例を用いて説明する。ここでは、図７に示すように、指定点ａ～ｄの間に目標位置ｅ（Ｘｅ，Ｙｅ）がある場合について説明する。また、距離Ｌａ～Ｌｄは、それぞれ指定点ａ～ｄと目標位置ｅとの距離とする。目標位置ｅへアーム２１を駆動する場合、例えば、指定点ａでの角度誤差は、目標位置ｅに対して、式（１）、（２）で表すだけ影響を与える。即ち、第１回動軸２４ａでは、指定点ａに対応付けられた補正角度△Ｑｊ１ａに、距離Ｌａ～Ｌｄを乗算しＬａで除算した項を、更に１つの指定点からの距離を含まない残りの距離の全てを乗算した値をそれぞれの指定点ごとに求めたものの総和（Ｌｂ×Ｌｃ×Ｌｄ＋Ｌａ×Ｌｃ×Ｌｄ＋Ｌａ×Ｌｂ×Ｌｄ＋Ｌａ×Ｌｂ×Ｌｃ：以下、指定点間の距離因子とも称する）で除算した値が目標位置ｅに影響する。同様に、第２回動軸２４ｂでは、補正角度△Ｑｊ２ａに、距離Ｌａ～Ｌｄを乗算しＬａで除算した項を、距離因子で除算した値が目標位置ｅに影響する。そして、目標位置ｅに対しては、指定点ａ～ｄが影響を与えるため、目標位置ｅでの補正角度は、距離の反比例した重み付けを行うと、第１回動軸２４ａに対して式（３）の補正角度△Ｑｊ１ｅ、第２回動軸２４ｂに対して、式（４）の補正角度△Ｑｊ２ｅが計算によって求められる。このように、ＣＰＵ３２は、指定点間に存在する目標位置を取得したときには、目標位置に近接する複数の指定点を抽出し、抽出した指定点の補正角度に該指定点以外の指定点と該目標位置との距離を乗算した値をそれぞれ加算し、指定点間の距離因子で除算して重み付けを行った補正角度を補間して得るのである。
Figure JPOXMLDOC01-appb-M000001
　Ｓ２７０で補正角度で補正した指示角度で回動軸２４を制御したあと、ＣＰＵ３２は、アームロボット２０の作業が全て終了したか否かを判定し（Ｓ２８０）、作業が全て終了していないときには、Ｓ２００以降の処理を繰り返し実行する。一方、Ｓ２８０で全ての作業が終了したときには、ＣＰＵ３２は、このルーチンを終了する。
　ここで、補正情報３４に含まれた補正角度による補正精度について実際に検討した。図８は、角度補正と位置補正における位置ずれ量の説明図である。図８は、５軸アームロボットの第２関節Ｊ２のヨーを０．５°捻った状態での目標位置（真値）と実測位置との差（距離）を求めた結果である。なお、ここでは、簡便な説明とするため、ＸＹ平面座標で説明するが、ＸＹＺの三次元座標に適用することができる。例えば、ＸＹロボットでは、絶対精度を保証するために、目標位置（Ｘ，Ｙ）に補正値を加味する補正を行うことがある。これをアームロボットに適用すると、目標位置（Ｘ，Ｙ）に補正値を加減しＸＹ座標補正を行い（Ｘ’，Ｙ’）、これを逆運動学に基づいて各回動軸２４の指示角度へ変換する処理となる（Ｑｊ１，Ｑｊ２）。これを位置補正と称する。一方、本開示の角度補正では、目標位置（Ｘ，Ｙ）から逆運動学に基づいて各回動軸２４の指示角度（Ｑｊ１’，Ｑｊ２’）を求め、これに角度補正（△Ｑｊ１，△Ｑｊ２）を加味し、各回動軸２４の指示角度（Ｑｊ１，Ｑｊ２）とする。角度補正では、位置から角度に変換する間接的な補正に比して、直接的な指令値である指示角度を補正するため、図８に示すように、より高い精度を示すことが明らかとなった。このように、補正角度を用いることによって、一般的にティーチングで制御するアームロボットに対し、絶対精度を与えることができることがわかった。
　ここで、本実施形態の構成要素と本発明の構成要素との対応関係を明らかにする。本実施形態の制御装置３１が本開示の制御装置に相当し、アームロボット２０がアームロボットに相当し、アーム２１、第１アーム２１ａ、第２アーム２１ｂがロボットアームに相当し、回動軸２４、第１回動軸２４ａ及び第２回動軸２４ｂが回動軸に相当し、記憶部３３が記憶部に相当し、補正情報３４が補正情報に相当し、ＣＰＵ３２が制御部に相当する。また、制御装置５１が情報処理装置に相当し、ＣＰＵ５２が設定部に相当し、光学トラッキング装置６０が光学トラッキング装置に相当する。なお、本実施形態では、制御装置３１の動作を説明することにより本開示の制御方法の一例も明らかにしており、また、制御装置５１の動作を説明することにより本開示の情報処理方法の一例を明らかにしている。
　以上説明した実施形態の制御ＰＣ３０は、回動軸２４を中心に回動するアーム２１を備えたアームロボットを制御する制御装置３１を備え、アーム２１を目標位置としての指定点へ配置させたときの回動軸２４の補正角度を含む補正情報３４を記憶する記憶部３３と、補正情報３４に含まれる目標位置に対する補正角度を取得しこの補正角度に基づいてアーム２１を回動させる制御部としてのＣＰＵ３２を備える。この制御装置３１では、アームロボット２０のアーム２１を目標位置へ配置させたときの回動軸２４の補正角度を含む補正情報３４を記憶部３３に記憶し、補正情報３４に含まれる目標位置に対する補正角度を取得し、この補正角度に基づいてアーム２１を回動させる。この制御装置３１では、制御する回動軸２４の角度を直接的に補正するため、例えば、間接的に目標位置を補正するものなどに比して、作業精度をより高めることができる。
　また、記憶部３３は、アーム２１を指定点へ配置させたときに計測した回動軸２４の角度に基づいて設定された回動軸２４の補正角度を指定点ごとに対応付けた補正情報３４を記憶し、ＣＰＵ３２は、指定点以外の目標位置に対して、補正角度の補間として、目標位置に近接する複数の指定点の補正角度に対し目標位置から指定点までの距離に反比例した重み付けを行った補正角度を導出し、導出した補正角度に基づいてアーム２１を回動させる。この制御装置３１では、直接的に補正角度が設定された指定点以外の目標位置に対しては、指定点までの距離に反比例した重み付けを行う、即ち、より近い指定点の補正値がより強く影響する補正角度を補間して求めるため、指定点以外の目標位置に対しても、作業精度をより高めることができる。更に、アームロボット２０は、アーム２１として第１アーム２１ａ及び第２アーム２１ｂを含む多関節ロボットであり、記憶部３３は、Ｘ軸、Ｙ軸及びＺ軸を含む三次元座標の指定点に対応付けられた回動軸２４の補正角度を含む補正情報３４を記憶し、ＣＰＵ３２は、指定点間に存在する目標位置を取得したときには、この目標位置に近接する複数の指定点を抽出し、抽出した指定点の補正角度に指定点以外の指定点と目標位置との距離を乗算した値をそれぞれ加算し、指定点間の距離因子で除算して重み付けを行う。この制御装置３１では、三次元座標の指定点と目標位置との関係において、その距離に応じた適切な補正角度を導出することができる。
　更にまた、記憶部３３は、目標位置へアーム２１を配置する際に第１アーム２１ａと第２アーム２１ｂとに複数の配置位置が存在する場合は、複数の配置位置に対してそれぞれ設定された補正角度を含む補正情報３４を記憶し、ＣＰＵ３２は、目標位置及びアーム２１の配置位置に応じた補正角度を取得し、補正角度に基づいてアーム２１を回動させる。この制御装置３１では、アーム２１の配置位置に応じて適切な補正を行うことができる。そして、ＣＰＵ３２は、目標位置を取得したときには、逆運動学に基づき、回動軸２４の指示角度を取得し、補正情報３４に基づいて補正角度を取得して指示角度を補正角度で補正し、補正後の指示角度でアームを回動させる。この制御装置３１では、逆運動学に基づいてアーム２１を動作させることにより、直接的なアーム２１の位置の補正を行うことができるため、作業精度をより高めることができる。
　また、情報処理ＰＣ５０は、回動軸２４を中心に回動するアーム２１を備えたアームロボット２０の位置を補正する補正値を設定する情報処理装置である。この制御装置５１は、アーム２１を目標位置としての指定点へ配置させたときに計測したアーム２１の位置を取得して回動軸２４の補正角度を求め、複数の指定点における補正角度を含む補正情報５４を設定する設定部としてのＣＰＵ５２を備える。この情報処理ＰＣ５０では、アーム２１を目標位置としての指定点へ配置させたときに計測したアーム２１の位置から回動軸２４の角度を取得して回動軸２４の補正角度を求め、複数の指定点における補正角度を含む補正情報５４を設定する。この情報処理ＰＣ５０では、上記制御装置３１と同様に、制御する回動軸２４の角度を直接的に補正するため、例えば、間接的に目標位置を補正するものなどに比して、アームロボット２０の作業精度をより高めることができる。
　また、ＣＰＵ５２は、目標位置へアーム２１を配置する際に第１アーム２１ａと第２アーム２１ｂとに複数の配置位置が存在する場合は、複数の配置位置に対してそれぞれ対応する補正角度を含む補正情報３４を設定する。この情報処理ＰＣ５０では、アーム２１の配置位置に応じて適切な補正を行うことができる。更に、ＣＰＵ５２は、目標位置へアーム２１を移動する指示角度で回動軸２４を回動した際のアーム２１の位置と目標位置との差分を減じる補正角度を求める。この情報処理ＰＣ５０では、より適切な補正角度を求めることができる。更にまた、ＣＰＵ５２は、光学トラッキング装置６０で測定したアーム２１の位置を光学トラッキング装置６０から取得し、取得したアームの位置を用いて補正角度を求める。この情報処理ＰＣ５０では、光学トラッキング装置６０を用いて、より適切な補正角度を求めることができる。
　なお、本開示は上述した実施形態に何ら限定されることはなく、本開示の技術的範囲に属する限り種々の態様で実施し得ることはいうまでもない。
　例えば、上述した実施形態では、ワーク作業システム１０と設定システム４０とが両方ある場合を説明したが、ワーク作業システム１０のみでもよいし、設定システム４０のみでもよい。また、上述した実施形態では、ワーク作業システム１０の出荷時に設定システム４０で補正値を設定するものとしたが、特にこれに限定されない。例えば、制御ＰＣ３０に情報処理ＰＣ５０の機能を加えて、制御ＰＣ３０が補正角度を設定することができるものとしてもよい。この制御ＰＣ３０では、定期的な作業ロボット２０の調整を行うことができる。
　上述した実施形態では、制御ＰＣ３０は、距離に応じた重み付けを行った補正角度を用いるものとしたが、この処理を省略してもよい。例えば、制御装置３１は、指定点の密度をより高めるなどした補正情報３４を記憶した上で、最も距離が近い指定点の補正角度を用いるものとしてもよい。この制御装置３１によっても、アームロボット２０の作業精度をより高めることができる。
　上述した実施形態では、記憶部３３は、アーム２１の配置位置が複数存在する場合は、それに応じた複数の補正角度を含む補正情報３４を記憶部３３に記憶するものとしたが、特にこれに限定されず、作業ロボット２０で用いるアーム２１の配置のみの補正角度を含む補正情報３４としてもよい。この制御装置３１でも、補正情報３４を用いることによって、アームロボット２０の作業精度をより高めることができる。また、情報処理ＰＣ５０は、アーム２１の配置位置が複数存在する場合は、それに応じた複数の補正角度を求めるものとしたが、特にこれに限定されず、作業ロボット２０で用いるアーム２１の配置のみの補正角度を求めるものとしてもよい。
　上述した実施形態では、情報処理ＰＣ５０は、光学トラッキング装置６０からアーム２１の位置座標を取得し、補正角度を設定するものとしたが、特に光学トラッキング装置６０に限定されない。情報処理ＰＣ５０は、光学トラッキング装置とは異なる他の座標測定装置からアーム２１の位置座標を取得するものとしてもよい。
　上述した実施形態では、制御装置３１をアームロボット２０の外部に接続された制御ＰＣ３０が備えるものとして説明したが、特にこれに限定されず、例えば、アームロボット２０の内部に備えるコントローラを制御装置としてもよい。また、上述した実施形態では、本開示の内容を制御装置３１や制御装置５１として説明したが、制御方法や情報処理方法としてもよい。また、制御方法を実行するプログラムとしてもよいし、情報処理方法を実行するプログラムとしてもよい。
　ここで、本開示の制御装置や情報処理装置は、以下のように構成してもよい。例えば、本開示の制御装置において、前記記憶部は、前記アームを指定点へ配置させたときに計測した前記アームの位置に基づいて設定された前記回動軸の補正角度を前記指定点ごとに対応付けた前記補正情報を記憶し、前記制御部は、前記指定点以外の目標位置に対して、前記補正角度の補間として、前記目標位置に近接する前記複数の指定点の前記補正角度に対し前記目標位置から前記指定点までの距離に反比例した重み付けを行った補正角度を導出し、導出した該補正角度に基づいて前記アームを回動させるものとしてもよい。この制御装置では、直接的に補正角度が設定された指定点以外の目標位置に対しては、指定点までの距離に反比例した重み付けを行う、即ち、より近い指定点の補正値がより強く影響する補正角度を補間して求めるため、指定点以外の目標位置に対しても、作業精度をより高めることができる。
　重み付けを行う本開示の制御装置において、前記アームロボットは、前記アームとして第１アーム及び第２アームを含む多関節ロボットであり、前記記憶部は、Ｘ軸、Ｙ軸及びＺ軸を含む三次元座標の前記指定点に対応付けられた前記回動軸の補正角度を含む前記補正情報を記憶し、前記制御部は、前記指定点間に存在する目標位置を取得したときには、該目標位置に近接する複数の前記指定点を抽出し、抽出した該指定点の補正角度に該指定点以外の指定点と該目標位置との距離を乗算した値をそれぞれ加算し、前記指定点間の距離因子で除算して前記重み付けを行うものとしてもよい。この制御装置では、三次元座標の指定点と目標位置との関係において、その距離に応じた適切な補正角度を導出することができる。
　本開示の制御装置において、前記アームロボットは、前記アームとして第１アーム及び第２アームを含む多関節ロボットであり、前記記憶部は、前記目標位置へ前記アームを配置する際に前記第１アームと前記第２アームとに複数の配置位置が存在する場合は、該複数の配置位置に対してそれぞれ設定された前記補正角度を含む前記補正情報を記憶し、前記制御部は、前記目標位置及び前記アームの配置位置に応じた前記補正角度を取得し該補正角度に基づいて前記アームを回動させるものとしてもよい。この制御装置では、アームの配置位置に応じて適切な補正を行うことができる。ここで、アームは、右手系動作と左手系動作とを基本動作とし、前記補正情報には、右手系動作用の補正角度と、左手系動作用の補正角度とが含まれているものとしてもよい。
　本開示の制御装置において、前記制御部は、前記目標位置を取得したときには、逆運動学に基づき、前記回動軸の指示角度を取得し、前記補正情報に基づいて前記補正角度を取得して前記指示角度を前記補正角度で補正し、補正後の指示角度で前記アームを回動させるものとしてもよい。この制御装置では、逆運動学に基づいてアームを動作させることにより、直接的なアームの位置の補正を行うことができるため、作業精度をより高めることができる。
　本開示の制御方法は、
　回動軸を中心に回動するアームを備えたアームロボットを制御する制御方法であって、
　前記アームを目標位置へ配置させたときの前記回動軸の補正角度を含む補正情報に含まれる目標位置に対する前記補正角度を取得する取得ステップと、
　前記取得ステップで取得した前記補正角度に基づいて前記アームを回動させる制御ステップと、
　を含むものである。
　この制御方法では、上記制御装置と同様に、制御する回動軸の角度を直接的に補正するため、例えば、間接的に目標位置を補正するものなどに比して、作業精度をより高めることができる。なお、この制御方法において、上述したいずれかの制御装置の態様を採用してもよいし、上述したいずれかの制御装置の機能を発現するステップを含むものとしてもよい。
　本開示の情報処理装置は、
　回動軸を中心に回動するアームを備えたアームロボットの位置を補正する補正値を設定する情報処理装置であって、
　前記アームを目標位置としての指定点へ配置させたときに計測した前記アームの位置を取得して前記回動軸の補正角度を求め、複数の前記指定点における補正角度を含む補正情報を設定する設定部、を備えたものである。
　この情報処理装置では、アームを目標位置としての指定点へ配置させたときに計測したアームの位置から回動軸の角度を取得して回動軸の補正角度を求め、複数の指定点における補正角度を含む補正情報を設定する。この情報処理装置では、上記制御装置と同様に、制御する回動軸の角度を直接的に補正するため、例えば、間接的に目標位置を補正するものなどに比して、アームロボットの作業精度をより高めることができる。
　本開示の情報処理装置において、前記アームロボットは、前記アームとして第１アーム及び第２アームを含む多関節ロボットであり、前記設定部は、前記目標位置へ前記アームを配置する際に前記第１アームと前記第２アームとに複数の配置位置が存在する場合は、該複数の配置位置に対してそれぞれ対応する前記補正角度を含む前記補正情報を設定するものとしてもよい。この情報処理装置では、アームの配置位置に応じて適切な補正を行うことができる。
　本開示の情報処理装置において、前記設定部は、前記目標位置へ前記アームを移動する指示角度で前記回動軸を回動した際の前記アームの位置と前記目標位置との差分を減じる前記補正角度を求めるものとしてもよい。この情報処理装置では、より適切な補正角度を求めることができる。
　本開示の情報処理装置において、前記設定部は、光学トラッキング装置で測定した前記アームの位置を該光学トラッキング装置から取得し、取得した前記アームの位置を用いて前記補正角度を求めるものとしてもよい。この情報処理装置では、光学トラッキング装置を用いて、より適切な補正角度を求めることができる。この光学トラッキング装置としては、レーザートラッキング装置などが挙げられる。
　本開示の情報処理方法は、
　回動軸を中心に回動するアームを備えたアームロボットの位置を補正する補正値を設定する情報処理方法であって、
　前記アームを目標位置としての指定点へ配置させたときに計測した前記アームの位置を取得して前記回動軸の補正角度を求める導出ステップと、
　複数の前記指定点における補正角度を含む補正情報を設定する設定ステップと、
　を含むものである。
　この情報処理方法は、上記情報処理装置と同様に、制御する回動軸の角度を直接的に補正するため、例えば、間接的に目標位置を補正するものなどに比して、アームロボットの作業精度をより高めることができる。なお、この情報処理方法において、上述したいずれかの情報処理装置の態様を採用してもよいし、上述したいずれかの情報処理装置の機能を発現するステップを含むものとしてもよい。
　本開示は、ロボットアームを備える作業ロボットの分野に利用可能である。
　１０　ワーク作業システム、１１　基台、１２　搬送部、１３　作業用部材、２０　アームロボット、２１　アーム、２１ａ　第１アーム、２１ｂ　第２アーム、２２　エンドエフェクタ、２３　駆動部、２４　回動軸、２４ａ　第１回動軸、２４ｂ　第２回動軸、３０　制御ＰＣ、３１　制御装置、３２　ＣＰＵ、３３　記憶部、３４　補正情報、３８　表示部、３９　入力装置、４０　設定システム、５０　情報処理ＰＣ、５１　制御装置、５２　ＣＰＵ、５３　記憶部、５４　補正情報、５８　表示部、５９　入力装置、６０　光学トラッキング装置、Ｗ　ワーク。

Claims (11)

  1. 　回動軸を中心に回動するアームを備えたアームロボットを制御する制御装置であって、
    　前記アームを目標位置へ配置させたときの前記回動軸の補正角度を含む補正情報を記憶する記憶部と、
    　前記補正情報に含まれる目標位置に対する前記補正角度を取得し該補正角度に基づいて前記アームを回動させる制御部と、
    　を備えた制御装置。
  2. 　前記記憶部は、前記アームを指定点へ配置させたときに計測した前記アームの位置に基づいて設定された前記回動軸の補正角度を前記指定点ごとに対応付けた前記補正情報を記憶し、
    　前記制御部は、前記指定点以外の目標位置に対して、前記補正角度の補間として、前記目標位置に近接する前記複数の指定点の前記補正角度に対し前記目標位置から前記指定点までの距離に反比例した重み付けを行った補正角度を導出し、導出した該補正角度に基づいて前記アームを回動させる、請求項１に記載の制御装置。
  3. 　前記アームロボットは、前記アームとして第１アーム及び第２アームを含む多関節ロボットであり、
    　前記記憶部は、Ｘ軸、Ｙ軸及びＺ軸を含む三次元座標の前記指定点に対応付けられた前記回動軸の補正角度を含む前記補正情報を記憶し、
    　前記制御部は、前記指定点間に存在する目標位置を取得したときには、該目標位置に近接する複数の前記指定点を抽出し、抽出した該指定点の補正角度に該指定点以外の指定点と該目標位置との距離を乗算した値をそれぞれ加算し、前記指定点間の距離因子で除算して前記重み付けを行う、請求項２に記載の制御装置。
  4. 　前記アームロボットは、前記アームとして第１アーム及び第２アームを含む多関節ロボットであり、
    　前記記憶部は、前記目標位置へ前記アームを配置する際に前記第１アームと前記第２アームとに複数の配置位置が存在する場合は、該複数の配置位置に対してそれぞれ設定された前記補正角度を含む前記補正情報を記憶し、
    　前記制御部は、前記目標位置及び前記アームの配置位置に応じた前記補正角度を取得し該補正角度に基づいて前記アームを回動させる、請求項１～３のいずれか１項に記載の制御装置。
  5. 　前記制御部は、前記目標位置を取得したときには、逆運動学に基づき、前記回動軸の指示角度を取得し、前記補正情報に基づいて前記補正角度を取得して前記指示角度を前記補正角度で補正し、補正後の指示角度で前記アームを回動させる、請求項１～４のいずれか１項に記載の制御装置。
  6. 　回動軸を中心に回動するアームを備えたアームロボットを制御する制御方法であって、
    　前記アームを目標位置へ配置させたときの前記回動軸の補正角度を含む補正情報に含まれる目標位置に対する前記補正角度を取得する取得ステップと、
    　前記取得ステップで取得した前記補正角度に基づいて前記アームを回動させる制御ステップと、
    　を含む制御方法。
  7. 　回動軸を中心に回動するアームを備えたアームロボットの位置を補正する補正値を設定する情報処理装置であって、
    　前記アームを目標位置としての指定点へ配置させたときに計測した前記アームの位置を取得して前記回動軸の補正角度を求め、複数の前記指定点における補正角度を含む補正情報を設定する設定部、を備えた情報処理装置。
  8. 　前記アームロボットは、前記アームとして第１アーム及び第２アームを含む多関節ロボットであり、
    　前記設定部は、前記目標位置へ前記アームを配置する際に前記第１アームと前記第２アームとに複数の配置位置が存在する場合は、該複数の配置位置に対してそれぞれ対応する前記補正角度を含む前記補正情報を設定する、請求項７に記載の情報処理装置。
  9. 　前記設定部は、前記目標位置へ前記アームを移動する指示角度で前記回動軸を回動した際の前記アームの位置と前記目標位置との差分を減じる前記補正角度を求める、請求項７又は８に記載の情報処理装置。
  10. 　前記設定部は、光学トラッキング装置で測定した前記アームの位置を該光学トラッキング装置から取得し、取得した前記アームの位置を用いて前記補正角度を求める、請求項７～９のいずれか１項に記載の情報処理装置。
  11. 　回動軸を中心に回動するアームを備えたアームロボットの位置を補正する補正値を設定する情報処理方法であって、
    　前記アームを目標位置としての指定点へ配置させたときに計測した前記アームの位置を取得して前記回動軸の補正角度を求める導出ステップと、
    　複数の前記指定点における補正角度を含む補正情報を設定する設定ステップと、
    　を含む情報処理方法。
PCT/JP2020/002987 2020-01-28 2020-01-28 制御装置、制御方法、情報処理装置及び情報処理方法 WO2021152697A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/JP2020/002987 WO2021152697A1 (ja) 2020-01-28 2020-01-28 制御装置、制御方法、情報処理装置及び情報処理方法
JP2021573667A JP7351935B2 (ja) 2020-01-28 2020-01-28 制御装置、制御方法、情報処理装置及び情報処理方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2020/002987 WO2021152697A1 (ja) 2020-01-28 2020-01-28 制御装置、制御方法、情報処理装置及び情報処理方法

Publications (1)

Publication Number Publication Date
WO2021152697A1 true WO2021152697A1 (ja) 2021-08-05

Family

ID=77078062

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/002987 WO2021152697A1 (ja) 2020-01-28 2020-01-28 制御装置、制御方法、情報処理装置及び情報処理方法

Country Status (2)

Country Link
JP (1) JP7351935B2 (ja)
WO (1) WO2021152697A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115167387A (zh) * 2022-06-06 2022-10-11 三一汽车制造有限公司 臂架控制方法、装置及作业机械

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0699372A (ja) * 1992-09-21 1994-04-12 Toyoda Mach Works Ltd ロボット制御装置
JP2006110702A (ja) * 2004-10-18 2006-04-27 Fanuc Ltd 学習制御機能を備えたロボット及びロボットの制御方法
JP2017113867A (ja) * 2015-12-25 2017-06-29 株式会社ダイヘン ロボット制御装置
WO2018092243A1 (ja) * 2016-11-17 2018-05-24 株式会社Ｆｕｊｉ 作業位置補正方法および作業ロボット
JP2019166626A (ja) * 2018-03-26 2019-10-03 ファナック株式会社 制御装置及び機械学習装置

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4675502A (en) * 1985-12-23 1987-06-23 General Electric Company Real time tracking control for taught path robots

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0699372A (ja) * 1992-09-21 1994-04-12 Toyoda Mach Works Ltd ロボット制御装置
JP2006110702A (ja) * 2004-10-18 2006-04-27 Fanuc Ltd 学習制御機能を備えたロボット及びロボットの制御方法
JP2017113867A (ja) * 2015-12-25 2017-06-29 株式会社ダイヘン ロボット制御装置
WO2018092243A1 (ja) * 2016-11-17 2018-05-24 株式会社Ｆｕｊｉ 作業位置補正方法および作業ロボット
JP2019166626A (ja) * 2018-03-26 2019-10-03 ファナック株式会社 制御装置及び機械学習装置

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115167387A (zh) * 2022-06-06 2022-10-11 三一汽车制造有限公司 臂架控制方法、装置及作业机械

Also Published As

Publication number Publication date
JP7351935B2 (ja) 2023-09-27
JPWO2021152697A1 (ja) 2021-08-05

Similar Documents

Publication Publication Date Title
US9221176B2 (en) Robot system and method for controlling the same
KR100986669B1 (ko) 로봇 캘리브레이션 장치 및 그 방법
US9782899B2 (en) Calibration method for coordinate system of robot manipulator
EP2381325B1 (en) Method for robot offline programming
JP7048535B2 (ja) ロボットを制御するための機構誤差パラメータを較正するロボットの制御装置
KR102311293B1 (ko) 캘리브레이션 장치 및 캘리브레이션 방법
CN107111296A (zh) 用于补偿工作点的偏差的方法
Mustafa et al. A geometrical approach for online error compensation of industrial manipulators
US20230256615A1 (en) Robot device controller for controlling position of robot
EP1886771B1 (en) Rotation center point calculating method, rotation axis calculating method, program creating method, operation method, and robot apparatus
WO2021152697A1 (ja) 制御装置、制御方法、情報処理装置及び情報処理方法
WO2022181688A1 (ja) ロボットの設置位置測定装置、設置位置測定方法、ロボット制御装置、教示システムおよびシミュレーション装置
KR20050108645A (ko) 로봇 용접의 보정장치 및 그 방법
JP5378908B2 (ja) ロボットの精度調整方法およびロボット
JP2019141983A (ja) ロボット制御装置
US20220314441A1 (en) Method For Controlling Robot, Robot System, And Storage Medium
JP6091272B2 (ja) 多関節ロボットのバネ定数補正装置
US11654562B2 (en) Apparatus, robot control device, robot system, and method of setting robot coordinate system
JP6896824B2 (ja) ロボット装置、ロボットシステム、ロボット装置の制御方法、ロボット装置を用いた物品の製造方法、情報処理装置、情報処理方法、制御プログラム及び記録媒体
WO2021152744A1 (ja) 制御装置、制御方法、情報処理装置及び情報処理方法
JP2015222196A (ja) 三次元測定機、及びこれを用いた形状測定方法
JP2022084259A (ja) 情報処理装置、情報処理方法、ロボットシステム、測定システム、ロボットシステムを用いた物品の製造方法、制御プログラム及び記録媒体
JP7295302B2 (ja) ロボットを制御するための機構誤差パラメータを較正するロボットの制御装置および教示操作盤
US20220314450A1 (en) Method For Controlling Robot, Robot System, And Storage Medium
US20220314451A1 (en) Method For Controlling Robot, Robot System, And Storage Medium

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20916965

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2021573667

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20916965

Country of ref document: EP

Kind code of ref document: A1