Angle sensor for motor control, motor control system, and method for controlling angle sensor for motor control

The motor control angle sensor system addresses the challenge of analyzing robot controller abnormalities by generating and storing position data for flexible and cost-effective analysis, enhancing error detection and reduction in transportation costs.

JP7593078B2Active Publication Date: 2024-12-03SEIKO EPSON CORP
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
JP2020198146
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2020-11-30
Publication Date
2024-12-03
Estimated Expiration
2040-11-30

AI Technical Summary

Technical Problem

Existing robot control systems require analyzing larger robot controllers for error analysis, increasing transportation costs and reducing analysis flexibility due to the need to analyze angle sensors independently.

Method used

A motor control angle sensor system with an arithmetic processing unit that generates and stores position information data, which is temporarily stored and saved in an operation history storage section upon abnormality detection, allowing for smaller, more flexible, and cost-effective analysis.

Benefits of technology

Enables efficient and accurate analysis of motor abnormalities by reducing system size, lowering transportation costs, and improving analysis flexibility by storing relevant data for subsequent analysis.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007593078000001
    Figure 0007593078000001
  • Figure 0007593078000002
    Figure 0007593078000002
  • Figure 0007593078000003
    Figure 0007593078000003
Patent Text Reader

Abstract

To provide an angle sensor for motor control, a motor control system, and a method for controlling an angle sensor for motor control that can achieve a reduction in conveyance cost for analysis and an improvement in flexibility of analysis.SOLUTION: An angle sensor for motor control has a sensor that outputs a signal according to the drive of a motor, an arithmetic processing unit, an operation history temporary storage unit, and an operation history storage unit. The arithmetic processing unit generates position information data including the position of the motor acquired based on the signal output from the sensor and the time at which the position is acquired, repeats processing of storing the generated position information data in the operation history temporary storage unit, and when detecting abnormality or receiving a signal notifying abnormality from an external device, stores the position information data stored in the operation history temporary storage unit in the operation history storage unit.SELECTED DRAWING: Figure 4
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to an angle sensor for controlling a motor, a motor control system, and a control method for an angle sensor for controlling a motor. [Background technology]

[0002] Patent document 1 describes a robot control device that, when an abnormality occurs in the robot's operation, records the operation history at the time of the error in a fault history memory section within the control device, making it easier to analyze the cause of the error thereafter. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] Japanese Patent Application Publication No. 4-130503 Summary of the Invention [Problem to be solved by the invention]

[0004] However, in this configuration, in order to analyze the cause of an error, it is necessary to analyze the robot control device that has a failure history memory unit. Therefore, for example, even if an abnormality occurs in an angle sensor that detects the amount of rotation of a motor used to drive a robot, it is necessary to analyze the robot control device instead of the angle sensor. The robot control device is larger in size than the angle sensor, which leads to issues such as increased transportation costs for analysis and reduced flexibility in analysis. [Means for solving the problem]

[0005] The motor control angle sensor of the present invention comprises: a sensor that outputs a signal in response to the driving of a motor; A calculation processing unit; An operation history temporary storage unit; An operation history storage unit, The calculation processing unit generates position information data including the position of the motor acquired based on the signal output from the sensor and the time when the position was acquired, repeats the process of storing the generated position information data in the operation history temporary storage unit, and when it detects an abnormality or receives a signal notifying of an abnormality from an external device, it saves the position information data stored in the operation history temporary storage unit in an operation history storage unit.

[0006] The motor control system of the present invention comprises: a motor; A sensor that outputs a signal in response to the driving of the motor; A calculation processing unit; An operation history temporary storage unit; An operation history storage unit; A control device that controls the driving of the motor, The calculation processing unit generates position information data including the position of the motor acquired based on the signal output from the sensor and the time when the position was acquired, repeats the process of storing the generated position information data in the operation history temporary storage unit, and when it detects an abnormality or receives a signal notifying of an abnormality from the control device, it saves the position information data stored in the operation history temporary storage unit in an operation history storage unit.

[0007] The method for controlling an angle sensor for controlling a motor of the present invention includes: A sensor that outputs a signal in response to the driving of the motor; A calculation processing unit; An operation history temporary storage unit; An operation history storage unit; A control method for a motor control angle sensor having a control device for controlling the drive of the motor, comprising: Each time the calculation processing unit receives a request signal from the control device, it generates position information data including the position of the motor obtained based on the signal output from the sensor and the time when the position was obtained, and repeats the process of storing the generated position information data in the operation history temporary storage unit.When an abnormality is detected or a signal notifying of an abnormality is received from the control device, the calculation processing unit saves the position information data stored in the operation history temporary storage unit in an operation history storage unit. [Brief description of the drawings]

[0008] [Figure 1] 1 is an overall view showing a robot system according to an embodiment of the present invention. [Diagram 2] FIG. [Diagram 3] FIG. [Figure 4] FIG. 2 is a block diagram of a drive device. [Diagram 5] 6 is a diagram showing an example of position information data generated by a calculation processing unit of the drive device; FIG. [Figure 6] 4 is a flowchart showing the processing steps of a calculation processing unit of the driving device. [Figure 7] 6 is a graph for explaining a method of detecting an abnormality in a calculation processing unit of the drive device. [Figure 8] 6 is a graph for explaining a method of detecting an abnormality in a calculation processing unit of the drive device. [Figure 9] 6 is a graph for explaining a method of detecting an abnormality in a calculation processing unit of the drive device. [Figure 10] 6 is a graph for explaining a method of detecting an abnormality in a calculation processing unit of the drive device. [Figure 11] FIG. 13 is a block diagram showing a modified example of the drive device. [Figure 12] FIG. 13 is a block diagram showing a modified example of the drive device. [Figure 13] FIG. 13 is a block diagram showing a modified example of the drive device. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0009] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, a motor control angle sensor, a motor control system, and a control method for an angle sensor for motor control of the present invention will be described in detail with reference to preferred embodiments shown in the accompanying drawings.

[0010] Fig. 1 is an overall view showing a robot system according to an embodiment of the present invention. Figs. 2 and 3 are cross-sectional views of a drive unit. Fig. 4 is a block diagram of the drive unit. Fig. 5 is a diagram showing an example of position information data generated by a processor included in the drive unit. Fig. 6 is a flowchart showing the processing steps of the processor included in the drive unit. Figs. 7 to 10 are graphs for explaining an abnormality detection method of the processor included in the drive unit.

[0011] 2 and 3 show three mutually orthogonal axes, the X-axis, the Y-axis, and the Z-axis. The tip end of each arrow indicating the X-axis, the Y-axis, and the Z-axis is designated as "+" and the base end as "-". The direction parallel to the X-axis is called the "X-axis direction", the direction parallel to the Y-axis is called the "Y-axis direction", and the direction parallel to the Z-axis is called the "Z-axis direction". The +Z-axis direction side is also called "up" and the -Z-axis direction side is also called "down". FIG. 3 is a cross-sectional view of FIG. 2 rotated 90° around the Z-axis.

[0012] 1 is capable of performing operations such as supplying, removing, transporting, and assembling precision equipment and the parts that constitute the equipment. The robot system 1 has a robot 2 that performs a predetermined operation, and a robot control device 3 as an external device that controls the driving of the robot 2.

[0013] The robot 2 is a six-axis robot. The robot 2 has a base 20 fixed to a floor, a wall, a ceiling, etc., a robot arm 21 supported by the base 20, and an end effector 22 attached to the tip of the robot arm 21. The robot arm 21 also has an arm 211 rotatably connected to the base 20, an arm 212 rotatably connected to the arm 211, an arm 213 rotatably connected to the arm 212, an arm 214 rotatably connected to the arm 213, an arm 215 rotatably connected to the arm 214, and an arm 216 rotatably connected to the arm 215. The end effector 22 is attached to the arm 216.

[0014] However, the configuration of the robot 2 is not particularly limited, and for example, the number of arms may be 1 to 5 or less, or 7 or more. Also, for example, the robot 2 may be a scalar robot, a dual-arm robot, etc.

[0015] The robot 2 has a driving device 41 that rotates the arm 211 relative to the base 20, a driving device 42 that rotates the arm 212 relative to the arm 211, a driving device 43 that rotates the arm 213 relative to the arm 212, a driving device 44 that rotates the arm 214 relative to the arm 213, a driving device 45 that rotates the arm 215 relative to the arm 214, and a driving device 46 that rotates the arm 216 relative to the arm 215. Each of these driving devices 41 to 46 is independently controlled by the robot control device 3.

[0016] The robot control device 3 receives a position command from a host computer (not shown) and independently controls the driving of the driving devices 41-46 so that the arms 211-216 are positioned according to the position command. The robot control device 3 is, for example, composed of a computer, and has a processor (CPU) for processing information, a memory communicatively connected to the processor, and an external interface. In addition, various programs executable by the processor are stored in the memory, and the processor can read and execute the various programs stored in the memory.

[0017] Next, the driving devices 41 to 46 will be explained, but because they have the same configuration, the following will explain only the driving device 41, and will not explain the other driving devices 42 to 46. The driving device 41 is a motor control system, and as shown in FIG. 2, has a motor 5 and a motor control angle sensor 6 that detects the rotation state of the rotation shaft of the motor 5.

[0018] The motor 5 is one of various motors such as a two-phase AC brushless motor, a three-phase AC brushless motor, and a three-phase synchronous motor. The motor 5 has a rotating shaft 51 arranged along an axis aZ parallel to the Z axis, a rotor 52 fixed to the rotating shaft 51, a stator 53 arranged around the rotor 52, a cylindrical housing 54 that houses these and supports the stator 53, and bearings 55 and 56 that support the rotating shaft 51 rotatably around the axis aZ relative to the housing 54. The housing 54 is fixed to the base 20. An arm 211 is connected to the end of the rotating shaft 51 on the opposite side to the motor control angle sensor 6. As a result, the output of the motor 5 is transmitted from the base 20 to the arm 211, and the arm 211 rotates relative to the base 20. The rotating shaft 51 may be connected to the arm 211 via a gear device such as a reducer as necessary.

[0019] The motor control angle sensor 6 is an encoder unit, and is disposed above the motor 5, i.e., on the +Z-axis side. The motor control angle sensor 6 has a rotation angle detection type optical encoder 61, a multi-rotation detection type magnetic encoder 62, and a substrate 63. These components are housed in a housing 68 fixed to the housing 54.

[0020] The optical encoder 61 is a reflective optical encoder, and includes an optical scale 611 fixed to the rotating shaft 51 of the motor 5, and an optical sensor 612 that detects the rotation state of the optical scale 611. The optical scale 611 rotates around the axis aZ together with the rotating shaft 51. The optical scale 611 includes a hub 611a fixed to the rotating shaft 51 of the motor 5, and a disk 611b fixed to the hub 611a. A detection pattern (not shown) that can detect the rotation angle and rotation speed of the disk 611b is formed on the upper surface of the disk 611b. The detection pattern is not particularly limited, and may be, for example, a pattern in which two regions with different light reflectances, that is, a reflective region and a non-reflective region, are alternately arranged along the circumferential direction centered on the axis aZ.

[0021] The optical sensor 612 is disposed above the disk 611b at a distance from the disk 611b. The optical sensor 612 has a light emitting element 612a that emits light L toward the detection pattern on the disk 611b, and a light receiving element 612b that receives the light L reflected by the detection pattern. The light emitting element 612a is, for example, a laser diode or a light emitting diode, and the light receiving element 612b is, for example, a photodiode. In the optical encoder 61 configured as above, the waveform of the output signal from the light receiving element 612b changes with the rotation of the disk 611b around the axis aZ. Therefore, based on this output signal, the rotation angle θ of the disk 611b within a 360° range can be detected. However, the configuration of the optical encoder 61 is not particularly limited.

[0022] The magnetic encoder 62 is disposed above the optical sensor 612, i.e., on the +Z-axis side. The magnetic encoder 62 has a main gear 621 fixed to the rotating shaft 51, two sub gears 622a and 622b meshing with the main gear 621, magnets 623a and 623b fixed to the sub gears 622a and 622b, and magnetic sensors 624a and 624b that detect the rotational states of the magnets 623a and 623b.

[0023] The main gear 621 rotates around the axis aZ together with the rotation shaft 51. The sub gear 622a is rotatably supported around an axis aZ1 parallel to the axis aZ, and rotates by the main gear 621 at an amount of rotation corresponding to the gear ratio with the main gear 621. Similarly, the sub gear 622b is rotatably supported around an axis aZ2 parallel to the axis aZ, and rotates by the main gear 621 at an amount of rotation corresponding to the gear ratio with the main gear 621. The main gear 621, the sub gear 622a, and the sub gear 622b have different numbers of teeth, and are mutually prime in this embodiment in particular.

[0024] The magnet 623a is fixed to the secondary gear 622a. Therefore, the magnet 623a rotates around the axis aZ1 together with the secondary gear 622a. Similarly, the magnet 623b is fixed to the secondary gear 622b. Therefore, the magnet 623b rotates around the axis aZ2 together with the secondary gear 622b. The magnets 623a and 623b are permanent magnets such as neodymium magnets, ferrite magnets, samarium cobalt magnets, alnico magnets, and bonded magnets, and are arranged so that the direction of the magnetic field changes with the rotation around the axes aZ1 and aZ2.

[0025] The magnetic sensors 624a and 624b are disposed below the magnets 623a and 623b, i.e., on the -Z axis side. Of these, the magnetic sensor 624a is disposed opposite the magnet 623a and outputs a signal corresponding to the direction of the magnetic field of the magnet 623a, i.e., the rotation angle of the secondary gear 622a within a 360° range. On the other hand, the magnetic sensor 624b is disposed opposite the magnet 623b and outputs a signal corresponding to the direction of the magnetic field of the magnet 623b, i.e., the rotation angle of the secondary gear 622b within a 360° range. In the magnetic encoder 62 configured as above, the number of rotations n of the rotating shaft 51 can be detected by a combination of the values ​​of the signals from the magnetic sensors 624a and 624b. However, the configuration of the magnetic encoder 62 is not particularly limited.

[0026] The substrate 63 is disposed between the optical encoder 61 and the magnetic encoder 62. The substrate 63 is a wiring board, and is fixed to a housing 68. An optical sensor 612 is mounted on a lower surface 631 of the substrate 63 so as to face the optical scale 611, and magnetic sensors 624a and 624b are mounted on an upper surface 632 so as to face the magnets 623a and 623b.

[0027] Furthermore, a semiconductor element 64 electrically connected to the optical sensor 612 and the magnetic sensors 624a and 624b is mounted on the lower surface 631 of the substrate 63 at a position not overlapping with the optical sensor 612. The semiconductor element 64 is, for example, configured as a computer, and has a processor (CPU) for processing information, a memory communicatively connected to the processor, and an external interface. Furthermore, various programs executable by the processor are stored in the memory, and the processor can read and execute the various programs stored in the memory.

[0028] 3, a connector 65 is mounted on an upper surface 632 of the substrate 63. The semiconductor element 64 and the robot control device 3 are electrically connected via wiring 66 connected to the connector 65.

[0029] The configuration of the driving device 41 has been described above. In the following, the optical sensor 612 and the magnetic sensors 624a and 624b are also referred to as sensors 60. Next, the semiconductor element 64 included in the driving device 41 will be described in detail. As shown in FIG. 4, the semiconductor element 64 has an arithmetic processing unit 641, an operation history temporary storage unit 642, an operation history storage unit 643, a timer 644, and a temperature sensor 69. In this way, by providing the arithmetic processing unit 641, the operation history temporary storage unit 642, the operation history storage unit 643, the timer 644, and the temperature sensor 69 in one semiconductor device 64, the driving device 41 can be made smaller. However, this is not limited to this, and at least one of them may be provided outside the semiconductor element 64.

[0030] The operation history temporary storage unit 642 is a RAM (random access memory), and the operation history storage unit 643 is a ROM (load only memory). Therefore, the data stored in the operation history temporary storage unit 642 is erased when the power supply to the drive device 41 is turned off, and the data stored in the operation history storage unit 643 is stored as is even when the power supply to the drive device 41 is turned off. In addition, the temperature sensor 69 detects the temperature of the motor 5.

[0031] The arithmetic processing unit 641 detects the amount of rotation R of the rotating shaft 51 based on the output from the sensor 60. Specifically, when the power is turned on, the number of rotations n of the rotating shaft 51 of the motor 5 is detected based on the output of the magnetic sensors 624a and 624b, and thereafter, the amount of rotation R is detected by adding or subtracting the rotation angle θ of the rotating shaft 51 detected based on the output (pulse signal) of the optical sensor 612 to the detected number of rotations n. However, the method of detecting the amount of rotation R is not particularly limited.

[0032] 5, the arithmetic processing unit 641 generates position information data Dr including the amount of rotation R, the time Ti at which the amount of rotation R was acquired, and the temperature Te of the motor 5 at the time Ti at which the amount of rotation R was acquired. Then, the arithmetic processing unit 641 performs a process of temporarily storing the generated position information data Dr in the operation history temporary storage unit 642, and also performs a process of transmitting the data to the robot control device 3. Note that the time Ti is a time based on a clock generated by the timer 644, and is indicated by a count number. Also, the temperature Te of the motor 5 is a temperature detected by the temperature sensor 69.

[0033] 6, the arithmetic processing unit 641 generates position information data Dr every time it receives a request signal Sr periodically transmitted from the robot control device 3, temporarily stores the generated position information data Dr in the operation history temporary storage unit 642, and transmits the generated position information data Dr to the robot control device 3. This makes it possible to prevent unnecessary generation and transmission of position information data Dr, and to reduce the processing load. While repeatedly performing such processing, if the arithmetic processing unit 641 detects an abnormality in the driving device 41 or receives an error flag Fe, which is a signal notifying an abnormality, from the robot control device 3, it selects necessary position information data Dr from the multiple position information data Dr stored in the operation history temporary storage unit 642 every time it receives a request signal Sr, and stores the necessary position information data Dr in the operation history storage unit 643 by linking it to the date and time of the abnormality occurrence.

[0034] In the example shown in FIG. 6, the calculation processing unit 641 detects an abnormality in the drive device 41 based on the position information data Dr corresponding to the nth request signal Sr, and therefore selects the position information data Dr corresponding to the nth request signal Sr from the most recent five position information data Dr, i.e., the position information data Dr corresponding to the n-4th request signal Sr, out of the numerous position information data Dr generated from when the power was turned on until the nth request signal Sr and stored in the operation history temporary storage unit 642, and links these to the date and time of the abnormality, i.e., the date and time equivalent to the time Ti corresponding to the nth request signal Sr, and stores them in the operation history storage unit 643.

[0035] As a result, the position information data Dr of the most recent times, including the time when an abnormality of the driving device 41 was detected, is stored even if the power is turned off. Therefore, it is possible to analyze the cause of the abnormality by analyzing the position information data Dr stored in the operation history storage unit 643 thereafter. Since the driving device 41 is smaller in size than the robot control device 3, it is possible to reduce the transportation cost for analyzing the abnormality and improve the flexibility of the analysis compared to the conventional method. In addition, it is not necessary to reproduce the occurrence of the abnormality, making it easier to analyze the abnormality. In addition, since the position information data Dr includes the temperature Te, it is also possible to check the state of the motor 5 when the abnormality occurs, and the abnormality can be analyzed more accurately.

[0036] Here, the operation history temporary storage unit 642 is configured with a ring buffer. This allows the latest position information data Dr to be stored sequentially. In addition, since the capacity of the operation history temporary storage unit 642 can be reduced, that is, in the above example, the capacity required is sufficient to store at least five pieces of position information data Dr, the cost of the drive unit 41 can be reduced.

[0037] The number of position information data Dr stored in the operation history storage unit 643 is not limited to five and can be set appropriately. For example, all the position information data Dr temporarily stored in the operation history temporary storage unit 642 may be stored in the operation history storage unit 643. That is, all the position information data Dr generated from after power-on until an abnormality is detected may be stored in the operation history storage unit 643. In addition, not only the position information data Dr before the abnormality is detected but also the position information data Dr after the detection may be stored in the operation history storage unit 643. For example, when an abnormality is detected in the position information data Dr corresponding to the n-th request signal Sr, the position information data Dr corresponding to the n-4th request signal Sr to the position information data Dr corresponding to the n+4th request signal Sr may be stored in the operation history storage unit 643. This makes it easier to analyze whether the abnormality is sudden or chronic.

[0038] The "abnormality of the drive device 41" is not particularly limited, but may be, for example, the following. For example, as shown in FIG. 7, when the output of the rotation amount R corresponding to the n-th request signal Sr immediately after the n-1th request signal Sr increases rapidly with respect to the rotation amount R corresponding to the n-1th request signal Sr, the arithmetic processing unit 641 detects an abnormality of the optical encoder 61. Also, for example, as shown in FIG. 8, when the count number indicating the time Ti corresponding to the n-1th request signal Sr immediately after the n-th request signal Sr increases rapidly with respect to the count number indicating the time Ti corresponding to the n-1th request signal Sr, the arithmetic processing unit 641 suspects a failure to receive the request signal Sr and detects an abnormality such as a break in the wiring 66 or the generation of noise. Also, for example, as shown in FIG. 9, when the temperature Te corresponding to the n-1th request signal Sr immediately after the n-th request signal Sr increases rapidly with respect to the temperature Te corresponding to the n-1th request signal Sr, the arithmetic processing unit 641 detects an abnormality of the temperature sensor 69. Also, for example, as shown in FIG. 10, when the temperature Te exceeds a threshold value SH, the arithmetic processing unit 641 detects an abnormality of the motor 5. In this way, according to the driving device 41, it is possible to estimate which element is causing the abnormality based on the suddenly changing parameters, which makes it easier to analyze the abnormality thereafter.

[0039] In addition, the cases in which "the robot control device 3 transmits an error flag Fe" are not particularly limited, but include, for example, a case in which position information data Dr is not transmitted in response to a request signal Sr, a case in which the rotation amount R included in the position information data Dr significantly deviates from the position command, a case in which an abnormality occurs in an element other than the driving device 41, etc.

[0040] The robot system 1 has been described above. The motor control angle sensor 6 included in the robot system 1 includes the sensor 60 that outputs a signal according to the drive of the motor 5, the arithmetic processing unit 641, the operation history temporary storage unit 642, and the operation history storage unit 643, as described above. The arithmetic processing unit 641 repeats the process of generating position information data Dr including the rotation amount R as the position of the motor 5 acquired based on the signal output from the sensor 60 and the time Ti at which the rotation amount R was acquired, and storing the generated position information data Dr in the operation history temporary storage unit 642, and when an abnormality is detected or a signal notifying an abnormality is received from the robot control device 3 as an external device, the position information data Dr stored in the operation history temporary storage unit 642 is stored in the operation history storage unit 643. According to this configuration, the position information data Dr for the most recent times including the time when an abnormality was detected or the time when a signal notifying an abnormality was received from the robot control device 3 is stored even if the power is turned off. Therefore, it is possible to analyze the cause of the abnormality by analyzing the position information data Dr stored in the operation history storage unit 643 thereafter. Here, since the motor control angle sensor 6 is smaller in size than the robot control device 3, it is possible to reduce the transportation cost for anomaly analysis and improve the flexibility of the analysis compared to the conventional art. In particular, since the position information data Dr includes the time Ti, it becomes easy to determine whether the anomaly is due to an anomaly in the sensor 60 or an anomaly in communication with the robot control device 3, for example.

[0041] As described above, the calculation processing unit 641 generates position information data Dr in response to a request signal Sr from the robot control device 3, and stores the generated position information data Dr in the operation history temporary storage unit 642. This makes it possible to suppress the generation of unnecessary position information data Dr and the storage of the unnecessary position information data Dr in the operation history temporary storage unit 642.

[0042] As described above, the arithmetic processing unit 641 generates position information data Dr in response to a request signal Sr from the robot control device 3, and transmits the generated position information data Dr to the robot control device 3. This makes it possible to suppress the generation of unnecessary position information data Dr and the transmission of the data to the robot control device 3.

[0043] As described above, the operation history temporary storage unit 642 is configured with a ring buffer. This allows the latest position information data Dr to be stored sequentially. In addition, the capacity of the operation history temporary storage unit 642 can be reduced, which allows the motor control angle sensor 6 to be manufactured at a low cost.

[0044] As described above, the motor control angle sensor 6 has the temperature sensor 69 that detects the temperature Te of the motor 5. The calculation processing unit 641 then generates position information data Dr that includes the temperature Te of the motor 5 at time Ti, in addition to the amount of rotation R and time Ti. This allows the motor control angle sensor 6 to detect abnormalities in the motor 5, as well as abnormalities in the sensor 60.

[0045] As described above, the arithmetic processing unit 641, the operation history temporary storage unit 642, and the operation history saving unit 643 are included in one semiconductor element 64. This allows the motor control angle sensor 6 to be made smaller.

[0046] As described above, the driving device 41 as a motor control system includes the motor 5, the sensor 60 that outputs a signal according to the driving of the motor 5, the calculation processing unit 641, the operation history temporary storage unit 642, the operation history storage unit 643, and the robot control device 3 as a control device that controls the driving of the motor 5. The calculation processing unit 641 repeats the process of generating position information data Dr including the rotation amount R, which is the position of the motor 5 acquired based on the signal output from the sensor 60, and storing the generated position information data Dr in the operation history temporary storage unit 642, and when an abnormality is detected or a signal notifying an abnormality is received from the robot control device 3, the position information data Dr stored in the operation history temporary storage unit 642 is stored in the operation history storage unit 643. With this configuration, the position information data Dr for the most recent times including the time when an abnormality is detected or the time when a signal notifying an abnormality is received from the robot control device 3 is stored even if the power is turned off. Therefore, it is possible to analyze the cause of the abnormality by subsequently analyzing the position information data Dr stored in the operation history storage unit 643. Here, since the driving device 41 is smaller in size than the robot control device 3, it is possible to reduce the transportation cost for abnormality analysis and improve the flexibility of analysis compared to the conventional method.

[0047] As described above, in the control method of the driving device 41 as a motor control system having the motor 5, the sensor 60 that outputs a signal according to the driving of the motor 5, the calculation processing unit 641, the operation history temporary storage unit 642, the operation history storage unit 643, and the robot control device 3 that controls the driving of the motor 5, the calculation processing unit 641 repeats the process of generating position information data Dr including the rotation amount R of the motor 5 acquired based on the signal output from the sensor 60 and the time Ti at which the rotation amount R was acquired, and storing the generated position information data Dr in the operation history temporary storage unit 642, and when an abnormality is detected or a signal notifying an abnormality is received from the robot control device 3, the position information data Dr stored in the operation history temporary storage unit 642 is stored in the operation history storage unit 643. According to this method, the position information data Dr for the most recent times including the time when an abnormality was detected or the time when a signal notifying an abnormality was received from the robot control device 3 is stored even if the power is turned off. Therefore, it is possible to analyze the cause of the abnormality by subsequently analyzing the position information data Dr stored in the operation history storage unit 643. Here, since the driving device 41 is smaller in size than the robot control device 3, it is possible to reduce the transportation cost for abnormality analysis and improve the flexibility of analysis compared to the conventional method.

[0048] The motor control angle sensor, motor control system, and control method of the motor control angle sensor of the present invention have been described above based on the illustrated embodiment, but the present invention is not limited thereto, and the configuration of each part can be replaced with any configuration having a similar function. In addition, any other configuration may be added to the present invention. In the above-mentioned embodiment, an example was described in which the motor control angle sensor, motor control system, and control method of the motor control angle sensor were applied to a robot system, but the motor control angle sensor, motor control system, and control method of the motor control angle sensor can also be applied to various electronic devices other than robot systems.

[0049] In the above-described embodiment, the temperature sensor 69 is disposed inside the semiconductor element 64, but this is not limiting and the temperature sensor 69 may be disposed outside the semiconductor element 64, for example, as shown in Figures 11 and 12. In the above-described embodiment, the operation history storage unit 643 is disposed inside the semiconductor element 64, but this is not limiting and the temperature sensor 69 may be disposed outside the semiconductor element 64, as shown in Figure 13. [Explanation of symbols]

[0050] 1...robot system, 2...robot, 20...base, 21...robot arm, 211...arm, 212...arm, 213...arm, 214...arm, 215...arm, 216...arm, 22...end effector, 3...robot control device, 41...drive device, 42...drive device, 43...drive device, 44...drive device, 45...drive device, 46...drive device, 5...motor, 51...rotating shaft, 52...rotor, 53...stator, 54...housing, 55...bearing, 56...bearing, 6...angle sensor for motor control, 60...sensor, 61...optical encoder, 611...optical scale, 611a...hub, 611b...disk, 612...optical sensor, 612 a...light emitting element, 612b...light receiving element, 62...magnetic encoder, 621...main gear, 622a...sub gear, 622b...sub gear, 623a...magnet, 623b...magnet, 624a...magnetic sensor, 624b...magnetic sensor, 63...substrate, 631...lower surface, 632...upper surface, 64...semiconductor element, 641...arithmetic processing unit, 642...operation history temporary storage unit, 643...operation history storage unit, 644...timer, 65...connector, 66...wiring, 68...housing, 69...temperature sensor, Dr...position information data, Fe...error flag, L...light, R...rotation amount, SH...threshold value, Sr...request signal, Te...temperature, Ti...time, aZ...axis line, aZ1...axis line, aZ2...axis line, n...rotation speed

Claims

1. A sensor that outputs a signal according to the drive of the motor; A calculation processing unit; An operation history temporary storage unit; An operation history storage unit, The arithmetic processing unit controls the sensor in response to a request signal periodically transmitted from an external device. The position of the motor is obtained based on a signal output from the sensor. and generating position information data including the time of the operation, and The process of storing the data in the memory unit is repeated, and when an abnormality is detected or an abnormality is notified from the external device, When a signal that causes the operation history to be temporarily stored in the operation history temporary storage unit is received, The data is stored in the operation history storage unit. The n-th request signal is counted up to the n-th time. Compared with the change in the count number indicating the time corresponding to the first request signal, n-1 The nth request signal is sent immediately after the count number indicating the time corresponding to the nth request signal. When the amount of change in the count number indicating the time corresponding to the request signal changes, The motor control angle sensor detects a failure in receiving the request signal. Speaker.

2. The arithmetic processing unit receives the position information data in response to a request signal from the external device. The method according to claim 1, wherein the generated position information data is stored in the operation history temporary storage unit. Angle sensor for motor control.

3. The arithmetic processing unit receives the position information data in response to a request signal from the external device.

3. The method according to claim 1, further comprising the step of: generating said position information data and transmitting said generated position information data to said external device. Angle sensor for motor control.

4. 4. The method according to claim 1, wherein the operation history temporary storage unit is configured as a ring buffer.

13. An angle sensor for motor control according to claim 1 .

5. a temperature sensor for detecting a temperature of the motor; The calculation processing unit calculates the position and the time, as well as the motor speed at the time.

5. The method according to claim 1, wherein the position information data includes a temperature of Angle sensor for motor control.

6. A motor, A sensor that outputs a signal in response to the driving of the motor; A calculation processing unit; An operation history temporary storage unit; An operation history storage unit; A control device that controls the driving of the motor, The arithmetic processing unit receives a request signal periodically transmitted from the control device. The position of the motor is acquired based on the signal output from the sensor, and the position is acquired. The generated position information data including the time of acquisition is stored in the operation history. The process of storing the data in the temporary storage unit is repeated, and when an abnormality is detected or an abnormality is notified from the control device, When a signal notifying the user of the position information stored in the operation history temporary storage unit is received, The information data is stored in the operation history storage unit. The n-th request signal is counted up to the n-th time. Compared with the change in the count number indicating the time corresponding to the first request signal, n-1 The nth request signal is sent immediately after the count number indicating the time corresponding to the nth request signal. When the amount of change in the count number indicating the time corresponding to the request signal changes, and a control section for detecting failure of reception of the request signal. 。

7. A motor, A sensor that outputs a signal in response to the driving of the motor; A calculation processing unit; An operation history temporary storage unit; An operation history storage unit; A control device for controlling the driving of the motor. It is a method, The arithmetic processing unit receives a request signal periodically transmitted from the control device. The position of the motor and the Generate location information data including the time when the location was acquired, and store the generated location information data in the The process of storing the operation history in the temporary storage unit is repeated, and when an abnormality is detected or When a signal notifying an abnormality is received from the The position information data is stored in the operation history storage unit, The n-th request signal is counted up to the n-th time. Compared with the change in the count number indicating the time corresponding to the first request signal, n-1 The nth request signal is sent immediately after the count number indicating the time corresponding to the nth request signal. When the amount of change in the count number indicating the time corresponding to the request signal changes, The motor control angle sensor detects a failure in receiving the request signal. How to control the sensor.

Citation Information

Patent Citations

  • Control device

    JP1992130503A

  • Encoder, motor with the encoder, servo system, method for processing signals of the encoder

    JP2015090307A

  • Motor controller

    JP2017229115A