Examination method for examining robot apparatus, control apparatus, and storage medium
A method for examining a robot apparatus which includes a driving source configured to drive a joint, the position and orientation of which are controlled based on trajectory data determined in advance for a normal motion. The examination method includes generating examination motion data for driving a joint as an examination target under a driving speed that causes the examination target joint to resonate and causing the examination target joint to pass through a path based on the trajectory data. A resonance amplitude of the joint is acquired based on the examination motion data.
1. A control method for controlling a robot including at least two joints and configured to be controlled based on a predetermined path for executing a normal motion, the control method comprising:
acquiring an amplitude of a vibration at a natural frequency from a predetermined joint of the at least two joints while operating the robot in a way that the robot maintains the predetermined path and moves at a driving speed that causes the predetermined joint to vibrate at the natural frequency; and
acquiring a state of the predetermined joint based on the amplitude,
wherein the predetermined joint includes:
a rotational driving source;
a transmission configured to be driven by the rotational driving source;
an output side angle sensor configured to measure a rotational angle of a rotating shaft on an output side of the transmission; and
an input side angle sensor configured to measure a rotational angle of the rotating shaft of an input side of the transmission,
wherein the amplitude is acquired based on a difference between angle information output from the output side angle sensor and angle information output from the input side angle sensor,
wherein a fast Fourier transform (FFT) process is performed in a predetermined section divided in the angle information output from the output side angle sensor,
wherein the robot is operated so that the robot maintains the predetermined path and the driving speed becomes the driving speed at which the predetermined joint performs the vibration at the natural frequency by changing a command value of the predetermined joint in an operation to be performed during acquisition of the state in a time direction so that a driving amount of the predetermined joint in the predetermined path matches a driving amount of the predetermined joint in the operation when the state is acquired, and
wherein the command value of the predetermined joint is stretched in the time direction.
2. The control method according to claim 1 , wherein the amplitude is acquired by changing a driving parameter of the predetermined joint over time during a single motion.
3. The control method according to claim 1 , wherein the driving speed corresponds to the natural frequency of the vibration that changes according to a change in an orientation of the robot.
4. The control method according to claim 1 , wherein, in the acquiring the state, a state of a transmission in the predetermined joint is acquired.
5. The control method according to claim 3 , wherein the driving speed is set to be a constant number times the natural frequency of the predetermined joint.
6. A control apparatus for controlling a robot which includes at least two joints and configured to be controlled based on a predetermined path for executing a normal motion, the control apparatus comprising:
a processing unit that performs operations including:
acquiring an amplitude of a vibration at a natural frequency from a predetermined joint of the at least two joints while operating the robot in a way that the robot maintains the predetermined path and moves at a driving speed that causes the predetermined joint to vibrate at the natural frequency;
acquiring a state of the predetermined joint based on the amplitude,
wherein the predetermined joint includes:
a rotational driving source;
a transmission configured to be driven by the rotational driving source;
an output side angle sensor configured to measure a rotational angle of a rotating shaft on an output side of the transmission; and
an input side angle sensor configured to measure a rotational angle of the rotating shaft of an input side of the transmission; and
acquiring the amplitude based on a difference between angle information output from the output side angle sensor and angle information output from the input side angle sensor,
wherein a fast Fourier transform (FFT) process is performed in a predetermined section divided in the angle information output from the output side angle sensor,
wherein the robot is operated so that the robot maintains the predetermined path and the driving speed becomes the driving speed at which the predetermined joint performs the vibration at the natural frequency by changing a command value of the predetermined joint in an operation to be performed during acquisition of the state in a time direction so that a driving amount of the predetermined joint in the predetermined path matches a driving amount of the predetermined joint in the operation when the state is acquired, and
wherein the command value of the predetermined joint is stretched in the time direction.
7. A non-transitory storage medium that stores a program for causing a computer to execute the examination method according to claim 1 .
8. The control method according to claim 1 , wherein
the state of the predetermined joint is acquired by comparing the amplitude with a reference value,
the user is notified that the state has become a predetermined state, and
the notification is made by means of at least one of display by a display unit or sound output by a sound output unit.
9. The control method according to claim 1 , wherein
a rate of change is acquired by comparing the amplitude with an amplitude that was acquired at a past point in time different from a point in time at which the amplitude is acquired, and the state of the predetermined joint is acquired based on the rate of change.
10. The control method according to claim 1 , wherein
a change is made within a range including a driving speed at which a resonance occurs on the predetermined joint as the natural frequency, at the driving speed of the predetermined joint.
11. The control method according to claim 1 , wherein the robot is operated so that the robot maintains the predetermined path and the driving speed becomes the driving speed at which the predetermined joint performs the vibration at the natural frequency by causing angle information in a joint other than the predetermined joint in the predetermined path to correspond to angle information in the joint other than the predetermined joint when the state is acquired.
12. The control method according to claim 1 , wherein
display is performed on a display unit such that the predetermined joint is selectable by a user, and the state of the predetermined joint selected by the user is acquired,
a first button for starting acquisition of the state of the predetermined joint is displayed on the display unit,
a second button for stopping acquisition of the state of the predetermined joint is displayed on the display unit,
a third button for making a setting for acquiring information regarding the robot apparatus is displayed on the display unit, and a first screen displaying the predetermined joint in a selectable manner is displayed when the fourth button is selected, and
a fourth button for displaying a history of the state of the predetermined joint displayed on the first screen.
13. The control method according to claim 12 , wherein
a second screen showing changes in the state of the predetermined joint by a graph is displayed when the fifth button is selected,
on the second screen, changes in states of all of the plurality of joints, including the state of the predetermined joint, are shown by graphs,
a fifth button for executing acquisition of the states of the all of the plurality of joints is displayed on the display unit,
a third screen showing an acquisition result is displayed on the display unit after executing the acquisition of the state of the predetermined joint,
a result of comparison with a reference value is shown in terms of percentage as the acquisition result,
whether the predetermined joint is normal or abnormal is displayed on the third screen, and
the predetermined joint that is abnormal is displayed in a highlighted manner.
14. The control method according to claim 8 , wherein
states of the joints are acquired in order, starting from a joint closest to a base unit of the robot apparatus.
15. The control method according to claim 8 , wherein
order of acquiring states of the joints is set by the user.
16. The control method according to claim 1 , wherein
the predetermined path is data for causing the robot apparatus to perform a production motion, and
the predetermined path in the normal motion is set according to a work to be executed by the robot.
17. The control method according to claim 2 , wherein
the driving parameter is changed within a range including a driving parameter at which vibration of the predetermined joint at the natural frequency occurs most often, and
motion based on the motion data is executed within a range of not going beyond a movable range of the predetermined joint.
18. The control method according to claim 10 , wherein the range includes a driving speed of ½ times a resonance frequency at which the resonance occurs.
19. The control method according to claim 1 , wherein the predetermined section is a time section of 100 msec.
20. The control method according to claim 1 , wherein a shifting width is set for the predetermined section.
21. A manufacturing method for manufacturing an article, wherein an article is manufactured by controlling the robot by the control apparatus according to claim 6 .
22. The control method according to claim 1 , wherein the state of the predetermined joint is acquired by operating the at least two joints one by one.