Robot system and sensing method
By storing the reference position information of the sensor relative to the motor in the robot system and correcting it, the problem of difficult to utilize sensor information is solved, and the correct directionality and efficient use of information are achieved.
Patent Information
- Application Number
- CN202280090680.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2022-02-03
- Publication Date
- 2024-11-05
AI Technical Summary
Sensor information in existing robot systems is difficult to effectively utilize because the relative position of the sensor relative to the motor is unclear, making it difficult to determine the directionality of the information.
By setting a memory in the robot system to store the relative position information of the sensor relative to the reference position of the motor, and correcting the sensor information based on this information, the sensor information correction unit is used to correct the sensor information.
Effectively utilize sensor information to ensure that the information is related to the correct direction and improve the efficiency of sensor data usage in the robot system.
Smart Images

Figure CN118900753A_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to robotic systems and sensing methods. Background Art
[0002] Patent Document 1 discloses a robot in which sensors for detecting actuator driving conditions, such as a position sensor, an acceleration sensor, an angular velocity sensor, and a torque sensor, are built into each joint actuator device.
[0003] Prior art literature
[0004] Patent Literature
[0005] Patent Document 1: Japanese Patent Application Publication No. 2004-188535 Summary of the invention
[0006] Problems to be solved by the invention
[0007] The present disclosure provides a robot system that is effective for further utilizing sensor information in the robot.
[0008] Means for solving problems
[0009] A robot system involved in one aspect of the present disclosure comprises: a first link, which is part of a robot arm; a first motor, which moves by rotation of the first link; a first sensor, whose relative position relative to the first motor is fixed; and a memory, which stores first position information, which indicates the relative position of the first sensor relative to a first reference position associated with the first motor.
[0010] Another aspect of the present disclosure relates to a sensing method that includes: obtaining first sensor information from a first sensor, wherein the relative position of the first sensor relative to a first motor is fixed, and the first motor is displaced by the rotation of a first link that is part of a robot arm; and correcting the first sensor information based on first position information indicating the relative position of the first sensor relative to the first motor and information related to the state of the first link.
[0011] Effects of the Invention
[0012] The present disclosure provides a robot system that is effective for further utilizing sensor information in the robot. BRIEF DESCRIPTION OF THE DRAWINGS
[0013] Figure 1 is a schematic diagram illustrating the structure of a robot system.
[0014] Figure 2 is a schematic diagram illustrating the structure of an encoder.
[0015] Figure 3is a block diagram illustrating the structure of a controller.
[0016] Figure 4 is a block diagram illustrating the hardware configuration of the controller.
[0017] Figure 5 is a flow chart illustrating the calibration procedure.
[0018] Figure 6 is a flowchart illustrating the setting status detection steps.
[0019] Figure 7 is a flowchart illustrating a vibration detection procedure.
[0020] Figure 8 is a flowchart illustrating the interpolation steps. DETAILED DESCRIPTION
[0021] Hereinafter, the embodiments will be described in detail with reference to the drawings. In the description, the same elements or elements having the same functions are denoted by the same reference numerals, and repeated descriptions are omitted.
[0022] 〔Robotic system〕
[0023] Figure 1 The robot system 1 shown is, for example, an industrial robot system, and performs operations such as conveying, processing, and assembling workpieces. For example, the robot system 1 includes a robot arm 10 and a controller 100 .
[0024] The robot arm 10 is, for example, a six-axis vertical multi-joint robot, and includes a robot base 11, an arm 12, an arm 13, a wrist 14, a terminal 15, motors 41, 42, 43, 44, 45, 46, and encoders 51, 52, 53, 54, 55, 56. The robot base 11 is disposed on the floor, wall, or ceiling of the work space. The robot base 11 may also be disposed on a movable surface such as the upper surface of an unmanned transport vehicle.
[0025] The robot base 11 has a base 16 and a rotating part 17. The base 16 is fixed to a setting surface such as the ground, wall, ceiling, or the upper surface of the unmanned transport vehicle as exemplified above. Figure 1 In the following description, the base 16 is fixed to the horizontal ground. In the following description, "up and down" means up and down when the base 16 is fixed to the horizontal ground.
[0026] The rotating part 17 is rotatably installed on the base 16 about the vertical axis 21 (the axis 21 perpendicular to the installation surface). Thus, a joint 31 is formed between the base 16 and the rotating part 17, and the base 16 supports the rotating part 17 rotatably.
[0027] The arm 12 is connected to the rotating part 17 in a manner that allows it to rotate around an axis 22 that intersects (e.g., is perpendicular to) the axis 21. The intersection includes a torsion relationship such as a so-called three-dimensional intersection. The same applies to the following. Thus, a joint 32 is formed between the rotating part 17 and the arm 12, and the rotating part 17 supports the arm 12 so that it can rotate. The arm 12 extends in a manner that intersects (e.g., is perpendicular to) the axis 22.
[0028] The arm 13 is connected to the end of the arm 12 in a manner that allows rotation around an axis 23 that is parallel to the axis 22. Thus, a joint 33 is formed between the arm 13 and the arm 12, and the arm 12 supports the arm 13 so that it can rotate. In addition, "support" includes indirect support in addition to direct support. For example, the arm 13 is also supported by the rotating portion 17 via the arm 12. The arm 13 extends along an axis 24 that intersects (for example, is perpendicular to) the axis 23.
[0029] The arm 13 has an arm base 18 and an arm end 19. The arm base 18 is connected to the end of the arm 12 in a manner that allows rotation around an axis 23. The arm end 19 is connected to the end of the arm base 18 in a manner that allows rotation around an axis 24, and extends along the axis 24. Thus, a joint 34 is formed between the arm end 19 and the arm base 18, and the arm base 18 supports the arm end 19 so that it can rotate.
[0030] The wrist 14 is connected to the end of the arm end 19 so as to be rotatable around an axis 25 intersecting (e.g., perpendicular) the axis 24. Thus, a joint 35 is formed between the wrist 14 and the arm end 19, and the arm end 19 rotatably supports the wrist 14. The wrist 14 extends along an axis 26 intersecting (e.g., perpendicular) the axis 25.
[0031] The terminal portion 15 is connected to the end of the wrist portion 14 in a manner that allows rotation around the axis 26. Thus, a joint 36 is formed between the terminal portion 15 and the wrist portion 14, and the wrist portion 14 supports the terminal portion 15 so that it can rotate. A tool that acts on a workpiece is provided at the terminal portion 15. Specific examples of the tool include a hand that holds the workpiece, a processing tool for the workpiece (e.g., a welding torch, a coating gun), an assembly tool (e.g., a screw tightening tool), and the like.
[0032] Motors 41, 42, 43, 44, 45, 46 drive joints 31, 32, 33, 34, 35, 36, respectively. Motor 41 is a "base motor" fixed to robot base 11. As an example, motor 41 is fixed to rotating unit 17. Motor 41 may also be fixed to base 16.
[0033] The motor 41 receives power supply and rotates the rotating part 17 around the axis 21. The motor 42 is fixed to the rotating part 17 at the joint 32 and moves by the rotation of the rotating part 17. In this relationship, the rotating part 17 is the "first link", the motor 41 is the "second motor" that rotates the "first link", and the motor 42 is the "first motor" that moves by the rotation of the "first link". The motor 42 can also be fixed to the arm 12.
[0034] The motor 42 receives power supply to rotate the arm 12 around the axis 22. The motor 43 is fixed to the arm 12 at the joint 33 and moves by the rotation of the arm 12. In addition, the motor 43 is also moved by the rotation of the rotating part 17. In this relationship, the arm 12 is the "first link", and the rotating part 17 is the "second link" that supports the "first link" so that it can rotate. The motor 42 is the "second motor" that rotates the "first link", and the motor 43 is the "first motor" that moves by the rotation of the "first link". The motor 43 can also be fixed to the arm base 18.
[0035] The motor 43 receives power supply to rotate the arm base 18 around the axis 23. The motor 44 is fixed to the arm base 18 and moves by the rotation of the arm base 18. In addition, the motor 44 is also moved by the rotation of the rotating part 17 and the rotation of the arm 12. In this relationship, the arm base 18 is the "first link", and the arm 12 is the "second link" that supports the "first link" so that it can rotate. The motor 43 is the "second motor" that rotates the "first link", and the motor 44 is the "first motor" that moves by the rotation of the "first link". The motor 44 can also be fixed to the arm end 19.
[0036] The motor 44 receives power supply to rotate the arm end 19 around the axis 24. The motors 45 and 46 are fixed to the arm end 19 and move by the rotation of the arm end 19. In addition, the motors 45 and 46 are also moved by the rotation of the rotating part 17, the rotation of the arm 12, and the rotation of the arm base 18. In this relationship, the arm end 19 is the "first link", and the arm base 18 is the "second link" that supports the "first link" so that it can rotate. The motor 44 is the "second motor" that rotates the "first link", and the motors 45 and 46 are the "first motor" that moves by the rotation of the "first link". The motor 45 receives power supply to rotate the wrist 14 around the axis 25. The motor 46 receives power supply to rotate the distal end 15 around the axis 26.
[0037] The configuration of the motor is only an example and can be changed appropriately. For example, the motor 46 can also be fixed to the wrist 14. In this case, the motor 46 moves by the rotation of the wrist 14. The wrist 14 is the "first link", and the arm end 19 is the "second link" that supports the "first link" so that it can rotate. The motor 45 is the "second motor" that rotates the "first link", and the motor 46 is the "first motor" that moves by the rotation of the "first link". In addition, the motor 46 is also moved by the rotation of the rotating part 17, the rotation of the arm 12, the rotation of the arm base 18, and the rotation of the arm end 19 (second link).
[0038] In addition, the motors 45 and 46 may be fixed to the arm base 18. In this case, the motors 45 and 46 are moved by the rotation of the arm base 18 (first link) similarly to the motor 44.
[0039] Encoders 51, 52, 53, 54, 55, 56 detect the rotation of motors 41, 42, 43, 44, 45, 46, respectively. For example, encoder 51 is fixed to motor 41 and detects the rotation angle of motor 41 for rotating rotating portion 17 around axis 21. For example, encoder 51 is fixed to the stator of motor 41 and detects the rotation angle of the rotor of motor 41. Encoder 51 is a "base encoder" fixed to the "base motor" and is also a "second encoder" fixed to the "second motor".
[0040] The encoder 52 is fixed to the motor 42 and detects the rotation angle of the motor 42 for rotating the arm 12 around the axis 22. For example, the encoder 52 is fixed to the stator of the motor 42 and detects the rotation angle of the rotor of the motor 42. The encoder 52 is a "first encoder" fixed to the "first motor" and a "second encoder" fixed to the "second motor".
[0041] The encoder 53 is fixed to the motor 43 and detects the rotation angle of the motor 43 for rotating the arm base 18 around the axis 23. For example, the encoder 53 is fixed to the stator of the motor 43 and detects the rotation angle of the rotor of the motor 43. The encoder 53 is a "first encoder" fixed to the "first motor" and a "second encoder" fixed to the "second motor".
[0042] The encoder 54 is fixed to the motor 44 and detects the rotation angle of the motor 44 for rotating the arm end 19 around the axis 24. For example, the encoder 54 is fixed to the stator of the motor 44 and detects the rotation angle of the rotor of the motor 44. The encoder 54 is a "first encoder" fixed to the "first motor" and is also a "second encoder" fixed to the "second motor".
[0043] The encoder 55 is fixed to the motor 45 and detects the rotation angle of the motor 45 for rotating the wrist 14 around the axis 25. For example, the encoder 55 is fixed to the stator of the motor 45 and detects the rotation angle of the rotor of the motor 45. The encoder 55 is a "first encoder" fixed to the "first motor". When the motor 46 is fixed to the wrist 14, the encoder 55 is also a "second encoder" fixed to the "second motor".
[0044] The encoder 56 is fixed to the motor 46 and detects the rotation angle of the motor 45 for rotating the tip portion 15 around the axis 26. For example, the encoder 56 is fixed to the stator of the motor 46 and detects the rotation angle of the rotor of the motor 46. The encoder 56 is a "first encoder" fixed to the "first motor".
[0045] The robot arm 10 includes sensors 61, 62, 63, 64, 65, 66 in addition to the encoders 51, 52, 53, 54, 55, 56. The relative position of the sensor 61 with respect to the motor 41 is fixed. The sensor 61 is a "base sensor" whose relative position with respect to the "base motor" is fixed, and is also a "second sensor" whose relative position with respect to the "second motor" is fixed. For example, the sensor 61 is built into the encoder 51 and fixed at the sensing position 51a in the encoder 51. The sensor 61 is an acceleration sensor that detects the acceleration of the sensing position 51a. The sensor 61 may also be built into the motor 41.
[0046] The relative position of the sensor 62 with respect to the motor 42 is fixed. The sensor 62 is a "first sensor" whose relative position with respect to the "first motor" is fixed, and is also a "second sensor" whose relative position with respect to the "second motor" is fixed. For example, the sensor 62 is built into the encoder 52 and fixed to the sensing position 52a in the encoder 52. The sensor 62 is an acceleration sensor that detects the acceleration of the sensing position 52a. The sensor 62 may also be built into the motor 42.
[0047] The relative position of the sensor 63 with respect to the motor 43 is fixed. The sensor 63 is a "first sensor" whose relative position with respect to the "first motor" is fixed, and is also a "second sensor" whose relative position with respect to the "second motor" is fixed. For example, the sensor 63 is built into the encoder 53 and fixed at the sensing position 53a in the encoder 53. The sensor 63 is an acceleration sensor that detects the acceleration of the sensing position 53a. The sensor 63 may also be built into the motor 43.
[0048] The relative position of the sensor 64 with respect to the motor 44 is fixed. The sensor 64 is a "first sensor" whose relative position with respect to the "first motor" is fixed, and is also a "second sensor" whose relative position with respect to the "second motor" is fixed. For example, the sensor 64 is built into the encoder 54 and fixed at the sensing position 54a in the encoder 54. The sensor 64 is an acceleration sensor that detects the acceleration of the sensing position 54a. The sensor 64 may also be built into the motor 44.
[0049] The relative position of the sensor 65 with respect to the motor 45 is fixed. The sensor 65 is a "first sensor" whose relative position with respect to the "first motor" is fixed. When the motor 46 is fixed to the wrist 14, the sensor 65 is also a "second sensor" whose relative position with respect to the "second motor" is fixed. For example, the sensor 65 is built into the encoder 55 and fixed to the sensing position 55a in the encoder 55. The sensor 65 is an acceleration sensor that detects the acceleration of the sensing position 55a. The sensor 65 may also be built into the motor 45.
[0050] The relative position of the sensor 66 with respect to the motor 46 is fixed. The sensor 66 is a "first sensor" whose relative position with respect to the "first motor" is fixed. For example, the sensor 66 is built into the encoder 56 and fixed to the sensing position 56a in the encoder 56. The sensor 66 is an acceleration sensor that detects the acceleration of the sensing position 56a. The sensor 66 may also be built into the motor 46.
[0051] The robot arm 10 may further include sensors (other sensors) different from the encoders 51, 52, 53, 54, 55, 56 and the sensors 61, 62, 63, 64, 65, 66. For example, the robot arm 10 includes a torque sensor 71, a torque sensor 72, and a contact sensor 73. The torque sensor 71 detects the torque acting between the rotating part 17 and the arm 12 at the joint 32. The torque sensor 72 detects the torque acting between the arm base 18 and the arm 12 at the joint 33. The contact sensor 73 detects the contact between the arm end 19 and the surrounding object.
[0052] Figure 1 The structure of the robot arm 10 shown is only an example. The structure of the robot arm 10 can be appropriately changed as long as it has one or more connecting rods (first connecting rods) and a motor (first motor) that moves by the rotation of the connecting rods. For example, the robot arm 10 can be a redundant multi-joint robot in which one or more joints are added to the above-mentioned six joints, or it can be a so-called SCARA-type multi-joint robot. In addition, the robot arm 10 can also be a parallel link type robot.
[0053] Reference Figure 2, the structures of the encoders 51, 52, 53, 54, 55, 56 are illustrated in more detail. The illustrated contents are common to the encoders 51, 52, 53, 54, 55, 56, and therefore they are not distinguished from each other but are referred to as the encoder 50. The motors 41, 42, 43, 44, 45, 46 to which the encoders 51, 52, 53, 54, 55, 56 are respectively fixed are also not distinguished from each other but are referred to as the motor 40. The sensors 61, 62, 63, 64, 65, 66 built into the encoders 51, 52, 53, 54, 55, 56 are also not distinguished from each other but are referred to as the sensor 60.
[0054] like Figure 2 As shown, the encoder 50 includes a disk 81 and a circuit board 82. The disk 81 is fixed to the rotor of the motor 40 and rotates together with the rotor. The circuit board 82 includes a pulse generating unit 83 and an integrated circuit 84. The pulse generating unit 83 generates a pulse signal corresponding to the rotation of the disk 81. The integrated circuit 84 calculates the rotation angle of the motor 40. For example, the integrated circuit 84 counts the pulse signals generated by the pulse generating unit 83 and calculates the rotation angle of the motor 40.
[0055] The sensor 60 may include a MEMS (Micro Electro Mechanical System) device formed on the integrated circuit 84. A MEMS device is a device in which an electric circuit and a mechanical structure are integrated on a single semiconductor substrate.
[0056] For example, the sensor 60 includes a sensing portion 85 and an AD conversion circuit 86. The sensing portion 85 is a MEMS device and is formed at the sensing position 50a in the integrated circuit 84. The sensing portion 85 generates an analog electrical signal indicating the acceleration of the sensing position 50a. The AD conversion circuit 86 is formed together with the sensing portion 85 in the integrated circuit 84, and converts the analog electrical signal generated by the sensing portion 85 into a digital signal.
[0057] For example, the sensor unit 85 generates an electrical signal representing the acceleration of the sensor position 50a in the sensor coordinate system CS2 fixed to the sensor position 50a. For example, the sensor coordinate system CS2 is a three-dimensional orthogonal coordinate system having three coordinate axes perpendicular to each other. The sensor unit 85 generates three analog electrical signals representing the acceleration of the sensor position 50a in the sensor coordinate system CS2. The AD conversion circuit 86 converts the three electrical signals generated by the sensor unit 85 into three digital signals, respectively.
[0058] The controller 100 operates the robot arm 10 according to a pre-prepared operation program. As described above, the robot arm 10 includes sensors 61, 62, 63, 64, 65, and 66 whose relative positions to the motors 41, 42, 43, 44, 45, and 46 are fixed, respectively. The sensors whose relative positions to the motors are fixed can be powered by the power supply system for the motors, and information can be obtained from the sensors by the communication system for controlling the motors, thereby simplifying the wiring to the sensors.
[0059] However, when the relative position of the first sensor with respect to the first motor is unclear, it is also unclear to which direction the first sensor information acquired from the first sensor relates, and thus it is difficult to effectively use the first sensor information.
[0060] In contrast, the controller 100 has a memory storing first position information indicating the relative position of the first sensor relative to the first reference position associated with the first motor. Since the first position information is stored in the memory, it is easy to determine which direction the first sensor information is associated with based on the first position information.
[0061] For example, Figure 3 As shown, the controller 100 includes a control unit 111 , a sensor information acquisition unit 112 , a position information memory 113 , and a sensor information correction unit 114 as functional components (hereinafter referred to as “functional blocks”).
[0062] The control unit 111 operates the robot arm 10 according to a pre-prepared motion program. The motion program includes a plurality of motion instructions in a time series. The plurality of motion instructions each include, for example, a target position and a target posture of the terminal portion 15. The plurality of motion instructions each may further include a target speed for movement to the target position and the target posture. For example, the control unit 111 repeatedly performs the following processing within a predetermined control cycle. Based on the motion instructions, the target position and the target posture of the terminal portion 15 for each control cycle are calculated. The target angles of the motors 41, 42, 43, 44, 45, 46 are calculated by inverse kinematics calculation based on the target position and the target posture of the terminal portion 15 for each control cycle and the model information of the robot arm 10. The current angles of the motors 41, 42, 43, 44, 45, 46 detected by the encoders 51, 52, 53, 54, 55, 56 are obtained. The motors 41, 42, 43, 44, 45, 46 are driven so that the current angles follow the target angles.
[0063] The sensor information acquisition unit 112 acquires first sensor information from the first sensor. The sensor information acquisition unit 112 may also acquire second sensor information from the second sensor. For example, the sensor information acquisition unit 112 acquires sensor information from sensors 61, 62, 63, 64, 65, and 66. For example, the sensor information acquisition unit 112 acquires sensor information representing the detection result of the acceleration at the sensing position 51a from sensor 61, acquires sensor information representing the detection result of the acceleration at the sensing position 52a from sensor 62, acquires sensor information representing the detection result of the acceleration at the sensing position 53a from sensor 63, acquires sensor information representing the detection result of the acceleration at the sensing position 54a from sensor 64, acquires sensor information representing the detection result of the acceleration at the sensing position 55a from sensor 65, and acquires sensor information representing the detection result of the acceleration at the sensing position 56a from sensor 66.
[0064] The sensor information acquisition unit 112 may also acquire other sensor information from other sensors. For example, the sensor information acquisition unit 112 also acquires other sensor information from torque sensors 71 and 72 and contact sensor 73. For example, the sensor information acquisition unit 112 acquires sensor information representing the detection result of torque from torque sensors 71 and 72, and acquires sensor information representing the detection result of contact from contact sensor 73.
[0065] The position information memory 113 stores first position information representing the relative position of the first sensor with respect to a first reference position associated with the first motor. The position information memory 113 may also store second position information representing the relative position of the second sensor with respect to a second reference position associated with the second motor. For example, the position information memory 113 stores position information representing the relative position of sensor 61 with respect to a reference position associated with motor 41, position information representing the relative position of sensor 62 with respect to a reference position associated with motor 42, position information representing the relative position of sensor 63 with respect to a reference position associated with motor 43, position information representing the relative position of sensor 64 with respect to a reference position associated with motor 44, position information representing the relative position of sensor 65 with respect to a reference position associated with motor 45, and position information representing the relative position of sensor 66 with respect to a reference position associated with motor 46. The reference position associated with motor 41 is a position where the relative position with respect to motor 41 is fixed. The reference position associated with motor 41 may be located either inside or outside motor 41. For example, the reference position associated with motor 41 may also be located at a part fixed to motor 41 (such as robot base 11). The same applies to the reference positions associated with other motors. Hereinafter, without distinguishing the respective position information, it is assumed to be position information representing the relative position of sensor 60 with respect to a reference position associated with motor 40, and the content of the position information will be described.
[0066] For example, the position information represents the relative position of the sensing position 50a of sensor 60 with respect to a reference position associated with motor 40 in coordinates in the motor coordinate system CS3 fixed to motor 40. Each position information may also represent the relative orientation of sensor 60 with respect to motor 40. For example, each position information may also represent the relative orientation of the sensor coordinate system CS2 with respect to the motor coordinate system CS3.
[0067] It is sufficient that the motor coordinate system CS3 is at least fixed to motor 40, and the origin (reference position) of the motor coordinate system CS3 may be located outside motor 40. For example, the origin of the motor coordinate system CS3 may also be located at a link that fixes motor 40. For example, regarding the origin of the motor coordinate system CS3, the origin of the motor coordinate system CS3 of motor 41 may be located at the rotating part 17, the origin of the motor coordinate system CS3 of motor 42 may be located at the rotating part 17, the origin of the motor coordinate system CS3 of motor 43 may be located at the arm 12, the origin of the motor coordinate system CS3 of motor 44 may be located at the arm base 18, and the origins of the motor coordinate systems CS3 of motors 45 and 46 may be located at the arm end 19.
[0068] The sensor information correction unit 114 corrects the first sensor information obtained from the first sensor based on the first position information and the information related to the state of the first link. The sensor information correction unit 114 may also correct the first sensor information obtained from the first sensor based on the first position information, the information related to the state of the first link, and the information related to the state of the second link. The sensor information correction unit 114 may also correct the second sensor information obtained from the second sensor based on the second position information. Examples of the information related to the state of the link include the rotation angle of the link, the angular velocity of rotation, the angular acceleration of rotation, the jerk of the rotation angle, the length of the link, the relative angle between the links, the distance between the links, and the like.
[0069] For example, the sensor information correction unit 114 corrects the sensor information obtained from the sensor 62 based on the information related to the state of the rotating unit 17. For example, the sensor information correction unit 114 may also correct the sensor information obtained from the sensor 62 to information that is independent of the posture of the sensor 62 based on the rotation angle of the rotating unit 17. The information that is independent of the posture of the sensor 62 means information that excludes the influence of the posture of the sensor 62. Hereinafter, the same applies to the descriptions of the sensors 63, 64, 65, and 66. For example, the sensor information correction unit 114 corrects the sensor information represented by the vector in the sensor coordinate system CS2 to the sensor information represented by the vector in the robot coordinate system CS1 based on the model information of the robot arm 10 described above, the position information of the sensor 62, and the rotation angle of the rotating unit 17.
[0070] The sensor information correction unit 114 may also correct the sensor information obtained from the sensor 62 to information that is independent of the rotational acceleration of the rotating unit 17 based on the position information of the sensor 62 and the rotational acceleration of the rotating unit 17. The information that is independent of the rotational acceleration of the rotating unit 17 means information that excludes the influence of the rotational acceleration of the rotating unit 17. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensing position 52a due to the rotational acceleration of the rotating unit 17 based on the model information of the robot arm 10, the rotational acceleration of the rotating unit 17, and the position information of the sensor 62, and removes the calculated acceleration from the acceleration detected by the sensor 62. Based on the sensor information that has undergone this correction, it is possible to detect the acceleration generated due to reasons different from the rotational acceleration of the rotating unit 17. Specific examples of different reasons include the deflection of the rotating unit 17, the sway of the rotating unit 17 relative to the base 16, the sway of the motor 42 relative to the rotating unit 17, and the like.
[0071] The sensor information correction unit 114 may correct the sensor information obtained from the sensor 62 to information that is not dependent on the rotation speed of the rotating unit 17 based on the position information of the sensor 62 and the rotation speed of the rotating unit 17. The information that is not dependent on the rotation speed of the rotating unit 17 refers to information that excludes the influence of the rotation speed of the rotating unit 17. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 52a due to the rotation speed of the rotating unit 17 based on the model information of the robot arm 10, the rotation speed of the rotating unit 17, and the position information of the sensor 62, and removes the calculated acceleration from the acceleration detected by the sensor 62. Based on the sensor information that has been corrected, it is possible to detect acceleration generated due to a cause different from the rotation speed of the rotating unit 17. Specific examples of different causes include deflection of the rotating unit 17, shaking of the rotating unit 17 relative to the base 16, shaking of the motor 42 relative to the rotating unit 17, and the like.
[0072] The sensor information correction unit 114 may correct the sensor information obtained from the sensor 62 to information that is not dependent on the rotational acceleration and rotational speed of the rotating unit 17 based on the position information of the sensor 62 and the rotational acceleration and rotational speed of the rotating unit 17. The information that is not dependent on the rotational acceleration and rotational speed of the rotating unit 17 refers to information that excludes the influence of the rotational acceleration and rotational speed of the rotating unit 17. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 52a due to the rotational acceleration and rotational speed of the rotating unit 17 based on the model information of the robot arm 10, the rotational acceleration and rotational speed of the rotating unit 17, and the position information of the sensor 62, and removes the calculated acceleration from the acceleration detected by the sensor 62. Based on the sensor information subjected to this correction, it is possible to detect acceleration generated due to a cause different from the rotational acceleration and rotational speed of the rotating unit 17. Specific examples of different causes include the deflection of the rotating unit 17, the shaking of the rotating unit 17 relative to the base 16, and the shaking of the motor 42 relative to the rotating unit 17.
[0073] The sensor information correction unit 114 corrects the sensor information obtained from the sensor 63 based on the information related to the state of the arm 12 and the information related to the state of the rotation unit 17. For example, the sensor information correction unit 114 may correct the sensor information obtained from the sensor 63 to information that does not depend on the posture of the sensor 63 based on the rotation angle of the arm 12 and the rotation angle of the rotation unit 17. For example, the sensor information correction unit 114 corrects the sensor information represented by the vector in the sensor coordinate system CS2 to the sensor information represented by the vector in the robot coordinate system CS1 based on the model information of the robot arm 10, the position information of the sensor 63, the rotation angle of the arm 12, and the rotation angle of the rotation unit 17. As a result, the sensor information obtained from the sensor 62 and the sensor information obtained from the sensor 63 are corrected to be information in the same coordinate system.
[0074] The sensor information correction unit 114 may also correct the sensor information obtained from the sensor 63 to information that is not dependent on gravity. Information that is not dependent on gravity refers to information that excludes the influence of gravity. For example, the sensor information correction unit 114 corrects the sensor information obtained from the sensor 63 to sensor information represented by a vector in the robot coordinate system CS1 as described above, and removes the gravity acceleration vector in the robot coordinate system CS1 from the corrected sensor information.
[0075] The sensor information correction unit 114 may correct the sensor information obtained from the sensor 63 to information that is not dependent on the rotational acceleration of the arm 12 and the rotational acceleration of the rotational part 17 based on the position information of the sensor 63, the rotational acceleration of the arm 12, and the rotational acceleration of the rotational part 17. The information that is not dependent on the rotational acceleration of the arm 12 and the rotational acceleration of the rotational part 17 is information from which the influence of the rotational acceleration of the arm 12 and the rotational acceleration of the rotational part 17 is eliminated. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 53a due to the rotational acceleration of the arm 12 and the rotational acceleration of the rotational part 17 based on the model information of the robot arm 10, the rotational acceleration of the arm 12, the rotational acceleration of the rotational part 17, and the position information of the sensor 63, and removes the calculated acceleration from the acceleration detected by the sensor 63. Based on the sensor information subjected to this correction, it is possible to detect acceleration generated due to a cause different from the rotational acceleration of the arm 12 and the rotational acceleration of the rotational part 17. Specific examples of the different causes include bending of the rotating portion 17 , shaking of the rotating portion 17 relative to the base 16 , bending of the arm 12 , shaking of the arm 12 relative to the rotating portion 17 , and shaking of the motor 43 relative to the arm 12 .
[0076] The sensor information correction unit 114 may correct the sensor information obtained from the sensor 63 to information that is not dependent on the rotation speed of the arm 12 and the rotation speed of the rotating unit 17 based on the position information of the sensor 63, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17. The information that is not dependent on the rotation speed of the arm 12 and the rotation speed of the rotating unit 17 refers to information from which the influence of the rotation speed of the arm 12 and the rotation speed of the rotating unit 17 is eliminated. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 53a due to the rotation speed of the arm 12 and the rotation speed of the rotating unit 17 based on the model information of the robot arm 10, the rotation speed of the arm 12, the rotation speed of the rotating unit 17, and the position information of the sensor 63, and removes the calculated acceleration from the acceleration detected by the sensor 63. Based on the sensor information that has been corrected, it is possible to detect acceleration generated due to a factor different from the rotation speed of the arm 12 and the rotation speed of the rotating unit 17. Specific examples of the different causes include bending of the rotating portion 17 , shaking of the rotating portion 17 relative to the base 16 , bending of the arm 12 , shaking of the arm 12 relative to the rotating portion 17 , and shaking of the motor 43 relative to the arm 12 .
[0077] The sensor information correction unit 114 may correct the sensor information obtained from the sensor 63 to information that is independent of the rotational acceleration and rotational speed of the arm 12 and the rotational acceleration and rotational speed of the swing unit 17 based on the position information of the sensor 63, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17. The information that is independent of the rotational acceleration and rotational speed of the arm 12 and the rotational acceleration and rotational speed of the swing unit 17 refers to information from which the influence of the rotational acceleration and rotational speed of the arm 12 and the influence of the rotational acceleration and rotational speed of the swing unit 17 are eliminated. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 53a due to the rotational acceleration and rotational speed of the arm 12 and the rotational acceleration and rotational speed of the swing unit 17 based on the model information of the robot arm 10, the rotational acceleration and rotational speed of the arm 12, the rotational acceleration and rotational speed of the swing unit 17, and the position information of the sensor 63, and removes the calculated acceleration from the acceleration detected by the sensor 63. Based on the sensor information subjected to this correction, it is possible to detect acceleration caused by a cause different from the rotation acceleration and rotation speed of the arm 12 and the rotation acceleration and rotation speed of the rotary unit 17. Specific examples of the different causes include the bending of the rotary unit 17, the shaking of the rotary unit 17 relative to the base 16, the bending of the arm 12, the shaking of the arm 12 relative to the rotary unit 17, and the shaking of the motor 43 relative to the arm 12.
[0078] The sensor information correction unit 114 corrects the sensor information obtained from the sensor 64 based on the information related to the state of the arm base 18, the information related to the state of the arm 12, and the information related to the state of the swing unit 17. For example, the sensor information correction unit 114 may correct the sensor information obtained from the sensor 64 to information that does not depend on the posture of the sensor 64 based on the rotation angle of the arm base 18, the rotation angle of the arm 12, and the rotation angle of the swing unit 17. For example, the sensor information correction unit 114 corrects the sensor information represented by the vector in the sensor coordinate system CS2 to the sensor information represented by the vector in the robot coordinate system CS1 based on the model information of the robot arm 10, the position information of the sensor 64, the rotation angle of the arm base 18, the rotation angle of the arm 12, and the rotation angle of the swing unit 17. As a result, the sensor information obtained from the sensor 62, the sensor information obtained from the sensor 63, and the sensor information obtained from the sensor 64 are corrected to information in the same coordinate system.
[0079] The sensor information correction unit 114 may also correct the sensor information obtained from the sensor 64 to information that is not dependent on gravitational acceleration. Information that is not dependent on gravitational acceleration includes information that is not dependent on gravity (mass×gravitational acceleration). For example, the sensor information correction unit 114 corrects the sensor information obtained from the sensor 64 to sensor information represented by a vector in the robot coordinate system CS1 as described above, and removes the gravitational acceleration vector in the robot coordinate system CS1 from the corrected sensor information.
[0080] The sensor information correction unit 114 may correct the sensor information obtained from the sensor 64 to information that is independent of the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotational portion 17, based on the position information of the sensor 64, the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotational portion 17. The information that is independent of the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotational portion 17 is information from which the influence of the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotational portion 17 is eliminated. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 54a due to the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotating part 17 based on the model information of the robot arm 10, the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotating part 17, and the position information of the sensor 64, and removes the calculated acceleration from the acceleration detected by the sensor 64. Based on the sensor information subjected to this correction, it is possible to detect acceleration generated due to a cause different from the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotating part 17. Specific examples of the different causes include the deflection of the rotating part 17, the shaking of the rotating part 17 relative to the base 16, the deflection of the arm 12, the shaking of the arm 12 relative to the rotating part 17, the deflection of the arm base 18, the shaking of the arm base 18 relative to the arm 12, and the shaking of the motor 44 relative to the arm base 18.
[0081] The sensor information correction unit 114 may correct the sensor information obtained from the sensor 64 to information that is not dependent on the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17 based on the position information of the sensor 64, the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17. The information that is not dependent on the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17 is information from which the influence of the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17 is eliminated. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 54a due to the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17 based on the model information of the robot arm 10, the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17, and the position information of the sensor 64, and removes the calculated acceleration from the acceleration detected by the sensor 64. Based on the sensor information subjected to this correction, it is possible to detect acceleration caused by a factor different from the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating part 17. Specific examples of the different factors include the bending of the rotating part 17, the shaking of the rotating part 17 relative to the base 16, the bending of the arm 12, the shaking of the arm 12 relative to the rotating part 17, the bending of the arm base 18, the shaking of the arm base 18 relative to the arm 12, and the shaking of the motor 44 relative to the arm base 18.
[0082] The sensor information correction unit 114 may correct the sensor information obtained from the sensor 64 to information that is not dependent on the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17, based on the position information of the sensor 64, the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17. The information that is not dependent on the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17 is information from which the influence of the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17 is eliminated. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 54a due to the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17 based on the model information of the robot arm 10, the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17, and the position information of the sensor 64, and removes the calculated acceleration from the acceleration detected by the sensor 64. Based on the sensor information subjected to this correction, it is possible to detect acceleration generated due to a factor different from the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17. Specific examples of different causes include the bending of the rotating part 17, the shaking of the rotating part 17 relative to the base 16, the bending of the arm 12, the shaking of the arm 12 relative to the rotating part 17, the bending of the arm base 18, the shaking of the arm base 18 relative to the arm 12, and the shaking of the motor 44 relative to the arm base 18.
[0083] The sensor information correction unit 114 corrects the sensor information obtained from the sensors 65 and 66 based on the information related to the state of the arm end 19, the information related to the state of the arm base 18, the information related to the state of the arm 12, and the information related to the state of the swing unit 17. For example, the sensor information correction unit 114 may correct the sensor information obtained from the sensors 65 and 66 to information that does not depend on the posture of the sensors 65 and 66 based on the rotation angle of the arm end 19, the rotation angle of the arm base 18, the rotation angle of the arm 12, and the rotation angle of the swing unit 17. For example, the sensor information correction unit 114 corrects the sensor information represented by the vector in the sensor coordinate system CS2 to the sensor information represented by the vector in the robot coordinate system CS1 based on the model information of the robot arm 10, the position information of the sensors 65 and 66, the rotation angle of the arm end 19, the rotation angle of the arm base 18, the rotation angle of the arm 12, and the rotation angle of the swing unit 17. Thereby, the sensor information acquired from the sensor 62 , the sensor information acquired from the sensor 63 , the sensor information acquired from the sensor 64 , and the sensor information acquired from the sensors 65 and 66 are corrected to be information in the same coordinate system.
[0084] The sensor information correction unit 114 may correct the sensor information obtained from the sensors 65 and 66 to information that does not depend on gravity. For example, the sensor information correction unit 114 corrects the sensor information obtained from the sensors 65 and 66 to sensor information represented by a vector in the robot coordinate system CS1 as described above, and removes the gravity acceleration vector in the robot coordinate system CS1 from the corrected sensor information.
[0085] The sensor information correction unit 114 may correct the sensor information obtained from the sensors 65 and 66 to information that is not dependent on the rotational acceleration of the arm end 19, the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotating unit 17, based on the position information of the sensors 65 and 66, the rotational acceleration of the arm end 19, the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotating unit 17. The information that is not dependent on the rotational acceleration of the arm end 19, the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotating unit 17 is information from which the influence of the rotational acceleration of the arm end 19, the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the rotating unit 17 is eliminated. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 55a due to the rotational acceleration of the arm end 19, the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, the rotational acceleration of the swing part 17, and the position information of the sensors 65 and 66 based on the model information of the robot arm 10, the rotational acceleration of the arm end 19, the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the swing part 17, and removes the calculated acceleration from the acceleration detected by the sensors 65 and 66. Based on the sensor information subjected to this correction, it is possible to detect acceleration generated due to a cause different from the rotational acceleration of the arm end 19, the rotational acceleration of the arm base 18, the rotational acceleration of the arm 12, and the rotational acceleration of the swing part 17. Specific examples of different causes include the bending of the rotating part 17, the rocking of the rotating part 17 relative to the base 16, the bending of the arm 12, the rocking of the arm 12 relative to the rotating part 17, the bending of the arm base 18, the rocking of the arm base 18 relative to the arm 12, the bending of the arm end 19, the rocking of the arm end 19 relative to the arm base 18, and the rocking of the motors 45 and 46 relative to the arm end 19.
[0086] The sensor information correction unit 114 may correct the sensor information obtained from the sensors 65 and 66 to information that is not dependent on the rotation speed of the arm end 19, the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17, based on the position information of the sensors 65 and 66, the rotation speed of the arm end 19, the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17. The information that is not dependent on the rotation speed of the arm end 19, the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17 is information from which the influence of the rotation speed of the arm end 19, the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the rotating unit 17 is eliminated. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 55a due to the rotation speed of the arm end 19, the rotation speed of the arm base 18, the rotation speed of the arm 12, the rotation speed of the swing unit 17, and the position information of the sensors 65 and 66 based on the model information of the robot arm 10, the rotation speed of the arm end 19, the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the swing unit 17, and removes the calculated acceleration from the acceleration detected by the sensors 65 and 66. Based on the sensor information subjected to this correction, the acceleration generated due to a factor different from the rotation speed of the arm end 19, the rotation speed of the arm base 18, the rotation speed of the arm 12, and the rotation speed of the swing unit 17 can be detected. Specific examples of different causes include the bending of the rotating part 17, the rocking of the rotating part 17 relative to the base 16, the bending of the arm 12, the rocking of the arm 12 relative to the rotating part 17, the bending of the arm base 18, the rocking of the arm base 18 relative to the arm 12, the bending of the arm end 19, the rocking of the arm end 19 relative to the arm base 18, and the rocking of the motors 45 and 46 relative to the arm end 19.
[0087] The sensor information correction unit 114 may correct the sensor information obtained from the sensors 65 and 66 to information that is not dependent on the rotational acceleration and rotational speed of the arm end 19, the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17, based on the position information of the sensors 65 and 66, the rotational acceleration and rotational speed of the arm end 19, the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17. The information that is not dependent on the rotational acceleration and rotational speed of the arm end 19, the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17 is information from which the influence of the rotational acceleration and rotational speed of the arm base 18, the influence of the rotational acceleration and rotational speed of the arm 12, and the influence of the rotational acceleration and rotational speed of the swing unit 17 is eliminated. For example, the sensor information correction unit 114 calculates the acceleration generated at the sensor position 55a due to the rotational acceleration and rotational speed of the arm end 19, the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, the rotational acceleration and rotational speed of the swing unit 17, and the position information of the sensors 65 and 66, and removes the calculated acceleration from the acceleration detected by the sensors 65 and 66. Based on the sensor information subjected to this correction, it is possible to detect acceleration generated due to a factor different from the rotational acceleration and rotational speed of the arm end 19, the rotational acceleration and rotational speed of the arm base 18, the rotational acceleration and rotational speed of the arm 12, and the rotational acceleration and rotational speed of the swing unit 17. Specific examples of different causes include the bending of the rotating part 17, the rocking of the rotating part 17 relative to the base 16, the bending of the arm 12, the rocking of the arm 12 relative to the rotating part 17, the bending of the arm base 18, the rocking of the arm base 18 relative to the arm 12, the bending of the arm end 19, the rocking of the arm end 19 relative to the arm base 18, and the rocking of the motors 45 and 46 relative to the arm end 19.
[0088] For example, the sensor information correction unit 114 may correct the sensor information obtained from the sensor 61 based on the information related to the state of the rotating unit 17. For example, the sensor information correction unit 114 may correct the sensor information obtained from the sensor 61 to information that is not dependent on the posture of the sensor 61 based on the rotation angle of the rotating unit 17. Information that is not dependent on the posture of the sensor 61 refers to information that eliminates the influence of the posture of the sensor 61. For example, the sensor information correction unit 114 corrects the sensor information represented by the vector in the sensor coordinate system CS2 to the sensor information represented by the vector in the robot coordinate system CS1 based on the model information of the robot arm 10, the position information of the sensor 61, and the rotation angle of the rotating unit 17.
[0089] The controller 100 may further include a relative information calculation unit 115. The relative information calculation unit 115 calculates relative sensor information obtained by removing a component corresponding to the second sensor information from the first sensor information, based on the first sensor information corrected by the sensor information correction unit 114 and the second sensor information corrected by the sensor information correction unit 114. For example, the relative information calculation unit 115 calculates relative sensor information obtained by removing a component corresponding to the sensor information of the sensor 62 from the sensor information of the sensor 63, based on the sensor information of the sensor 63 corrected by the sensor information correction unit 114 and the sensor information of the corrected sensor 62. For example, the relative information calculation unit 115 calculates the relative acceleration obtained by removing the acceleration indicated by the corrected sensor information of the sensor 62 from the acceleration indicated by the corrected sensor information of the sensor 63, as the relative sensor information. For example, the relative information calculation unit 115 calculates the relative acceleration of the sensor position 53a obtained by dividing the acceleration of the sensor position 52a represented by the vector in the robot coordinate system CS1 from the acceleration of the sensor position 53a represented by the vector in the robot coordinate system CS1.
[0090] In addition, the relative position of the "second sensor" that detects the "second sensor information" in the calculation of the relative sensor information is fixed with respect to the "second motor", and the "second motor" may not necessarily be a motor that rotates the "first link", as long as it is a motor that rotates at least a part of the robot arm 10. For example, the relative information calculation unit 115 may calculate the relative sensor information obtained by removing the component corresponding to the sensor information of the sensor 61 from the sensor information of the sensor 63 based on the sensor information of the sensor 63 corrected by the sensor information correction unit 114 and the sensor information of the corrected sensor 61. For example, the relative information calculation unit 115 may calculate the relative acceleration obtained by removing the acceleration represented by the sensor information of the corrected sensor 61 from the acceleration represented by the sensor information of the corrected sensor 63 as the relative sensor information. For example, the relative information calculation unit 115 may calculate the relative acceleration of the sensor position 53a obtained by dividing the acceleration of the sensor position 51a represented by the vector in the robot coordinate system CS1 from the acceleration of the sensor position 53a represented by the vector in the robot coordinate system CS1.
[0091] The relative information calculation unit 115 may calculate the relative vibration obtained by removing the vibration component corresponding to the vibration indicated by the sensor information of the corrected sensor 62 from the vibration indicated by the sensor information of the corrected sensor 63. For example, the relative information calculation unit 115 detects the vibration of the sensor position 52a in the robot coordinate system CS1 based on the acceleration indicated by the sensor information of the corrected sensor 62, and detects the vibration of the sensor position 53a in the robot coordinate system CS1 based on the acceleration indicated by the sensor information of the corrected sensor 63. The relative information calculation unit 115 calculates the relative vibration of the sensor position 53a obtained by removing the vibration of the sensor position 52a in the robot coordinate system CS1 from the vibration of the sensor position 53a in the robot coordinate system CS1. The relative information calculation unit 115 may calculate the relative vibration of the sensor position 53a based on the above-mentioned relative acceleration.
[0092] The relative information calculation unit 115 may also calculate the main relative vibration of the sensor position 53a along the moving direction of the motor 43 driven by the motor 42 as the relative vibration. For example, the relative information calculation unit 115 calculates the relative vibration represented by the vector in the robot coordinate system CS1, and calculates the component along the moving direction of the motor 43 driven by the motor 42 based on the calculated relative vibration as the main relative vibration of the sensor position 53a. The relative information calculation unit 115 may also calculate the sub-relative vibration of the sensor position 53a along the direction intersecting (for example, perpendicular) with the moving direction of the motor 43 driven by the motor 42 as the relative vibration. For example, the relative information calculation unit 115 calculates the relative vibration represented by the vector in the robot coordinate system CS1, and calculates the component along the direction intersecting with the moving direction of the motor 43 driven by the motor 42 based on the calculated relative vibration as the sub-relative vibration of the sensor position 53a. The relative information calculation unit 115 may also calculate both the main relative vibration and the sub-relative vibration.
[0093] In this case, the control unit 111 may also control the robot arm 10 to reduce the relative vibration of the sensing position 53a. For example, the control unit 111 controls the motor 42 to reduce the main relative vibration of the sensing position 53a. For example, the control unit 111 controls the motor 42 to generate a torque that cancels the main relative vibration of the sensing position 53a.
[0094] The control unit 111 may control a motor different from the motor 42 (eg, the motor 41) to reduce the secondary relative vibration of the sensing position 53a. For example, the control unit 111 controls the motor 41 to generate a torque that cancels the secondary relative vibration of the sensing position 53a.
[0095] Similarly, the relative information calculation unit 115 may calculate relative sensor information obtained by removing a component corresponding to the sensor information of the sensor 63 from the sensor information of the sensor 64, based on the sensor information of the sensor 64 corrected by the sensor information correction unit 114 and the sensor information of the corrected sensor 63. For example, the relative information calculation unit 115 calculates the relative acceleration of the sensor position 54a obtained by removing the acceleration indicated by the corrected sensor information of the sensor 63 from the acceleration indicated by the corrected sensor information of the sensor 64. The relative information calculation unit 115 may calculate the relative vibration of the sensor position 54a obtained by removing a vibration component corresponding to the vibration indicated by the corrected sensor information of the sensor 63 from the vibration indicated by the corrected sensor information of the sensor 64. The relative information calculation unit 115 may calculate the main relative vibration of the sensor position 54a along the moving direction of the motor 44 based on the driving of the motor 43 as the relative vibration. The relative information calculation unit 115 may calculate, as relative vibration, a secondary relative vibration of the sensor position 54a in a direction intersecting (eg, perpendicular) to the moving direction of the motor 44 driven by the motor 43. The relative information calculation unit 115 may calculate both the primary relative vibration and the secondary relative vibration.
[0096] The control unit 111 may also control the robot arm 10 to reduce the relative vibration of the sensing position 54a. For example, the control unit 111 controls the motor 43 to reduce the primary relative vibration of the sensing position 54a. The control unit 111 may also control a motor different from the motor 43 (e.g., motors 41 and 42) to reduce the secondary relative vibration of the sensing position 54a.
[0097] Similarly, the relative information calculation unit 115 may calculate relative sensor information obtained by removing the component corresponding to the sensor information of the sensor 64 from the sensor information of the sensors 65 and 66, based on the sensor information of the sensors 65 and 66 corrected by the sensor information correction unit 114 and the sensor information of the corrected sensor 64. For example, the relative information calculation unit 115 calculates the relative acceleration of the sensor positions 55a and 56a obtained by removing the acceleration indicated by the sensor information of the corrected sensors 65 and 66 from the acceleration indicated by the sensor information of the corrected sensors 64. The relative information calculation unit 115 may calculate the relative vibration of the sensor positions 55a and 56a obtained by removing the vibration component corresponding to the vibration indicated by the sensor information of the corrected sensors 64 from the vibration indicated by the sensor information of the corrected sensors 65 and 66. The relative information calculation unit 115 may calculate the main relative vibration of the sensor positions 55a and 56a along the moving direction of the motors 45 and 46 based on the driving of the motor 44 as the relative vibration. The relative information calculation unit 115 may calculate, as relative vibration, the secondary relative vibration of the sensor positions 55a, 56a in a direction intersecting (e.g., perpendicular) to the moving direction of the motors 45, 46 driven by the motor 44. The relative information calculation unit 115 may calculate both the primary relative vibration and the secondary relative vibration.
[0098] The control unit 111 may also control the robot arm 10 to reduce the relative vibration of the sensing positions 55a and 56a. For example, the control unit 111 controls the motor 44 to reduce the primary relative vibration of the sensing positions 55a and 56a. The control unit 111 may also control a motor different from the motor 44 (for example, the motors 41, 42, and 43) to reduce the secondary relative vibration of the sensing positions 55a and 56a.
[0099] The controller 100 may also have a torsion detection unit 116. The torsion detection unit 116 detects the torsion of the first link based on the first sensor information corrected by the sensor information correction unit 114 and the second sensor information corrected by the sensor information correction unit 114. When the torsion is detected, the torsion detection unit 116 may also display the detection of the torsion on a display device 197 (described later) or the like. For example, the torsion detection unit 116 calculates the above-mentioned relative acceleration based on the corrected sensor information of the sensor 63 and the corrected sensor information of the sensor 62, and calculates the rotational acceleration of the arm 12 based on the above-mentioned relative acceleration. Hereinafter, the calculated result will be referred to as "the rotational acceleration of the arm 12 based on the relative acceleration". The torsion detection unit 116 calculates the rotational acceleration of the arm 12 based on the model information of the robot arm 10, the rotational acceleration of the motor 41, and the rotational acceleration of the motor 42. Hereinafter, the calculated result will be referred to as "the rotational acceleration of the arm 12 based on the model information of the robot arm 10". The twist detection unit 116 detects the twist of the arm 12 based on the deviation between the rotation acceleration of the arm 12 based on the relative acceleration and the rotation acceleration of the arm 12 based on the model information.
[0100] The controller 100 may further include an interpolation unit 117. The interpolation unit 117 interpolates other sensor information obtained from other sensors based on the first sensor information corrected by the sensor information correction unit 114. For example, the interpolation unit 117 interpolates the torque represented by the sensor information of the torque sensor 71 based on the acceleration represented by the sensor information of the corrected sensor 63. For example, the interpolation unit 117 calculates the high-frequency component of the torque acting on the joint 32 based on the acceleration, and adds the calculated high-frequency component to the torque represented by the sensor information of the torque sensor 71.
[0101] The interpolation unit 117 may interpolate the torque represented by the sensor information of the torque sensor 72 based on the acceleration represented by the sensor information of the corrected sensor 64. For example, the interpolation unit 117 calculates the high-frequency component of the torque acting on the joint 33 based on the acceleration, and adds the calculated high-frequency component to the torque represented by the sensor information of the torque sensor 72.
[0102] When contact sensor 73 detects contact with a surrounding object, interpolation unit 117 may add the direction of action of the reaction force from the surrounding object to the sensor information of contact sensor 73 based on the acceleration indicated by the corrected sensor information of sensors 65 and 66 .
[0103] The controller 100 may further include a setting state detection unit 118. The setting state detection unit 118 detects the setting state of the robot base 11 based on the sensor information (base sensor information) obtained from the sensor 61. The setting state detection unit 118 may also detect the setting state of the robot base 11 based on the sensor information of the sensor 61 corrected by the sensor information correction unit 114.
[0104] For example, the installation state detection unit 118 may detect the installation posture of the robot base 11 based on the sensor information of the sensor 61. For example, the installation state detection unit 118 recognizes the direction of action of gravity acceleration in the robot coordinate system CS1 based on the acceleration indicated by the sensor information of the sensor 61 after correction, and detects the installation posture of the robot base 11 based on the direction of action of gravity acceleration. For example, the installation state detection unit 118 detects whether the robot base 11 is installed on the ground in a manner that the rotating part 17 is located above the base 16, whether the robot base 11 is installed on the ceiling surface in a manner that the rotating part 17 is located below the base 16, or whether the robot base 11 is installed on the wall surface in a manner that the rotating part 17 is located next to the base 16.
[0105] The installation state detection unit 118 sets control parameters based on the installation posture of the robot base 11. For example, the installation state detection unit 118 sets the direction of action of gravity acceleration in the robot coordinate system CS1 based on the installation posture of the robot base 11. The control unit 111 may also cause the motors 41, 42, 43, 44, 45, and 46 to generate torque for gravity compensation based on the set direction of action of gravity acceleration.
[0106] The setting state detection unit 118 may also detect the shaking of the robot base 11 based on the sensor information of the sensor 61. When the setting state detection unit 118 detects the shaking, it may also display the detection of the shaking on the display device 197 (described later) or the like. For example, the setting state detection unit 118 detects the vibration of the sensing position 51a based on the acceleration indicated by the sensor information of the sensor 61, and detects the shaking of the robot base 11 based on the detection result of the vibration.
[0107] The calibration unit 119 calibrates the first position information based on the comparison between the information related to the state of the first link and the first sensor information obtained from the first sensor. For example, the calibration unit 119 estimates the acceleration of the sensor position 52a based on the model information of the robot arm 10, the rotation acceleration of the motor 41, and the position information of the sensor 62, and calculates the difference between the acceleration, the estimation result, and the sensor information obtained from the sensor 62. The calibration unit 119 calibrates the position information of the sensor 62 in a manner that reduces the above-mentioned difference, and stores the calibration result in the position information memory 113.
[0108] The calibration unit 119 estimates the acceleration of the sensor position 53a based on the model information of the robot arm 10, the rotational acceleration of the motor 41, the rotational acceleration of the motor 42, and the position information of the sensor 63, and calculates the difference between the acceleration, the estimation result, and the sensor information obtained from the sensor 63. The calibration unit 119 calibrates the position information of the sensor 63 in a manner that reduces the above-mentioned difference, and stores the calibration result in the position information memory 113.
[0109] The calibration unit 119 estimates the acceleration of the sensor position 54a based on the model information of the robot arm 10, the rotational acceleration of the motor 41, the rotational acceleration of the motor 42, the rotational acceleration of the motor 43, and the position information of the sensor 64, and calculates the difference between the acceleration, the estimation result, and the sensor information obtained from the sensor 64. The calibration unit 119 calibrates the position information of the sensor 64 in a manner that reduces the above-mentioned difference, and stores the calibration result in the position information memory 113.
[0110] The calibration unit 119 estimates the acceleration of the sensor positions 55a and 56a based on the model information of the robot arm 10, the rotational acceleration of the motor 41, the rotational acceleration of the motor 42, the rotational acceleration of the motor 43, the rotational acceleration of the motor 44, and the position information of the sensors 65 and 66, and calculates the difference between the acceleration, the estimation result, and the sensor information obtained from the sensors 65 and 66. The calibration unit 119 calibrates the position information of the sensors 65 and 66 in a manner that reduces the above-mentioned difference, and stores the calibration result in the position information memory 113.
[0111] Figure 4 is a block diagram illustrating the hardware structure of the controller 100. Figure 4 As shown, the controller 100 has a circuit 190 . The circuit 190 has one or more processors 191 , one or more temporary memories 192 , one or more storages 193 , a servo drive corridor 194 , a communication port 195 , an input device 196 , and a display device 197 .
[0112] One or more storages 193 store programs for causing the controller 100 to execute the following processes: obtaining first sensor information from the first sensor; and correcting the first sensor information based on the first position information and information related to the state of the first link. For example, one or more storages 193 store programs for causing the controller 100 to configure the above-mentioned functional blocks.
[0113] One or more temporary memories 192 temporarily store programs loaded from one or more storages 193. One or more processors 191 cause the controller 100 to configure the above-mentioned functional blocks by executing the programs loaded into one or more temporary memories 192. The calculation results of one or more processors 191 are appropriately stored in one or more temporary memories 192 or one or more storages 193.
[0114] The servo drive corridor 194 obtains information on the rotation angle of the motor 40 from the encoder 50 based on instructions from one or more processors 191, and outputs drive power to the motor 40. The communication port 195 obtains sensor information from the sensor 60, the torque sensors 71, 72, and the contact sensor 73 based on instructions from one or more processors 191.
[0115] The input device 196 obtains the user's operation input based on the instructions from the one or more processors 191. As specific examples of the input device 196, a keyboard, a mouse, a keypad, etc. can be listed. The display device 197 displays the notification content to the user based on the instructions from the one or more processors 191. As specific examples of the display device 197, a liquid crystal monitor and an organic EL (Electro-Luminescence) monitor can be listed. The input device 196 can also be integrated with the display device 197 as a so-called touch panel.
[0116] [Sensing method]
[0117] As an example of a sensing method, a sensing step performed by the controller 100 using sensors 61, 62, 63, 64, 65, 66, torque sensors 71, 72, and contact sensor 73 is specifically illustrated. This step includes: obtaining first sensor information from a first sensor; and correcting the first sensor information based on the first position information and information related to the state of the first link. This step may also include a calibration step, a setting state detection step, a vibration detection step, and an interpolation step. Below, each step is illustrated in detail.
[0118] (Calibration Steps)
[0119] This step is a step of calibrating the position information of sensors 61, 62, 63, 64, 65, and 66 stored in the position information memory 113. Figure 5As shown, the controller 100 executes steps S01, S02, and S03. In step S01, the calibration unit 119 requests the control unit 111 to perform a calibration operation. The control unit 111 starts driving the motors 41, 42, 43, 44, 45, and 46 to cause the robot arm 10 to start a predetermined calibration operation. In step S02, the calibration unit 119 obtains the detection results based on the rotation angles of the encoders 51, 52, 53, 54, 55, and 56 and the sensor information from the sensors 61, 62, 63, 64, 65, and 66. In step S03, the calibration unit 119 confirms whether the calibration operation is completed.
[0120] If it is determined in step S03 that the calibration operation is not completed, the controller 100 returns the process to step S02. If it is determined in step S03 that the calibration operation is completed, the controller 100 executes step S04. In step S04, the calibration unit 119 calibrates the position information of the sensors 61, 62, 63, 64, 65, and 66 based on the data accumulated in steps S02 and S03.
[0121] For example, the calibration unit 119 estimates the acceleration of the sensor position 52a based on the model information of the robot arm 10, the rotational acceleration of the motor 41, and the position information of the sensor 62, and calibrates the position information of the sensor 62 based on the acceleration, the estimation result, and the sensor information obtained from the sensor 62. The calibration unit 119 estimates the acceleration of the sensor position 53a based on the model information of the robot arm 10, the rotational acceleration of the motor 41, the rotational acceleration of the motor 42, and the position information of the sensor 63, and calibrates the position information of the sensor 63 based on the acceleration, the estimation result, and the sensor information obtained from the sensor 63. The calibration unit 119 estimates the acceleration of the sensor position 54a based on the model information of the robot arm 10, the rotational acceleration of the motor 41, the rotational acceleration of the motor 42, the rotational acceleration of the motor 43, and the position information of the sensor 64, and calibrates the position information of the sensor 64 based on the acceleration, the estimation result, and the sensor information obtained from the sensor 64. The calibration unit 119 estimates the acceleration of the sensor positions 55a and 56a based on the model information of the robot arm 10, the rotational acceleration of the motor 41, the rotational acceleration of the motor 42, the rotational acceleration of the motor 43, the rotational acceleration of the motor 44, and the position information of the sensors 65 and 66, and calibrates the position information of the sensors 65 and 66 based on the acceleration, the estimation result, and the sensor information obtained from the sensors 65 and 66. The calibration unit 119 stores the calibration result of the position information of the sensors 61, 62, 63, 64, 65, and 66 in the position information memory 113. The calibration step is completed as described above.
[0122] (Setting status detection steps)
[0123] This step is a step of detecting the installation posture of the robot base 11 as an example of the installation state of the robot base 11. Figure 6 As shown, the controller 100 executes steps S11, S12, and S13. In step S11, the installation state detection unit 118 obtains sensor information from the sensor 61. The installation state detection unit 118 may also obtain sensor information of the sensor 61 corrected by the sensor information correction unit 114.
[0124] In step S12, the setting state detection unit 118 may also detect the setting posture of the robot base 11 based on the sensor information of the sensor 61. For example, the setting state detection unit 118 recognizes the direction of action of gravity acceleration in the robot coordinate system CS1 based on the acceleration indicated by the sensor information of the sensor 61 after correction, and detects the setting posture of the robot base 11 based on the direction of action of gravity acceleration.
[0125] In step S13, the setting state detection unit 118 sets control parameters based on the setting posture of the robot base 11. For example, the setting state detection unit 118 sets the direction of gravity acceleration in the robot coordinate system CS1 based on the setting posture of the robot base 11. The setting state detection step is completed.
[0126] (Vibration detection steps)
[0127] This step is a step of detecting the above-mentioned relative vibration and controlling the robot arm 10 to suppress the detected relative vibration. Figure 7 As shown, the controller 100 executes steps S21 and S22. In step S21, the sensor information acquisition unit 112 acquires sensor information from the sensors 61, 62, 63, 64, 65, and 66. In step S22, the sensor information correction unit 114 corrects the sensor information of the sensors 61, 62, 63, 64, 65, and 66 as described above.
[0128] For example, the sensor information correction unit 114 corrects the sensor information obtained from the sensor 62 to information that is not dependent on the posture of the sensor 62 (e.g., sensor information represented by a vector in the robot coordinate system CS1) based on the rotation angle of the swivel unit 17. The sensor information correction unit 114 corrects the sensor information obtained from the sensor 63 to information that is not dependent on the posture of the sensor 63 (e.g., sensor information represented by a vector in the robot coordinate system CS1) based on the rotation angle of the arm 12 and the rotation angle of the swivel unit 17. The sensor information correction unit 114 corrects the sensor information obtained from the sensor 64 to information that is not dependent on the posture of the sensor 64 (e.g., sensor information represented by a vector in the robot coordinate system CS1) based on the rotation angle of the arm base 18, the rotation angle of the arm 12, and the rotation angle of the swivel unit 17. The sensor information correction unit 114 corrects the sensor information obtained from the sensors 65 and 66 into information that is independent of the posture of the sensors 65 and 66 (for example, sensor information represented by a vector in the robot coordinate system CS1) based on the rotation angle of the arm end 19, the rotation angle of the arm base 18, the rotation angle of the arm 12, and the rotation angle of the rotating unit 17.
[0129] Next, the controller 100 executes step S23. In step S23, the torsion detection unit 116 checks whether the arm 12 is twisted based on the sensor information of the corrected sensor 63 and the sensor information of the corrected sensor 62. If it is determined in step S23 that the arm 12 is twisted, the controller 100 executes step S24. In step S24, the display device 197 or the like displays that the torsion detection unit 116 has detected the torsion.
[0130] Next, the controller 100 executes step S25. If it is determined in step S23 that the arm 12 is not twisted, the controller 100 does not execute step S24 but executes step S25. In step S25, the twist detection unit 116 confirms whether the robot base 11 is shaking based on the sensor information of the sensor 61. In step S25, if it is determined that the robot base 11 is shaking, the controller 100 executes step S26. In step S26, the display device 197 or the like displays that the twist detection unit 116 has detected the shaking of the robot base 11.
[0131] Next, the controller 100 executes step S27. When it is determined in step S25 that the robot base 11 is not shaking, the controller 100 does not execute step S26 but executes step S27. In step S27, the relative information calculation unit 115 calculates the relative sensor information.
[0132] For example, the relative information calculation unit 115 calculates the relative vibration of the sensor position 53a obtained by removing the vibration component corresponding to the vibration indicated by the sensor information of the corrected sensor 62 from the vibration indicated by the sensor information of the corrected sensor 63. For example, the relative information calculation unit 115 calculates the main relative vibration of the sensor position 53a and the sub-relative vibration of the sensor position 53a. The relative information calculation unit 115 calculates the relative vibration of the sensor position 54a obtained by removing the vibration component corresponding to the vibration indicated by the sensor information of the corrected sensor 63 from the vibration indicated by the sensor information of the corrected sensor 64. For example, the relative information calculation unit 115 calculates the main relative vibration of the sensor position 54a and the sub-relative vibration of the sensor position 54a. The relative information calculation unit 115 calculates the relative vibration of the sensor positions 55a and 56a obtained by removing the vibration component corresponding to the vibration indicated by the sensor information of the corrected sensor 64 from the vibration indicated by the sensor information of the corrected sensors 65 and 66. For example, the relative information calculation unit 115 calculates the main relative vibration of the sensor positions 55 a and 56 a and the sub-relative vibration of the sensor positions 55 a and 56 a .
[0133] Next, the controller 100 executes step S28. In step S28, the control unit 111 controls the robot arm 10 to reduce the relative vibration. For example, the control unit 111 controls the motor 42 to reduce the main relative vibration of the sensor position 53a, and controls a motor different from the motor 42 (for example, the motor 41) to reduce the secondary relative vibration of the sensor position 53a. The control unit 111 controls the motor 43 to reduce the main relative vibration of the sensor position 54a, and controls a motor different from the motor 43 (for example, the motors 41 and 42) to reduce the secondary relative vibration of the sensor position 54a. The control unit 111 controls the motor 44 to reduce the main relative vibration of the sensor positions 55a and 56a, and controls a motor different from the motor 44 (for example, the motors 41, 42, and 43) to reduce the secondary relative vibration of the sensor positions 55a and 56a. The controller 100 repeats the above steps.
[0134] (Interpolation step)
[0135] This step is a step of storing other sensor information based on the sensor information corrected by the sensor information correction unit 114. Figure 8 As shown, the controller 100 executes steps S31 and S32. In step S31, the interpolation unit 117 waits for the sensor information correction unit 114 to correct the sensor information (for example, the sensor information correction in step S22). In step S32, the interpolation unit 117 obtains other sensor information from the torque sensors 71 and 72 and the contact sensor 73.
[0136] Next, the controller 100 executes steps S33 and S34. In step S33, the interpolation unit 117 calculates information for interpolating other sensor information. For example, the interpolation unit 117 calculates the high-frequency component of the torque acting on the joint 32 based on the acceleration represented by the sensor information of the corrected sensor 63. The interpolation unit 117 calculates the high-frequency component of the torque acting on the joint 33 based on the acceleration represented by the sensor information of the corrected sensor 64. The interpolation unit 117 calculates the direction of action of the reaction force from the surrounding objects based on the acceleration represented by the sensor information of the corrected sensors 65 and 66. In step S34, the interpolation unit 117 interpolates other sensor information. For example, the interpolation unit 117 adds the calculation result of the high-frequency component of the torque acting on the joint 32 to the torque represented by the sensor information of the torque sensor 71. The interpolation unit 117 adds the calculation result of the high-frequency component of the torque acting on the joint 33 to the torque represented by the sensor information of the torque sensor 72. The interpolation unit 117 adds the calculation result of the direction of action of the reaction force from the surrounding object to the sensor information of the contact sensor 73 .
[0137] [Effects of implementation methods]
[0138] As described above, the robot system 1 comprises: a first link, which is a part of the robot arm 10; a first motor 40, which moves by the rotation of the first link; a first sensor 60, whose relative position relative to a reference position associated with the first motor 40 is fixed; and a memory, which stores first position information, which indicates the relative position of the first sensor 60 relative to the reference position associated with the first motor 40.
[0139] When the relative position of the first sensor 60 with respect to the first motor 40 is unclear, it is also unclear to which direction the first sensor information obtained from the first sensor 60 is related, so it is difficult to effectively use the first sensor information. In contrast, according to the robot system 1, since the first position information is stored in the memory, it is possible to easily determine which direction the first sensor information is related based on the first position information. Therefore, further use of sensor information in the robot is effective.
[0140] The robot system 1 may further include a sensor information correction unit 114 that corrects the first sensor information obtained from the first sensor 60 based on the first position information and information related to the state of the first link. The first sensor information can be used more effectively based on the first position information and the state of the first link.
[0141] Alternatively, the robot system 1 further includes a second link that supports the first link so as to be rotatable, and the sensor information correction unit 114 corrects the first sensor information obtained from the first sensor 60 based on the first position information, information related to the state of the first link, and information related to the state of the second link. By correcting the first sensor information based on the first position information, the state of the first link, and the state of the second link, the first sensor information can be used more effectively.
[0142] Alternatively, the robot system 1 further includes: a second motor 40 that rotates the first link; and a second sensor 60 whose relative position relative to a reference position related to the second motor 40 is fixed, the memory further stores second position information indicating the relative position of the second sensor 60 relative to the second motor 40, and the sensor information correction unit 114 corrects the second sensor information obtained from the second sensor 60 based on the second position information. By correcting both the first sensor information and the second sensor information, the first sensor information and the second sensor information can be appropriately combined and used.
[0143] The sensor information correction unit 114 may correct the first sensor information and the second sensor information to be information in the same coordinate system. By correcting the first sensor information and the second sensor information to be information in the same coordinate system, the first sensor information and the second sensor information can be combined and used more appropriately.
[0144] The robot system 1 may further include a relative information calculation unit 115 that calculates relative sensor information obtained by removing a component corresponding to the second sensor information from the first sensor information based on the first sensor information corrected by the sensor information correction unit 114 and the second sensor information corrected by the sensor information correction unit 114. Specific examples of the relative sensor information include a relative acceleration of a fixed position of the first sensor 60 relative to a fixed position of the second sensor 60, a relative vibration of a fixed position of the first sensor 60 relative to a fixed position of the second sensor 60, and the like. These relative sensor information can be used for detecting a phenomenon occurring between the first sensor 60 and the second sensor 60, controlling a portion between the first sensor 60 and the second sensor 60, and the like.
[0145] Alternatively, the relative information calculation unit 115 calculates a relative vibration obtained by removing a vibration component corresponding to the vibration indicated by the second sensor information from the vibration indicated by the first sensor information as the relative sensor information, and the robot system 1 further includes a control unit 111 for controlling the robot arm 10 to reduce the relative vibration. The detection result of the relative vibration can be used to reduce the vibration.
[0146] Alternatively, the relative information calculation unit 115 calculates the main relative vibration along the moving direction of the first sensor 60 based on the drive of the second motor 40 as the relative vibration, and the control unit 111 controls the second motor 40 to reduce the main relative vibration. The detection result of the relative vibration can be used for the control of reducing the vibration by the second motor 40.
[0147] Alternatively, the relative information calculation unit 115 calculates the secondary relative vibration along the direction intersecting the moving direction of the first sensor 60 based on the drive of the second motor 40 as the relative vibration, and the control unit 111 controls the motor 40 different from the second motor 40 to reduce the secondary relative vibration. The detection result of the relative vibration can be further used to suppress the secondary relative vibration that cannot be reduced by the second motor 40.
[0148] A torsion detection unit 116 may be further provided to detect torsion of the first link based on the first sensor information corrected by the sensor information correction unit 114 and the second sensor information corrected by the sensor information correction unit 114. The combination of the first sensor information and the second sensor information can be used to detect torsion of the second link.
[0149] The sensor information correction unit 114 may correct the first sensor information to information not depending on the posture of the first sensor 60 based on the first position information and the rotation angle of the first link. The first sensor information can be used to detect a phenomenon different from a change in the posture of the first sensor 60.
[0150] The first sensor 60 may be an acceleration sensor, and the sensor information correction unit 114 may correct the first sensor information to be information that does not depend on gravity. The acceleration at a fixed position of the first sensor 60 can be detected with higher reliability.
[0151] The sensor information correction unit 114 may correct the first sensor information to information independent of the rotational acceleration of the first link based on the first position information and the rotational acceleration of the first link. The first sensor information can be used to detect a phenomenon different from the rotation of the first link, such as deflection of the first link.
[0152] The sensor information correction unit 114 may correct the first sensor information to be independent of the rotation speed of the first link based on the first position information and the rotation speed of the first link. The first sensor information can be used to detect a phenomenon different from the rotation of the first link, such as deflection of the first link.
[0153] The interpolation unit 117 may be further provided to interpolate other sensor information acquired from other sensors based on the first sensor information corrected by the sensor information correction unit 114. The first sensor information corrected by the sensor information correction unit 114 can be used to interpolate other sensor information.
[0154] Alternatively, the first sensor 60 is an acceleration sensor, and the other sensors are torque sensors, and the interpolation unit 117 interpolates the torque represented by the other sensor information based on the acceleration represented by the first sensor information corrected by the sensor information correction unit 114. Compared with the torque sensor, the acceleration sensor has a tendency to be able to cope with changes of higher frequency. By utilizing this property, the torque represented by the other sensor information can be interpolated based on the acceleration represented by the first sensor information corrected by the sensor information correction unit 114.
[0155] Alternatively, the first sensor 60 is an acceleration sensor, and the other sensors are contact sensors that detect contact with surrounding objects, and the interpolation unit 117 adds the direction of the reaction force from the surrounding objects to the other sensor information based on the acceleration represented by the first sensor information corrected by the sensor information correction unit 114. According to the contact sensor 60, although it is possible to detect contact with surrounding objects, it is sometimes impossible to detect the direction of the reaction force from the surrounding objects. On the other hand, according to the acceleration sensor 60, although it is possible to detect that a certain acceleration has been generated, it is impossible to detect that it is caused by contact with surrounding objects. In contrast, by combining the contact with surrounding objects represented by other sensor information and the acceleration represented by the sensor information, the direction of the reaction force from the surrounding objects can be easily added to the other sensor information.
[0156] The robot base 11 may further include: a robot base 11 supporting the first link; a base motor 40 fixed to the robot base 11; a base sensor 60 whose relative position relative to a reference position related to the base motor 40 is fixed; and a setting state detection unit 118 that detects the setting state of the robot base 11 based on base sensor information obtained from the base sensor 60. The base sensor information can be used to detect the setting state of the robot base 11.
[0157] The base sensor 60 may be an acceleration sensor, and the installation state detection unit 118 may detect the installation posture of the robot base 11 based on the base sensor information. The base sensor information can be effectively used to detect the installation posture of the robot base 11.
[0158] The installation state detection unit 118 may detect the shaking of the robot base 11 based on the base sensor information. The base sensor information can be effectively used to detect the shaking of the robot base 11.
[0159] The robot system 1 may further include a calibration unit 119 that calibrates the first position information based on a comparison between information related to the state of the first link and the first sensor information obtained from the first sensor 60. The calibration can improve the reliability of the first position information. Thus, the first sensor information can be used more effectively.
[0160] The first encoder 50 fixed to the first motor 40 and detecting the rotation of the first motor 40 may be further provided, and the first sensor 60 may be built in the first encoder 50. The first sensor 60 can be easily provided in the robot arm 10.
[0161] Alternatively, the first encoder 50 may include an integrated circuit 84 for calculating the rotation angle of the first motor 40, and the first sensor 60 may be included in the integrated circuit 84. By including the first sensor 60 in the integrated circuit 84, the transmission distance of the first sensor information can be shortened and the noise resistance of the first sensor information can be improved. In addition, when the first sensor 60 is included in the integrated circuit 84 of the encoder 50, the first sensor 60 moves together with the encoder 50, but the influence of the movement can be reduced by the sensor information correction unit 114. Therefore, the noise resistance of the first sensor information and the utilization of the first sensor information can be taken into account.
[0162] The first sensor 60 may also include a MEMS device formed on the integrated circuit 84. Various first sensors 60 can be included in the integrated circuit 84.
[0163] The first sensor 60 may include a sensor unit 85 that converts a sensing target into an analog signal and an AD conversion circuit 86 that converts the analog signal into a digital signal. Since all the processes from detecting the first sensor information to converting it into a digital signal can be performed in the integrated circuit 84, noise resistance can be further improved.
[0164] As mentioned above, although embodiment was described, this disclosure is not necessarily limited to the said embodiment, Various changes are possible within the range which does not deviate from the summary.
[0165] Description of symbols
[0166] 1: robot system; 10: robot arm; 11: robot base; 40: motor; 50: encoder; 84: integrated circuit; 60: sensor; 85: sensing unit; 86: AD conversion circuit; 111: control unit; 113: position information storage; 114: sensor information correction unit; 115: relative information calculation unit; 116: torsion detection unit; 117: interpolation unit; 118: setting state detection unit; 119: calibration unit.
Claims
1. A robot system, wherein: The robot system comprises: a first link, which is part of the robot arm; a first motor that is moved by rotation of the first connecting rod; a first sensor whose relative position with respect to the first motor is fixed; and A memory stores first position information indicating a relative position of the first sensor relative to a first reference position associated with the first motor.
2. The robot system according to claim 1, wherein: The robot system further includes a sensor information correction unit that corrects first sensor information acquired from the first sensor based on the first position information and information related to the state of the first link.
3. The robot system according to claim 2, wherein: The robot system further includes a second link that rotatably supports the first link. The sensor information correction unit corrects the first sensor information acquired from the first sensor based on the first position information, information related to the state of the first link, and information related to the state of the second link.
4. The robot system according to claim 2 or 3, wherein: The robot system also has: a second motor that rotates the first connecting rod; and a second sensor, whose relative position with respect to the second motor is fixed, The memory further stores second position information indicating a relative position of the second sensor relative to a second reference position associated with the second motor. The sensor information correction unit corrects second sensor information acquired from the second sensor based on the second position information.
5. The robot system according to claim 4, wherein: The sensor information correction unit corrects the first sensor information and the second sensor information into information in the same coordinate system.
6. The robot system according to claim 4 or 5, wherein: The robot system also includes a relative information calculation unit, which calculates relative sensor information obtained by removing a component corresponding to the second sensor information from the first sensor information based on the first sensor information corrected by the sensor information correction unit and the second sensor information corrected by the sensor information correction unit.
7. The robot system according to claim 4 or 5, wherein: The robot system also has: a second motor that rotates a portion of the robot arm that is different from the first link; and a second sensor whose relative position relative to a second reference position associated with the second motor is fixed, The memory further stores second position information, the second position information indicating a relative position of the second sensor relative to the second motor. The robot system also includes a relative information calculation unit, which calculates relative sensor information obtained by removing a component corresponding to the second sensor information from the first sensor information based on the first sensor information corrected by the sensor information correction unit and the second sensor information corrected by the sensor information correction unit.
8. The robot system according to claim 6 or 7, wherein: The relative information calculation unit calculates a relative vibration obtained by removing a vibration component corresponding to the vibration represented by the second sensor information from the vibration represented by the first sensor information as the relative sensor information, The robot system further includes a control unit that controls the robot arm so as to reduce the relative vibration.
9. The robot system according to claim 8, wherein: The relative information calculation unit calculates a main relative vibration along a moving direction of the first sensor based on driving of the second motor as the relative vibration. The control unit controls the second motor so that the main relative vibration is reduced.
10. The robot system according to claim 9, wherein: The relative information calculation unit calculates, as the relative vibration, a secondary relative vibration in a direction intersecting with a moving direction of the first sensor due to driving of the second motor. The control unit controls a motor different from the second motor so that the secondary relative vibration is reduced.
11. The robot system according to any one of claims 4 to 10, wherein: The robot system further includes a twist detection unit configured to detect a twist of the first link based on the first sensor information corrected by the sensor information correction unit and the second sensor information corrected by the sensor information correction unit.
12. The robot system according to any one of claims 2 to 11, wherein: The sensor information correction unit corrects the first sensor information to information that is not dependent on a posture of the first sensor based on the first position information and a rotation angle of the first link.
13. The robot system according to claim 12, wherein: The first sensor is an acceleration sensor, and the sensor information correction unit corrects the first sensor information to information that is not dependent on gravitational acceleration.
14. The robot system according to any one of claims 2 to 13, wherein: The sensor information correction unit corrects the first sensor information to information that is not dependent on the rotational acceleration of the first link based on the first position information and the rotational acceleration of the first link.
15. The robot system according to any one of claims 2 to 14, wherein: The sensor information correction unit corrects the first sensor information to information that is not dependent on the rotation speed of the first link based on the first position information and the rotation speed of the first link.
16. The robot system according to any one of claims 2 to 15, wherein: The robot system further includes an interpolation unit that interpolates other sensor information acquired from other sensors based on the first sensor information corrected by the sensor information correction unit.
17. The robot system according to claim 16, wherein: The first sensor is an acceleration sensor, The other sensor is a torque sensor, The interpolation unit interpolates the torque indicated by the other sensor information based on the acceleration indicated by the first sensor information corrected by the sensor information correction unit.
18. The robot system according to claim 16, wherein: The first sensor is an acceleration sensor, The other sensor is a contact sensor that detects contact with a surrounding object, The interpolation unit adds the direction of action of the reaction force from the surrounding object to the other sensor information based on the acceleration indicated by the first sensor information corrected by the sensor information correction unit.
19. The robot system according to any one of claims 1 to 18, wherein: The robot system also has: a robot base supporting the first link; A base motor, which is fixed to the robot base; a base sensor whose relative position with respect to the base motor is fixed; and The installation state detection unit detects the installation state of the robot base based on the base sensor information obtained from the base sensor.
20. The robot system according to claim 19, wherein: The base sensor is an acceleration sensor, The installation state detection unit detects an installation posture of the robot base based on the base sensor information.
21. The robot system according to claim 19 or 20, wherein: The installation state detection unit detects shaking of the robot base based on the base sensor information.
22. The robotic system according to any one of claims 2 to 18, wherein: The robot system further includes a calibration unit that calibrates the first position information based on a comparison between information related to the state of the first link and the first sensor information acquired from the first sensor.
23. The robotic system according to any one of claims 1 to 22, wherein: The robot system further includes a first encoder fixed to the first motor and detecting rotation of the first motor. The first sensor is built in the first encoder.
24. The robot system according to claim 23, wherein: The first encoder has an integrated circuit for calculating the rotation angle of the first motor. The first sensor is included in the integrated circuit.
25. The robot system according to claim 24, wherein: The first sensor includes a MEMS device formed on the integrated circuit.
26. The robot system according to claim 24 or 25, wherein: The first sensor has: a sensing part that converts a sensing object into an analog signal; and The AD conversion circuit converts the analog signal into a digital signal.
27. A sensing method, wherein: The sensing method comprises: obtaining first sensor information from a first sensor whose relative position with respect to a first reference position associated with a first motor that is moved by rotation of a first link that is part of a robot arm; as well as The first sensor information is corrected based on first position information indicating a relative position of the first sensor with respect to the first motor and information related to a state of the first link.
Citation Information
Patent Citations
Legged mobile robot, and actuator device applied as joint axis for legged mobile robot
JP2004188535A
