WO2021145460A1 - アブソリュートエンコーダ - Google Patents
アブソリュートエンコーダ Download PDFInfo
- Publication number
- WO2021145460A1 WO2021145460A1 PCT/JP2021/001529 JP2021001529W WO2021145460A1 WO 2021145460 A1 WO2021145460 A1 WO 2021145460A1 JP 2021001529 W JP2021001529 W JP 2021001529W WO 2021145460 A1 WO2021145460 A1 WO 2021145460A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- phase signal
- detected
- rising
- unit
- absolute encoder
- Prior art date
Links
- 230000000630 rising effect Effects 0.000 claims abstract description 231
- 238000001514 detection method Methods 0.000 claims abstract description 163
- 230000007246 mechanism Effects 0.000 claims abstract description 76
- 230000033228 biological regulation Effects 0.000 claims abstract description 26
- 230000005856 abnormality Effects 0.000 claims description 26
- 238000012937 correction Methods 0.000 claims description 22
- 230000001105 regulatory effect Effects 0.000 claims description 14
- 238000005259 measurement Methods 0.000 abstract description 39
- 238000012545 processing Methods 0.000 description 20
- 239000003638 chemical reducing agent Substances 0.000 description 16
- 238000010586 diagram Methods 0.000 description 13
- 238000000034 method Methods 0.000 description 12
- 230000008569 process Effects 0.000 description 10
- 238000004364 calculation method Methods 0.000 description 5
- 230000004907 flux Effects 0.000 description 5
- 230000003287 optical effect Effects 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 239000000470 constituent Substances 0.000 description 3
- 230000002159 abnormal effect Effects 0.000 description 2
- 239000012636 effector Substances 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 230000033001 locomotion Effects 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 230000002194 synthesizing effect Effects 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005674 electromagnetic induction Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 230000000149 penetrating effect Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000000638 solvent extraction Methods 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D5/00—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
- G01D5/12—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
- G01D5/244—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains
- G01D5/245—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains using a variable number of pulses in a train
- G01D5/2454—Encoders incorporating incremental and absolute signals
- G01D5/2455—Encoders incorporating incremental and absolute signals with incremental and absolute tracks on the same encoder
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D5/00—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
- G01D5/12—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
- G01D5/14—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage
- G01D5/24—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage by varying capacitance
- G01D5/241—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage by varying capacitance by relative movement of capacitor electrodes
- G01D5/2412—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage by varying capacitance by relative movement of capacitor electrodes by varying overlap
- G01D5/2415—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage by varying capacitance by relative movement of capacitor electrodes by varying overlap adapted for encoders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D5/00—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
- G01D5/12—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
- G01D5/244—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains
- G01D5/245—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains using a variable number of pulses in a train
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D5/00—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
- G01D5/12—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
- G01D5/244—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains
- G01D5/249—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains using pulse code
- G01D5/2497—Absolute encoders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D5/00—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
- G01D5/26—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light
- G01D5/32—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light
- G01D5/34—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells
- G01D5/347—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells using displacement encoding scales
Definitions
- the present invention relates to an absolute encoder.
- a motor system including an encoder that acquires an absolute rotation angle (mechanical angle of 360 degrees) of a rotation shaft and a braking mechanism has been proposed.
- the motor system disclosed in Patent Document 1 detects a signal detection pattern, which is a member to be detected of the AB phase signal sensor for detecting the rotation angle of the motor, and an absolute position of the rotation angle within one rotation. It has a plurality of permanent magnets for signal detection and a plurality of Hall sensors, which are members to be detected of the Z-phase signal sensor for the purpose.
- the signal detection pattern of the AB phase signal sensor is provided on a disk fixed to the rotation shaft of the motor.
- the plurality of permanent magnets for signal detection of the Z-phase signal sensor have the same circumferential length and are provided side by side in the circumferential direction of the gear-type brake wheel. Further, the plurality of Hall sensors for signal detection of the Z-phase signal sensor are fixed on the permanent magnet.
- the Z-phase signal sensor has a plurality of magnetic sensors. In the Z-phase signal sensor, the rotation angle during one rotation of the rotation shaft of the motor is divided into 24 sections by the permanent magnet and the Hall sensor. The encoder can determine the rotation angle of the motor by counting the pulse and phase of the AB phase signal in one of the 24 sections in the same rotation direction.
- the motor system having the above-mentioned AB phase signal sensor, the encoder having the Z phase signal sensor, and the brake mechanism has the motor in order to maintain the rotation angle of the motor when the lock by the brake mechanism is released after the power is turned on.
- Information about the electrical angle can be output to the computer.
- the motor system When the power is turned on, the motor system outputs information about the magnetic poles of the permanent magnet and the signal of the Hall sensor to the computer by the Z-phase signal sensor of the encoder.
- the computer calculates a section including the rotation angle of the motor.
- the computer calculates the coarse electrical angle of the motor from the calculated section.
- the Z-phase signal sensor of the encoder disclosed in Patent Document 1 has the plurality of permanent magnets and the plurality of magnetometers in order to calculate the electric angle of the motor whose rotation range is regulated by the braking mechanism.
- a dedicated IC chip different from the IC chip of the sensor, the plurality of Hall sensors, and the AB phase signal sensor is required. Therefore, the structure of the Z-phase signal sensor becomes complicated.
- the encoder includes the disk provided with the signal pattern of the optical AB phase signal sensor, the permanent magnet of the magnetic Z phase signal sensor, and the gear type brake wheel provided with a plurality of Hall sensors. Needs. Therefore, the structure of the encoder becomes complicated. Therefore, even if the rotation range of the measurement target member is limited by the brake mechanism, an absolute encoder that outputs a signal capable of calculating the rotation angle of the measurement target member with a simple structure is desired.
- the present invention provides an absolute encoder capable of generating an AB phase signal and a Z phase signal capable of calculating the rotation angle of the measurement target member with a simple structure even if the rotation range of the measurement target member is limited by the brake mechanism.
- the purpose is to provide.
- the present inventor examined the configuration of an absolute encoder that outputs a signal capable of calculating the rotation angle of the measurement target member with a simple structure even if the rotation range of the measurement target member is limited by the brake mechanism. As a result of diligent studies, the present inventor has come up with the following configuration.
- the absolute encoder includes a rotating body having a plurality of engaging protrusions and a braking mechanism having an engaging pin that engages with one of the plurality of engaging protrusions.
- a plurality of AB phase signal detected units that are arranged at equal intervals in the circumferential direction within a mechanical angle of 360 degrees, and a Z phase signal rising detected unit and a Z phase that generate a rising edge of a Z phase signal.
- Each has a Z-phase signal fall-detected portion that generates a signal fall, and the Z-phase signal rise-detected portion and the Z-phase signal fall-detected portion are alternately positioned in the circumferential direction.
- It has a plurality of Z-phase signal detected units arranged in the circumferential direction within a range of a mechanical angle of 360 degrees, and an output unit capable of outputting the AB-phase signal and the Z-phase signal to a computer, and is a measurement target.
- This is an absolute encoder used to acquire a rotation angle of a member within a mechanical angle of 360 degrees.
- the AB phase signal detected unit, the Z phase signal rising detected unit, the Z phase signal falling detected unit, and the rotating body rotate integrally.
- the engaging protrusion of the rotating body is provided so as to divide the rotation range of the rotating body into a plurality of regulation ranges.
- the AB phase signal detected unit is located between the Z-phase signal rising detected unit and the Z-phase signal falling detected unit adjacent to each other in the circumferential direction.
- each of the plurality of restricted ranges includes at least one set of the Z-phase signal rising detected portion and the Z-phase signal falling detected portion, and the Z-phase signal rising covered portions adjacent to each other in the circumferential direction.
- the absolute encoder When the rotation range of the absolute encoder is limited by the brake mechanism according to the above configuration, the absolute encoder is rotated by a motor or the like which is a member to be measured within the rotation range, so that the AB phase signal and Z Generate a phase signal.
- the absolute encoder outputs an AB phase signal and a Z phase signal generated within the rotation range to the computer.
- the absolute encoder has the Z-phase so that the interval determined by the combination of the Z-phase signal rising detection unit and the Z-phase signal falling detection unit is different in each of a plurality of regulation ranges divided by the brake mechanism.
- the signal rising detection unit and the Z-phase signal falling detection unit are arranged.
- the computer identifies the regulation range by the interval of the Z-phase signal acquired from the interval of each of the plurality of regulation ranges stored in advance and the number of pulses of the AB phase signal in the interval, and also identifies the regulation range. Identify the mechanical angle within. As a result, even if the rotation range of the measurement target member is limited by the brake mechanism, it is possible to generate an AB phase signal and a Z phase signal capable of calculating the mechanical angle of the measurement target member with a simple structure.
- the absolute encoder of the present invention preferably includes the following configurations.
- the Z-phase signal rising detected section and the Z-phase signal falling detected section in the plurality of Z-phase signal detected sections are adjacent to each other in the circumferential direction, that is, the Z-phase signal rising detected section and the Z-phase signal falling section.
- the engaging projections are arranged to be the same as at least one of the spacings in the other angular range in which they are located.
- the Z-phase signal rising-detected section and the Z-phase signal falling-detected section in the plurality of Z-phase signal detected sections are the Z-phase signal rising detected section and the Z-phase signal that are adjacent to each other in the circumferential direction.
- the width of the angle range (distance between the Z-phase signal rising detected portion and the Z-phase signal rising detected portion) is within the angle range in which the engaging protrusion is arranged between the falling detected portions. They are arranged so that there is one or more angle ranges that are equal to the width of the other angle ranges.
- the computer for executing real-time control is required to have performance that does not lose real-time performance even during peak loads. Therefore, the required performance of the computer can be simplified by reducing the peak load. Thereby, even if the rotation range of the measurement target member is limited by the brake mechanism, it is possible to generate an AB phase signal and a Z phase signal capable of calculating the rotation angle of the measurement target member with a simple structure.
- the absolute encoder of the present invention preferably includes the following configurations.
- the rotating body has at least two engaging protrusions within a mechanical angle of 360 degrees.
- the measurement target member when the rotation angle of the measurement target member is limited by the at least two engaging protrusions by the brake mechanism, the measurement target member is limited to a rotation angle of less than 180 degrees of mechanical angle. ..
- the absolute encoder provides the AB phase signal and the Z phase signal for specifying the rotation angle within a range of less than 180 degrees of mechanical angle even if the measurement target member is rotated when the power of the absolute encoder is turned off. Output to the computer. Since the computer can assume that the rotation angle of the measurement target member is less than 180 degrees by the brake mechanism, the rotation angle of the measurement target member can be uniquely calculated. Thereby, the AB phase signal and the Z phase signal capable of calculating the rotation angle of the measurement target member can be generated by a simple structure.
- the absolute encoder of the present invention preferably includes the following configurations.
- the rotating body has six engaging protrusions within a mechanical angle of 360 degrees.
- the measurement target member when the rotation angle of the measurement target member is limited by the six engaging protrusions by the brake mechanism, the measurement target member is limited to any two engaging protrusions among the engaging protrusions. Is limited to a rotation angle of less than 180 degrees mechanical angle even when is not in contact with the engaging pin. Since the computer can assume that the rotation angle of the measurement target member is less than 180 degrees by the brake mechanism, the rotation angle of the measurement target member can be uniquely calculated. Thereby, the AB phase signal and the Z phase signal capable of calculating the rotation angle of the measurement target member can be generated by a simple structure.
- the absolute encoder of the present invention preferably includes the following configurations.
- the Z-phase signal detected unit has different intervals between the adjacent Z-phase signal rising detected unit and the Z-phase signal falling detected unit, and the adjacent Z-phase signals are detected.
- Z phase where the difference between the median and the smallest interval in the interval between the signal rising detection part and the Z phase signal falling detection part and the difference between the median and the largest interval are smaller than half of the median.
- the distances between the signal detected unit, the adjacent Z-phase signal rising detected unit and the Z-phase signal rising detected unit are all different, and the adjacent Z-phase signal rising detected unit and the Z-phase signal rising detected unit are different from each other.
- the Z-phase signal detected portion where the difference between the median and the smallest interval and the difference between the median and the largest interval is less than half of the median, and the adjacent Z-phase signal fall
- the distance between the detected part and the Z-phase signal falling detected part is all different, and the median and the smallest distance between the adjacent Z-phase signal falling detected part and the Z-phase signal falling detected part are the smallest.
- the Z-phase signal detected portion is the Z-phase signal rising detected portion in the entire range of the rotation angle of the rotating body limited by the engaging protrusions adjacent to the brake mechanism. At least one of the intervals defined by the combination with the Z-phase signal falling detection unit is different in the variation within a predetermined range.
- the computer causes the rising and rising of one Z-phase signal.
- interrupt processing in both lowering and lowering, it is possible to increase the chance of detecting the absolute position during one rotation of the absolute encoder.
- the computer can suppress the calculation load by generating an interrupt process at one of the rising and falling edges of the Z-phase signal.
- the absolute encoder has a difference between the median and the smallest interval and a difference between the median and the largest interval within an interval of 360 degrees of mechanical angle at an arbitrary interval in the signal waveform of the adjacent Z-phase signals. Are both configured to be less than half of the median. Therefore, the absolute encoder generates the Z-phase signal at a constant rotation speed so as to be within a predetermined variation range with reference to the median value. That is, the absolute encoder generates the Z-phase signal at a time interval of a predetermined time or longer. Therefore, the computer connected to the absolute encoder has an interrupt processing time interval for calculating the absolute rotation angle generated each time the Z-phase signal is acquired, which is equal to or longer than a predetermined time, and the rotation angle is within 360 degrees of the mechanical angle. It is possible to equalize each process of acquiring the position of.
- the peak processing load of the computer can be reduced and the degree of freedom in designing the hardware resources of the computer can be improved.
- Computers used for real-time control such as motor control are required not to lose real-time performance even during peak loads. Therefore, the maximum processing performance of the computer can be suppressed by reducing the peak load of signal processing from the absolute encoder. Further, in the case of a computer having the same processing performance, if the peak load of signal processing from the absolute encoder is reduced, the computer can execute other processing.
- the absolute encoder can simplify the process of acquiring the rotation angle of the member to be measured. As a result, even if the range of the rotation angle of the measurement target member is limited by the brake mechanism, it is possible to generate an AB phase signal and a Z phase signal capable of calculating the rotation angle of the measurement target member with a simple structure. can.
- the absolute encoder of the present invention preferably includes the following configurations.
- the Z-phase signal rising-detected section and the Z-phase signal falling-detected section in the Z-phase signal detected section are the adjacent Z-phase signal rising detected section and the Z-phase in each of the plurality of regulation ranges.
- the distances between the signal falling detected parts are all different, the difference between the smallest distance and the largest distance between the adjacent Z-phase signal rising detected parts and the Z-phase signal falling detected parts is the center. Arranged so that it is less than half the value.
- the Z-phase signal rising-detected section and the Z-phase signal falling-detected section in the Z-phase signal detected section are the adjacent Z-phase signal rising detected sections in each of the plurality of regulation ranges.
- the distances between the Z-phase signal rising detected part and the Z-phase signal rising detected part are all different, the difference between the smallest distance and the largest distance between the adjacent Z-phase signal rising detected part and the Z-phase signal rising detected part is the center. Arranged so that it is less than half the value.
- the Z-phase signal rising-detected section and the Z-phase signal falling-detected section in the Z-phase signal detected section are the adjacent Z-phase signal falling-detected sections in each of the plurality of regulation ranges.
- the distances between the Z-phase signal falling detected portion and the Z-phase signal falling detected portion are all different, the smallest and largest spacing between the adjacent Z-phase signal falling detected portion and the Z-phase signal falling detected portion is used. The difference is arranged so that it is smaller than half of the median value.
- the Z-phase signal rising-detected portion and the Z-phase signal falling-detected portion in the Z-phase signal detected portion are the rotation angles of the rotating body limited by the engaging portion adjacent to the brake mechanism.
- the smallest interval and the largest interval in the interval from the falling edge to the rising edge of the adjacent signal waveforms are all different in the plurality of Z-phase signals. It is arranged so that the difference from the interval is smaller than half of the median value.
- the interval defined by the combination of the Z-phase signal rising detected portion and the Z-phase signal falling detected portion is determined with reference to the median value.
- the Z-phase signal rising detected portion and the Z-phase signal falling detected portion are arranged so as to be within the range of the variation of.
- the absolute encoder of the present invention preferably includes the following configurations.
- the absolute encoder has a rotating plate that rotates integrally with the rotating body.
- the rotating plate is configured as one or more rotating plates that rotate integrally with the brake mechanism. That is, the rotating plate has the plurality of AB phase signal detected portions, the plurality of Z phase signal rising detected portions, and the plurality of Z phase signal falling detected portions.
- Both the AB phase signal detected unit and the Z phase signal detected unit are provided on the rotating plate. Therefore, the AB phase signal detected unit and the Z phase signal detected unit are integrally provided on the measurement target member or the rotating body in a state where the phase is fixed. As a result, even if the rotatable range of the measurement target member is limited by the brake mechanism, it is possible to generate an AB phase signal and a Z phase signal capable of calculating the rotation angle of the measurement target member with a simple structure. can.
- the absolute encoder of the present invention preferably includes the following configurations.
- the rotating body configured as the brake mechanism has the plurality of AB phase signal detected units and the plurality of Z phase signal detected units. That is, the plurality of AB phase signal detected units, the plurality of Z phase signal detected units, and the brake mechanism are provided as the same rotating body.
- the AB phase signal detected unit and the Z phase signal detected unit are integrally provided on the rotating body of the brake mechanism in a state where the phase is fixed.
- the brake mechanism even if the rotatable range of the measurement target member is limited by the brake mechanism, it is possible to generate an AB phase signal and a Z phase signal capable of calculating the rotation angle of the measurement target member with a simple structure. can.
- the absolute encoder of the present invention preferably includes the following configurations.
- An abnormality detection unit configured as hardware for detecting an abnormality of the Z-phase signal due to deformation of the rotating body provided with the Z-phase signal detection unit, deterioration and fouling of the Z-phase signal detection unit, and the like. To be equipped.
- the absolute encoder of the present invention preferably includes the following configurations.
- the absolute encoder is provided in the motor.
- the abnormality detection unit detects the abnormality of the Z-phase signal based on the electric angle of the motor.
- the computer uses a Hall element of the motor that rotates integrally with the absolute encoder and a proximity sensor that reacts at the engaging protrusion of the brake mechanism, which is faster than detecting an abnormality of the absolute encoder by software. Abnormality can be detected. Therefore, the processing load of the computer can be reduced and the degree of freedom in designing the hardware resources of the computer can be improved.
- the absolute encoder of the present invention comprises an AB phase signal detection unit that detects the AB phase signal detected unit, a Z phase signal rising detection unit, and a Z phase signal falling detection unit. It has a Z-phase signal detection unit for detecting.
- the AB phase signal is generated when the AB phase signal detected unit is detected by the AB phase signal detection unit
- the Z phase signal is generated by the Z phase signal rising detection unit and the Z phase signal falling unit. It is generated when the detected unit is detected by the Z-phase signal detection unit.
- the interval from the rising edge to the falling edge of the signal waveforms in the plurality of Z-phase signals the interval from the rising edge to the rising edge of the adjacent signal waveforms, the interval from the falling edge to the falling edge of the adjacent signal waveforms, or adjacent to each other. It is possible to realize an error correction function for correcting an error of the AB phase signal from the number of pulses of the AB phase signal generated at the interval from the falling edge to the rising edge of the signal waveform.
- the absolute encoder Even if an error occurs in which a part of the AB phase signal cannot be detected, the absolute encoder has an angle from the Z-phase signal rising detected portion to the Z-phase signal falling detected portion in the Z-phase signal detected portion. By utilizing the difference in the range, the AB phase signal in which the error has occurred can be easily estimated. As a result, an AB phase signal and a Z phase signal that can calculate the rotation angle of the member to be measured are generated by a simple structure, and the processing load of the computer is reduced to improve the degree of freedom in designing the hardware resources of the computer. can do.
- the absolute encoder of the present invention preferably includes the following configurations.
- the absolute encoder reciprocates clockwise and counterclockwise a plurality of times within the rotatable range of the rotating body.
- the Z-phase signal detection unit includes a control device that detects the Z-phase signal rising detection unit and the Z-phase signal falling detection unit.
- the absolute encoder receives at least one Z-phase signal and an AB-phase signal while rotating the rotating body whose regulation range is restricted a plurality of times clockwise and counterclockwise. Is generated.
- the computer can surely acquire the number of pulses of the AB phase signal at the interval by the combination from the falling edge to the rising edge of the signal waveform in the Z phase signal from the absolute encoder. As a result, even if the rotatable range of the measurement target member is limited by the brake mechanism, it is possible to generate an AB phase signal and a Z phase signal capable of calculating the rotation angle of the measurement target member with a simple structure. can.
- the absolute encoder of the present invention preferably includes the following configurations.
- the absolute encoder stores the value of the mechanical angle immediately before the power is turned off and the value of the number of rotations from the determined origin in the non-volatile memory, and saves the value from the non-volatile memory immediately after the power is turned on. A device for reading those values is provided. Further, the absolute encoder has a function of restricting rotation by the brake mechanism while the power is off.
- the absolute encoder can maintain the number of rotations from the determined origin because the rotation of the rotating body is restricted while the power is off. This makes it possible to configure a multi-turn absolute encoder capable of calculating the rotation angle and the number of rotations of the member to be measured with a simple structure.
- the articulated robot arm means a robot arm having a plurality of joint portions connecting a plurality of links.
- the articulated robot arm includes a vertical articulated robot arm.
- the vertical articulated robot arm is a robot arm of a serial link mechanism in which links are connected in series from the root to the tip with a rotary joint having one degree of freedom.
- the vertical articulated robot arm has a plurality of rotary joint portions.
- the absolute encoder is a device that detects a mechanical rotation position on a motor or a rotation shaft as a rotation angle from a determined origin and converts it into a signal that can be processed by a computer.
- the absolute encoders those capable of detecting the number of rotations from a predetermined origin together with the rotation angle are called a multi-turn absolute encoder.
- the absolute encoder detects the mechanical angle during one rotation.
- the multi-turn absolute encoder needs to maintain the rotation speed when the main power is turned off.
- the multi-turn absolute encoder is a multi-turn absolute encoder that monitors the operation of the object to be detected with the power supplied from the backup power supply even if the main power supply is turned off by a backup power supply composed of a battery or the like in addition to the main power supply.
- the number of rotations is via an encoder, a multi-turn absolute encoder that monitors the operation of the object to be detected with the energy generated by rotational motion even when the main power is turned off without having the backup power supply, and a reduction gear with a high reduction ratio.
- Multi-turn absolute encoder which holds the number of rotations immediately before the main power is turned off in the non-volatile memory, and mechanically locks the rotation axis while the main power is off. There are absolute encoders, etc.
- the AB phase signal is a pulse signal generated in proportion to the amount of rotation of the motor or the rotating shaft.
- the AB phase signal is a signal obtained by synthesizing the number of pulses and the phase difference between the A phase signal output by the A phase signal detection unit and the B phase signal output by the B phase signal detection unit.
- the Z-phase signal is a pulse signal generated to set the origin.
- the AB phase signal detected unit is a mark (for example, a slit, a reflecting surface, a magnet, etc.) that can be detected by the AB phase signal detecting unit.
- the AB phase signal detection unit generates an AB phase signal which is a pulse signal each time the AB phase signal detected unit is detected.
- the AB phase signal detected unit includes a case where the A phase signal detection unit and the B phase signal detection unit are provided at different positions on the mark of one track, and a mark of one of the marks of two tracks. Is provided with the A-phase signal detection unit, and the mark of the other track includes the case where the B-phase signal detection unit is provided.
- the Z-phase signal rising detection unit and the Z-phase signal falling detection unit are marks (for example, slits, reflective surfaces, magnets, etc.) that can be detected by the Z-phase signal detection unit.
- the Z-phase signal detection unit detects the Z-phase signal rising detected unit
- the Z-phase signal is turned on.
- the Z-phase signal detection unit detects the Z-phase signal fall-down detected unit
- the Z-phase signal is turned off. That is, when the Z-phase signal detection unit detects the Z-phase signal rising detected unit, the Z-phase signal detecting unit continuously generates a Z-phase signal until the Z-phase signal falling detected unit is detected.
- the mechanical angle is the rotation angle of the rotating plate.
- the electric angle is an angle obtained by multiplying the rotation angle obtained by subtracting the stator offset angle and the rotor offset angle from the mechanical angle by the number of pole pairs.
- the stator offset angle is, for example, the deviation angle between the Z-phase signal detection unit and the center of the U-phase coil of the stator when the rotating body is viewed along the axis.
- the rotor offset angle is, for example, the deviation angle between the mark that generates the Z-phase signal detected portion, which is the origin of the absolute encoder, and the center of the N-pole magnet when the rotating body is viewed along the axis.
- the interval between the AB phase signal detected units is the interval between the AB phase signal detected units adjacent to each other from the mechanical angle when the AB phase signal detected unit detects the mark of the AB phase signal detected unit. It means the rotation angle to the machine angle when the mark is detected.
- the distance between the adjacent Z-phase signal rising detected part and the Z-phase signal falling detected part is the said that the Z-phase signal detecting part is adjacent to each other from the mechanical angle when the Z-phase signal rising detected part is detected.
- Z-phase signal fall means the rotation angle to the mechanical angle when the detected portion is detected.
- the distance between the adjacent Z-phase signal rising detected part and the Z-phase signal rising detected part is adjacent to each other from the mechanical angle when the Z-phase signal detecting part detects the Z-phase signal rising detected part. It means the rotation angle to the mechanical angle when the Z-phase signal rising detected portion is detected. Further, the distance between the adjacent Z-phase signal falling detected part and the Z-phase signal falling detected part is the mechanical angle when the Z-phase signal detecting part detects the Z-phase signal falling detected part. It means the rotation angle from the to the mechanical angle when the adjacent Z-phase signal fall-detected portion is detected.
- the distance between the adjacent Z-phase signal falling detected part and the Z-phase signal rising detected part is from the mechanical angle when the Z-phase signal detecting part detects the Z-phase signal falling detected part. It means the rotation angle to the mechanical angle when the adjacent Z-phase signal rising detected portion is detected.
- the interval is defined based on the moment when the AB phase signal detection unit outputs the mark of the AB phase signal and the moment when the Z phase signal detection unit outputs the rise and fall of the Z phase signal.
- the abnormality is an abnormal state, for example, the AB phase signal detected unit or the Z phase signal detected unit has an AB phase signal or Z at a time interval corresponding to the rotation speed of the rotating body. A state in which a phase signal is not generated.
- the AB phase signal and Z that can calculate the rotation angle of the measurement target member by a simple structure.
- Absolute encoders that generate phase signals can be provided.
- the overall block diagram of the absolute encoder which concerns on Embodiment 1 of this invention is shown.
- the plan view of the absolute encoder which concerns on Embodiment 1 of this invention is shown.
- the plan view of the brake mechanism which concerns on Embodiment 1 of this invention is shown.
- the side view of the brake mechanism which concerns on Embodiment 1 of this invention is shown.
- the plan view which shows the positional relationship between the AB phase signal detected part, the Z phase signal detected part, and the rotating body which concerns on Embodiment 1 and Embodiment 3 of this invention is shown.
- a schematic diagram showing a signal waveform of an AB phase signal and a signal waveform of a Z phase signal according to the first embodiment of the present invention is shown.
- FIG. 5 is a plan view showing an operating state when a rotation angle is detected in a state where the rotation range is limited by the brake mechanism according to the first embodiment of the present invention.
- a schematic diagram showing the relationship between the AB phase signal and the Z phase signal detected in a state where the rotation range is limited by the brake mechanism according to the first embodiment of the present invention is shown.
- the schematic diagram of the articulated robot arm device which concerns on Embodiment 2 of this invention is shown.
- the schematic diagram of the base end side motor unit which concerns on the articulated robot arm which concerns on Embodiment 2 of this invention is shown.
- the control block diagram of the articulated robot arm device which concerns on Embodiment 2 of this invention is shown.
- the schematic diagram which shows the signal waveform of the AB phase signal and the signal waveform of the Z phase signal which concerns on Embodiment 3 of this invention is shown.
- the flowchart which shows the control mode of the error correction by the absolute encoder which concerns on Embodiment 4 of this invention is shown.
- the flowchart which shows the control mode of abnormality detection of the absolute encoder by the actuator which concerns on Embodiment 5 of this invention is shown.
- the schematic diagram which shows the signal waveform of the AB phase signal and the signal waveform of the Z phase signal which concerns on Embodiment 6 of this invention is shown.
- FIG. 1 is a schematic view showing the overall configuration of the absolute encoder 1 according to the first embodiment of the present invention.
- FIG. 2 is a plan view showing the absolute encoder 1 according to the first embodiment of the present invention.
- FIG. 3 is a plan view showing the brake mechanism 8 according to the first embodiment of the present invention.
- FIG. 4 is a side view showing the brake mechanism 8 according to the first embodiment of the present invention.
- the absolute encoder 1 has information on an absolute rotation angle when a determined origin is used as a reference on a rotation axis which is a member to be measured (the number of pulses of the AB phase signal in this embodiment). It is a rotary encoder that detects and outputs the detection result.
- the absolute encoder 1 is, for example, a reflection type optical absolute encoder.
- the absolute encoder 1 generates an AB phase signal for detecting a rotation angle within 360 degrees of the mechanical angle of the member to be measured and a Z phase signal for detecting the origin of the mechanical angle of the member to be measured.
- the absolute encoder 1 includes an AB phase signal detected unit 2 for generating an AB phase signal, a Z phase signal detected unit 3 for generating a Z phase signal, and an AB. It controls the AB phase signal detection unit 4 that detects the phase signal detection unit 2, the Z phase signal detection unit 5 that detects the Z phase signal detection unit 3, and the motor 27 (see FIG. 4) that is a measurement target member.
- a computer (not shown) is provided with an output unit 6 capable of outputting an AB phase signal and a Z phase signal, and a brake mechanism 8.
- the AB phase signal detected unit 2 and the Z phase signal detected unit 3 are provided on a rotating plate 7 (see FIG.
- the rotating plate 7 rotates 360 degrees when the rotating shaft 27a of the motor 27 rotates at a mechanical angle of 360 degrees. That is, the rotation angle of the rotating plate 7 and the rotation angle of the rotating shaft 27a of the motor 27 coincide with each other.
- the mechanical angle of the motor 27 is simply defined as the mechanical angle.
- the AB phase signal detected unit 2 is a mark that the AB phase signal detecting unit 4 can detect.
- the AB phase signal detected unit 2 includes an A phase signal detected unit and a B phase signal detected unit.
- the AB phase signal detected portion 2 is provided with substantially rectangular reflective surfaces and non-reflective surfaces alternately arranged in the circumferential direction on the rotating plate 7.
- the AB phase signal detected unit 2 reflects the detection light output by the AB phase signal detection unit 4 by the reflecting surface and absorbs it on the non-reflecting surface.
- the plurality of AB phase signal detected units 2 are arranged in an annular shape and radially. Further, the plurality of AB phase signal detected units 2 have the same width in the circumferential direction.
- the plurality of AB phase signal detected units 2 are arranged so that the angle ranges determined by the mechanical angles according to the positions of the adjacent AB phase signal detected units 2 are equal. That is, the plurality of AB phase signal detected units 2 are arranged so that the intervals in the circumferential direction of the adjacent AB phase signal detected units 2 are equal.
- the plurality of AB phase signal detected units 2 constitute an annular AB phase signal chord wheel CW1 in which a plurality of reflecting surfaces having the same width in the circumferential direction are arranged at equal intervals in the circumferential direction. ..
- the AB phase signal cord wheel CW1 composed of a plurality of AB phase signal detected units 2, reflective surfaces and non-reflective surfaces are alternately arranged in the circumferential direction. Further, the center of the AB phase signal cord wheel CW1 coincides with the rotation axis P of the rotation plate 7.
- the AB phase signal detection unit 4 includes, for example, a light projecting element (not shown) made of an LED light emitting element or the like and a light receiving element (not shown) made of a photodiode or the like.
- the AB phase signal detection unit 4 is supported, for example, by a portion that does not rotate in conjunction with the rotation shaft 27a of the motor 27.
- the AB phase signal detection unit 4 is provided at a position capable of projecting light on the AB phase signal code wheel CW1 and receiving the reflected light reflected by the AB phase signal code wheel CW1.
- the detected light of the light projecting element is reflected on the reflecting surface of the AB phase signal detected unit 2, while being absorbed by the non-reflecting surface.
- the AB phase signal detection unit 4 outputs an AB phase signal while the detection light output from the light projecting element is reflected on the reflecting surface and received by the light receiving element.
- the AB phase signal detection unit 4 does not output the AB phase signal while the detection light output from the light projecting element is absorbed by the non-reflective surface and is not received by the light receiving element.
- the AB phase signal detection unit 4 includes an A phase signal detection unit 4a that outputs an A phase signal and a B phase signal detection unit 4b that outputs a B phase signal.
- the A-phase signal and the B-phase signal generated by the AB phase signal detected unit 2 and the AB phase signal detecting unit 4 have the same mechanical angle range, which is the interval from the rising edge to the falling edge of the signal waveform, respectively. Is. Further, in the A-phase signal and the B-phase signal, the interval from the rising edge to the falling edge and the interval from the falling edge to the rising edge of adjacent signal waveforms are all the same.
- the A-phase signal detection unit 4a that outputs the A-phase signal and the B-phase signal detection unit 4b that outputs the B-phase signal are different in position with respect to the AB-phase signal detected unit 2. Therefore, the phases of the signal waveforms of the A-phase signal and the B-phase signal are out of phase. As a result, the phase difference between the A-phase signal and the B-phase signal differs depending on the rotation direction of the rotation shaft 27a of the motor 27. Therefore, the absolute encoder 1 can output the phase difference of the B-phase signal with respect to the A-phase signal as information for determining the rotation direction of the rotation shaft 27a of the motor 27.
- the AB phase signal detection unit 4 outputs an AB phase signal obtained by synthesizing the number of pulses and the phase difference between the A phase signal output by the A phase signal detection unit 4a and the B phase signal output by the B phase signal detection unit 4b.
- the circumferential width of the reflective surface of the plurality of AB phase signal detected units 2 defines the angular range of the mechanical angle of the motor 27 that rotates while the AB phase signal detecting unit 4 outputs the AB phase signal. There is. Further, the distance between the reflective surfaces adjacent to each other in the circumferential direction in the plurality of AB phase signal detected units 2 is the mechanical angle of the motor 27 that rotates until the AB phase signal detecting unit 4 outputs the next AB phase signal. The angle range is specified.
- the AB phase signal detection unit 4 outputs an AB phase signal according to the width of the reflection surface in the plurality of AB phase signal detection units 2 in the circumferential direction and the distance between the reflection surfaces adjacent to each other in the circumferential direction. In this way, the AB phase signal can be generated by the plurality of AB phase signal detected units 2 and the AB phase signal detecting unit 4.
- the generated AB phase signals have the same signal waveform and the same signal interval, respectively.
- the Z-phase signal detected unit 3 is a mark that can be detected by the Z-phase signal detection unit 5.
- the Z-phase signal detected unit 3 is a substantially rectangular reflecting surface provided on the rotating plate 7.
- the plurality of Z-phase signal detected units 3 are arranged in an annular shape. Further, the plurality of Z-phase signal detected units 3 are composed of reflecting surfaces having various widths including a reflecting surface having the same width in the circumferential direction. Further, the plurality of Z-phase signal detected units 3 are arranged in the circumferential direction so that the intervals in the circumferential direction, which is an angle range determined by each mechanical angle, are different. Part of the interval in the plurality of Z-phase signal detected units 3 may be equal.
- the reflecting surfaces having various widths including the reflecting surfaces having the same width in the circumferential direction are arranged at various intervals including the intervals equal to the circumferential direction, so that the plurality of Z-phase signal detected units 3 form an annular shape.
- the Z-phase signal cord wheel CW2 is configured.
- the Z-phase signal cord wheel CW2 composed of a plurality of Z-phase signal detected units 3 reflective surfaces (lightly inked portions in FIG. 2) and non-reflective surfaces are alternately arranged in the circumferential direction. Further, the center of the Z-phase signal cord wheel CW2 coincides with the rotation axis P of the rotation plate 7.
- the plurality of Z-phase signal detected units 3 and the plurality of AB-phase signal detected units 2 are arranged concentrically on the rotating plate 7. As a result, the phases of the plurality of Z-phase signal detected units 3 are fixed with respect to the plurality of AB phase signal detected units 2.
- the Z-phase signal detection unit 5 includes, for example, a light emitting element composed of an LED light emitting element or the like and a light receiving element composed of a photodiode or the like.
- the Z-phase signal detection unit 5 is supported by a portion that does not rotate in conjunction with the rotation shaft 27a of the motor 27. Further, the Z-phase signal detection unit 5 is provided at a position capable of projecting light on the Z-phase signal code wheel CW2 and receiving the reflected light reflected by the Z-phase signal code wheel CW2.
- the detected light of the light projecting element is reflected on the reflecting surface of the Z-phase signal detected unit 3, while being absorbed by the non-reflecting surface.
- the Z-phase signal detection unit 5 outputs a Z-phase signal while the detection light output from the light projecting element is reflected on the reflecting surface and received by the light receiving element.
- the Z-phase signal detection unit 5 does not output the Z-phase signal while the detection light output from the light projecting element is absorbed by the non-reflective surface and is not received by the light receiving element.
- the plurality of Z-phase signal detected units 3 include a Z-phase signal rising detected unit 3a that generates a rising edge of a Z-phase signal and a Z-phase signal falling detected unit 3b that generates a falling edge of a Z-phase signal.
- a Z-phase signal rising detected unit 3a that generates a rising edge of a Z-phase signal
- a Z-phase signal falling detected unit 3b that generates a falling edge of a Z-phase signal.
- the Z-phase signal rising detected portion 3a is an edge located in front of the rotation direction on the reflection surface when viewed from the axis direction of the rotation axis P of the rotation plate 7.
- the Z-phase signal fall-down detected unit 3b is a Z-phase signal detecting unit in which the detected light is reflected on the reflecting surface on the reflecting surface. This is a portion that switches from a state in which light is received by the light receiving element of 5 to a state in which the detected light is absorbed by the non-reflective surface and is not received by the light receiving element.
- the Z-phase signal fall-detected portion 3b is an edge located behind the rotation direction on the reflection surface when viewed from the axis direction of the rotation axis P of the rotation plate 7.
- FIG. 2 shows a Z-phase signal rising detected unit 3a and a Z-phase signal falling detected unit 3b when the rotating plate 7 rotates clockwise when viewed from the axial direction of the rotating axis P.
- the distance between the adjacent Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b is the mechanical angle corresponding to the position of the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b. It is an angle range of the machine angle defined by the machine angle corresponding to the position of (see ⁇ 1 in FIG. 2).
- the angular range of the mechanical angle from the rising edge to the falling edge of the Z-phase signal is defined by the circumferential distance from the adjacent Z-phase signal rising detected section 3a to the Z-phase signal falling detected section 3b.
- the angle of the mechanical angle from the falling edge of the Z-phase signal to the rising edge of the next Z-phase signal is determined by the circumferential distance from the adjacent Z-phase signal falling detected portion 3b to the Z-phase signal rising detected portion 3a.
- the range is defined. Therefore, the circumferential distance from the adjacent Z-phase signal rising detected portion 3a to the Z-phase signal falling detected portion 3b indicates the width of the reflecting surface in the circumferential direction. Further, the circumferential distance from the adjacent Z-phase signal falling detected portion 3b to the Z-phase signal rising detected portion 3a indicates the distance between the reflecting surfaces adjacent to each other in the circumferential direction.
- the Z-phase signal detection unit 5 starts outputting the Z-phase signal when the Z-phase signal rise detection unit 3a is detected. That is, the Z-phase signal detection unit 5 outputs a Z-phase signal when the detection light output from the light projecting element is reflected on the reflecting surface and received by the light receiving element.
- the Z-phase signal detection unit 5 detects the Z-phase signal falling edge detected unit 3b
- the Z-phase signal detection unit 5 stops the output of the Z-phase signal. That is, the Z-phase signal detection unit 5 stops the output of the Z-phase signal when the detection light output from the light projecting element is absorbed by the non-reflective surface and is no longer received by the light receiving element.
- the Z-phase signal detection unit 5 outputs a Z-phase signal according to the width of the reflective surface in the circumferential direction and the distance between the reflective surfaces adjacent to each other in the circumferential direction. In this way, the plurality of Z-phase signal detected units 3 and the Z-phase signal detecting unit 5 can generate a Z-phase signal.
- the AB phase signal detected unit 2 is located between the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b that are adjacent to each other in the circumferential direction. Be placed.
- the Z-phase signal detecting unit 5 detects the Z-phase signal rising detected unit 3a and outputs the rising edge of the Z-phase signal
- the Z-phase signal detecting unit 5 detects the Z-phase signal falling detected unit 3b.
- the AB phase signal is generated by the AB phase signal detected unit 2 and the AB phase signal detecting unit 4a until the detection is performed and the falling edge of the Z phase signal is output. That is, the absolute encoder 1 outputs information regarding the angle range of the mechanical angle of the motor 27 that rotates between the rise and fall of the Z-phase signal in terms of the number of pulses of the AB-phase signal.
- the output unit 6 motors the AB phase signal generated by the AB phase signal detected unit 2 and the AB phase signal detection unit 4 and the Z phase signal generated by the Z phase signal detected unit 3 and the Z phase signal detection unit 5.
- the output is output to the drive device 31 (see FIG. 12), which is the computer that controls the 27.
- the drive device 31 can acquire information on the rotation angle within 360 degrees of the machine angle with respect to the determined origin on the rotation shaft 27a of the motor 27. Further, the drive device 31 can acquire information about the origin within the mechanical angle of 360 degrees of the rotation shaft 27a of the motor 27 from the Z-phase signal generated by the Z-phase signal detected unit 3.
- the brake mechanism 8 limits the rotation of the rotating shaft 27a of the motor 27 when no current is supplied to the motor 27 or when the motor 27 does not output torque. do.
- the brake mechanism 8 includes a rotating body 9, an engaging pin 10, and a solenoid 10a.
- the rotating body 9 rotates integrally with the rotating shaft 27a of the motor 27.
- the rotating body 9 is a substantially disk-shaped member.
- the rotating body 9 is provided on the rotating shaft 27a.
- the rotating body 9 is connected to the rotating shaft 27a in a state where the center thereof coincides with the rotating axis P of the rotating shaft 27a. That is, the rotating body 9 rotates integrally with the rotating shaft 27a around the rotating axis P of the rotating shaft 27a.
- the rotating body 9 has at least two engaging protrusions 9a protruding outward in the radial direction at its outer edge.
- the plurality of engaging protrusions 9a are arranged at equal intervals in the circumferential direction of the rotating body 9.
- the rotating body 9 has six engaging protrusions 9a in the circumferential direction every 60 degrees. As a result, the rotating body 9 is divided in the order of the first section S1 to the sixth section S6 in the circumferential direction by the six engaging protrusions 9a.
- the engaging pin 10 is a member that regulates the rotation of the rotating body 9.
- the engagement pin 10 is supported by a portion that does not rotate in conjunction with the rotating body 9, such as the housing of the motor 27 or the housing of the speed reducer 25 (see FIG. 11) of the motor 27.
- the engagement pin 10 is arranged so that the axis is parallel to the rotation axis P of the rotating body 9. Further, the engaging pin 10 is configured to be movable in the axial direction of the axial line.
- the position of the engaging pin 10 is a regulated position (two-dot chain line) in which the engaging pin 10 is located at a position where the engaging pin 10 overlaps the engaging protrusion 9a when the rotating body 9 is viewed in a direction orthogonal to the axial direction of the rotating axis P. (Fig.) And the open position (solid diagram) where the engaging pin 10 is located at a position where it does not overlap the engaging protrusion 9a.
- a force is applied to the engaging pin 10 in the axial direction of the engaging pin so as to be held at the regulated position by an elastic body 10b such as a spring.
- the engaging pin 10 When the engaging pin 10 is located at the restricted position, it is positioned in any one of the first section S1 to the sixth section S6 divided by the engaging protrusions 9a adjacent to each other in the circumferential direction.
- the distance between the engaging protrusions 9a adjacent to each other in the circumferential direction in the rotating body 9 is the circumferential direction between the engaging protrusions 9a in which the engaging pins 10 are adjacent to each other when the engaging pins 10 are located at the restricted positions.
- the engaging pin 10 engages with one of the engaging protrusions 9a constituting the section and the other engaging protrusions 9a adjacent to each other in the circumferential direction due to the rotation of the rotating body 9. It fits.
- the solenoid 10a is an actuator that moves the engagement pin 10.
- the solenoid 10a is supported by a portion that does not rotate in conjunction with the rotating body 9, such as the housing of the motor 27 or the housing of the speed reducer 25.
- the solenoid 10a moves the engaging pin 10 held in the regulated position in the energized ON state to the open position.
- the brake mechanism 8 configured in this way regulates the rotation range of the rotating body 9 that rotates integrally with the rotating shaft 27a by switching the position of the engaging pin 10 from the open position to the restricted position by the solenoid 10a. ..
- the brake mechanism 8 sets the rotation range of the rotating body 9 to an angular range from a position in contact with one engaging protrusion 9a constituting the section to a position in contact with the other engaging protrusion 9a adjacent in the circumferential direction. Restrict. That is, the brake mechanism 8 limits the rotation range of the rotating body 9 to the angle range of any one of the first section S1 to the sixth section S6.
- the regulation range which is the angular range of each section, is the respective motors 27 when the engaging pin 10 comes into contact with one engaging protrusion 9a constituting the section and the other engaging protrusion 9a adjacent in the circumferential direction. Specified by the mechanical angle of.
- the brake mechanism 8 regulates the rotation range of the rotating shaft 27a of the motor 27 to which the rotating body 9 is connected to the regulation range by each section.
- a rotating plate 7 having a plurality of AB phase signal detected units 2 and a plurality of Z phase signal detected units 3 is provided.
- the rotating plate 7 rotates each of the AB phase signal chord wheel CW1 composed of the plurality of AB phase signal detected units 2 and the Z phase signal chord wheel CW2 composed of the plurality of Z phase signal detected units 3.
- the axis P is fixed to the rotating body 9 so as to coincide with the rotating axis P of the rotating body 9. That is, the AB phase signal detected unit 2, the Z phase signal detected unit 3, the rotating plate 7, and the rotating body 9 rotate integrally around the rotating axis P of the rotating shaft 27a of the motor 27.
- the plurality of AB phase signal detected units 2 are arranged at equal intervals in the circumferential direction along the circumferential direction of the rotating body 9.
- the plurality of Z-phase signal detected units 3 are arranged at various intervals including equal intervals in the circumferential direction along the circumferential direction of the rotating body 9.
- FIG. 5 is a plan view showing the positional relationship between the absolute encoder 1 and the rotating body 9 according to the embodiment of the present invention.
- FIG. 6 is a schematic diagram showing a signal waveform of an AB phase signal and a signal waveform of a Z phase signal according to the embodiment of the present invention.
- the front edge in the rotation direction when viewed from the axial direction of the rotation axis P of the rotating body 9 is the Z phase signal rising detected unit (for example, the Z phase signal rising detected unit 3Aa). It is arranged to match with. That is, the absolute encoder 1 generates the rising edge of the Z-phase signal and the rising edge of the AB-phase signal at the same timing.
- a plurality of AB phase signal detected units 2 are arranged at equal intervals within a range of a mechanical angle of 360 degrees along the circumferential direction of the rotating body 9.
- the numbers are equal to each other.
- the AB phase signal detected unit 2 of the above is positioned.
- the plurality of Z-phase signal detected units 3 are arranged at various intervals including equal intervals within a range of a mechanical angle of 360 degrees along the circumferential direction of the rotating body 9.
- the plurality of Z-phase signal detected units 3 are positioned at least one in each section within the regulation range.
- the first Z-phase signal detected unit 3A is positioned in the first section S1.
- the second Z-phase signal detected unit 3B is positioned in the second section S2.
- the third Z phase signal detected unit 3C is positioned.
- the 4Z phase signal detected unit 3D is positioned in the fourth section S4.
- the fifth Z phase signal detected unit 3E is positioned.
- the sixth Z phase signal detected unit 3F is positioned.
- At least one set of the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b are located in each section.
- the first Z-phase signal rising detection detected unit 3Aa and the first Z-phase signal falling detected unit 3Ab constituting the first Z-phase signal detected unit 3A are located adjacent to each other in the circumferential direction. ..
- the first Z-phase signal rising detection unit 3Aa and the first Z-phase signal falling detection unit 3Ab are arranged so as to have a first interval Ga1 in the circumferential direction.
- the first interval Ga1 is an angle range of the mechanical angle defined by the mechanical angle corresponding to the position of the 1st Z phase signal rising detected portion 3Aa and the mechanical angle corresponding to the position of the 1st Z phase signal falling detected portion 3Ab. Is.
- the second Z-phase signal rising detected unit 3Ba and the second Z-phase signal falling detected unit 3Bb constituting the second Z-phase signal detected unit 3B are located adjacent to each other in the circumferential direction. ..
- the second Z-phase signal rising detected unit 3Ba and the second Z-phase signal falling detected unit 3Bb are arranged so as to have a second interval Gb1 in the circumferential direction.
- the second interval Gb1 is an angle range of the mechanical angle defined by the mechanical angle corresponding to the position of the second Z phase signal rising detected portion 3Ba and the mechanical angle corresponding to the position of the second Z phase signal falling detected portion 3Bb. Is.
- the third Z phase signal rising detected unit 3Ca and the third Z phase signal falling detected unit 3Cb constituting the third Z phase signal detected unit 3C are located adjacent to each other in the circumferential direction. ..
- the third Z-phase signal rising detection unit 3Ca and the third Z-phase signal falling detection unit 3Cb are arranged so as to have a third interval Gc1 in the circumferential direction.
- the third interval Gc1 is an angle range of the mechanical angle defined by the mechanical angle corresponding to the position of the 3Z phase signal rising detected portion 3Ca and the mechanical angle corresponding to the position of the 3Z phase signal falling detected portion 3Cb. Is.
- the 4Z phase signal rising detected unit 3Da and the 4Z phase signal falling detected unit 3Db constituting the 4Z phase signal detected unit 3D are located adjacent to each other in the circumferential direction. ..
- the 4Z phase signal rising detection unit 3Da and the 4Z phase signal falling detected unit 3Db are arranged so as to have a fourth interval Gd1 in the circumferential direction.
- the fourth interval Gd1 is an angle range of the mechanical angle defined by the mechanical angle corresponding to the position of the 4Z phase signal rising detected portion 3Da and the mechanical angle corresponding to the position of the 4Z phase signal falling detected portion 3Db. Is.
- the 5th Z-phase signal rising detected unit 3Ea and the 5Z phase signal falling detected unit 3Eb constituting the 5Z phase signal detected unit 3E are located adjacent to each other in the circumferential direction. ..
- the fifth Z-phase signal rising detection unit 3Ea and the fifth Z-phase signal falling detection unit 3Eb are arranged so as to have a fifth interval Ge1 in the circumferential direction.
- the fifth interval Ge1 is an angle range of the mechanical angle defined by the mechanical angle corresponding to the position of the 5th Z-phase signal rising detected portion 3Ea and the mechanical angle corresponding to the position of the 5th Z-phase signal falling detected portion 3Eb. Is.
- the sixth Z-phase signal rising detected unit 3F and the sixth Z-phase signal falling detected unit 3Fb constituting the sixth Z-phase signal detected unit 3F are located adjacent to each other in the circumferential direction. ..
- the 6th Z phase signal rising detected unit 3Fa and the 6Z phase signal falling detected unit 3Fb are arranged so as to have a sixth interval Gf1 in the circumferential direction.
- the sixth interval Gf1 is an angle range of the mechanical angle defined by the mechanical angle corresponding to the position of the 6th Z-phase signal rising detected portion 3Fa and the mechanical angle corresponding to the position of the 6th Z-phase signal falling detected portion 3Fb. Is.
- the fourth interval Gd1 of the above, the fifth interval Ge1 of the fifth Z phase signal detected unit 3E, and the sixth interval Gf1 of the sixth Z phase signal detected unit 3F are defined in different angle ranges.
- Within the first interval Ga1, P1 AB phase signal detected units 2 are located.
- Within the third interval Gc1, P3 AB phase signal detected units 2 are located.
- Within the fourth interval Gd1, P4 AB phase signal detected units 2 are located.
- the 1st Z-phase signal falling detected unit 3Ab and the 2nd Z-phase signal rising detected unit 3Ba are located adjacent to each other in the circumferential direction.
- the first section S1 and the first section S1 and the first section S1 and the first section are within the angle range defined by the mechanical angle corresponding to the position of the first Z-phase signal falling detected portion 3Ab and the mechanical angle corresponding to the position of the second Z-phase signal rising detected portion 3Ba.
- the engaging protrusion 9a that separates the two sections S2 is located.
- the 1st Z-phase signal falling detection unit 3Ab and the 2nd Z-phase signal rising detected unit 3Ba are arranged so as to have a 1-2 interval GAb in the circumferential direction.
- the second section S2 and the third section S3 are included in the angle range defined by the mechanical angle of the second Z phase signal falling detected unit 3Bb and the mechanical angle of the third Z phase signal rising detected unit 3Ca.
- the partitioning engaging protrusion 9a is located.
- the second Z-phase signal falling detected unit 3Bb and the third Z-phase signal rising detected unit 3Ca are arranged so as to have a 2-3 interval Gbc in the circumferential direction.
- the third section S3 and the fourth section S4 are divided into an angle range defined by the mechanical angle of the third Z phase signal falling detected unit 3Cb and the mechanical angle of the fourth Z phase signal rising detected unit 3Da.
- the engaging protrusion 9a is located.
- the 3rd Z-phase signal falling detection unit 3Cb and the 4th Z-phase signal rising detected unit 3Da are arranged so as to have a 3rd-4th interval Gcd in the circumferential direction.
- the fourth section S4 and the fifth section S5 are divided into an angle range defined by the mechanical angle of the fourth Z-phase signal falling detected unit 3Db and the mechanical angle of the fifth Z-phase signal rising detected unit 3Ea.
- the engaging protrusion 9a is located.
- the 5th Z phase signal falling detection unit 3b3Db and the 5Z phase signal rising detected unit 3Ea are arranged so as to have a 4th to 5th interval Gde in the circumferential direction.
- the fifth section S5 and the sixth section S6 are divided into an angle range defined by the mechanical angle of the 5th Z phase signal falling detected unit 3Eb and the mechanical angle of the 6th Z phase signal rising detected unit 3F.
- the engaging protrusion 9a is located.
- the 5th Z-phase signal falling detected unit 3Eb and the 6th Z-phase signal rising detected unit 3F are arranged so as to have a 5th to 6th interval Gef in the circumferential direction.
- the sixth section S6 and the first section S1 are divided into an angle range defined by the mechanical angle of the 6th Z phase signal falling detected unit 3Fb and the mechanical angle of the 1st Z phase signal rising detected unit 3Aa.
- the engaging protrusion 9a is located.
- the 6th Z-phase signal falling detection unit 3Fb and the 1st Z-phase signal rising detected unit 3Aa are arranged so as to have a 6-1th interval Gfa in the circumferential direction.
- the absolute encoder 1 generates the first Z phase signal Z1 by the first Z phase signal detected unit 3A within the regulation range of the first section S1 of the rotating body 9. At the same time, the absolute encoder 1 generates P1 AB phase signals by the P1 AB phase signal detected unit 2 in the first interval Ga1. The absolute encoder 1 generates the second Z phase signal Z2 by the second Z phase signal detected unit 3B within the range of the second section S2. At the same time, the absolute encoder 1 generates P2 AB phase signals by the P2 AB phase signal detected unit 2 in the second interval Gb1. The absolute encoder 1 generates a third Z phase signal Z3 by the third Z phase signal detected unit 3C within the range of the third section S3.
- the absolute encoder 1 generates P3 AB phase signals by the P3 AB phase signal detected unit 2 in the third interval Gc1.
- the absolute encoder 1 generates the 4Z phase signal Z4 by the 4Z phase signal detected unit 3D within the range of the 4th section S4.
- the absolute encoder 1 generates P4 AB phase signals by the P4 AB phase signal detected unit 2 in the fourth interval Gd1.
- the absolute encoder 1 generates the 5th Z phase signal Z5 by the 5th Z phase signal detected unit 3E within the range of the 5th section S5.
- the absolute encoder 1 generates P5 AB phase signals by the P5 AB phase signal detected unit 2 in the fifth interval Ge1.
- the absolute encoder 1 generates a sixth Z phase signal Z6 by the sixth Z phase signal detected unit 3F within the range of the sixth section S6. At the same time, the absolute encoder 1 generates P6 AB phase signals by the P6 AB phase signal detected unit 2 in the sixth interval Gf1.
- FIG. 7 is a graph showing the relationship between the number of pulses of the AB phase signal and the interval Gd from the falling edge to the rising edge of the signal waveform in the Z phase signal.
- FIG. 8 is a plan view showing an operating state when the rotation angle is detected in a state where the rotation range is limited by the brake mechanism according to the embodiment of the invention.
- FIG. 9 is a schematic view showing the relationship between the AB phase signal and the Z phase signal detected in a state where the rotation range is limited by the brake mechanism according to the embodiment of the present invention.
- the drive device 31 determines the mechanical angles corresponding to the positions of the AB phase signal detection unit 4 and the positions of the light emitting element and the light receiving element of the Z phase signal detection unit 5 with reference to the origin of the mechanical angle. I remember. Further, the drive device 31 has a number P1 of AB phase signal detected units 2 located in the first interval Ga1, a number P2 of AB phase signal detected units 2 located in the second interval Gb1, and a third interval Gc1.
- the number P6 of the AB phase signal detected unit 2 located in P5 and the sixth interval Gf1 is stored (see FIG. 6). That is, the drive device 31 stores the number of AB phase signals generated between the rise and fall of the Z phase signal generated in each section by the absolute encoder 1.
- the drive device 31 When the rotating plate 7 or the rotating body 9 rotates counterclockwise, the drive device 31 counts up (adds) the number of pulses of the A-phase signal, the B-phase signal, and the Z-phase signal, and the rotating plate 7 or the rotating body 9 counts up (adds) the number of pulses.
- the number of pulses of the AB phase signal and the Z phase signal shall be counted down (subtracted).
- the drive device 31 acquires the AB phase signal from the absolute encoder 1 and sequentially transfers the 1st Z phase signal Z1 to the 6th Z phase signal Z6. get. Further, the drive device 31 counts up the acquired AB phase signal and Z phase signal. The drive device 31 calculates, for example, the number of pulses of the AB phase signal acquired between the rising edge and the rising edge of the signal waveform in the first Z phase signal Z1.
- the drive device 31 which of the number of pulses of the AB phase signal generated in each of the first interval Ga1 to the sixth interval Gf1 stored in advance is equal to the pulse P1 which is the calculated number of pulses of the AB phase signal. to decide.
- the drive device 31 determines that the calculated number of pulses of the AB phase signal is equal to the number of pulses generated in the first interval Ga1, the acquired Z-phase signal is specified as the first Z-phase signal Z1.
- the drive device 31 When the drive device 31 generates the rise of the first Z phase signal Z1 from the mechanical angle of the first Z phase signal rise detection unit 3Aa that generated the rise of the first Z phase signal Z1, the drive device 31 generates the rise of the first Z phase signal Z1.
- the mechanical angle ⁇ z of the rotating shaft 27a at the position corresponding to the position of the Z-phase signal detection unit 5 of the above is calculated (see FIG. 2).
- the drive device 31 calculates the rotation angle of the rotation shaft 27a within 360 degrees in real time by counting the number of pulses of the AB phase signal from the time when the rise of the first Z phase signal Z1 is acquired.
- the drive device 31 periodically sets the rotation angle of the rotation shaft 27a within 360 degrees based on the number of pulses of the AB phase signal acquired during the period from the rise to the fall of the signal waveform in the Z-phase signal to be sequentially acquired. calculate.
- the drive device 31 When starting the supply of current to the motor 27 (see FIG. 4), the drive device 31 switches the engagement pin 10 to the regulated position in order to detect the rotation angle of the rotation shaft 27a (see FIG. 4) of the motor 27. In this state, the rotation shaft 27a of the motor 27 is alternately rotated counterclockwise (see CCW arrow) and clockwise (see CW arrow). At this time, the drive device 31 resets the number of pulses of the AB phase signal acquired in the past to zero, and then rotates the rotation shaft 27a counterclockwise and clockwise.
- the drive device 31 determines from the output current value, the rotation angle, and the like that the engaging protrusion 9a of the rotating body 9 has come into contact with the engaging pin 10, the motor 27 rotating shaft 27a is rotated in the opposite direction.
- the drive device 31 reverses the rotation direction of the motor 27 rotating shaft 27a each time it detects contact between the engaging protrusion 9a of the rotating body 9 and the engaging pin 10 in the section of the rotating body 9.
- the absolute encoder 1 generates an AB phase signal and a Z phase signal as the rotation shaft 27a rotates in the counterclockwise direction and the clockwise direction, and transmits the AB phase signal and the Z phase signal to the drive device 31.
- the drive device 31 calculates the number of pulses of the acquired AB phase signal.
- the drive device 31 counts up the number of pulses of the AB phase signal during counterclockwise rotation, and counts down the number of pulses of the AB phase signal during clockwise rotation.
- the drive device 31 rotates the rotation shaft 27a a plurality of times in the counterclockwise (CCW) direction and the clockwise (CW) direction to obtain a signal waveform in the Z-phase signal.
- the number of pulses of the AB phase signal generated from the rising edge to the falling edge is acquired.
- the drive device 31 can be used in any section. With the number of pulses of the AB phase signal at the rotation angle set to 0, the rotation shaft of the motor 27 until the engagement pin 10 located at the regulated position comes into contact with one of the engagement protrusions 9a constituting the section of the rotating body 9. Rotate 27a counterclockwise (see arrow CCW in FIG. 8 and arrow A1 in FIG. 9). The drive device 31 counts up the number of pulses of the generated AB phase signal.
- the drive device 31 detects the contact between one of the engaging protrusions 9a of the rotating body 9 and the engaging pin 10, the rotating shaft 27a of the motor 27 is stopped. At the same time, the drive device 31 stops the count-up of the AB phase signal at the time of the p-pulse PA.
- the drive device 31 rotates the rotating shaft 27a of the motor 27 clockwise until the engaging pin 10 comes into contact with the other engaging projection 9a forming the same section (arrow CW in FIG. 8). , See arrow A2 in FIG. 9).
- the drive device 31 counts down from the pulse PA according to the pulse of the generated AB phase signal.
- the drive device 31 acquires the rising edge of the signal waveform of the Z-phase signal, it stores the pulse PB and the pulse PD as the number of rising pulses.
- the drive device 31 detects the contact between the other engaging protrusion 9a of the rotating body 9 and the engaging pin 10
- the rotating shaft 27a of the motor 27 is stopped.
- the drive device 31 stops the countdown of the AB phase signal at the time of the pulse PF.
- the drive device 31 rotates the motor 27 counterclockwise until the engaging pin 10 comes into contact with the one engaging protrusion 9a of the rotating body 9 (arrow CCW in FIG. 8 and arrow A3 in FIG. 9). reference).
- the drive device 31 counts up from the pulse PF according to the pulse of the generated AB phase signal.
- the drive device 31 acquires the Z-phase signal, it stores the pulse PE and the pulse PC as the number of rising pulses.
- the drive device 31 detects the contact between one of the engaging protrusions 9a of the rotating body 9 and the engaging pin 10
- the rotating shaft 27a of the motor 27 is stopped.
- the drive device 31 stops the count-up of the AB phase signal at the time of the pulse PA.
- the drive device 31 calculates the average value of the pulse PB, which is the maximum value of the obtained rising pulse number, and the pulse PE, which is the minimum value of the rising pulse number.
- the drive device 31 has a pulse PD, which is the maximum number of rising pulses among the number of rising pulses smaller than the average value of the number of rising pulses, and a pulse PD, which is the smallest rising pulse number among the number of rising pulses larger than the average value of the number of rising pulses.
- the difference from the pulse PC which is the number of pulses, is calculated.
- the drive device 31 determines whether the calculated difference in the number of rising pulses is equal to the number of pulses of the AB phase signal generated in each of the first interval Ga1 to the sixth interval Gf1 of the Z phase signal stored in advance. do.
- the drive device 31 identifies the section of the rotating body 9 in which the engagement pin 10 is located at the regulated position from the interval at which it is determined that the AB phase signals having the same number of pulses are generated.
- the brake mechanism 8 of the absolute encoder 1 configured as described above includes a rotating body 9 having at least two engaging protrusions 9a.
- the rotation range of the rotation shaft 27a of the motor 27 when the power is off is limited by the brake mechanism 8 to an angle range of less than 180 degrees at the maximum.
- the absolute encoder 1 includes an AB phase signal and a Z phase signal for specifying the rotation angle within a range of less than 180 degrees even if the rotation shaft 27a of the motor 27 rotates when the power of the absolute encoder 1 is turned off. Is output to the drive device 31.
- the rotation range of the rotation shaft 27a of the motor 27 is less than 180 degrees. Therefore, the drive device 31 can uniquely calculate the rotation angle and the number of rotations of the rotation shaft 27a of the motor 27 from the determined origin.
- the rotation range of the rotating shaft 27a of the motor 27 is limited by the rotating body 9 having six engaging protrusions 9a, two adjacent engaging protrusions 9a are engaged due to wear of the engaging protrusions 9a or the like. Even when the joint protrusion 9a does not come into contact with the engaging pin 10, the rotation range of the rotation shaft 27a of the motor 27 is limited to a rotation angle of less than 180 degrees. This makes it possible to configure a multi-turn absolute encoder capable of calculating the rotation angle and the number of rotations of the rotation shaft 27a of the motor 27 with a simple structure.
- the conventional Gray code encoder or magnetic encoder functions as an absolute encoder even in a stationary state immediately after the power is turned on, and can detect the mechanical angle of the member to be detected by the motor 27.
- the gray code encoder and the magnetic encoder require a large amount of calculation for specifying the mechanical angle, a dedicated IC is required.
- the ABZ type encoder that uses the M-sequence as the Z-phase signal does not function as an absolute encoder in the stationary state immediately after the power is turned on, but it becomes an absolute encoder by rotating within the limited range limited by the brake mechanism or the like. can do. That is, the ABZ type encoder adopting the M sequence can detect the mechanical angle of the member to be detected.
- the absolute encoder 1 of the present embodiment at least one set of Z-phase signal rising detection unit 3a and Z-phase signal falling cover having different circumferential intervals within the respective regulation ranges of each section of the rotating body 9.
- the detection unit 3b is located.
- the absolute encoder 1 calculates the number of pulses of the AB phase signal generated by the AB phase signal detected unit 2 from the rising edge to the falling edge of the signal waveform of the Z phase signal in each section of the rotating body 9. Identify the mechanical angle inside. Therefore, the calculation load is smaller than that of the conventional absolute encoder, and a dedicated IC is not required.
- first and second intervals GAb and the second which are the intervals in the circumferential direction between the Z-phase signal falling detected portion 3b and the Z-phase signal rising detected portion 3a located in both the circumferential directions of the engaging protrusions 9a.
- the -3 interval Gbc, the 3-4 interval Gcd, the 4-5 interval Gde, the 5-6 interval Gef and the 6-1 interval Gfa may include intervals in the same angular range.
- the processing for acquiring the rotation angle within the mechanical angle of 360 degrees can be leveled, and the peak load of the processing of the drive device for specifying the rotation angle of the rotation shaft 27a of the motor 27 can be reduced.
- a computer for executing real-time control is required to have performance that does not lose real-time performance even during peak loads. Therefore, the required performance of the computer can be simplified by reducing the peak load.
- the rotation range of the motor 27 is limited to any one of the first section S1 to the sixth section S6 by the brake mechanism 8.
- the drive device 31 reciprocates the motor 27 a plurality of times clockwise and counterclockwise within the regulation range of any section.
- the drive device 31 is generated between the rising edge and the falling edge of the signal waveform of the Z phase signal by passing the AB phase signal detected unit 2 and the Z phase signal detected unit 3 a plurality of times within the regulation range by the section.
- the number of pulses of the AB phase signal obtained can be reliably acquired.
- the AB phase signal and the Z phase signal that can calculate the rotation angle of the rotation shaft 27a of the motor 27 are generated by a simple structure. be able to. Further, the processing load of the drive device 31 can be reduced to improve the degree of freedom in designing the hardware resources of the drive device 31.
- the plurality of AB phase signal detected units 2, the plurality of Z phase signal rising detected units 3a, and the plurality of Z phase signal falling detected units 3b are a rotating plate 7 or a rotating body that rotates integrally with the rotating body 9. It is provided in 9. Therefore, the AB phase signal detected unit 2 and the Z phase signal detected unit 3 are integrally provided on the rotating shaft 27a of the motor 27 or the rotating body 9 of the brake mechanism 8 in a state where the phases are fixed to each other. As a result, even if the rotatable range of the rotating shaft 27a of the motor 27 is limited by the brake mechanism 8, the AB phase signal and the Z phase signal that can calculate the rotation angle of the rotating shaft 27a of the motor 27 with a simple structure can be obtained. Can be generated.
- the drive device 31 identifies the section in which the engagement pin 10 is located at the regulation position from the number of pulses of the acquired AB phase signal. As a result, the position detection accuracy of the rotating body 9 is improved even immediately after the motor 27 does not output sufficient torque. Therefore, the processing load of the drive device 31 can be reduced and the degree of freedom in designing the hardware resources of the drive device 31 can be improved.
- FIG. 10 is a schematic view of the articulated robot arm device 11 according to the embodiment of the present invention.
- FIG. 11 is a schematic view of an S-axis rotary joint 14 according to an articulated robot arm 12 according to an embodiment of the present invention.
- FIG. 12 is a control block diagram of the articulated robot arm device 11 according to the second embodiment of the present invention.
- the articulated robot arm device 11 includes an articulated robot arm 12 and an articulated robot arm control device 32.
- the articulated robot arm 12 is a robot arm of a serial link mechanism in which links are connected in series from the base end to the tip end by a rotary joint having one degree of freedom.
- the articulated robot arm 12 is, for example, a 6-axis vertical articulated robot arm.
- the articulated robot arm 12 is provided, for example, on a base of a manufacturing device or a remote-controlled vehicle that can be remotely controlled.
- the S-axis rotary joint 14, the L-axis rotary joint 16, the U-axis rotary joint 18, the R-axis rotary joint 20, the B-axis rotary joint 22, and the T-axis rotary joint 24 are arranged in this order from the proximal end. They are connected in series by a housing and a link, respectively. Each shaft is rotatably configured by a motor unit M.
- the S-axis rotary joint 14, the L-axis rotary joint 16, the U-axis rotary joint 18, the R-axis rotary joint 20, the B-axis rotary joint 22, and the T-axis rotary joint 24 each have a motor unit M.
- the motor unit M includes a speed reducer 25 and an actuator 26.
- the articulated robot arm 12 is controlled by the articulated robot arm control device 32.
- the articulated robot arm 12 acquires a control signal output from the articulated robot arm control device 32 by a drive device 31 included in the actuator 26 of each axis. Further, the articulated robot arm 12 transmits information regarding the output of the motor 27 of the motor unit M of each axis and information output from the absolute encoder 1 to the articulated robot arm control device 32.
- the S-axis rotary joint 14 is a rotary joint that rotates the entire articulated robot arm 12.
- the S-axis rotary joint 14 is provided in the housing 15 for the SL axis of the articulated robot arm 12.
- a base member 13 is fixed to the output shaft of the S-axis rotary joint 14.
- the base member 13 is fixed to the installation surface of the articulated robot arm 12.
- the S-axis rotary joint 14 is arranged so that the axis of the S-axis rotary joint 14 extends in a direction perpendicular to the installation surface of the articulated robot arm 12.
- the L-axis rotary joint 16 is a rotary joint that swings the lower bowl link 17.
- the L-axis rotary joint 16 is provided in the housing 15 for the SL axis.
- the L-axis rotary joint 16 is arranged so that the axis of the L-axis rotary joint 16 extends in a direction perpendicular to the axis of the S-axis rotary joint 14.
- One end of the lower bowl link 17 is fixed to the output shaft of the L-axis rotary joint 16.
- the U-axis rotary joint 18 is a rotary joint that swings the upper arm link 21.
- the U-axis rotary joint 18 is provided in the housing 19 for the UR axis of the articulated robot arm 12.
- the output shaft of the U-axis rotary joint 18 is fixed to the other end of the lower bowl link 17.
- the U-axis rotary joint 18 is arranged so that the axis of the U-axis rotary joint 18 extends in a direction parallel to the axis of the L-axis rotary joint 16.
- the R-axis rotary joint 20 is a rotary joint that rotates the upper arm link 21.
- the R-axis rotary joint 20 is provided in the housing 19 for the UR axis.
- the R-axis rotary joint 20 is arranged so that the axis of the R-axis rotary joint 20 extends in a direction perpendicular to the axis of the U-axis rotary joint 18.
- One end of the upper arm link 21 is fixed to the output shaft of the R-axis rotary joint 20.
- the B-axis rotary joint 22 is a rotary joint that swings the T-axis rotary joint 24.
- the B-axis rotary joint 22 is provided in the housing 23 for the BT axis of the articulated robot arm 12.
- the output shaft of the B-axis rotary joint 22 is fixed to the other end of the upper arm link 21.
- the B-axis rotary joint 22 is arranged so that the axis of the B-axis rotary joint 22 extends in a direction perpendicular to the axis of the R-axis rotary joint 20.
- the T-axis rotary joint 24 is a rotary joint that rotates an end effector (not shown).
- the T-axis rotary joint 24 is provided in the housing 23 for the BT axis.
- the T-axis rotary joint 24 is arranged so that the axis of the T-axis rotary joint 24 extends in a direction perpendicular to the axis of the B-axis rotary joint 22.
- the output shaft of the T-axis rotary joint 24 has an end effector mounting portion.
- the articulated robot arm 12 configured in this way has three degrees of freedom of translation in the X-axis, Y-axis, and Z-axis directions and three degrees of freedom of rotation around the X-axis, Y-axis, and Z-axis by the motor unit M of each axis. It has a total of 6 degrees of freedom. Therefore, the articulated robot arm 12 can move the output axis of the T-axis to an arbitrary position and can be in an arbitrary posture in the movable space of the articulated robot arm 12.
- the S-axis, L-axis, U-axis, R-axis, B-axis, and T-axis motor units M each have output axes according to control signals from the articulated robot arm control device 32. It is a drive device that rotates.
- the motor unit M for each shaft includes a speed reducer 25 and an actuator 26. That is, in the motor unit M, the drive device 31, which is a computer that controls the absolute encoder 1 including the speed reducer 25, the motor 27, the brake mechanism 8, and the motor 27, is the housing 15 and the housing 19 of the articulated robot arm 12 (FIG. 2), and are arranged inside the housing 23 (see FIG. 2). Since the motor unit M of each axis has the same configuration, the S-axis rotary joint 14 will be described below.
- the speed reducer 25 of the S-axis rotary joint 14 rotates the output shaft in a state of being decelerated with respect to the rotation speed of the input shaft, and outputs the output torque of the output shaft in inverse proportion to the deceleration. It is a device that generates torque.
- the speed reducer 25 is provided in the housing 15 of the articulated robot arm 12.
- the housing of the speed reducer 25 is fixed inside the housing 15 of the articulated robot arm 12.
- the output shaft of the speed reducer 25 is fixed to the base member 13.
- the actuator 26 of the S-axis rotary joint 14 includes a speed reducer 25, a motor 27, an absolute encoder 1, and a drive device 31.
- the S-axis rotary joint 14 is provided in the housing 15 of the articulated robot arm 12. That is, in the housing 15 of the articulated robot arm 12, the absolute encoder 1 including the speed reducer 25, the motor 27, and the brake mechanism 8 and the drive device 31 are arranged.
- the motor 27 included in the actuator 26 is a power source.
- the motor 27 is a so-called inner rotor type motor 27 in which a rotor is rotatably arranged in a tubular stator.
- a rotating shaft 27a extending along the axis is fixed to the rotor in a state of penetrating in the axial direction.
- the motor 27 is fixed to one end where power is input in the case of the speed reducer 25.
- One end of the rotating shaft 27a is connected to the input shaft of the speed reducer 25 as an output shaft of the motor 27.
- the absolute encoder 1 included in the actuator 26 detects a rotation angle of the rotation shaft 27a of the motor 27 within a mechanical angle of 360 degrees.
- the absolute encoder 1 uses a drive device 31 and an articulated robot arm control device 32 (FIG. 3) to transmit an AB phase signal for detecting a rotation angle within 360 degrees of the machine angle and a Z phase signal for detecting the origin of the machine angle. 10) and.
- the absolute encoder 1 is provided at the other end of the rotating shaft 27a of the motor 27. That is, the absolute encoder 1 including the brake mechanism 8 is provided on the rotating shaft 27a of the motor 27.
- the brake mechanism 8 included in the absolute encoder 1 regulates the rotation of the rotating shaft 27a in the motor 27.
- the brake mechanism 8 is provided at the other end of the rotating shaft 27a.
- the brake mechanism 8 limits the rotation of the rotating shaft 27a of the motor 27 by mechanical engagement.
- the brake mechanism 8 may be provided at one end of the rotating shaft 27a.
- the drive device 31 included in the actuator 26 controls the drive current supplied to the motor 27.
- the drive device 31 is, for example, a computer.
- the drive device 31 is provided in the housing 15 of the articulated robot arm 12.
- the drive device 31 supplies the motor 27 with a current corresponding to the control signal from the articulated robot arm control device 32. Further, the drive device 31 acquires the AB phase signal and the Z phase signal of the absolute encoder 1 as feedback pulses.
- the drive device 31 controls the motor 27 by feedback control that supplies a current corresponding to the difference between the feedback pulses to the command pulses to the motor 27 (see FIG. 12).
- the S-axis rotary joint 14 configured in this way is integrally composed of the speed reducer 25, the motor 27 included in the actuator 26, and the absolute encoder 1. Further, the motor unit M is configured as a mechatronic integrated structure in which the speed reducer 25, the actuator 26, and the drive device 31 are arranged in the housing 15 of the articulated robot arm 12. In the S-axis rotary joint 14, the output shaft of the speed reducer 25 is rotated by the rotation of the motor 27, so that the housing 15 of the articulated robot arm 12 and the actuator 26 are integrally rotated.
- the articulated robot arm control device 32 is a device that controls the articulated robot arm 12.
- the articulated robot arm control device 32 may actually have a configuration in which a CPU, ROM, RAM, HDD, etc. are connected by a bus, or may have a configuration including a one-chip LSI or the like.
- the articulated robot arm control device 32 stores various programs and data for controlling the operation of the articulated robot arm 12.
- the articulated robot arm control device 32 is a drive device 31 included in the S-axis rotary joint 14, the L-axis rotary joint 16, the U-axis rotary joint 18, the R-axis rotary joint 20, the B-axis rotary joint 22, and the T-axis rotary joint 24. Are connected to each.
- the articulated robot arm control device 32 can transmit a control signal to the drive device 31 of each axis. Further, the articulated robot arm control device 32 can acquire the rotation position information of the motor 27 from the motor unit M of each axis.
- the drive device 31 to which the above-mentioned absolute encoder 1 is connected stores the number of pulses of the AB phase signal generated from the falling edge to the rising edge of the signal waveform in the adjacent Z phase signals. Therefore, the drive device 31 counts the number of pulses and the phase of the AB phase signal generated from the falling edge to the rising edge of the signal waveform of the Z phase signal, so that the rotation angle of the rotation shaft 27a is within 360 degrees. Can be identified. As a result, the drive device 31 can simplify and improve the accuracy of the process of acquiring the rotation angle of the rotation shaft 27a of the motor 27 without adding an IC dedicated to the encoder. Therefore, even if the rotatable range of the motor is limited by the brake mechanism 8, it is possible to generate an AB phase signal and a Z phase signal capable of calculating the rotation angle of the rotation shaft 27a of the motor 27 with a simple structure.
- FIG. 13 is a schematic diagram showing the signal waveform of the AB phase signal and the signal waveform of the Z phase signal according to the third embodiment of the present invention.
- two Z-phase signal detected units 3 are positioned in the angle range of each section of the rotating body 9.
- the two Z-phase signal detected units 3 are adjacent to each other in the circumferential direction.
- the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b of each Z-phase signal detected unit 3 are adjacent to each other in the circumferential direction.
- the interval G1 and the interval G2 which are the circumferential intervals between the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b of each Z-phase signal detected unit 3 in each section. are all at the same interval. Further, in each section, the distance between the Z-phase signal rising detected unit 3a of one Z-phase signal detected unit 3 and the Z-phase signal rising detected unit 3a of the other Z-phase signal detected unit 3 in the circumferential direction.
- the intervals G3 are all different intervals. Further, in each section, the distance between the Z-phase signal falling detected unit 3b of one Z-phase signal detected unit 3 and the Z-phase signal falling detected unit 3b of the other Z-phase signal detected unit 3 in the circumferential direction.
- the intervals G4 are all different intervals. Further, in each section, the Z-phase signal rising detection unit 3a of one Z-phase signal detected unit 3 and the Z-phase signal falling detection unit 3b of the other Z-phase signal detected unit 3 are spaced apart from each other in the circumferential direction.
- the intervals G5 are all different intervals. Further, in each section, the Z-phase signal falling detection unit 3b of one Z-phase signal detection unit 3 and the Z-phase signal rising detection unit 3a of the other Z-phase signal detection unit 3 are in the circumferential direction.
- the intervals G6, which are intervals, are all different intervals.
- the AB phase signal detected unit 2 is located between the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b that are adjacent to each other in the circumferential direction. Be placed. Further, the absolute encoder 1A generates a Z-phase signal having a pulse number (for example, 12 pulses) smaller than the number of pulses (for example, 360 pulses) of the AB phase signal generated at a rotation of a mechanical angle of 360 degrees. Therefore, the interval G1, the interval G2, the interval G3, the interval G4, the interval G5, and the interval G6 can be expressed by the number of pulses of the AB phase signal.
- the absolute encoder 1A generates an AB phase signal with the same number of pulses in all the angular ranges defined by the intervals G1 and G2 in each section.
- the absolute encoder 1A also produces AB phase signals with different pulse numbers over the entire angular range defined by the spacing G3 in each section.
- the absolute encoder 1A produces AB phase signals with different pulse numbers over the entire angular range defined by the spacing G4 in each section.
- the absolute encoder 1A produces AB phase signals with different pulse numbers over the entire angular range defined by the spacing G5 in each section.
- the absolute encoder 1A produces AB phase signals with different pulse numbers over the entire angular range defined by the spacing G6 in each section.
- the Z-phase signal detected unit 3 satisfies at least one of the following conditions in each of the regulation ranges of each section.
- the Z-phase signal rising detected unit 3a and the Z-phase signal rising detected unit 3a of each section are predetermined with reference to the median number of pulses of the AB phase signal generated in the angle range of the interval G3 of each section. It is located within the limits of each section so that it fits within the interval of. Specifically, the Z-phase signal rising detected unit 3a and the Z-phase signal rising detected unit 3a of each section are the median values of the number of pulses of the AB phase signal generated in the angle range of the interval G3 of each section. It is located so that the difference between the minimum value and the minimum value and the difference between the median value and the maximum value are smaller than half of the median value.
- the Z-phase signal falling detected unit 3b and the Z-phase signal falling detected unit 3b of each section have the median number of pulses of the AB phase signal generated in the angle range of the interval G4 of each section. It is located within the limits of each section so that it fits within the reference interval. Specifically, the Z-phase signal falling detected unit 3b and the Z-phase signal falling detected unit 3b of each section are in the number of pulses of the AB phase signal generated in the angle range of the interval G4 of each section. It is located so that the difference between the median and the minimum value and the difference between the median value and the maximum value are smaller than half of the median value.
- the Z-phase signal rising detection unit 3a and the Z-phase signal falling detection unit 3b of each section are based on the median number of pulses of the AB phase signal generated in the angle range of the interval G5 of each section. It is located within the limits of each section so that it fits within the specified interval. Specifically, the Z-phase signal rising detection unit 3a and the Z-phase signal falling detection unit 3b of each section are at the center of the number of pulses of the AB phase signal generated in the angle range of the interval G5 of each section. It is located so that the difference between the value and the minimum value and the difference between the median value and the maximum value are smaller than half of the median value.
- the Z-phase signal falling detected unit 3b and the Z-phase signal rising detected unit 3a of each section are based on the median number of pulses of the AB phase signal generated in the angle range of the interval G6 of each section. It is located within the limits of each section so that it fits within the specified interval. Specifically, the Z-phase signal falling detected unit 3b and the Z-phase signal rising detected unit 3a of each section are at the center of the number of pulses of the AB phase signal generated in the angle range of the interval G6 of each section. It is located so that the difference between the value and the minimum value and the difference between the median value and the maximum value are smaller than half of the median value.
- the absolute encoder 1A generates 24 pulses of the AB phase signal in the angle range of the interval G3 in the first section S1.
- the absolute encoder 1A generates 29 pulses of the AB phase signal in the angular range of the interval G3 in the second section S2.
- the absolute encoder 1A generates 28 pulses of the AB phase signal in the angular range of the interval G3 in the second section S2.
- the absolute encoder 1A generates 27 pulses of the AB phase signal in the angular range of the interval G3 in the fourth section S4.
- 26 pulses of AB phase signal are generated in the angular range of the interval G3 in the fifth section S5.
- the absolute encoder 1A generates 25 pulses of the AB phase signal in the angular range of the interval G3 in the sixth section S6.
- the median number of pulses of the AB phase signal generated in the angle range of the interval G3 of each section described above is 26.5 pulses. Further, the minimum number of pulses of the AB phase signal generated in the angle range of the interval G3 of each section is 24 pulses. The maximum number of pulses of the AB phase signal generated in the angle range of the interval G3 of each section is 29 pulses.
- the difference between the median 26.5 pulses and the minimum 24 pulses of the number of pulses of the AB phase signal generated in the angle range of the interval G3 is 2.5 pulses. It is configured in. Further, in the Z-phase signal detected unit 3 of each section, the difference between the median 26.5 pulses and the maximum value of the number of pulses of the AB phase signal generated in the angle range of the interval G3 is 2.5 pulses. It is configured in. Therefore, the Z-phase signal detected portion 3 of each section is configured so that the difference between the median value and the minimum value and the difference between the median value and the maximum value are smaller than 13.25 pulses, which is half of the median value. ing.
- the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b are included in the entire restricted range of the rotating body 9 limited by the adjacent engaging projections 9a. At least one of the intervals G3, the interval G4, the interval G5, and the interval G6 defined by the combination is different in the variation within a predetermined range. That is, in a state where the intervals G3, the intervals G4, the intervals G5, and the intervals G6, which are a combination of the intervals in the circumferential direction between the adjacent Z-phase signal rising detected parts 3a and the Z-phase signal rising detected parts 3a, are close to equal intervals.
- the Z-phase signal rising detected unit 3a and the Z-phase signal rising detected unit 3a are located so that all the intervals are different.
- the Z-phase signal detected unit 3 of the absolute encoder 1A may be configured to further satisfy the following conditions in each of the regulation ranges of each section.
- the Z-phase signal rising detected unit 3a and the Z-phase signal rising detected unit 3a of each section are the maximum value and the minimum value of the number of pulses of the AB phase signal generated in the angle range of the interval G3 of each section.
- the difference is located so that it is less than half the median in the number of pulses of the AB phase signal generated, respectively, in the angular range of the interval G3 of each section.
- the Z-phase signal falling detected portion 3b and the Z-phase signal falling detected portion 3b of each section are the maximum value and the minimum value in the number of pulses of the AB phase signal generated in the angle range of the interval G4 of each section, respectively.
- the difference from is smaller than half of the median number of pulses of the AB phase signal generated in the angular range of the interval G4 of each section.
- the Z-phase signal rising detected unit 3a and the Z-phase signal rising detected unit 3a of each section are the maximum value and the minimum value of the number of pulses of the AB phase signal generated in the angle range of the interval G5 of each section.
- the difference is located so that it is less than half the median in the number of pulses of the AB phase signal generated, respectively, in the angular range of the interval G5 of each section.
- the Z-phase signal falling detected unit 3b and the Z-phase signal falling detected unit 3b of each section are the maximum value and the minimum value in the number of pulses of the AB phase signal generated in the angle range of the interval G6 of each section, respectively.
- the difference from is located so as to be less than half of the median in the number of pulses of the AB phase signal generated in the angular range of the interval G6 of each section.
- the Z-phase signal detected unit 3 in each section has a median value of 5 pulses, which is the difference between the maximum value of 29 pulses and the minimum value of 24 pulses of the number of pulses of the AB phase signal generated in the angle range of the interval G3. It is generated to be smaller than 13.25 pulses, which is half of .5 pulses.
- the absolute encoder 1A is at least one of the interval G1, the interval G2, the interval G3, the interval G4, the interval G5 and the interval G6 defined by the two Z-phase signal detection units 3 located in each section.
- the intervals are arranged differently in each section. Further, the number of pulses of the AB phase signal generated in the angle range of at least one interval among the intervals defined by the two Z-phase signal detected units 3 in each section is different for each section. Therefore, the absolute encoder 1A of the third embodiment has the same effect as that of the absolute encoder 1 of the first embodiment.
- the absolute encoder 1A has an angle of the interval G3, the interval G4, the interval G5 and the interval G6 which are a combination of the intervals in the circumferential direction between the Z-phase signal rising detected unit 3a and the Z-phase signal rising detected unit 3a in each section.
- the variation in the number of pulses of the AB phase signal generated in the range is configured to be within a certain range based on the median number of pulses of the AB phase signal generated in the angular range of the gap of each section. There is. That is, the absolute encoder 1A is generated so that the intervals between adjacent Z-phase signals are close to equal intervals and all the intervals are different.
- the AB phase signal and the Z phase signal that can calculate the rotation angle of the rotation shaft 27a of the motor 27 are generated by a simple structure. can do.
- the absolute encoder 1A can generate a Z-phase signal at a time interval of a predetermined time or more with reference to the median number of pulses of the AB phase signal at a constant rotation speed. As a result, the processing load of the drive device 31 can be reduced and the degree of freedom in designing the hardware resources of the drive device 31 can be improved.
- the drive device 31 can suppress the calculation load by generating an interrupt process at one of the rising and falling edges of the Z-phase signal.
- FIG. 14 is a flowchart showing a control mode of error correction by the absolute encoder 1B according to another embodiment of the present invention.
- the absolute encoders 1 and 1A may have a correction unit 33 which is an error correction unit for correcting an error of the AB phase signal.
- the correction unit 33 of the absolute encoder 1B corrects the rotation angle of the rotation shaft 27a within 360 degrees when a part of the AB phase signal cannot be generated.
- the correction unit 33 is provided in the absolute encoder 1B.
- the correction unit 33 is a combination of the Z-phase signal rising detected unit 3a and the Z-phase signal rising detected unit 3a in each section in the circumferential direction, which is a combination of the intervals G1, the intervals G2, the intervals G3, the intervals G4, and the intervals G5.
- the number of each pulse of the AB phase signal generated in the angle range of the interval G6 is stored (see FIG. 8).
- the correction unit 33 acquires the AB phase signal and the Z phase signal from the AB phase signal detection unit 4 and the Z phase signal detection unit 5 (step S110). Further, the correction unit 33 starts counting up (integrating) the number of pulses of the AB phase signal (step S120).
- step S130 When the correction unit 33 acquires the next Z-phase signal (step S130), the correction unit 33 in the Z-phase signal acquired in the step of this time (step S130) from the rise of the signal waveform in the Z-phase signal acquired immediately before (step S110).
- step S140 The number of pulses Pb1 of the AB phase signal acquired before the rise of the signal waveform is calculated (step S140).
- the correction unit 33 is the signal waveform in the Z-phase signal acquired in the step of this time (step S130) from the rise of the signal waveform estimated based on the pulse number Pa1 of the AB phase signal calculated immediately before that (before step S110).
- the number of pulses Pb2 acquired by the rising edge of is calculated (step S150).
- the calculated number of pulses Pb2 of the AB phase signal coincides with the number of pulses Pb2 estimated from the number of pulses Pa1 generated between the rising edge and the rising edge of the signal waveform in the Z phase signal immediately before that. Whether or not it is determined (step S160).
- the correction unit 33 causes an error in the portion corresponding to the interval Gdb in the AB phase chord wheel 4c. It is determined that this is not the case, and no correction is made (step S170).
- the correction unit 33 determines that an error has occurred in the corresponding AB phase signal detected unit 2. (Step S171). The correction unit 33 makes a correction to change the calculated pulse number Pb1 to the estimated pulse number Pb2.
- the absolute encoder 1B is provided with the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b in different angle ranges, so that the adjacent Z-phase signal rising detected unit 3a is provided.
- the relationship between the number of pulses of the AB phase signal generated in the angular range between the Z-phase signal falling edge and the detected portion 3b in the circumferential direction is predetermined. Therefore, the absolute encoder 1B causes an error that a part of the AB phase signal cannot be generated in the angular range in the circumferential distance between the specific Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b.
- FIG. 15 is a flowchart showing a control mode of abnormality detection of the absolute encoders 1, 1A and 1B by the actuator 26 according to another embodiment of the present invention.
- the abnormality detection unit 30 of the actuator 26 is provided in the drive device 31 of the motor 27 which is a part of the actuator 26.
- the abnormality detection unit 30 has a magnetic flux observer.
- the magnetic flux observer is a mathematical model that calculates the state of the internal magnetic flux of the motor 27 from the voltage and current applied to the motor 27, and estimates the speed or electric angle of the rotating shaft 27a (rotor) in the motor 27. ..
- the abnormality detection unit 30 can acquire an AB phase signal and a Z phase signal from the absolute encoders 1, 1A, and 1B.
- the abnormality detection unit 30 acquires the AB phase signal and the Z phase signal from the absolute encoders 1, 1A and 1B (step S210).
- the abnormality detection unit 30 calculates the electric angle ⁇ x of the rotating shaft 27a based on the acquired AB phase signal and Z phase signal (step S220).
- the abnormality detection unit 30 estimates the electric angle ⁇ y of the rotating shaft 27a with the magnetic flux observer (step S230).
- the abnormality detection unit 30 compares the electric angle ⁇ x calculated from the AB phase signals and the Z phase signals of the absolute encoders 1, 1A and 1B with the electric angle ⁇ y estimated by the magnetic flux observer. When the difference (
- the abnormality detection unit 30 detects the AB phase signal due to deformation such as plastic deformation of the rotating body 9. It is determined that distortion occurs in the unit 2 and the Z-phase signal detected unit 3, and an abnormality occurs in the generation of the AB-phase signal and the Z-phase signal (step S251).
- the drive device 31 can quickly detect abnormalities in the absolute encoders 1, 1A, and 1B, so that the peak load can be reduced and the degree of freedom in designing the hardware resources of the drive device 31 can be improved. ..
- the abnormality detection unit 30 may be provided in the AB phase signal detection unit 4 and the Z phase signal detection unit 5 of the absolute encoders 1, 1A and 1B.
- FIG. 16 is a schematic diagram showing a signal waveform of an AB phase signal and a signal waveform of a Z phase signal according to another embodiment of the present invention.
- two Z-phase signal detected units 3 are positioned in the angle range of each section of the rotating body 9.
- the two Z-phase signal detected units 3 are adjacent to each other in the circumferential direction.
- the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b of each Z-phase signal detected unit 3 are adjacent to each other in the circumferential direction.
- the absolute encoder 1C has different intervals G1 and G2 between the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b that are adjacent to each other in the circumferential direction. Therefore, the absolute encoder 1C has different pulse numbers in all of the angle ranges defined by the mechanical angle of the Z-phase signal rising detected unit 3a and the mechanical angle of the Z-phase signal falling detected unit 3b adjacent to each other in the circumferential direction.
- the absolute encoder 1C covers the entire angle range defined by the mechanical angle of the Z-phase signal fall-detected portion 3b adjacent to each other in the circumferential direction and the mechanical angle of the Z-phase signal fall-detected portion 3b in each section. Generates AB phase signals with different pulse numbers. Similarly, the absolute encoder 1C covers all of the angle ranges defined by the mechanical angles of the Z-phase signal rising detected parts 3a adjacent to each other in the circumferential direction and the mechanical angles of the Z-phase signal rising detected parts 3a in each section. Generate AB phase signals with different pulse numbers.
- the drive device 31 sets the signal in one Z-phase signal. Interrupt processing can be generated at both the rising and falling edges of the waveform. As a result, the drive device 31 can increase the chance of detecting the rotation angle during one rotation of the rotation shaft 27a. On the other hand, the drive device 31 can suppress the calculation load by generating an interrupt process at either the rising edge or the falling edge of the signal waveform in one Z-phase signal.
- the articulated robot arm 12 which is a 6-axis vertical articulated robot arm, is, for example, an S-axis rotary joint 14, an L-axis rotary joint 16, a U-axis rotary joint 18, and an R-axis.
- the rotary joint 20, the B-axis rotary joint 22, and the T-axis rotary joint 24 are each connected in series by a link, but the present invention is not limited to this.
- the connection order of the motor units M of each axis, the axial direction at the time of connection, and the like may be a configuration other than the above-described second embodiment as long as the structure is established as an articulated robot arm.
- the motor unit M is used as a rotary joint of each axis of the articulated robot arm 12.
- the configuration of the motor unit M is not limited to the configuration of the above-described embodiment.
- the motor unit may be applied to a device that requires position control, such as an XY table or a vertical transfer device. Further, the motor unit may have only an actuator.
- the absolute encoder 1 including the motor 27 and the brake mechanism 8 and the drive device 31 are housed in the housing 15, the housing 19, and the housing 23 of the articulated robot arm 12, respectively. It is configured as an integrated mechanical and electrical structure.
- the configuration of the actuator is not limited to the configuration of the above-described embodiment.
- the drive device may be arranged outside the housing of the articulated robot arm.
- the absolute encoders 1, 1A, 1B, and 1C are reflection type optical absolute encoders.
- the configuration of the absolute encoder is not limited to the configuration of the above-described embodiment.
- the absolute encoder may be a transmissive optical absolute encoder, a magnetic absolute encoder, an electromagnetic induction type absolute encoder, or the like.
- the absolute encoders 1, 1A, 1B, and 1C generate 360 pulses of the AB phase signal for every 360 degrees of the mechanical angle.
- the configuration of the absolute encoder is not limited to the configuration of the above-described embodiment.
- the absolute encoder may be configured to generate the number of pulses required to ensure the required rotational accuracy.
- the absolute encoders 1, 1A, 1B, and 1C generate 12 pulses of Z-phase signal for every 360 degrees of mechanical angle.
- the configuration of the absolute encoder is not limited to the configuration of the above-described embodiment.
- the absolute encoder may have two or more Z-phase signals and less than the number of pulses of the AB-phase signal per 360 degrees of mechanical angle.
- the absolute encoders 1, 1A, 1B, and 1C are the mechanical angles of the Z-phase signal rising detected unit 3a and the Z-phase signal falling detected unit 3b adjacent to each other in all circumferential directions.
- the Z-phase signal rising detection unit 3a and the Z-phase signal falling detection unit 3b are arranged so that there is an angle range in which the number of pulses of the AB phase signal is the same in the angle range defined by the combination with the mechanical angle. You may. For example, when the interval of 12 is composed of 6 kinds of pulse numbers, the computer acquires three Z-phase signals and compares the pulse numbers of the AB-phase signals to detect the rotation angle of the rotation axis in the motor. Can be done.
- the rotating plate 7 is provided on the rotating body 9 of the brake mechanism 8.
- the rotating plate 7 is not limited to the configuration of the above-described embodiment.
- the rotating plate 7 may be directly fixed to the rotating shaft of the motor.
- the rotating body 9 of the brake mechanism 8 has six engaging protrusions 9a at equal intervals in the circumferential direction.
- the rotating body 9 of the brake mechanism 8 is not limited to the configuration of the above-described embodiment.
- the rotating body of the brake mechanism may have a plurality of engaging protrusions at equal intervals in the circumferential direction.
- the rotating body may have a plurality of engaging protrusions at unequal intervals in the circumferential direction.
- the embodiment of the present invention has been described above, the above-described embodiment is merely an example for carrying out the present invention. Therefore, the embodiment is not limited to the above-described embodiment, and the above-described embodiment can be appropriately modified and implemented within a range that does not deviate from the gist thereof.
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Transmission And Conversion Of Sensor Element Output (AREA)
Abstract
前記ブレーキ機構によって前記計測対象部材の回転可能な範囲が制限されていても、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成するアブソリュートエンコーダを提供する。ブレーキ機構8を有するアブソリュートエンコーダ1であって、複数のZ相信号被検出部3は、周方向に隣り合うZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの間にAB相信号被検出部2が位置するように配置されるとともに、複数の規制範囲である各セッションのそれぞれに、Z相信号立ち上がり被検出部3a及びZ相信号立ち下がり被検出部3bを少なくとも一組含むとともに、周方向に隣り合うZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの周方向の間隔が複数の規制範囲においてそれぞれ異なるように配置されている。
Description
本発明は、アブソリュートエンコーダに関する。
インクリメンタル信号を出力する光学式のA相信号とB相信号の合成信号を出力するAB相信号センサ及びアブソリュート信号を出力する磁気式のZ相信号センサの信号を処理することによって、例えばモータ等の回転軸の絶対回転角(機械角360度)を取得するエンコーダと、ブレーキ機構とを備えたモータシステムが提案されている。特許文献1に開示されているモータシステムは、前記モータの回転角を検出するための前記AB相信号センサの被検出部材である信号検出パターンと、1回転以内の回転角の絶対位置を検出するためのZ相信号センサの被検出部材である信号検出用の複数の永久磁石及び複数のホールセンサとを有する。
前記AB相信号センサの信号検出パターンは、前記モータの回転軸に固定されたディスク上に設けられている。前記Z相信号センサの信号検出用の前記複数の永久磁石は、周方向長さが等しく、且つ、前記歯車型ブレーキホイールの周方向に並んで設けられている。さらに、前記Z相信号センサの信号検出用の前記複数のホールセンサは、前記永久磁石上に固定されている。前記Z相信号センサは、複数の磁気センサを有する。前記Z相信号センサでは、前記モータの回転軸が1回転する間の回転角は、前記永久磁石と前記ホールセンサとによって24の区間に分割されている。前記エンコーダは、同一回転方向における前記24の区間のうち1つの区間内のAB相信号のパルスと位相をカウントすることによって、前記モータの回転角を決定することができる。
一般に、交流のブラシレスモータでは、電源投入後も回転角度を維持するために、前記ブラシレスモータの電気角に関する情報が必要である。上述のAB相信号センサ及びZ相信号センサを有するエンコーダ及びブレーキ機構を有するモータシステムは、電源の投入後にブレーキ機構によるロックが解除された際、前記モータの回転角度を保持するために前記モータの電気角に関する情報をコンピュータに出力することができる。前記モータシステムは、電源が投入された際に、前記エンコーダのZ相信号センサによって、前記永久磁石の磁極に関する情報と前記ホールセンサの信号を前記コンピュータに出力する。前記コンピュータは、前記モータの回転角を含む区間を算出する。前記コンピュータは、算出した前記区間から前記モータの粗い電気角を算出する。
このように、特許文献1に開示されるエンコーダのZ相信号センサは、ブレーキ機構によって回転範囲が規制されている前記モータの電気角を算出するために、前記複数の永久磁石、前記複数の磁気センサ、前記複数のホールセンサ及び前記AB相信号センサのICチップとは異なる専用のICチップを必要とする。そのため、Z相信号センサの構造が複雑になる。さらに、前記エンコーダは、光学式の前記AB相信号センサの信号パターンが設けられた前記ディスクと、磁気式の前記Z相信号センサの永久磁石及び複数のホールセンサが設けられる前記歯車型ブレーキホイールとを必要とする。そのため、前記エンコーダの構造が複雑になる。そこで、ブレーキ機構によって計測対象部材の回転範囲が制限されていても、簡素な構造によって計測対象部材の回転角度を算出可能な信号を出力するアブソリュートエンコーダが望まれている。
本発明は、ブレーキ機構によって計測対象部材の回転範囲が制限されていても、簡素な構造によって計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成することができるアブソリュートエンコーダを提供することを目的とする。
本発明者は、ブレーキ機構によって計測対象部材の回転範囲が制限されていても、簡素な構造によって計測対象部材の回転角度を算出可能な信号を出力するアブソリュートエンコーダの構成について検討した。鋭意検討の結果、本発明者は、以下のような構成に想到した。
本発明の一実施形態に係るアブソリュートエンコーダは、複数の係合突起部を有する回転体と前記複数の係合突起部のうち一つの係合突起部に係合する係合ピンとを有するブレーキ機構と、機械角360度以内に周方向に等間隔に配置され、AB相信号を生成する複数のAB相信号被検出部と、Z相信号の立ち上がりを生成するZ相信号立ち上がり被検出部及びZ相信号の立ち下がりを生成するZ相信号立ち下がり被検出部をそれぞれ有し、前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部とが周方向に交互に位置するように、機械角360度の範囲内に周方向に配置される複数のZ相信号被検出部と、前記AB相信号と前記Z相信号とをコンピュータに出力可能な出力部と、を有し、計測対象部材の機械角360度以内の回転角度の取得に用いられるアブソリュートエンコーダである。
前記AB相信号被検出部と前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部と前記回転体とは、一体に回転する。前記回転体の係合突起部は、前記回転体の回転範囲を、複数の規制範囲に分割するように設けられてる。前記複数のZ相信号被検出部は、周方向に隣り合う前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との間に前記AB相信号被検出部が位置するように配置されるとともに、前記複数の規制範囲のそれぞれに、前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部を少なくとも一組含むとともに、周方向に隣り合う前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との間隔、周方向に隣り合う前記Z相信号立ち上がり被検出部と前記Z相信号立ち上がり被検出部との間隔、及び、周方向に隣り合う前記Z相信号立ち下がり被検出部と前記Z相信号立ち下がり被検出部との間隔のうち少なくとも一つの間隔が前記複数の規制範囲においてそれぞれ異なるように配置されている。
上述の構成により、前記ブレーキ機構によって前記アブソリュートエンコーダの回転範囲が制限されている場合、前記アブソリュートエンコーダは、前記回転範囲内において計測対象部材であるモータ等によって回転することにより、AB相信号及びZ相信号を生成する。前記アブソリュートエンコーダは、前記回転の範囲内において生成したAB相信号とZ相信号とを前記コンピュータに出力する。
前記アブソリュートエンコーダは、前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との組み合わせによって定まる間隔が前記ブレーキ機構によって分割される複数の規制範囲のそれぞれで異なるように前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部とが配置されている。前記コンピュータは、予め記憶された前記複数の規制範囲毎の前記間隔から取得したZ相信号の前記間隔と前記間隔におけるAB相信号のパルス数とによって、前記規制範囲を特定するとともに、前記規制範囲内における機械角を特定する。これにより、前記ブレーキ機構によって計測対象部材の回転範囲が制限されていても、簡素な構造によって前記計測対象部材の機械角を算出可能なAB相信号及びZ相信号を生成することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記複数のZ相信号被検出部における前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部は、周方向に隣り合う前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部によって規定される周方向の角度範囲のうち前記係合突起部が位置する角度範囲における前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との周方向の間隔が、前記係合突起部が位置する他の角度範囲における間隔の少なくとも一つと同じになるように、配置されている。すなわち、前記複数のZ相信号被検出部における前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部は、周方向に隣り合う前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部の間に前記係合突起部が配置されるような角度範囲のうち、角度範囲の幅(前記Z相信号立ち上がり被検出部と前記Z相信号立ち上がり被検出部の間隔)が他の角度範囲の幅と等しくなるような角度範囲が1つ以上あるように、配置されている。
上述の構成により、前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との組み合わせによって規定される周方向の間隔が全て異なるように前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部を配置する必要がない。つまり、前記係合突起部の周方向両方に位置する前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との周方向の間隔は、他の前記係合突起部の周方向両方に位置する前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との周方向の間隔の少なくとも一つと同じになるように、配置してもよい。これにより、前記Z相信号被検出部によって生成される前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との組み合わせによって規定される周方向の間隔のばらつきを小さくできる。従って、機械角360度内の回転角度を取得する各処理の平準化が図られ、前記計測対象部材の回転角度を特定するコンピュータの処理のピーク負荷を低減することができる。一般にリアルタイム制御を実行するための前記コンピュータはピーク負荷時にもリアルタイム性を失わないような性能が要求される。よって、ピーク負荷を低減することでコンピュータの要求性能を簡素化できる。これにより、前記ブレーキ機構によって前記計測対象部材の回転範囲が制限されていても、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記回転体は、機械角360度内に前記係合突起部を少なくとも2つ有する。
上述の構成により、前記ブレーキ機構によって計測対象部材の回転角度が前記少なくとも2つの前記係合突起部によって制限されている場合、前記計測対象部材は、機械角180度未満の回転角度に制限される。前記アブソリュートエンコーダは、前記アブソリュートエンコーダの電源がオフの場合に前記計測対象部材が回転されても、機械角180度未満の範囲において回転角度を特定するためのAB相信号とZ相信号とを前記コンピュータに出力する。前記コンピュータは、前記ブレーキ機構によって前記計測対象部材の回転角度が180度未満であることを前提とできるので、前記計測対象部材の回転角度を一義的に算出することができる。これにより、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記回転体は、機械角360度内に前記係合突起部を6つ有する。
上述の構成により、前記ブレーキ機構によって計測対象部材の回転角度が6つの前記係合突起部によって制限されている場合、前記計測対象部材は、係合突起部のうち任意の2つの係合突起部が係合ピンに接触しない状態であっても機械角180度未満の回転角度に制限される。前記コンピュータは、前記ブレーキ機構によって前記計測対象部材の回転角度が180度未満であることを前提とできるので、前記計測対象部材の回転角度を一義的に算出することができる。これにより、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記Z相信号被検出部は、前記複数の規制範囲のそれぞれにおいて、前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との間隔が全て異なり、且つ前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との間隔における中央値と最も小さい間隔との差、及び前記中央値と最も大きい間隔との差が前記中央値の半分よりも小さいZ相信号被検出部と、前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔が全て異なり、且つ前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔における中央値と最も小さい間隔との差、及び前記中央値と最も大きい間隔との差が前記中央値の半分よりも小さいZ相信号被検出部と、前記隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔が全て異なり、且つ前記隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔における中央値と最も小さい間隔との差、及び前記中央値と最も大きい間隔との差が前記中央値の半分よりも小さいZ相信号被検出部と、のうち少なくとも一つのZ相信号被検出部を含む。
上述の構成では、前記Z相信号被検出部は、前記ブレーキ機構の隣り合う前記係合突起部によって制限される前記回転体の回転角度の範囲の全てにおいて、前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との組み合わせによって規定される間隔のうち少なくとも一つの間隔が所定の範囲内のばらつきにおいて全て異なる。
前記複数の規制範囲のそれぞれにおいて、前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との間隔が全て異なる場合、前記コンピュータは、一つの前記Z相信号の立ち上がりと立ち下がりの両方において割り込み処理を発生させることで、前記アブソリュートエンコーダの1回転中における絶対位置の検出機会を増やすことができる。一方、前記複数の規制範囲のそれぞれにおいて、前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔が全て異なる場合、または、前記隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔が全て異なる場合、前記コンピュータは、一つの前記Z相信号の立ち上がりもしくは立ち下がりの一方に割り込み処理を発生させることで計算負荷を抑えることができる。
前記アブソリュートエンコーダは、隣り合う前記Z相信号の信号波形における任意の間隔において、機械角360度以内の間隔における中央値と一番小さい間隔との差及び前記中央値と一番大きい間隔との差が両方とも前記中央値の半分より小さくなるように構成されている。このため、前記アブソリュートエンコーダは、一定の回転速度において、前記中央値を基準として、所定のばらつきの範囲内に収まるように前記Z相信号を生成させる。つまり、前記アブソリュートエンコーダは、前記Z相信号を所定時間以上の時間間隔によって生成する。従って、前記アブソリュートエンコーダに接続される前記コンピュータは、前記Z相信号を取得する度に発生する絶対回転角を算出する割り込み処理の時間間隔が所定時間以上になり、機械角360度内の回転角度の位置を取得する各処理の平準化を図ることができる。
これにより、前記コンピュータの処理のピーク負荷を低減して前記コンピュータのハードウェアリソースの設計自由度を向上させることができる。モータ制御のようなリアルタイム制御に供されるコンピュータはピーク負荷時にもリアルタイム性を失わないことが求められる。よって、前記アブソリュートエンコーダからの信号処理のピーク負荷の低減によって前記コンピュータの最大処理性能を抑制することができる。また、同じ処理性能のコンピュータである場合、前記アブソリュートエンコーダからの信号処理のピーク負荷が低減されれば、前記コンピュータが他の処理を実行することができる。
上述の構造よって、前記アブソリュートエンコーダは、前記計測対象部材の回転角度を取得する処理を簡易にすることができる。これにより、前記ブレーキ機構によって前記計測対象部材の回転角度の範囲が制限されていても、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記Z相信号被検出部における前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部は、前記複数の規制範囲のそれぞれにおいて、前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との間隔が全て異なる場合、前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との間隔における最も小さい間隔と最も大きい間隔との差が前記中央値の半分よりも小さくなるように配置される。
また、前記Z相信号被検出部における前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部は、前記複数の規制範囲のそれぞれにおいて、前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔が全て異なる場合、前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔における最も小さい間隔と最も大きい間隔との差が前記中央値の半分よりも小さくなるように配置される。
また、前記Z相信号被検出部における前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部は、前記複数の規制範囲のそれぞれにおいて、前記隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔が全て異なる場合、前記隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔における最も小さい間隔と最も大きい間隔との差が前記中央値の半分よりも小さくなるように配置される。
また、前記Z相信号被検出部における前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部は、前記ブレーキ機構の隣り合う前記係合部によって制限される前記回転体の回転角度の範囲の全てにおいて、複数の前記Z相信号において、隣り合う信号波形の立ち下がりから立ち上がりまでの間隔が全て異なる場合、隣り合う信号波形の立ち下がりから立ち上がりまでの間隔における最も小さい間隔と最も大きい間隔との差が前記中央値の半分よりも小さくなるように配置される。
上述の構成では、前記アブソリュートエンコーダは、一定の回転速度において、前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との組み合わせによって規定される間隔が前記中央値を基準として所定のばらつきの範囲内に収まるように前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部とが配置される。これにより、前記ブレーキ機構によって前記計測対象部材の回転可能な範囲が制限されていても、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成することができる。また、前記コンピュータの処理負荷を低減して前記コンピュータのハードウェアリソースの設計自由度を向上することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記アブソリュートエンコーダは、前記回転体と一体に回転する回転板を有する。前記回転板は、前記ブレーキ機構と一体に回転するような一つ以上の回転板として構成される。すなわち前記回転板は、前記複数のAB相信号被検出部、前記複数のZ相信号立ち上がり被検出部及び前記複数のZ相信号立ち下がり被検出部を有する。
前記AB相信号被検出部と前記Z相信号被検出部とは、共に前記回転板に設けられている。従って、前記AB相信号被検出部と前記Z相信号被検出部とは、位相が固定された状態において一体に前記計測対象部材または前記回転体に設けられる。これにより、前記ブレーキ機構によって前記計測対象部材の回転可能な範囲が制限されていても、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記ブレーキ機構として構成される回転体は、前記複数のAB相信号被検出部及び前記複数のZ相信号被検出部を有する。すなわち前記複数のAB相信号被検出部及び前記複数のZ相信号被検出部とブレーキ機構が同一の回転体として供される。
上述の構成では、前記AB相信号被検出部と前記Z相信号被検出部とは、位相が固定された状態において一体に前記ブレーキ機構の前記回転体に設けられる。これにより、前記ブレーキ機構によって前記計測対象部材の回転可能な範囲が制限されていても、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記Z相信号被検出部が設けられた前記回転体の変形、前記Z相信号被検出部の劣化及び汚損等による前記Z相信号の異常を検出するためのハードウェアとして構成される異常検出部を備える。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記アブソリュートエンコーダは、モータに設けられる。前記異常検出部は、前記Z相信号の異常を前記モータの電気角に基づいて検出する。例えば、前記コンピュータは、前記アブソリュートエンコーダと一体に回転する前記モータのホール素子、前記ブレーキ機構の前記係合突起部で反応する近接センサにより、ソフトウェアによって前記アブソリュートエンコーダの異常を検出するよりも速やかに異常を検出することができる。よって、前記コンピュータの処理負荷を低減して前記コンピュータのハードウェアリソースの設計自由度を向上することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、前記AB相信号被検出部を検出するAB相信号検出部と、前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部を検出するZ相信号検出部と、を有する。前記AB相信号は、前記AB相信号被検出部が前記AB相信号検出部によって検出されることにより生成され、前記Z相信号は、前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部が前記Z相信号検出部によって検出されることにより生成される。この構成から、複数の前記Z相信号における信号波形の立ち上がりから立ち下がりまでの間隔、隣り合う信号波形の立ち上がりから立ち上がりまでの間隔、隣り合う信号波形の立ち下がりから立ち下がりまでの間隔または隣り合う前記信号波形の立ち下がりから立ち上がりまでの間隔において生成される前記AB相信号のパルス数から前記AB相信号のエラーを訂正するエラー訂正機能を実現できる。
前記アブソリュートエンコーダは、前記AB相信号の一部が検出できないエラーが生じても、前記Z相信号被検出部における前記Z相信号立ち上がり被検出部から前記Z相信号立ち下がり被検出部までの角度範囲の差異を利用することにより、エラーが発生した前記AB相信号を容易に推測することができる。これにより、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成するとともに、前記コンピュータの処理負荷を低減してコンピュータのハードウェアリソースの設計自由度を向上することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記アブソリュートエンコーダは、前記ブレーキ機構によって前記回転体の規制範囲が制限されている場合、前記回転体が回転可能な範囲内において時計回りと反時計回りとに複数回、往復回転している際に前記Z相信号検出部が前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部を検出する制御装置を備える。
上述の構成では、前記アブソリュートエンコーダは、前記規制範囲が制限されている前記回転体を時計回りと反時計回りに複数回、往復回転させている間に少なくとも一つのZ相信号とAB相信号とが生成される。前記コンピュータは、アブソリュートエンコーダから前記Z相信号における信号波形の立ち下がりから立ち上がりまでの組み合わせによる間隔における前記AB相信号のパルス数を確実に取得することができる。これにより、前記ブレーキ機構によって前記計測対象部材の回転可能な範囲が制限されていても、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成することができる。
他の観点によれば、本発明のアブソリュートエンコーダは、以下の構成を含むことが好ましい。前記アブソリュートエンコーダは、電源がオフになる直前の機械角の値と決められた原点からの回転回数の値を不揮発性メモリに保存し、電源がオンになった直後に前記不揮発性メモリから保存したそれらの値を読み出す装置を備える。また前記アブソリュートエンコーダは、前記電源がオフの間、前記ブレーキ機構により回転を規制する機能を備える。
上述の構成では、前記アブソリュートエンコーダは、前記電源がオフの間に回転体の回転が規制されることから、決められた原点からの回転回数を保持することができる。これにより、簡素な構造によって前記計測対象部材の回転角度と回転回数を算出可能なマルチターンアブソリュートエンコーダを構成することができる。
本明細書で使用される専門用語は、特定の実施例のみを定義する目的で使用されるのであって、前記専門用語によって発明を制限する意図はない。
本明細書で使用される「及び/または」は、一つまたは複数の関連して列挙された構成物のすべての組み合わせを含む。
本明細書において、「含む、備える(including)」「含む、備える(comprising)」または「有する(having)」及びそれらの変形の使用は、記載された特徴、工程、要素、成分、及び/または、それらの等価物の存在を特定するが、ステップ、動作、要素、コンポーネント、及び/または、それらのグループのうちの1つまたは複数を含むことができる。
本明細書において、「取り付けられた」、「接続された」、「結合された」、及び/または、それらの等価物は、広義の意味で使用され、“直接的及び間接的な”取り付け、接続及び結合の両方を包含する。さらに、「接続された」及び「結合された」は、物理的または機械的な接続または結合に限定されず、直接的または間接的な接続または結合を含むことができる。
他に定義されない限り、本明細書で使用される全ての用語(技術用語及び科学用語を含む)は、本発明が属する技術分野の当業者によって一般的に理解される意味と同じ意味を有する。
一般的に使用される辞書に定義された用語は、関連する技術及び本開示の文脈における意味と一致する意味を有すると解釈されるべきであり、本明細書で明示的に定義されていない限り、理想的または過度に形式的な意味で解釈されることはない。
本発明の説明においては、いくつもの技術および工程が開示されていると理解される。これらの各々は、個別の利益を有し、他に開示された技術の1つ以上、または、場合によっては全てと共に使用することもできる。
したがって、明確にするために、本発明の説明では、不要に個々のステップの可能な組み合わせをすべて繰り返すことを控える。しかしながら、本明細書及び特許請求の範囲は、そのような組み合わせがすべて本発明の範囲内であることを理解して読まれるべきである。
本明細書では、本発明に係るアブソリュートエンコーダの実施形態について説明する。
以下の説明では、本発明の完全な理解を提供するために多数の具体的な例を述べる。しかしながら、当業者は、これらの具体的な例がなくても本発明を実施できることが明らかである。
よって、以下の開示は、本発明の例示として考慮されるべきであり、本発明を以下の図面または説明によって示される特定の実施形態に限定することを意図するものではない。
[多関節ロボットアーム]
本明細書において、多関節ロボットアームとは、複数のリンクを連結する関節部を複数有するロボットアームを意味する。前記多関節ロボットアームは、垂直多関節ロボットアームを含む。具体的には、前記垂直多関節ロボットアームは、リンクが1自由度の回転関節で根元から先端まで直列に連結されたシリアルリンク機構のロボットアームである。前記垂直多関節ロボットアームは、複数の回転関節部を有する。
本明細書において、多関節ロボットアームとは、複数のリンクを連結する関節部を複数有するロボットアームを意味する。前記多関節ロボットアームは、垂直多関節ロボットアームを含む。具体的には、前記垂直多関節ロボットアームは、リンクが1自由度の回転関節で根元から先端まで直列に連結されたシリアルリンク機構のロボットアームである。前記垂直多関節ロボットアームは、複数の回転関節部を有する。
[アブソリュートエンコーダ]
本明細書において、アブソリュートエンコーダとは、モータや回転軸における機械的な回転位置を決められた原点からの回転角度として検出し、コンピュータで処理が可能な信号に変換する装置である。前記アブソリュートエンコーダのうち、前記回転角度とともに、決められた原点からの回転回数を検出可能なものをマルチターンアブソリュートエンコーダと呼ぶ。前記アブソリュートエンコーダは一回転中の機械角を検出する。一方、前記マルチターンアブソリュートエンコーダは、主電源が切られたときに回転回数を保持する必要がある。前記マルチターンアブソリュートエンコーダには、主電源と別に電池などにより構成されるバックアップ電源により前記主電源がオフになっても前記バックアップ電源から供給される電力で被検出体の動作を監視するマルチターンアブソリュートエンコーダ、前記バックアップ電源を持たずに前記主電源がオフになっても回転運動で発電したエネルギーで被検出体の動作を監視するマルチターンアブソリュートエンコーダ、高減速比の減速機を介することで回転回数をアブソリュートエンコーダで算出するマルチターンアブソリュートエンコーダ、前記主電源が切られる直前の回転回数を不揮発性メモリに保持し、前記主電源がオフの間はは機械的に回転軸をロックしてしまうマルチターンアブソリュートエンコーダ、などがある。
本明細書において、アブソリュートエンコーダとは、モータや回転軸における機械的な回転位置を決められた原点からの回転角度として検出し、コンピュータで処理が可能な信号に変換する装置である。前記アブソリュートエンコーダのうち、前記回転角度とともに、決められた原点からの回転回数を検出可能なものをマルチターンアブソリュートエンコーダと呼ぶ。前記アブソリュートエンコーダは一回転中の機械角を検出する。一方、前記マルチターンアブソリュートエンコーダは、主電源が切られたときに回転回数を保持する必要がある。前記マルチターンアブソリュートエンコーダには、主電源と別に電池などにより構成されるバックアップ電源により前記主電源がオフになっても前記バックアップ電源から供給される電力で被検出体の動作を監視するマルチターンアブソリュートエンコーダ、前記バックアップ電源を持たずに前記主電源がオフになっても回転運動で発電したエネルギーで被検出体の動作を監視するマルチターンアブソリュートエンコーダ、高減速比の減速機を介することで回転回数をアブソリュートエンコーダで算出するマルチターンアブソリュートエンコーダ、前記主電源が切られる直前の回転回数を不揮発性メモリに保持し、前記主電源がオフの間はは機械的に回転軸をロックしてしまうマルチターンアブソリュートエンコーダ、などがある。
[AB相信号、Z相信号]
本明細書において、AB相信号とは、モータや回転軸の回転量に比例して生成されるパルス信号である。前記AB相信号は、A相信号検出部が出力するA相信号とB相信号検出部が出力するB相信号とのパルス数と位相差を合成した信号である。Z相信号とは、原点を設定するために生成されるパルス信号である。
本明細書において、AB相信号とは、モータや回転軸の回転量に比例して生成されるパルス信号である。前記AB相信号は、A相信号検出部が出力するA相信号とB相信号検出部が出力するB相信号とのパルス数と位相差を合成した信号である。Z相信号とは、原点を設定するために生成されるパルス信号である。
[AB相信号被検出部]
本明細書において、前記AB相信号被検出部とは、前記AB相信号検出部が検出することができる印(例えばスリット、反射面、磁石等)である。前記AB相信号検出部は、前記AB相信号被検出部を検出する度にパルス信号であるAB相信号を生成する。前記AB相信号被検出部は、1トラックの印において異なる位置に前記A相信号検出部と前記B相信号検出部が設けられている場合と、2トラックの印のうち、一方のトラックの印に前記A相信号検出部が設けられ、他方のトラックの印に前記B相信号被検出部に設けられた場合とを含む。
本明細書において、前記AB相信号被検出部とは、前記AB相信号検出部が検出することができる印(例えばスリット、反射面、磁石等)である。前記AB相信号検出部は、前記AB相信号被検出部を検出する度にパルス信号であるAB相信号を生成する。前記AB相信号被検出部は、1トラックの印において異なる位置に前記A相信号検出部と前記B相信号検出部が設けられている場合と、2トラックの印のうち、一方のトラックの印に前記A相信号検出部が設けられ、他方のトラックの印に前記B相信号被検出部に設けられた場合とを含む。
[Z相信号立ち上がり被検出部、Z相信号立ち上がり被検出部]
本明細書において、Z相信号立ち上がり被検出部及びZ相信号立ち下がり被検出部は、前記Z相信号検出部が検出することができる印(例えばスリット、反射面、磁石等)である。前記Z相信号検出部は、前記Z相信号立ち上がり被検出部を検出するとZ相信号をオン状態にする。また、前記Z相信号検出部は、前記Z相信号立ち下がり被検出部を検出すると前記Z相信号をオフ状態にする。つまり、前記Z相信号検出部は、前記Z相信号立ち上がり被検出部を検出すると、前記Z相信号立ち下がり被検出部を検出するまで継続してZ相信号を生成する。
本明細書において、Z相信号立ち上がり被検出部及びZ相信号立ち下がり被検出部は、前記Z相信号検出部が検出することができる印(例えばスリット、反射面、磁石等)である。前記Z相信号検出部は、前記Z相信号立ち上がり被検出部を検出するとZ相信号をオン状態にする。また、前記Z相信号検出部は、前記Z相信号立ち下がり被検出部を検出すると前記Z相信号をオフ状態にする。つまり、前記Z相信号検出部は、前記Z相信号立ち上がり被検出部を検出すると、前記Z相信号立ち下がり被検出部を検出するまで継続してZ相信号を生成する。
[機械角、電気角]
本明細書において、機械角とは、回転板の回転角度である。前記機械角がゼロの場合、例えば、前記回転板のZ相信号被検出部は、Z相信号検出部の検出位置に位置付けられている。電気角とは、前記機械角からステータオフセット角とロータオフセット角とを除いた回転角度に、極対数を乗じた角度である。前記ステータオフセット角は、例えば前記回転体を軸線に沿って見た場合において、前記Z相信号検出部とステータのU相コイル中心とのずれ角である。前記ロータオフセット角は、例えば前記回転体を軸線に沿って見た場合において、アブソリュートエンコーダの原点である前記Z相信号被検出部を生成する印とN極磁石中心とのずれ角である。
本明細書において、機械角とは、回転板の回転角度である。前記機械角がゼロの場合、例えば、前記回転板のZ相信号被検出部は、Z相信号検出部の検出位置に位置付けられている。電気角とは、前記機械角からステータオフセット角とロータオフセット角とを除いた回転角度に、極対数を乗じた角度である。前記ステータオフセット角は、例えば前記回転体を軸線に沿って見た場合において、前記Z相信号検出部とステータのU相コイル中心とのずれ角である。前記ロータオフセット角は、例えば前記回転体を軸線に沿って見た場合において、アブソリュートエンコーダの原点である前記Z相信号被検出部を生成する印とN極磁石中心とのずれ角である。
[AB相信号被検出部の間隔、隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との間隔]
本明細書において、AB相信号被検出部の間隔とは、前記AB相信号検出部が前記AB相信号被検出部の印を検出した際の機械角から隣り合う前記AB相信号被検出部の印を検出した際の機械角までの回転角度を意味する。隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との間隔とは、前記Z相信号検出部が前記Z相信号立ち上がり被検出部を検出した際の機械角から隣り合う前記Z相信号立ち下がり被検出部を検出した際の機械角までの回転角度を意味する。また、隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔とは、前記Z相信号検出部が前記Z相信号立ち上がり被検出部を検出した際の機械角から隣り合う前記Z相信号立ち上がり被検出部を検出した際の機械角までの回転角度を意味する。また、隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔とは、前記Z相信号検出部が前記Z相信号立ち下がり被検出部を検出した際の機械角から隣り合う前記Z相信号立ち下がり被検出部を検出した際の機械角までの回転角度を意味する。また、隣り合うZ相信号立ち下がり被検出部とZ相信号立ち上がり被検出部との間隔とは、前記Z相信号検出部が前記Z相信号立ち下がり被検出部を検出した際の機械角から隣り合う前記Z相信号立ち上がり被検出部を検出した際の機械角までの回転角度を意味する。なお、間隔は、AB相信号検出部がAB相信号の印を出力した瞬間、及びZ相信号検出部がZ相信号の立ち上がり及び立ち下がりを出力した瞬間を基準として規定される。
本明細書において、AB相信号被検出部の間隔とは、前記AB相信号検出部が前記AB相信号被検出部の印を検出した際の機械角から隣り合う前記AB相信号被検出部の印を検出した際の機械角までの回転角度を意味する。隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との間隔とは、前記Z相信号検出部が前記Z相信号立ち上がり被検出部を検出した際の機械角から隣り合う前記Z相信号立ち下がり被検出部を検出した際の機械角までの回転角度を意味する。また、隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔とは、前記Z相信号検出部が前記Z相信号立ち上がり被検出部を検出した際の機械角から隣り合う前記Z相信号立ち上がり被検出部を検出した際の機械角までの回転角度を意味する。また、隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔とは、前記Z相信号検出部が前記Z相信号立ち下がり被検出部を検出した際の機械角から隣り合う前記Z相信号立ち下がり被検出部を検出した際の機械角までの回転角度を意味する。また、隣り合うZ相信号立ち下がり被検出部とZ相信号立ち上がり被検出部との間隔とは、前記Z相信号検出部が前記Z相信号立ち下がり被検出部を検出した際の機械角から隣り合う前記Z相信号立ち上がり被検出部を検出した際の機械角までの回転角度を意味する。なお、間隔は、AB相信号検出部がAB相信号の印を出力した瞬間、及びZ相信号検出部がZ相信号の立ち上がり及び立ち下がりを出力した瞬間を基準として規定される。
[異常]
本明細書において、異常とは、正常でない状態であり、例えば、前記AB相信号被検出部又は前記Z相信号被検出部が前記回転体の回転速度に応じた時間間隔でAB相信号またはZ相信号を生成していない状態をいう。
本明細書において、異常とは、正常でない状態であり、例えば、前記AB相信号被検出部又は前記Z相信号被検出部が前記回転体の回転速度に応じた時間間隔でAB相信号またはZ相信号を生成していない状態をいう。
本発明の一実施形態によれば、前記ブレーキ機構によって前記計測対象部材の回転可能な範囲が制限されていても、簡素な構造によって前記計測対象部材の回転角度を算出可能なAB相信号及びZ相信号を生成するアブソリュートエンコーダを提供することができる。
以下で、各実施形態について、図面を参照しながら説明する。各図において、同一部分には同一の符号を付して、その同一部分の説明は繰り返さない。なお、各図中の構成部材の寸法は、実際の構成部材の寸法及び各構成部材の寸法比率等を忠実に表したものではない。
[実施形態1]
<アブソリュートエンコーダの全体構成>
図1から図4を用いて本発明の実施形態1に係るアブソリュートエンコーダ1の全体構成について説明する。図1は、本発明の実施形態1に係るアブソリュートエンコーダ1の全体構成を表す模式図である。図2は、本発明の実施形態1に係るアブソリュートエンコーダ1を表す平面図である。図3は、本発明の実施形態1に係るブレーキ機構8を表す平面図である。図4は、本発明の実施形態1に係るブレーキ機構8を表す側面図である。
<アブソリュートエンコーダの全体構成>
図1から図4を用いて本発明の実施形態1に係るアブソリュートエンコーダ1の全体構成について説明する。図1は、本発明の実施形態1に係るアブソリュートエンコーダ1の全体構成を表す模式図である。図2は、本発明の実施形態1に係るアブソリュートエンコーダ1を表す平面図である。図3は、本発明の実施形態1に係るブレーキ機構8を表す平面図である。図4は、本発明の実施形態1に係るブレーキ機構8を表す側面図である。
図1に示すように、アブソリュートエンコーダ1は、計測対象部材である回転軸において、決められた原点を基準とした場合の絶対的な回転角度に関する情報(本実施例においてAB相信号のパルス数)を検出し、その検出結果を出力するロータリーエンコーダである。アブソリュートエンコーダ1は、例えば、反射型の光学式アブソリュートエンコーダである。アブソリュートエンコーダ1は、計測対象部材の機械角360度以内の回転角度を検出するためのAB相信号と計測対象部材の機械角の原点を検出するためのZ相信号とを生成する。
図1と図2に示すように、アブソリュートエンコーダ1は、AB相信号を生成するためのAB相信号被検出部2と、Z相信号を生成するためのZ相信号被検出部3と、AB相信号被検出部2を検出するAB相信号検出部4と、Z相信号被検出部3を検出するZ相信号検出部5と、計測対象部材であるモータ27(図4参照)を制御している図示しないコンピュータにAB相信号及びZ相信号を出力可能な出力部6と、ブレーキ機構8とを備える。本実施形態において、AB相信号被検出部2及びZ相信号被検出部3は、モータ27の回転軸27a(図4参照)と一体に回転する回転板7上(図4参照)に設けられている。また、回転板7は、モータ27の回転軸27aが機械角360度回転することで360度回転する。すなわち、回転板7の回転角度とモータ27の回転軸27aの回転角度とは一致する。以下の実施形態において、モータ27の機械角を、単に機械角とする。
AB相信号被検出部2は、AB相信号検出部4が検出可能な印である。AB相信号被検出部2は、A相信号被検出部とB相信号被検出部とを含む。本実施形態において、AB相信号被検出部2には、回転板7上に略矩形状の反射面と非反射面が交互に周方向に配置されている。AB相信号被検出部2は、AB相信号検出部4が出力した検出光を反射面によって反射し、非反射面では吸収する。複数のAB相信号被検出部2は、円環状且つ放射状に配置されている。また、複数のAB相信号被検出部2は、それぞれ周方向の幅が等しい。また、複数のAB相信号被検出部2は、隣り合うAB相信号被検出部2の位置に応じた機械角によって定まる角度範囲が等しくなるように並んでいる。すなわち、複数のAB相信号被検出部2は、隣り合うAB相信号被検出部2の周方向の間隔が等しくなるように並んでいる。このように、複数のAB相信号被検出部2は、周方向に等しい幅を有する複数の反射面が周方向に等間隔に並んだ円環状のAB相信号用コードホイールCW1を構成している。複数のAB相信号被検出部2によって構成されるAB相信号用コードホイールCW1は、反射面と非反射面とが周方向に交互に並んでいる。また、AB相信号用コードホイールCW1の中心は、回転板7の回転軸線Pと一致している。
AB相信号検出部4は、例えば、LED発光素子等からなる図示しない投光素子とフォトダイオード等からなる図示しない受光素子とを含む。AB相信号検出部4は、例えば、モータ27の回転軸27aと連動して回転しない部分に支持されている。AB相信号検出部4は、AB相信号用コードホイールCW1に投光可能で且つAB相信号用コードホイールCW1によって反射された反射光を受光可能な位置に設けられている。投光素子の検出光は、AB相信号被検出部2である反射面上で反射する一方、非反射面では吸収される。AB相信号検出部4は、投光素子から出力された検出光が反射面上で反射して受光素子によって受光されている間、AB相信号を出力する。AB相信号検出部4は、投光素子から出力された検出光が非反射面によって吸収されて受光素子によって受光されていない間、AB相信号を出力しない。AB相信号検出部4は、A相信号を出力するA相信号検出部4aと、B相信号を出力するB相信号検出部4bとを含む。
AB相信号被検出部2及びAB相信号検出部4によって生成されるA相信号とB相信号とは、それぞれ、信号波形の立ち上がりから立ち下がりまでの間隔である機械角の角度範囲が全て同じである。また、前記A相信号と前記B相信号において、隣り合う信号波形の立ち上がりから立ち下がりまでの間隔、及び立ち下がりから立ち上がりまでの間隔、は全て同じである。
一方、A相信号を出力するA相信号検出部4aとB相信号を出力するB相信号検出部4bとは、AB相信号被検出部2に対する位置が異なる。このため、A相信号とB相信号とは、信号波形の位相がずれている。これにより、A相信号とB相信号とは、モータ27の回転軸27aの回転方向によって信号波形の位相差が異なる。よって、アブソリュートエンコーダ1は、モータ27の回転軸27aの回転方向を判別する情報としてA相信号に対するB相信号の位相差を出力することができる。AB相信号検出部4は、A相信号検出部4aが出力するA相信号とB相信号検出部4bが出力するB相信号とのパルス数と位相差を合成したAB相信号を出力する。
複数のAB相信号被検出部2における反射面の周方向の幅は、AB相信号検出部4がAB相信号を出力している間に回転するモータ27の機械角の角度範囲を規定している。また、複数のAB相信号被検出部2において周方向に隣り合う反射面の間隔は、AB相信号検出部4が次のAB相信号を出力するまでの間に回転するモータ27の機械角の角度範囲を規定している。AB相信号検出部4は、複数のAB相信号被検出部2における反射面の周方向の幅と周方向に隣り合う反射面の間隔とに応じたにAB相信号を出力する。このように、複数のAB相信号被検出部2及びAB相信号検出部4によってAB相信号を生成することができる。生成されるAB相信号は、それぞれ、同じ信号波形、且つ同じ信号の間隔である。
Z相信号被検出部3は、Z相信号検出部5が検出可能な印である。本実施形態において、Z相信号被検出部3は、回転板7上に複数設けられた略矩形状の反射面である。複数のZ相信号被検出部3は、円環状に配置されている。また、複数のZ相信号被検出部3は、それぞれ周方向に等しい幅を有する反射面を含む様々な幅の反射面によって構成されている。また、複数のZ相信号被検出部3は、それぞれの機械角によって定まる角度範囲である周方向の間隔が異なるように周方向に配置されている。複数のZ相信号被検出部3における前記間隔の一部は等しくてもよい。このように、周方向に等しい幅を有する反射面を含む様々な幅の反射面が周方向に等しい間隔を含む様々な間隔に並ぶことにより、複数のZ相信号被検出部3によって円環状のZ相信号用コードホイールCW2が構成される。複数のZ相信号被検出部3によって構成されるZ相信号用コードホイールCW2は、反射面(図2の薄墨部分)と非反射面とが周方向に交互に並んでいる。また、Z相信号用コードホイールCW2の中心は、回転板7の回転軸線Pと一致する。つまり、複数のZ相信号被検出部3と複数のAB相信号被検出部2とは、回転板7上において同心円状に配置されている。これにより、複数のZ相信号被検出部3は、複数のAB相信号被検出部2に対して位相が固定されている。
Z相信号検出部5は、例えば、LED発光素子等からなる投光素子とフォトダイオード等からなる受光素子とを含む。Z相信号検出部5は、モータ27の回転軸27aと連動して回転しない部分に支持されている。また、Z相信号検出部5は、Z相信号用コードホイールCW2に投光可能で且つZ相信号用コードホイールCW2によって反射された反射光を受光可能な位置に設けられている。投光素子の検出光は、Z相信号被検出部3である反射面上で反射する一方、非反射面では吸収される。Z相信号検出部5は、投光素子から出力された検出光が反射面上で反射して受光素子によって受光されている間、Z相信号を出力する。Z相信号検出部5は、投光素子から出力された検出光が非反射面によって吸収されて受光素子によって受光されていない間、Z相信号を出力しない。
複数のZ相信号被検出部3は、Z相信号の立ち上がりを生成するZ相信号立ち上がり被検出部3aと、Z相信号の立ち下がりを生成するZ相信号立ち下がり被検出部3bとをそれぞれ有する。回転板7が回転板7の回転軸線P回りに回転している場合において、Z相信号立ち上がり被検出部3aは、反射面において、検出光が非反射面によって吸収されてZ相信号検出部5の受光素子によって受光されていない状態から、検出光が反射面上で反射して受光素子によって受光される状態に切り替わる部分である。つまり、Z相信号立ち上がり被検出部3aは、回転板7の回転軸線Pの軸線方向から見て、反射面において回転方向の前方に位置するエッジである。回転板7が回転板7の回転軸線P回りに回転している場合において、Z相信号立ち下がり被検出部3bは、反射面において、検出光が反射面上で反射してZ相信号検出部5の受光素子によって受光されている状態から、検出光が非反射面によって吸収されて受光素子によって受光されていない状態に切り替わる部分である。つまり、Z相信号立ち下がり被検出部3bは、回転板7の回転軸線Pの軸線方向から見て、反射面において回転方向の後方に位置するエッジである。図2には、回転板7が回転軸線Pの軸線方向からみて時計回りに回転する場合におけるZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとを示している。
隣り合うZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの間隔は、Z相信号立ち上がり被検出部3aの位置に対応する機械角とZ相信号立ち下がり被検出部3bの位置に対応する機械角とによって規定される機械角の角度範囲である(図2のθ1参照)。隣り合うZ相信号立ち上がり被検出部3aからZ相信号立ち下がり被検出部3bまでの周方向の間隔によって、Z相信号の立ち上がりから立ち下がりまでの機械角の角度範囲が規定される。また、隣り合うZ相信号立ち下がり被検出部3bからZ相信号立ち上がり被検出部3aまでの周方向の間隔によって、Z相信号の立ち下がりから次のZ相信号の立ち上がりまでの機械角の角度範囲が規定される。よって、隣り合うZ相信号立ち上がり被検出部3aからZ相信号立ち下がり被検出部3bまでの周方向の間隔は、反射面の周方向の幅を示している。また、隣り合うZ相信号立ち下がり被検出部3bからZ相信号立ち上がり被検出部3aまでの周方向の間隔は、周方向に隣り合う反射面の間隔を示している。
Z相信号検出部5は、Z相信号立ち上がり被検出部3aを検出するとZ相信号の出力を開始する。つまり、Z相信号検出部5は、投光素子から出力された検出光が反射面上で反射して受光素子に受光されるとZ相信号を出力する。Z相信号検出部5は、Z相信号立ち下がり被検出部3bを検出するとZ相信号の出力を停止する。つまり、Z相信号検出部5は、投光素子から出力された検出光が非反射面によって吸収され受光素子に受光されなくなるとZ相信号の出力を停止する。Z相信号検出部5は、反射面の周方向の幅と周方向に隣り合う反射面の間隔とに応じてZ相信号を出力する。このように、複数のZ相信号被検出部3及びZ相信号検出部5は、Z相信号を生成することができる。
複数のZ相信号被検出部3は、周方向に隣り合うZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの間にAB相信号被検出部2が位置するように配置される。これにより、Z相信号検出部5がZ相信号立ち上がり被検出部3aを検出してZ相信号の立ち上がりを出力してから、Z相信号検出部5がZ相信号立ち下がり被検出部3bを検出してZ相信号の立ち下がりを出力するまでの間に、AB相信号被検出部2及びAB相信号検出部4aによってAB相信号が生成される。つまり、アブソリュートエンコーダ1は、Z相信号が立ち上がってから立ち下がるまでの間に回転するモータ27の機械角の角度範囲に関する情報をAB相信号のパルス数で出力する。
出力部6は、AB相信号被検出部2及びAB相信号検出部4が生成したAB相信号とZ相信号被検出部3及びZ相信号検出部5が生成したZ相信号とを、モータ27を制御しているコンピュータである駆動装置31(図12参照)に出力する。、駆動装置31は、モータ27の回転軸27aにおいて、決められた原点を基準とする機械角360度以内の回転角度に関する情報を取得することができる。また、駆動装置31は、Z相信号被検出部3が生成したZ相信号からモータ27の回転軸27aの機械角360度以内の原点に関する情報を取得することができる。
(ブレーキ機構)
図3と図4とに示すように、ブレーキ機構8は、モータ27に電流が供給されていない場合、又はモータ27がトルクを出力していない場合に、モータ27の回転軸27aの回転を制限する。ブレーキ機構8は、回転体9と、係合ピン10と、ソレノイド10aとを備える。
図3と図4とに示すように、ブレーキ機構8は、モータ27に電流が供給されていない場合、又はモータ27がトルクを出力していない場合に、モータ27の回転軸27aの回転を制限する。ブレーキ機構8は、回転体9と、係合ピン10と、ソレノイド10aとを備える。
回転体9は、モータ27の回転軸27aと一体で回転する。回転体9は、略円板状の部材である。回転体9は、回転軸27aに設けられている。回転体9は、その中心が回転軸27aの回転軸線Pと一致した状態において回転軸27aに接続されている。つまり、回転体9は、回転軸27aの回転軸線P回りに回転軸27aと一体に回転する。
回転体9は、その外縁部に、径方向外方に向かって突出した少なくとも2つの係合突起部9aを有する。複数の係合突起部9aは、回転体9の周方向に等間隔に配置されている。本実施形態において、回転体9は、60度毎に周方向に6つの係合突起部9aを有する。これにより、回転体9は、6つの係合突起部9aにより周方向に第1セクションS1から第6セクションS6の順に分割されている。
係合ピン10は、回転体9の回転を規制する部材である。係合ピン10は、モータ27のハウジング又はモータ27が有する減速機25(図11参照)のハウジング等、回転体9と連動して回転しない部分に支持されている。係合ピン10は、軸線が回転体9の回転軸線Pと平行になるように配置されている。また、係合ピン10は、軸線の軸線方向に移動可能に構成されている。
係合ピン10の位置は、回転体9を回転軸線Pの軸線方向に対して直交する方向に見て、係合ピン10が係合突起部9aに重なる位置に位置する規制位置(二点鎖線図)と、係合ピン10が係合突起部9aに重ならない位置に位置する開放位置(実線図)とに切り替えられる。係合ピン10には、ばね等の弾性体10bによって規制位置に保持されるように係合ピンの軸線方向に力が加えられている。係合ピン10は、前記規制位置に位置する場合、周方向に隣り合う係合突起部9aによって分割される第1セクションS1から第6セクションS6のいずれか一つのセクション内に位置付けられる。回転体9において周方向に隣り合う係合突起部9aの間隔は、係合ピン10が規制位置に位置している状態において、係合ピン10が隣り合う係合突起部9aの間において周方向に相対移動可能な周方向の距離を有する。係合ピン10は、回転体9の回転により、セクションを構成する一方の係合突起部9aと周方向に隣り合う他方の係合突起部9aとのうちいずれかの係合突起部9aに係合する。
ソレノイド10aは、係合ピン10を移動させるアクチュエータである。ソレノイド10aは、モータ27のハウジング又は減速機25のハウジング等、回転体9と連動して回転しない部分に支持されている。ソレノイド10aは、通電されたON状態において規制位置に保持されている係合ピン10を開放位置に移動させる。
このように構成されるブレーキ機構8は、ソレノイド10aによって係合ピン10の位置を前記開放位置から前記規制位置に切り替えることで、回転軸27aと一体に回転する回転体9の回転範囲を規制する。ブレーキ機構8は、回転体9の回転範囲を、セクションを構成する一方の係合突起部9aに接触する位置から周方向に隣り合う他方の係合突起部9aに接触する位置までの角度範囲に制限する。つまり、ブレーキ機構8は、回転体9の回転範囲を、第1セクションS1から第6セクションS6のうちいずれか一つのセクションの角度範囲に規制する。各セクションの角度範囲である規制範囲は、係合ピン10がセクションを構成する一方の係合突起部9aと周方向に隣り合う他方の係合突起部9aとに接触した際のそれぞれのモータ27の機械角によって規定される。ブレーキ機構8は、回転体9の回転範囲を規制することにより、回転体9が接続されているモータ27の回転軸27aの回転範囲を各セクションによる規制範囲に規制する。
回転体9の回転軸線Pに垂直な面には、複数のAB相信号被検出部2と複数のZ相信号被検出部3とを有する回転板7が設けられている。回転板7は、複数のAB相信号被検出部2によって構成されるAB相信号用コードホイールCW1及び複数のZ相信号被検出部3によって構成されるZ相信号用コードホイールCW2のそれぞれの回転軸線Pが回転体9の回転軸線Pと一致するように回転体9に固定されている。つまり、AB相信号被検出部2、Z相信号被検出部3、回転板7及び回転体9は、モータ27の回転軸27aの回転軸線Pを中心として一体で回転する。また、複数のAB相信号被検出部2は、回転体9の周方向に沿って周方向に等間隔に配置されている。複数のZ相信号被検出部3は、回転体9の周方向に沿って周方向に等間隔を含む様々な間隔で配置されている。
(回転体とアブソリュートエンコーダの位置関係)
次に、図5と図6とを用いて、アブソリュートエンコーダ1のAB相信号被検出部2及びZ相信号被検出部3とブレーキ機構8の回転体9との位置関係について詳細に説明する。図5は、本発明の実施形態に係るアブソリュートエンコーダ1と回転体9との位置関係を表す平面図である。図6は、本発明の実施形態に係るAB相信号の信号波形とZ相信号の信号波形を表す模式図である。
次に、図5と図6とを用いて、アブソリュートエンコーダ1のAB相信号被検出部2及びZ相信号被検出部3とブレーキ機構8の回転体9との位置関係について詳細に説明する。図5は、本発明の実施形態に係るアブソリュートエンコーダ1と回転体9との位置関係を表す平面図である。図6は、本発明の実施形態に係るAB相信号の信号波形とZ相信号の信号波形を表す模式図である。
複数のAB相信号被検出部2は、回転体9の回転軸線Pの軸線方向から見て回転方向の前方のエッジがZ相信号立ち上がり被検出部(例えば、Z相信号立ち上がり被検出部3Aa)と一致するように配置されている。つまり、アブソリュートエンコーダ1は、Z相信号の立ち上がりとAB相信号の立ち上がりとを同じタイミングで生成する。
図5に示すように、複数のAB相信号被検出部2は、回転体9の周方向に沿って機械角360度の範囲に等間隔に配置されている。回転体9の回転範囲を規制している第1セクションS1、第2セクションS2、第3セクションS3、第4セクションS4、第5セクションS5及び第6セクションS6による規制範囲内には、それぞれ等しい数のAB相信号被検出部2が位置付けられている。
複数のZ相信号被検出部3は、回転体9の周方向に沿って機械角360度の範囲に等間隔を含む様々な間隔で配置されている。複数のZ相信号被検出部3は、規制範囲である各セクションに少なくとも一つ位置付けられる。本実施形態において、第1セクションS1には、第1Z相信号被検出部3Aが位置付けられている。第2セクションS2には、第2Z相信号被検出部3Bが位置付けられている。第3セクション3Sには、第3Z相信号被検出部3Cが位置付けられている。第4セクションS4には、第4Z相信号被検出部3Dが位置付けられている。第5セクションS5には、第5Z相信号被検出部3Eが位置付けられている。第6セクションS6には、第6Z相信号被検出部3Fが位置付けられている。
また、各セクションには、少なくとも一組のZ相信号立ち上がり被検出部3a及びZ相信号立ち下がり被検出部3bが位置している。第1セクションS1には、第1Z相信号被検出部3Aを構成する第1Z相信号立ち上がり被検出部3Aaと第1Z相信号立ち下がり被検出部3Abとが周方向に隣り合って位置している。第1Z相信号立ち上がり被検出部3Aaと第1Z相信号立ち下がり被検出部3Abとは、周方向に第1間隔Ga1を有するように配置される。第1間隔Ga1は、第1Z相信号立ち上がり被検出部3Aaの位置に対応する機械角と第1Z相信号立ち下がり被検出部3Abの位置に対応する機械角とによって規定される機械角の角度範囲である。
第2セクションS2には、第2Z相信号被検出部3Bを構成する第2Z相信号立ち上がり被検出部3Baと第2Z相信号立ち下がり被検出部3Bbとが周方向に隣り合って位置している。第2Z相信号立ち上がり被検出部3Baと第2Z相信号立ち下がり被検出部3Bbとは、周方向に第2間隔Gb1を有するように配置される。第2間隔Gb1は、第2Z相信号立ち上がり被検出部3Baの位置に対応する機械角と第2Z相信号立ち下がり被検出部3Bbの位置に対応する機械角とによって規定される機械角の角度範囲である。
第3セクションS3には、第3Z相信号被検出部3Cを構成する第3Z相信号立ち上がり被検出部3Caと第3Z相信号立ち下がり被検出部3Cbとが周方向に隣り合って位置している。第3Z相信号立ち上がり被検出部3Caと第3Z相信号立ち下がり被検出部3Cbとは、周方向に第3間隔Gc1を有するように配置される。第3間隔Gc1は、第3Z相信号立ち上がり被検出部3Caの位置に対応する機械角と第3Z相信号立ち下がり被検出部3Cbの位置に対応する機械角とによって規定される機械角の角度範囲である。
第4セクションS4には、第4Z相信号被検出部3Dを構成する第4Z相信号立ち上がり被検出部3Daと第4Z相信号立ち下がり被検出部3Dbとが周方向に隣り合って位置している。第4Z相信号立ち上がり被検出部3Daと第4Z相信号立ち下がり被検出部3Dbとは、周方向に第4間隔Gd1を有するように配置される。第4間隔Gd1は、第4Z相信号立ち上がり被検出部3Daの位置に対応する機械角と第4Z相信号立ち下がり被検出部3Dbの位置に対応する機械角とによって規定される機械角の角度範囲である。
第5セクションS5には、第5Z相信号被検出部3Eを構成する第5Z相信号立ち上がり被検出部3Eaと第5Z相信号立ち下がり被検出部3Ebとが周方向に隣り合って位置している。第5Z相信号立ち上がり被検出部3Eaと第5Z相信号立ち下がり被検出部3Ebとは、周方向に第5間隔Ge1を有するように配置される。第5間隔Ge1は、第5Z相信号立ち上がり被検出部3Eaの位置に対応する機械角と第5Z相信号立ち下がり被検出部3Ebの位置に対応する機械角とによって規定される機械角の角度範囲である。
第6セクションS6には、第6Z相信号被検出部3Fを構成する第6Z相信号立ち上がり被検出部3Faと第6Z相信号立ち下がり被検出部3Fbとが周方向に隣り合って位置している。第6Z相信号立ち上がり被検出部3Faと第6Z相信号立ち下がり被検出部3Fbとは、周方向に第6間隔Gf1を有するように配置される。第6間隔Gf1は、第6Z相信号立ち上がり被検出部3Faの位置に対応する機械角と第6Z相信号立ち下がり被検出部3Fbの位置に対応する機械角とによって規定される機械角の角度範囲である。
第1Z相信号被検出部3Aの第1間隔Ga1、第2Z相信号被検出部3Bの第2間隔Gb1、第3Z相信号被検出部3Cの第3間隔Gc1、第4Z相信号被検出部3Dの第4間隔Gd1、第5Z相信号被検出部3Eの第5間隔Ge1及び第6Z相信号被検出部3Fの第6間隔Gf1は、それぞれ異なる角度範囲に規定されている。第1間隔Ga1内には、P1個のAB相信号被検出部2が位置する。第2間隔Gb1内には、P2個のAB相信号被検出部2が位置する。第3間隔Gc1内には、P3個のAB相信号被検出部2が位置する。第4間隔Gd1内には、P4個のAB相信号被検出部2が位置する。第5間隔Ge1内には、P5個のAB相信号被検出部2が位置する。第6間隔Gf1内には、P6個のAB相信号被検出部2が位置する。各間隔内には、それぞれ異なる数のAB相信号被検出部2が位置する。従って、各セクション内のZ相信号被検出部3によって生成されるZ相信号の立ち上がりから立下りまでの角度範囲においてAB相信号被検出部2によって生成されるAB相信号のパルス数は、セクション毎に異なる。
第1Z相信号立ち下がり被検出部3Abと第2Z相信号立ち上がり被検出部3Baとは、周方向に隣り合って位置している。第1Z相信号立ち下がり被検出部3Abの位置に対応する機械角と第2Z相信号立ち上がり被検出部3Baの位置に対応する機械角とによって規定される角度範囲には、第1セクションS1と第2セクションS2とを区画している係合突起部9aが位置している。第1Z相信号立ち下がり被検出部3Abと第2Z相信号立ち上がり被検出部3Baとは、周方向に第1-2間隔GAbを有するように配置される。
同様に、第2Z相信号立ち下がり被検出部3Bbの機械角と第3Z相信号立ち上がり被検出部3Caの機械角とによって規定される角度範囲には、第2セクションS2と第3セクションS3とを区画している係合突起部9aが位置している。第2Z相信号立ち下がり被検出部3Bbと第3Z相信号立ち上がり被検出部3Caとは、周方向に第2-3間隔Gbcを有するように配置される。
第3Z相信号立ち下がり被検出部3Cbの機械角と第4Z相信号立ち上がり被検出部3Daの機械角とによって規定される角度範囲には、第3セクションS3と第4セクションS4とを区画している係合突起部9aが位置している。第3Z相信号立ち下がり被検出部3Cbと第4Z相信号立ち上がり被検出部3Daとは、周方向に第3-4間隔Gcdを有するように配置される。
第4Z相信号立ち下がり被検出部3Dbの機械角と第5Z相信号立ち上がり被検出部3Eaの機械角とによって規定される角度範囲には、第4セクションS4と第5セクションS5とを区画している係合突起部9aが位置している。第5Z相信号立ち下がり被検出部3b3Dbと第5Z相信号立ち上がり被検出部3Eaとは、周方向に第4-5間隔Gdeを有するように配置される。
第5Z相信号立ち下がり被検出部3Ebの機械角と第6Z相信号立ち上がり被検出部3Faの機械角とによって規定される角度範囲には、第5セクションS5と第6セクションS6とを区画している係合突起部9aが位置している。第5Z相信号立ち下がり被検出部3Ebと第6Z相信号立ち上がり被検出部3Faとは、周方向に第5-6間隔Gefを有するように配置される。
第6Z相信号立ち下がり被検出部3Fbの機械角と第1Z相信号立ち上がり被検出部3Aaの機械角とによって規定される角度範囲には、第6セクションS6と第1セクションS1とを区画している係合突起部9aが位置している。第6Z相信号立ち下がり被検出部3Fbと第1Z相信号立ち上がり被検出部3Aaとは、周方向に第6-1間隔Gfaを有するように配置される。
第1-2間隔GAb、第2-3間隔Gbc、第3-4間隔Gcd、第4-5間隔Gde、第5-6間隔Gef及び第6-1間隔Gfaの角度範囲のいずれかに係合ピン10が位置する場合、回転体9は、係合突起部9aと係合ピン10との接触により各角度範囲内の全域に亘って周方向に回転できない。従って、第1-2間隔GAb、第2-3間隔Gbc、第3-4間隔Gcd、第4-5間隔Gde、第5-6間隔Gef及び第6-1間隔Gfaの角度範囲は、機械角の特定に用いることが出来ない。
図6に示すように、アブソリュートエンコータ1は、回転体9の第1セクションS1の規制範囲内において第1Z相信号被検出部3Aによって第1Z相信号Z1を生成する。合わせて、アブソリュートエンコーダ1は、第1間隔Ga1内においてP1個のAB相信号被検出部2によってP1個のAB相信号を生成する。アブソリュートエンコーダ1は、第2セクションS2の範囲内において第2Z相信号被検出部3Bによって第2Z相信号Z2を生成する。合わせて、アブソリュートエンコーダ1は、第2間隔Gb1内においてP2個のAB相信号被検出部2によってP2個のAB相信号を生成する。アブソリュートエンコーダ1は、第3セクションS3の範囲内において第3Z相信号被検出部3Cによって第3Z相信号Z3を生成する。合わせて、アブソリュートエンコーダ1は、第3間隔Gc1内においてP3個のAB相信号被検出部2によってP3個のAB相信号を生成する。アブソリュートエンコーダ1は、第4セクションS4の範囲内において第4Z相信号被検出部3Dによって第4Z相信号Z4を生成する。合わせて、アブソリュートエンコーダ1は、第4間隔Gd1内においてP4個のAB相信号被検出部2によってP4個のAB相信号を生成する。アブソリュートエンコーダ1は、第5セクションS5の範囲内において第5Z相信号被検出部3Eによって第5Z相信号Z5を生成する。合わせて、アブソリュートエンコーダ1は、第5間隔Ge1内においてP5個のAB相信号被検出部2によってP5個のAB相信号を生成する。アブソリュートエンコーダ1は、第6セクションS6の範囲内において第6Z相信号被検出部3Fによって第6Z相信号Z6を生成する。合わせて、アブソリュートエンコーダ1は、第6間隔Gf1内においてP6個のAB相信号被検出部2によってP6個のAB相信号を生成する。
(連続回転時の回転角度検出)
次に、図2及び図7から図9を用いて、モータ27を制御する駆動装置31(図12参照)によるアブソリュートエンコーダ1を用いたモータ27の回転軸27a(図4参照)の回転角度の検出について説明する。図7は、Z相信号における信号波形の立ち下がりから立ち上がりの間隔GdにおけるAB相信号のパルス数の関係を表すグラフである。図8は、発明の実施形態に係るブレーキ機構により回転範囲が制限されてる状態で回転角度を検出する際の作動状態を表す平面図である。図9は、本発明の実施形態に係るブレーキ機構により回転範囲が制限されてる状態で検出するAB相信号とZ相信号との関係を表す模式図である。
次に、図2及び図7から図9を用いて、モータ27を制御する駆動装置31(図12参照)によるアブソリュートエンコーダ1を用いたモータ27の回転軸27a(図4参照)の回転角度の検出について説明する。図7は、Z相信号における信号波形の立ち下がりから立ち上がりの間隔GdにおけるAB相信号のパルス数の関係を表すグラフである。図8は、発明の実施形態に係るブレーキ機構により回転範囲が制限されてる状態で回転角度を検出する際の作動状態を表す平面図である。図9は、本発明の実施形態に係るブレーキ機構により回転範囲が制限されてる状態で検出するAB相信号とZ相信号との関係を表す模式図である。
図2に示すように、駆動装置31は、機械角の原点を基準としてAB相信号検出部4の位置、Z相信号検出部5の投光素子及び受光素子の位置にそれぞれ対応する機械角を記憶している。また、駆動装置31は、第1間隔Ga1内に位置するAB相信号被検出部2の数P1、第2間隔Gb1内に位置するAB相信号被検出部2の数P2、第3間隔Gc1内に位置するAB相信号被検出部2の数P3、第4間隔Gd1内に位置するAB相信号被検出部2の数P4、第5間隔Ge1内に位置するAB相信号被検出部2の数P5、及び、第6間隔Gf1内に位置するAB相信号被検出部2の数P6を記憶している(図6参照)。つまり、駆動装置31は、アブソリュートエンコーダ1によって各セクションにおいて生成されるZ相信号の立ち上がりと立ち下がりとの間に生成されるAB相信号の数を記憶している。
駆動装置31は、回転板7または回転体9が反時計回りに回転する場合、A相信号、B相信号及びZ相信号のパルス数をカウントアップ(加算)し、回転板7または回転体9が反時計回りに回転する場合、AB相信号及びZ相信号のパルス数をカウントダウン(減算)するものとする。
図7に示すように、モータ27が反時計回りに連続回転している場合、駆動装置31は、アブソリュートエンコーダ1からAB相信号を取得するとともに第1Z相信号Z1から第6Z相信号Z6を順に取得する。また、駆動装置31は、取得したAB相信号及びZ相信号をカウントアップする。駆動装置31は、例えば、第1Z相信号Z1における信号波形の立ち上がりから立ち上がりまでの間に取得するAB相信号のパルス数を算出する。
駆動装置31は、算出したAB相信号のパルス数であるパルスP1が、予め記憶している第1間隔Ga1から第6間隔Gf1のそれぞれにおいて生成されるAB相信号のパルス数のいずれに等しいか判断する。駆動装置31は、算出したAB相信号のパルス数が第1間隔Ga1において生成されるパルス数に等しいと判断すると、取得したZ相信号を第1Z相信号Z1に特定する。
駆動装置31は、第1Z相信号Z1の立ち上がりを生成した第1Z相信号立ち上がり被検出部3Aaの機械角から第1Z相信号立ち上がり被検出部3Aaが第1Z相信号Z1の立ち上がりを生成した時点でのZ相信号検出部5の位置に対応する位置における回転軸27aの機械角θzを算出する(図2参照)。駆動装置31は、第1Z相信号Z1の立ち上がりを取得した時点からのAB相信号のパルス数をカウントすることにより、実時間における回転軸27aの機械角360度以内の回転角度を算出する。
駆動装置31は、順次取得するZ相信号における信号波形の立ち上がりから立ち下がりまでの間に取得するAB相信号のパルス数に基づいて回転軸27aの機械角360度以内の回転角度を定期的に算出する。
(起動時の回転角度検出)
図8に示すように、モータ27(図4参照)に電流が供給されていない場合、またはモータ27がトルクを出力していない場合、回転体9は、規制位置に切り替えられた係合ピン10によって回転可能な範囲が規制範囲に制限されている。この際、回転体9が回転可能な規制範囲は、セクションを構成している一方の係合突起部9aが係合ピン10に接触する機械角から同一のセクションを構成している他方の係合突起部9aが係合ピン10に接触する機械角までの角度θの範囲である。
図8に示すように、モータ27(図4参照)に電流が供給されていない場合、またはモータ27がトルクを出力していない場合、回転体9は、規制位置に切り替えられた係合ピン10によって回転可能な範囲が規制範囲に制限されている。この際、回転体9が回転可能な規制範囲は、セクションを構成している一方の係合突起部9aが係合ピン10に接触する機械角から同一のセクションを構成している他方の係合突起部9aが係合ピン10に接触する機械角までの角度θの範囲である。
モータ27(図4参照)に電流の供給を開始する場合、駆動装置31は、モータ27の回転軸27a(図4参照)の回転角を検出するために、係合ピン10を規制位置に切り替えた状態で、モータ27の回転軸27aを反時計回り(CCW矢印参照)と時計回り(CW矢印参照)に交互に回転させる。この際、駆動装置31は、過去に取得したAB相信号のパルス数をゼロにリセットしてから回転軸27aを反時計回りと時計回りとに回転させる。駆動装置31は、出力電流値、回転角度等から、回転体9の係合突起部9aが係合ピン10に接触したと判断すると、モータ27回転軸27aを逆の方向に回転させる。駆動装置31は、回転体9のセクション内において、回転体9の係合突起部9aと係合ピン10との接触を検出する度にモータ27回転軸27aの回転方向を反転させる。
アブソリュートエンコーダ1は、回転軸27aの反時計回り方向と時計回り方向の回転に伴ってAB相信号及びZ相信号を生成しつつ、駆動装置31に送信する。
駆動装置31は、取得したAB相信号のパルス数を算出する。駆動装置31は、反時計回りの回転時においてAB相信号のパルス数をカウントアップし、時計回りの回転時においてAB相信号のパルス数をカウントダウンする。
図8と図9とに示すように、駆動装置31は、回転軸27aを複数回の反時計回り(CCW)方向と時計回り(CW)方向に回転させることで、Z相信号における信号波形の立ち上がりから立ち下がりまでの間に生成されるAB相信号のパルス数を取得する。
例えば、回転体9のセクション内に2組のZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとが位置している場合、駆動装置31は、任意のセクション内の任意の回転角度でのAB相信号のパルス数を0として、規制位置に位置する係合ピン10が回転体9のセクションを構成している一方の係合突起部9aに接触するまでモータ27の回転軸27aを反時計回りに回転させる(図8の矢印CCW、図9の矢印A1参照)。駆動装置31は、生成されるAB相信号のパルス数をカウントアップする。駆動装置31は、回転体9の一方の係合突起部9aと係合ピン10との接触を検出すると、モータ27の回転軸27aを停止させる。同時に、駆動装置31は、AB相信号のカウントアップをpパルスPAの時点で停止する。
次に、駆動装置31は、係合ピン10が同一のセクションを構成している他方の係合突起部9aに接触するまでモータ27の回転軸27aを時計回りに回転させる(図8の矢印CW、図9の矢印A2参照)。駆動装置31は、生成されるAB相信号のパルスに応じてパルスPAからカウントダウンする。駆動装置31は、Z相信号の信号波形の立ち上がりを取得すると、立ち上がりパルス数としてパルスPB、パルスPDを記憶する。駆動装置31は、回転体9前記他方の係合突起部9aと係合ピン10との接触を検出すると、モータ27の回転軸27aを停止させる。同時に、駆動装置31は、AB相信号のカウントダウンをパルスPFの時点で停止する。
次に、駆動装置31は、係合ピン10が回転体9の前記一方の係合突起部9aに接触するまでモータ27を反時計回りに回転させる(図8の矢印CCW、図9の矢印A3参照)。駆動装置31は、生成されるAB相信号のパルスに応じてパルスPFからカウントアップする。駆動装置31は、Z相信号を取得すると、立ち上がりパルス数としてパルスPE、パルスPCを記憶する。駆動装置31は、回転体9の一方の係合突起部9aと係合ピン10との接触を検出すると、モータ27の回転軸27aを停止させる。同時に、駆動装置31は、AB相信号のカウントアップをパルスPAの時点で停止する。
駆動装置31は、求めた立ち上がりパルス数の最大値であるパルスPBと立ち上がりパルス数の最小値であるパルスPEとの平均値を算出する。次に、駆動装置31は、立ち上がりパルス数の平均値よりも小さい立ち上がりパルス数のうち最大の立ち上がりパルス数であるパルスPDと、立ち上がりパルス数の平均値よりも大きい立ち上がりパルス数のうち最小の立ち上がりパルス数であるパルスPCとの差を算出する。
駆動装置31は、算出した立ち上がりパルス数の差が、予め記憶しているZ相信号の第1間隔Ga1から第6間隔Gf1のそれぞれで生成されるAB相信号のパルス数のいずれに等しいか判定する。駆動装置31は、等しいパルス数のAB相信号が生成されると判定した間隔から係合ピン10が規制位置に位置している回転体9のセクションを特定する。
このように構成されるアブソリュートエンコーダ1のブレーキ機構8は、少なくとも2つの係合突起部9aを有する回転体9を備える。電源がオフ時におけるモータ27の回転軸27aの回転範囲は、ブレーキ機構8によって、最大でも機械角180度未満の角度範囲に制限される。アブソリュートエンコーダ1は、アブソリュートエンコーダ1の電源がオフの場合にモータ27の回転軸27aが回転しても、機械角180度未満の範囲において回転角度を特定するためのAB相信号とZ相信号とを駆動装置31に出力する。モータ27の回転軸27aの回転範囲は、180度未満である。よって、駆動装置31は、モータ27の回転軸27aの決められた原点からの回転角度と回転回数とを一義的に算出することができる。また、係合突起部9aを6つ有する回転体9によってモータ27の回転軸27aの回転範囲を制限する場合、係合突起部9aの摩耗等によって係合突起部9aのうち隣り合う2つの係合突起部9aが係合ピン10に接触しない状態であってもモータ27の回転軸27aの回転範囲が機械角180度未満の回転角度に制限される。これにより、簡素な構造によってモータ27の回転軸27aの回転角度と回転回数とを算出可能なマルチターンアブソリュートエンコーダを構成することができる。
従来のグレイコードエンコーダや磁気式エンコーダは、電源を投入した直後の静止状態でもアブソリュートエンコーダとして機能し、モータ27の検出対象部材の機械角を検出することができる。しかしながら、グレイコードエンコーダや磁気式エンコーダは、機械角を特定するための計算量が多いため、専用ICが必要になる。また、Z相信号としてM系列を採用したABZ型エンコーダは、電源を投入した直後の静止状態ではアブソリュートエンコーダとして機能しないが、ブレーキ機構等によって制限された制限範囲において回転運動することでアブソリュートエンコーダ化することができる。つまり、前記M系列を採用したABZ型エンコーダは、検出対象部材の機械角を検出できるようになる。しかしながら、前記M系列を採用したABZ型エンコーダは、割り込み頻度のボラティリティが大きいため、ピーク負荷に合わせた専用ICが必要になる。一方、本実施形態におけるアブソリュートエンコーダ1は、回転体9における各セクションのそれぞれの規制範囲に、周方向の間隔がそれぞれ異なる少なくとも一組のZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとが位置する。これにより、アブソリュートエンコーダ1は、回転体9の各セクションにおいてZ相信号の信号波形が立ち上がりから立ち下がりまでにAB相信号被検出部2が生成するAB相信号のパルス数を算出することでセクション内の機械角を特定する。よって、従来のアブソリュートエンコーダよりも計算負荷が小さく専用ICを必要としない。
また、各係合突起部9aの周方向両方に位置するZ相信号立ち下がり被検出部3bとZ相信号立ち上がり被検出部3aとの周方向の間隔である第1-2間隔GAb、第2-3間隔Gbc、第3-4間隔Gcd、第4-5間隔Gde、第5-6間隔Gef及び第6-1間隔Gfaは、同じ角度範囲の間隔が含まれていてもよい。これにより、Z相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの組み合わせによって規定される周方向の間隔のばらつきが小さくなる。従って、機械角360度内の回転角度を取得する各処理の平準化が図られ、モータ27の回転軸27aの回転角度を特定する駆動装置の処理のピーク負荷を低減することができる。一般にリアルタイム制御を実行するためのコンピュータは、ピーク負荷時にもリアルタイム性を失わないような性能が要求される。よって、ピーク負荷を低減することでコンピュータの要求性能を簡素化できる。
また、モータ27は、ブレーキ機構8によって回転範囲が第1セクションS1から第6セクションS6のいずれかに制限されている。駆動装置31は、いずれかのセクションの規制範囲でモータ27を時計回りと反時計回りに複数回、往復回転させる。駆動装置31は、セクションによる規制範囲をAB相信号被検出部2とZ相信号被検出部3とが複数回通過することにより、Z相信号の信号波形における立ち上がりから立ち下がりまでの間に生成されたAB相信号のパルス数を確実に取得することができる。これにより、ブレーキ機構8によってモータ27の回転軸27aの回転範囲が制限されていても、簡素な構造によってモータ27の回転軸27aの回転角度を算出可能なAB相信号及びZ相信号を生成することができる。また、駆動装置31の処理負荷を低減して駆動装置31のハードウェアリソースの設計自由度を向上することができる。
また、複数のAB相信号被検出部2、複数のZ相信号立ち上がり被検出部3a及び複数のZ相信号立ち下がり被検出部3bは、回転体9と一体に回転する回転板7または回転体9に設けられる。従って、AB相信号被検出部2とZ相信号被検出部3とは、互いの位相が固定された状態において一体にモータ27の回転軸27aまたはブレーキ機構8の回転体9に設けられる。これにより、ブレーキ機構8によってモータ27の回転軸27aの回転可能な範囲が制限されていても、簡素な構造によってモータ27の回転軸27aの回転角度を算出可能なAB相信号及びZ相信号を生成することができる。
駆動装置31は、取得したAB相信号のパルス数から、係合ピン10が規制位置に位置しているセクションを特定する。これにより、モータ27が十分なトルクを出力していない起動直後でも回転体9の位置検出精度が向上する。従って、駆動装置31の処理負荷を低減して駆動装置31のハードウェアリソースの設計自由度を向上することができる。
[実施形態2]
<多関節ロボットアーム装置>
図10から図12を用いて、本発明の実施形態2に係る多関節ロボットアーム装置11の全体構成について説明する。多関節ロボットアーム装置11は、上述のアブソリュートエンコーダ1を含む。なお、以下の実施形態において、既に説明した実施形態と同様の点に関してはその具体的説明を省略し、相違する部分を中心に説明する。
<多関節ロボットアーム装置>
図10から図12を用いて、本発明の実施形態2に係る多関節ロボットアーム装置11の全体構成について説明する。多関節ロボットアーム装置11は、上述のアブソリュートエンコーダ1を含む。なお、以下の実施形態において、既に説明した実施形態と同様の点に関してはその具体的説明を省略し、相違する部分を中心に説明する。
図10は、本発明の実施形態に係る多関節ロボットアーム装置11の模式図である。図11は、本発明の実施形態に係る多関節ロボットアーム12に係るS軸回転関節14の模式図である。図12は、本発明の実施形態2に係る多関節ロボットアーム装置11の制御ブロック図である。
(多関節ロボットアーム)
図10に示すように、多関節ロボットアーム装置11は、多関節ロボットアーム12及び多関節ロボットアーム制御装置32を含む。多関節ロボットアーム12は、本実施形態において、リンクが1自由度の回転関節によって基端から先端まで直列に連結されたシリアルリンク機構のロボットアームである。多関節ロボットアーム12は、例えば6軸の垂直多関節ロボットアームである。多関節ロボットアーム12は、例えば製造装置の基台や遠隔操作可能な遠隔操作車両に設けられている。
図10に示すように、多関節ロボットアーム装置11は、多関節ロボットアーム12及び多関節ロボットアーム制御装置32を含む。多関節ロボットアーム12は、本実施形態において、リンクが1自由度の回転関節によって基端から先端まで直列に連結されたシリアルリンク機構のロボットアームである。多関節ロボットアーム12は、例えば6軸の垂直多関節ロボットアームである。多関節ロボットアーム12は、例えば製造装置の基台や遠隔操作可能な遠隔操作車両に設けられている。
多関節ロボットアーム12では、基端部から順に、S軸回転関節14、L軸回転関節16、U軸回転関節18、R軸回転関節20、B軸回転関節22及びT軸回転関節24が、それぞれ、筐体及びリンクによって、直列に連結されている。各軸は、モータユニットMによって回転可能に構成されている。S軸回転関節14、L軸回転関節16、U軸回転関節18、R軸回転関節20、B軸回転関節22及びT軸回転関節24は、それぞれ、モータユニットMを有する。
モータユニットMは、減速機25、アクチュエータ26を含む。多関節ロボットアーム12は、多関節ロボットアーム制御装置32によって制御される。多関節ロボットアーム12は、多関節ロボットアーム制御装置32から出力される制御信号を各軸のアクチュエータ26に含まれる駆動装置31によって取得する。また、多関節ロボットアーム12は、各軸のモータユニットMのモータ27の出力に関する情報及びアブソリュートエンコーダ1から出力される情報を、多関節ロボットアーム制御装置32に送信する。
図11に示すように、S軸回転関節14は、多関節ロボットアーム12全体を旋回させる回転関節である。S軸回転関節14は、多関節ロボットアーム12のSL軸用の筐体15に設けられている。S軸回転関節14の出力軸には、ベース部材13が固定されている。ベース部材13は、多関節ロボットアーム12の設置面に固定されている。S軸回転関節14は、多関節ロボットアーム12の設置面に対して垂直な方向にS軸回転関節14の軸線が延びるように配置されている。
図10に示すように、L軸回転関節16は、下碗リンク17を揺動させる回転関節である。L軸回転関節16は、SL軸用の筐体15に設けられている。L軸回転関節16は、S軸回転関節14の軸線に対して垂直な方向にL軸回転関節16の軸線が延びるように配置されている。L軸回転関節16の出力軸には、下碗リンク17の一端部が固定されている。
U軸回転関節18は、上腕リンク21を揺動させる回転関節である。U軸回転関節18は、多関節ロボットアーム12のUR軸用の筐体19に設けられている。U軸回転関節18の出力軸は、下碗リンク17の他端部に固定されている。U軸回転関節18は、L軸回転関節16の軸線に対して平行な方向にU軸回転関節18の軸線が延びるように配置されている。
R軸回転関節20は、上腕リンク21を回転させる回転関節である。R軸回転関節20は、UR軸用の筐体19に設けられている。R軸回転関節20は、U軸回転関節18の軸線に対して垂直な方向にR軸回転関節20の軸線が延びるように配置されている。R軸回転関節20の出力軸には、上腕リンク21の一端部が固定されている。
B軸回転関節22は、T軸回転関節24を揺動させる回転関節である。B軸回転関節22は、多関節ロボットアーム12のBT軸用の筐体23に設けられている。B軸回転関節22の出力軸は、上腕リンク21の他端部に固定されている。B軸回転関節22は、R軸回転関節20の軸線に対して垂直な方向にB軸回転関節22の軸線が延びるように配置されている。
T軸回転関節24は、図示しないエンドエフェクタを回転させる回転関節である。T軸回転関節24は、BT軸用の筐体23に設けられている。T軸回転関節24は、B軸回転関節22の軸線に対して垂直な方向にT軸回転関節24の軸線が延びるように配置されている。T軸回転関節24の出力軸は、エンドエフェクタ取り付け部を有している。
このように構成される多関節ロボットアーム12は、各軸のモータユニットMによってX軸、Y軸、Z軸方向の併進3自由度とX軸、Y軸、Z軸まわりの回転3自由度の合計6自由度を有する。従って、多関節ロボットアーム12は、多関節ロボットアーム12の可動空間内において、T軸の出力軸を任意の位置に移動させることができるとともに任意の姿勢にすることができる。
(モータユニット)
図10と図11に示すように、S軸、L軸、U軸、R軸、B軸、T軸のモータユニットMは、それぞれ、多関節ロボットアーム制御装置32からの制御信号に従って、出力軸を回転させる駆動装置である。各軸のモータユニットMは、減速機25と、アクチュエータ26とを含む。つまり、モータユニットMは、減速機25、モータ27、ブレーキ機構8を含むアブソリュートエンコーダ1及びモータ27を制御するコンピュータである駆動装置31が多関節ロボットアーム12の筐体15,筐体19(図2参照),筐体23(図2参照)の内部に配置されている。なお、各軸のモータユニットMは同一の構成を有するため、以下では、S軸回転関節14について説明を行う。
図10と図11に示すように、S軸、L軸、U軸、R軸、B軸、T軸のモータユニットMは、それぞれ、多関節ロボットアーム制御装置32からの制御信号に従って、出力軸を回転させる駆動装置である。各軸のモータユニットMは、減速機25と、アクチュエータ26とを含む。つまり、モータユニットMは、減速機25、モータ27、ブレーキ機構8を含むアブソリュートエンコーダ1及びモータ27を制御するコンピュータである駆動装置31が多関節ロボットアーム12の筐体15,筐体19(図2参照),筐体23(図2参照)の内部に配置されている。なお、各軸のモータユニットMは同一の構成を有するため、以下では、S軸回転関節14について説明を行う。
図11に示すように、S軸回転関節14の減速機25は、出力軸を入力軸の回転速度に対して減速した状態において回転させるとともに、前記出力軸の出力トルクとして前記減速に反比例した出力トルクを生成する装置である。減速機25は、多関節ロボットアーム12の筐体15内に設けられている。減速機25のハウジングは、多関節ロボットアーム12の筐体15の内部に固定されている。減速機25の出力軸は、ベース部材13に固定されている。
S軸回転関節14のアクチュエータ26は、減速機25と、モータ27と、アブソリュートエンコーダ1と駆動装置31とを含む。S軸回転関節14は、多関節ロボットアーム12の筐体15内に設けられている。つまり、多関節ロボットアーム12の筐体15内には、減速機25、モータ27、ブレーキ機構8を含むアブソリュートエンコーダ1及び駆動装置31が配置されている。
アクチュエータ26に含まれるモータ27は、動力の発生源である。本実施形態では、モータ27は、筒状のステータ内に、ロータが回転可能に配置された、いわゆるインナーロータ型のモータ27である。ロータには、軸心に沿って延びる回転軸27aが軸方向に貫通した状態において固定される。モータ27は、減速機25のケースにおいて動力が入力される一端部に固定されている。回転軸27aの一端部は、モータ27の出力軸として減速機25の入力軸に連結されている。
アクチュエータ26に含まれるアブソリュートエンコーダ1は、モータ27における回転軸27aの機械角360度以内の回転角度を検出する。アブソリュートエンコーダ1は、機械角360度以内の回転角度を検出するためのAB相信号と機械角の原点を検出するためのZ相信号とを、駆動装置31と多関節ロボットアーム制御装置32(図10参照)とに送信する。アブソリュートエンコーダ1は、モータ27における回転軸27aの他端部に設けられている。つまり、ブレーキ機構8を含むアブソリュートエンコーダ1とは、モータ27の回転軸27aに設けられている。
アブソリュートエンコーダ1に含まれるブレーキ機構8は、モータ27における回転軸27aの回転を規制する。本実施形態では、ブレーキ機構8は、回転軸27aの他端部に設けられている。ブレーキ機構8は、機械的な係合によってモータ27の回転軸27aの回転を制限する。なお、ブレーキ機構8は、回転軸27aの一端部に設けられていてもよい。
アクチュエータ26に含まれる駆動装置31は、モータ27に供給する駆動電流を制御する。駆動装置31は、例えば、コンピュータである。駆動装置31は、多関節ロボットアーム12の筐体15内に設けられている。駆動装置31は、多関節ロボットアーム制御装置32からの制御信号に応じた電流をモータ27に供給する。また、駆動装置31は、アブソリュートエンコーダ1のAB相信号とZ相信号とをフィードバックパルスとして取得する。駆動装置31は、指令パルスに対するフィードバックパルスの差分に応じた電流をモータ27に供給するフィードバック制御によって、モータ27を制御する(図12参照)。
このように構成されるS軸回転関節14は、減速機25と、アクチュエータ26に含まれるモータ27及びアブソリュートエンコーダ1が一体に構成されている。また、モータユニットMは、減速機25、アクチュエータ26及び駆動装置31が多関節ロボットアーム12の筐体15内に配置された機電一体構造として構成されている。S軸回転関節14では、モータ27の回転によって減速機25の出力軸が回転することにより、多関節ロボットアーム12の筐体15とアクチュエータ26とを一体に回転させる。
図12に示すように、多関節ロボットアーム制御装置32は、多関節ロボットアーム12を制御する装置である。多関節ロボットアーム制御装置32は、実体的には、CPU、ROM、RAM、HDD等がバスによって接続された構成であってもよく、あるいはワンチップのLSI等からなる構成であってもよい。多関節ロボットアーム制御装置32には、多関節ロボットアーム12の動作を制御するために種々のプログラムやデータが格納されている。
多関節ロボットアーム制御装置32は、S軸回転関節14、L軸回転関節16、U軸回転関節18、R軸回転関節20、B軸回転関節22及びT軸回転関節24に含まれる駆動装置31にそれぞれ接続されている。多関節ロボットアーム制御装置32は、各軸の駆動装置31に制御信号を送信することができる。また、多関節ロボットアーム制御装置32は、各軸のモータユニットMからモータ27の回転位置情報を取得することができる。
上述のアブソリュートエンコーダ1が接続された駆動装置31は、隣り合うZ相信号における信号波形の立ち下がりから立ち上がりまでに生成されるAB相信号のパルス数を記憶している。従って、駆動装置31は、Z相信号の信号波形の立ち下がりから立ち上がりまでに生成されるAB相信号のパルス数と位相とをカウントすることで、回転軸27aの機械角360度以内の回転角度を特定することができる。これにより、駆動装置31は、エンコーダ専用のICを追加することなく、モータ27の回転軸27aの回転角を取得する処理を簡易かつ高精度にすることができる。よって、ブレーキ機構8によってモータの回転可能な範囲が制限されていても、簡素な構造によってモータ27の回転軸27aの回転角度を算出可能なAB相信号及びZ相信号を生成することができる。
[実施形態3]
<他のZ相信号の間隔のばらつき>
以下に、図5と図13とを用いて、本発明の実施形態4に係るアブソリュートエンコーダ1Aについて説明する。図13は、本発明の実施形態3に係るAB相信号の信号波形とZ相信号の信号波形を表す模式図である。本実施形態において、回転体9の各セクションの角度範囲には、2つのZ相信号被検出部3が位置付けられている。2つのZ相信号被検出部3は、周方向に隣り合っている。また、各Z相信号被検出部3のZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとは、周方向に隣り合っている。
<他のZ相信号の間隔のばらつき>
以下に、図5と図13とを用いて、本発明の実施形態4に係るアブソリュートエンコーダ1Aについて説明する。図13は、本発明の実施形態3に係るAB相信号の信号波形とZ相信号の信号波形を表す模式図である。本実施形態において、回転体9の各セクションの角度範囲には、2つのZ相信号被検出部3が位置付けられている。2つのZ相信号被検出部3は、周方向に隣り合っている。また、各Z相信号被検出部3のZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとは、周方向に隣り合っている。
図13に示すように、各セクションにおける各Z相信号被検出部3のZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの周方向の間隔である間隔G1、間隔G2は、全て同じ間隔である。また、各セクションにおける一方のZ相信号被検出部3のZ相信号立ち上がり被検出部3aと他方のZ相信号被検出部3のZ相信号立ち上がり被検出部3aとの周方向の間隔である間隔G3は、全て異なる間隔である。また、各セクションにおける一方のZ相信号被検出部3のZ相信号立ち下がり被検出部3bと他方のZ相信号被検出部3のZ相信号立ち下がり被検出部3bとの周方向の間隔である間隔G4は、全て異なる間隔である。また、各セクションにおける一方のZ相信号被検出部3のZ相信号立ち上がり被検出部3aと他方のZ相信号被検出部3のZ相信号立ち下がり被検出部3bとの周方向の間隔である間隔G5は、全て異なる間隔である。また、また、各セクションにおける一方のZ相信号被検出部3のZ相信号立ち下がり被検出部3bと他方のZ相信号被検出部3のZ相信号立ち上がり被検出部3aとの周方向の間隔である間隔G6は、全て異なる間隔である。
このように構成されるアブソリュートエンコーダ1Aは、周方向に隣り合うZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの間にAB相信号被検出部2が位置するように配置される。また、アブソリュートエンコーダ1Aは、機械角360度の回転において生成するAB相信号のパルス数(例えば360パルス)よりも少ないパルス数(例えば12パルス)のZ相信号を生成する。従って、間隔G1、間隔G2、間隔G3、間隔G4、間隔G5及び間隔G6は、AB相信号のパルス数で表現することができる。
アブソリュートエンコーダ1Aは、各セクションにおける間隔G1及び間隔G2によって規定される角度範囲の全てにおいて、同じパルス数のAB相信号を生成する。また、アブソリュートエンコーダ1Aは、各セクションにおける間隔G3によって規定される角度範囲の全てにおいて、異なるパルス数のAB相信号を生成する。同様に、アブソリュートエンコーダ1Aは、各セクションにおける間隔G4によって規定される角度範囲の全てにおいて、異なるパルス数のAB相信号を生成する。同様に、アブソリュートエンコーダ1Aは、各セクションにおける間隔G5によって規定される角度範囲の全てにおいて、異なるパルス数のAB相信号を生成する。同様に、アブソリュートエンコーダ1Aは、各セクションにおける間隔G6によって規定される角度範囲の全てにおいて、異なるパルス数のAB相信号を生成する。
この際、Z相信号被検出部3は、各セクションの規制範囲のそれぞれにおいて、次の条件のうち少なくとも一つを満たす。
各セクションのZ相信号立ち上がり被検出部3aとZ相信号立ち上がり被検出部3aとは、各セクションの間隔G3の角度範囲においてそれぞれ生成されるAB相信号のパルス数の中央値を基準とする所定の間隔内に収まるように各セクションの制限範囲内に位置する。具体的には、各セクションのZ相信号立ち上がり被検出部3aとZ相信号立ち上がり被検出部3aとは、各セクションの間隔G3の角度範囲においてそれぞれ生成されるAB相信号のパルス数における中央値と最小値との差、及び前記中央値と最大値との差が前記中央値の半分よりも小さくなるように位置する。
または、各セクションのZ相信号立ち下がり被検出部3bとZ相信号立ち下がり被検出部3bとは、各セクションの間隔G4の角度範囲においてそれぞれ生成されるAB相信号のパルス数の中央値を基準とする所定の間隔内に収まるように各セクションの制限範囲内に位置する。具体的には、各セクションのZ相信号立ち下がり被検出部3bとZ相信号立ち下がり被検出部3bとは、各セクションの間隔G4の角度範囲においてそれぞれ生成されるAB相信号のパルス数における中央値と最小値との差、及び前記中央値と最大値との差が前記中央値の半分よりも小さくなるように位置する。
または、各セクションのZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとは、各セクションの間隔G5の角度範囲においてそれぞれ生成されるAB相信号のパルス数の中央値を基準とする所定の間隔内に収まるように各セクションの制限範囲内に位置する。具体的には、各セクションのZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとは、各セクションの間隔G5の角度範囲においてそれぞれ生成されるAB相信号のパルス数における中央値と最小値との差、及び前記中央値と最大値との差が前記中央値の半分よりも小さくなるように位置する。
または、各セクションのZ相信号立ち下がり被検出部3bとZ相信号立ち上がり被検出部3aとは、各セクションの間隔G6の角度範囲においてそれぞれ生成されるAB相信号のパルス数の中央値を基準とする所定の間隔内に収まるように各セクションの制限範囲内に位置する。具体的には、各セクションのZ相信号立ち下がり被検出部3bとZ相信号立ち上がり被検出部3aとは、各セクションの間隔G6の角度範囲においてそれぞれ生成されるAB相信号のパルス数における中央値と最小値との差、及び前記中央値と最大値との差が前記中央値の半分よりも小さくなるように位置する。
例えば、アブソリュートエンコーダ1Aは、第1セクションS1における間隔G3の角度範囲においてAB相信号を24パルス生成する。
同様に、アブソリュートエンコーダ1Aは、第2セクションS2における間隔G3の角度範囲においてAB相信号を29パルス生成する。アブソリュートエンコーダ1Aは、第2セクションS2における間隔G3の角度範囲においてAB相信号を28パルス生成する。アブソリュートエンコーダ1Aは、第4セクションS4における間隔G3の角度範囲においてAB相信号を27パルス生成する。第5セクションS5における間隔G3の角度範囲においてAB相信号を26パルス生成する。アブソリュートエンコーダ1Aは、第6セクションS6における間隔G3の角度範囲においてAB相信号を25パルス生成する。
上述した各セクションの間隔G3の角度範囲において生成されるAB相信号のパルス数の中央値は、26.5パルスである。また、各セクションの間隔G3の角度範囲において生成されるAB相信号のパルス数の最小値は、24パルスである。また、各セクションの間隔G3の角度範囲において生成されるAB相信号のパルス数の最大値は、29パルスである。
各セクションのZ相信号被検出部3は、間隔G3の角度範囲において生成されたAB相信号のパルス数の中央値26.5パルスと最小値24パルスとの差が2.5パルスになるように構成されている。また、各セクションのZ相信号被検出部3は、間隔G3の角度範囲において生成されたAB相信号のパルス数の中央値26.5パルスと最大値との差が2.5パルスになるように構成されている。従って、各セクションのZ相信号被検出部3は、中央値と最小値との差、及び中央値と最大値との差が中央値の半分の13.25パルスよりも小さくなるように構成されている。
Z相信号被検出部3では、隣り合う係合突起部9aによって制限される回転体9の規制範囲の全てにおいて、Z相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの組み合わせによって規定される間隔G3、間隔G4、間隔G5及び間隔G6のうち少なくとも一つの間隔が所定の範囲内のばらつきにおいて全て異なる。つまり、隣り合うZ相信号立ち上がり被検出部3aとZ相信号立ち上がり被検出部3aとの周方向の間隔の組み合わせである間隔G3、間隔G4、間隔G5及び間隔G6がほぼ等間隔に近い状態で、全ての間隔が異なるようにZ相信号立ち上がり被検出部3aとZ相信号立ち上がり被検出部3aとが位置している。
<第3実施形態の別実施形態>
第3実施形態の別実施形態として、アブソリュートエンコーダ1AのZ相信号被検出部3は、各セクションの規制範囲のそれぞれにおいて、更に次の条件を満たすように構成されてもよい。
第3実施形態の別実施形態として、アブソリュートエンコーダ1AのZ相信号被検出部3は、各セクションの規制範囲のそれぞれにおいて、更に次の条件を満たすように構成されてもよい。
各セクションのZ相信号立ち上がり被検出部3aとZ相信号立ち上がり被検出部3aとは、各セクションの間隔G3の角度範囲においてそれぞれ生成されるAB相信号のパルス数における最大値と最小値との差が、各セクションの間隔G3の角度範囲においてそれぞれ生成されるAB相信号のパルス数における中央値の半分よりも小さくなるように位置する。
各セクションのZ相信号立ち下がり被検出部3bとZ相信号立ち下がり被検出部3bとは、各セクションの間隔G4の角度範囲においてそれぞれ生成されるAB相信号のパルス数における最大値と最小値との差が、各セクションの間隔G4の角度範囲においてそれぞれ生成されるAB相信号のパルス数における中央値の半分よりも小さくなるように位置する。
各セクションのZ相信号立ち上がり被検出部3aとZ相信号立ち上がり被検出部3aとは、各セクションの間隔G5の角度範囲においてそれぞれ生成されるAB相信号のパルス数における最大値と最小値との差が、各セクションの間隔G5の角度範囲においてそれぞれ生成されるAB相信号のパルス数における中央値の半分よりも小さくなるように位置する。
各セクションのZ相信号立ち下がり被検出部3bとZ相信号立ち下がり被検出部3bとは、各セクションの間隔G6の角度範囲においてそれぞれ生成されるAB相信号のパルス数における最大値と最小値との差が、各セクションの間隔G6の角度範囲においてそれぞれ生成されるAB相信号のパルス数における中央値の半分よりも小さくなるように位置する。
例えば、各セクションのZ相信号被検出部3は、間隔G3の角度範囲において生成されたAB相信号のパルス数の最大値29パルスと最小値24パルスとの差である5パルスが中央値26.5パルスの半分である13.25パルスよりも小さくなるように生成される。
このようにアブソリュートエンコーダ1Aは、各セクションに位置付けられている2つのZ相信号被検出部3によって規定される間隔G1、間隔G2、間隔G3、間隔G4、間隔G5及び間隔G6のうち少なくとも一つの間隔が各セクションにおいてそれぞれ異なるように配置されている。また、各セクション内の2つのZ相信号被検出部3によって規定される間隔のうち少なくとも一つの間隔の角度範囲において生成されるAB相信号のパルス数は、セクション毎に異なる。よって、実施形態3のアブソリュートエンコーダ1Aは、実施形態1のアブソリュートエンコーダ1と同様の作用効果が得られる。
また、アブソリュートエンコーダ1Aは、各セクションのZ相信号立ち上がり被検出部3aとZ相信号立ち上がり被検出部3aとの周方向の間隔の組み合わせである間隔G3、間隔G4、間隔G5及び間隔G6の角度範囲において生成されるAB相信号の各パルス数のばらつきが各セクションの隙間の角度範囲において生成されるAB相信号のパルス数の中央値を基準とする一定の範囲内になるように構成されている。つまり、アブソリュートエンコーダ1Aは、隣り合うZ相信号の間隔がほぼ等間隔に近い状態で、全ての間隔が異なるように生成する。これにより、前記ブレーキ機構8によってモータ27の回転軸27aの回転範囲が制限されていても、簡素な構造によってモータ27の回転軸27aの回転角度を算出可能なAB相信号及びZ相信号を生成することができる。
また、アブソリュートエンコーダ1Aは、一定の回転速度において、AB相信号のパルス数の中央値を基準として所定時間以上の時間間隔においてZ相信号を生成することができる。これにより、駆動装置31の処理負荷を低減して駆動装置31のハードウェアリソースの設計自由度を向上することができる。
また、Z相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの組み合わせによって規定される間隔が全て異なる場合、つまり、Z相信号の信号波形が全て異なる場合、一つのZ相信号の立ち上がりと立ち下がりの両方において割り込み処理を発生させることにより、アブソリュートエンコーダ1Aの1回転中における絶対位置の検出機会を増やすことができる。一方、駆動装置31は、一つの前記Z相信号の立ち上がりもしくは立ち下がりの一方に割り込み処理を発生させることにより計算負荷を抑えることができる。
[実施形態4]
<訂正部>
以下に、図12と図14とを用いて、本発明の実施形態4に係るアブソリュートエンコーダ1Bについて説明する。図14は、本発明の他の実施形態に係るアブソリュートエンコーダ1Bによるエラー訂正の制御態様を表すフローチャートである。
<訂正部>
以下に、図12と図14とを用いて、本発明の実施形態4に係るアブソリュートエンコーダ1Bについて説明する。図14は、本発明の他の実施形態に係るアブソリュートエンコーダ1Bによるエラー訂正の制御態様を表すフローチャートである。
図12に示すように、アブソリュートエンコーダ1、1Aは、AB相信号のエラーを訂正するエラー訂正部である訂正部33を有していてもよい。
アブソリュートエンコーダ1Bの訂正部33は、AB相信号の一部が生成できなかった場合に、回転軸27aの機械角360度以内の回転角度の訂正を行う。訂正部33は、アブソリュートエンコーダ1Bに設けられている。訂正部33は、各セクションのZ相信号立ち上がり被検出部3aとZ相信号立ち上がり被検出部3aとの周方向の間隔の組み合わせである間隔G1、間隔G2、間隔G3、間隔G4、間隔G5及び間隔G6の角度範囲において生成されるAB相信号の各パルス数を全て記憶している(図8参照)。
図14に示すように、訂正部33は、AB相信号検出部4、及びZ相信号検出部5からAB相信号及びZ相信号を取得する(ステップS110)。さらに、訂正部33は、AB相信号のパルス数のカウントアップ(積算)を開始する(ステップS120)。
訂正部33は、次のZ相信号を取得すると(ステップS130)、その直前(ステップS110)に取得したZ相信号における信号波形の立ち上がりから今回(ステップS130)のステップで取得したZ相信号における信号波形の立ち上がりまでの間に取得したAB相信号のパルス数Pb1を算出する(ステップS140)。
訂正部33は、その直前(ステップS110の前)に算出したAB相信号のパルス数Pa1に基づいて推測される信号波形の立ち上がりから今回(ステップS130)のステップで取得したZ相信号における信号波形の立ち上がりまでに取得したパルス数Pb2を算出する(ステップS150)。訂正部33は、算出したAB相信号のパルス数Pb2が、その直前のZ相信号における信号波形の立ち上がりから立ち上がりまでの間に生成されたパルス数Pa1から推測されるパルス数Pb2に一致しているか否か判定する(ステップS160)。
訂正部33は、算出したAB相信号のパルス数Pb1が、推測されるAB相信号のパルス数Pb2と一致している場合、AB相用コードホイール4cにおける間隔Gdbに該当する部分についてエラーが生じていないと判定し、訂正を行わない(ステップS170)。
訂正部33は、算出したAB相信号のパルス数Pb1が、推測されるAB相信号のパルス数Pb2に一致していない場合、該当するAB相信号被検出部2においてエラーが生じていると判定する(ステップS171)。訂正部33は、算出したパルス数Pb1を、推測されるパルス数Pb2に変更する訂正を実施する。
このように、アブソリュートエンコーダ1Bは、全て異なる角度範囲においてZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bが設けられていることにより、隣接するZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの周方向の間隔における角度範囲において生成されるAB相信号のパルス数の関係が予め定められている。従って、アブソリュートエンコーダ1Bは、特定のZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの周方向の間隔における角度範囲においてAB相信号の一部が生成できないエラーが生じても、訂正部33によって隣接するZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの周方向の間隔における角度範囲において生成されたAB相信号のパルス数からエラーが生じたAB相信号を推測する。これにより、駆動装置31の処理負荷を低減して駆動装置31のハードウェアリソースの設計自由度を向上することができる。
[実施形態5]
<異常検出部>
以下に、図10と図15とを用いて、本発明の実施形態5に係るアブソリュートエンコーダ1、1A、1Bについて説明する。図15は、本発明の他の実施形態に係るアクチュエータ26によるアブソリュートエンコーダ1、1A、1Bの異常検知の制御態様を表すフローチャートである。
<異常検出部>
以下に、図10と図15とを用いて、本発明の実施形態5に係るアブソリュートエンコーダ1、1A、1Bについて説明する。図15は、本発明の他の実施形態に係るアクチュエータ26によるアブソリュートエンコーダ1、1A、1Bの異常検知の制御態様を表すフローチャートである。
図10に示すように、アクチュエータ26の異常検出部30は、アクチュエータ26の一部であるモータ27の駆動装置31に設けられている。異常検出部30は、磁束オブザーバを有している。磁束オブザーバとは、モータ27に印可される電圧と電流とから、モータ27の内部磁束等の状態を算出し、モータ27における回転軸27a(ロータ)の速度又は電気角を推定する数理モデルである。異常検出部30は、アブソリュートエンコーダ1、1A、1BからAB相信号とZ相信号とを取得することができる。
図15に示すように、異常検出部30は、アブソリュートエンコーダ1、1A、1BからAB相信号とZ相信号とを取得する(ステップS210)。異常検出部30は、取得したAB相信号とZ相信号とに基づいて回転軸27aの電気角θxを算出する(ステップS220)。
次に、異常検出部30は、磁束オブザーバで回転軸27aの電気角θyを推定する(ステップS230)。
異常検出部30は、アブソリュートエンコーダ1、1A、1BのAB相信号及びZ相信号から算出した電気角θxと磁束オブザーバによって推定した電気角θyとを比較する。異常検出部30は、電気角θxと電気角θyとの差異(|θx-θy|)が基準値θs以下の場合、AB相信号被検出部2及びZ相信号被検出部3に異常は生じていないと判定する(ステップS250)。
一方、異常検出部30は、電気角θxと電気角θyとの差異(|θx-θy|)が基準値θsよりも大きい場合、回転体9の塑性変形等の変形により、AB相信号被検出部2及びZ相信号被検出部3にひずみが生じ、AB相信号及びZ相信号の生成に異常が発生していると判定する(ステップS251)。
これにより、駆動装置31は、アブソリュートエンコーダ1、1A、1Bの異常を速やかに検出することができるので、ピーク負荷を低減して駆動装置31のハードウェアリソースの設計自由度を向上することができる。なお、異常検出部30は、アブソリュートエンコーダ1、1A、1BのAB相信号検出部4及びZ相信号検出部5に設けてもよい。
[実施形態6]
<他のZ相信号の信号波形>
以下に、図16を用いて、本発明の実施形態5に係るアブソリュートエンコーダ1Cについて説明する。図16は、本発明の他の実施形態に係るAB相信号の信号波形とZ相信号の信号波形を表す模式図である。本実施形態において、回転体9の各セクションの角度範囲には、2つのZ相信号被検出部3が位置付けられている。2つのZ相信号被検出部3は、周方向に隣り合っている。また、各Z相信号被検出部3のZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとは、周方向に隣り合っている。
<他のZ相信号の信号波形>
以下に、図16を用いて、本発明の実施形態5に係るアブソリュートエンコーダ1Cについて説明する。図16は、本発明の他の実施形態に係るAB相信号の信号波形とZ相信号の信号波形を表す模式図である。本実施形態において、回転体9の各セクションの角度範囲には、2つのZ相信号被検出部3が位置付けられている。2つのZ相信号被検出部3は、周方向に隣り合っている。また、各Z相信号被検出部3のZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとは、周方向に隣り合っている。
図16に示すように、アブソリュートエンコーダ1Cは、各セクションにおいて周方向に隣り合うZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとの間隔G1及び間隔G2が全て異なる。従って、アブソリュートエンコーダ1Cは、周方向に隣り合うZ相信号立ち上がり被検出部3aの機械角とZ相信号立ち下がり被検出部3bの機械角とによって規定される角度範囲の全てにおいて、異なるパルス数のAB相信号を生成する。
同様に、アブソリュートエンコーダ1Cは、各セクションにおいて周方向に隣り合うZ相信号立ち下がり被検出部3bの機械角とZ相信号立ち下がり被検出部3bの機械角とによって規定される角度範囲の全てにおいて、異なるパルス数のAB相信号を生成する。同様に、アブソリュートエンコーダ1Cは、各セクションにおいて周方向に隣り合うZ相信号立ち上がり被検出部3aの機械角とZ相信号立ち上がり被検出部3aの機械角とによって規定される角度範囲の全てにおいて、異なるパルス数のAB相信号を生成する。
Z相信号立ち上がり被検出部3aの機械角とZ相信号立ち下がり被検出部3bの機械角との組み合わせによって規定される角度範囲が全て異なる場合、駆動装置31は、一つのZ相信号における信号波形の立ち上がりと立ち下がりの両方において割り込み処理を発生させることができる。これにより、駆動装置31は、回転軸27aの1回転中における回転角の検出機会を増やすことができる。一方、駆動装置31は、一つのZ相信号における信号波形の立ち上がりもしくは立ち下がりの一方に割り込み処理を発生させることで計算負荷を抑えることができる。
(その他の実施形態)
なお、上述の全ての実施形態2において、6軸の垂直多関節ロボットアームである多関節ロボットアーム12は、一例としてS軸回転関節14、L軸回転関節16、U軸回転関節18、R軸回転関節20、B軸回転関節22及びT軸回転関節24がそれぞれリンクによって直列に連結されているが、これに限定されない。各軸のモータユニットMの連結順、連結される際の軸線方向等は、多関節ロボットアームとして成立する構造であれば、上述の実施形態2以外の構成であってもよい。
なお、上述の全ての実施形態2において、6軸の垂直多関節ロボットアームである多関節ロボットアーム12は、一例としてS軸回転関節14、L軸回転関節16、U軸回転関節18、R軸回転関節20、B軸回転関節22及びT軸回転関節24がそれぞれリンクによって直列に連結されているが、これに限定されない。各軸のモータユニットMの連結順、連結される際の軸線方向等は、多関節ロボットアームとして成立する構造であれば、上述の実施形態2以外の構成であってもよい。
また、上述の全ての実施形態において、モータユニットMは、多関節ロボットアーム12の各軸の回転関節として用いられる。しかしながら、モータユニットMの構成は、上述の実施形態の構成に限定されない。例えば、モータユニットは、XYテーブルや垂直搬送装置等、位置制御が必要な装置等に適用してもよい。また、モータユニットは、アクチュエータのみの構成でもよい。
また、上述の全ての実施形態において、アクチュエータ26は、モータ27、ブレーキ機構8を含むアブソリュートエンコーダ1及び駆動装置31が多関節ロボットアーム12の筐体15、筐体19、筐体23内にそれぞれ設けられている機電一体構造として構成されている。しかしながら、アクチュエータの構成は、上述の実施形態の構成に限定されない。例えば、アクチュエータは、駆動装置が多関節ロボットアームの筐体の外部に配置されていてもよい。
また、上述の全ての実施形態において、アブソリュートエンコーダ1、1A、1B、1Cは、反射型の光学式アブソリュートエンコーダである。しかしながら、アブソリュートエンコーダの構成は、上述の実施形態の構成に限定されない。例えば、アブソリュートエンコーダは、透過型の光学式アブソリュートエンコーダ、磁気式アブソリュートエンコーダ又は電磁誘導式アブソリュートエンコーダ等であってもよい。
また、上述の全ての実施形態において、アブソリュートエンコーダ1、1A、1B、1Cは、機械角360度につきAB相信号を360パルス生成する。しかしながら、アブソリュートエンコーダの構成は、上述の実施形態の構成に限定されない。例えば、アブソリュートエンコーダは、必要な回転精度を確保するために必要なパルス数を生成するように構成されていればよい。
また、上述の全ての実施形態において、アブソリュートエンコーダ1、1A、1B、1Cは、機械角360度につきZ相信号が12パルス生成する。しかしながら、アブソリュートエンコーダの構成は、上述の実施形態の構成に限定されない。例えば、アブソリュートエンコーダは、機械角360度につきZ相信号が2パルス以上、且つAB相信号のパルス数未満であればよい。
また、上述の全ての実施形態において、アブソリュートエンコーダ1、1A、1B、1Cは、全ての周方向に隣り合うZ相信号立ち上がり被検出部3aの機械角とZ相信号立ち下がり被検出部3bの機械角との組み合わせによって規定される角度範囲において同一のAB相信号のパルス数となる角度範囲が存在するようにZ相信号立ち上がり被検出部3aとZ相信号立ち下がり被検出部3bとを配置してもよい。例えば12の間隔が6種類のパルス数によって構成される場合、コンピュータは、Z相信号を3個取得し、AB相信号のパルス数を比較することでモータにおける回転軸の回転角を検出することができる。
また、上述の全ての実施形態において、回転板7は、ブレーキ機構8の回転体9に設けられている。しかしながら、回転板7は、上述の実施形態の構成に限定されない。例えば、回転板7は、モータの回転軸に直接固定されていてもよい。
また、上述の全ての実施形態において、ブレーキ機構8の回転体9は、係合突起部9aを周方向に等間隔に6つ有している。しかしながら、ブレーキ機構8の回転体9は、上述の実施形態の構成に限定されない。例えば、ブレーキ機構の回転体は、複数の係合突起部を周方向に等間隔に有していればよい。また、回転体は、複数の係合突起部を周方向に不等間隔に有していてもよい。
以上、本発明の実施の形態を説明したが、上述した実施の形態は本発明を実施するための例示に過ぎない。よって、上述した実施の形態に限定されることなく、その趣旨を逸脱しない範囲内で上述した実施の形態を適宜変形して実施することが可能である。
1、1A、1B、1C アブソリュートエンコーダ
2 AB相信号被検出部2
3 Z相信号被検出部
3a Z相信号立ち上がり被検出部
3b Z相信号立ち下がり被検出部
4 AB相信号検出部
5 Z相信号検出部
6 出力部
7 回転板
8 ブレーキ機構
9 回転体
9a 係合突起部
10 係合ピン
11 多関節ロボットアーム装置
12 多関節ロボットアーム
27 モータ
31 駆動装置
27a 回転軸 G1、G2、G3、G4、G5、G6 隙間
S1、S2、S3、S4、S5、S6 セクション
2 AB相信号被検出部2
3 Z相信号被検出部
3a Z相信号立ち上がり被検出部
3b Z相信号立ち下がり被検出部
4 AB相信号検出部
5 Z相信号検出部
6 出力部
7 回転板
8 ブレーキ機構
9 回転体
9a 係合突起部
10 係合ピン
11 多関節ロボットアーム装置
12 多関節ロボットアーム
27 モータ
31 駆動装置
27a 回転軸 G1、G2、G3、G4、G5、G6 隙間
S1、S2、S3、S4、S5、S6 セクション
Claims (12)
- 複数の係合突起部を有する回転体と前記複数の係合突起部のうち一つの係合突起部に係合する係合ピンとを有するブレーキ機構と、
機械角360度の範囲内に周方向に等間隔に配置され、AB相信号を生成する複数のAB相信号被検出部と、
Z相信号の立ち上がりを生成するZ相信号立ち上がり被検出部及びZ相信号の立ち下がりを生成するZ相信号立ち下がり被検出部をそれぞれ有し、前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部とが周方向に交互に位置するように、機械角360度の範囲内に周方向に配置される複数のZ相信号被検出部と、
前記AB相信号と前記Z相信号とをコンピュータに出力可能な出力部と、
を有し、
計測対象部材の機械角360度以内の回転角度の取得に用いられるアブソリュートエンコーダであって、
前記AB相信号被検出部と前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部と前記回転体とは、一体に回転し、
前記回転体の係合突起部は、前記回転体の回転範囲を、複数の規制範囲に分割するように設けられていて、
前記複数のZ相信号被検出部は、
周方向に隣り合う前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との間に前記AB相信号被検出部が位置するように配置されるとともに、
前記複数の規制範囲のそれぞれに、前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部を少なくとも一組含むとともに、周方向に隣り合う前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との周方向の間隔、周方向に隣り合う前記Z相信号立ち上がり被検出部と前記前記Z相信号立ち上がり被検出部との周方向の間隔、及び、周方向に隣り合うZ相信号立ち下がり被検出部と前記Z相信号立ち下がり被検出部との周方向の間隔のうち少なくとも一つの間隔が前記複数の規制範囲においてそれぞれ異なるように配置されている、
アブソリュートエンコーダ。 - 請求項1に記載のアブソリュートエンコーダにおいて、
前記複数のZ相信号被検出部における前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部は、
周方向に隣り合う前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部によって規定される周方向の角度範囲のうち前記係合突起部が位置する角度範囲における前記Z相信号立ち上がり被検出部と前記Z相信号立ち下がり被検出部との周方向の間隔が、前記係合突起部が位置する他の角度範囲における間隔の少なくとも一つと同じになるように、配置されている、
アブソリュートエンコーダ。 - 請求項1または2に記載のアブソリュートエンコーダにおいて、
前記回転体は、
前記機械角360度の範囲内に、前記係合突起部を少なくとも2つ有する、
アブソリュートエンコーダ。 - 請求項1から3のいずれか一項に記載のアブソリュートエンコーダにおいて、
前記回転体は、
前記機械角360度の範囲内に、前記係合突起部を6つ有する、
アブソリュートエンコーダ。 - 請求項1から4のいずれか一項に記載のアブソリュートエンコーダにおいて、
前記Z相信号被検出部は、
前記複数の規制範囲のそれぞれにおいて、
前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との周方向の間隔が全て異なり、且つ前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との周方向の間隔における中央値と最も小さい間隔との差、及び前記中央値と最も大きい間隔との差が前記中央値の半分よりも小さいZ相信号被検出部と、
前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔が全て異なり、且つ複数の前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔における中央値と最も小さい間隔との差、及び前記中央値と最も大きい間隔との差が前記中央値の半分よりも小さいZ相信号被検出部と、
前記隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔が全て異なり、且つ複数の前記隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔における中央値と最も小さい間隔との差、及び前記中央値と最も大きい間隔との差が前記中央値の半分よりも小さいZ相信号被検出部と、のうち少なくとも一つのZ相信号被検出部を含む、
アブソリュートエンコーダ。 - 請求項5に記載のアブソリュートエンコーダにおいて、
前記Z相信号被検出部における前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部は、
前記複数の規制範囲のそれぞれにおいて、
前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との間隔が全て異なる場合、複数の前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち下がり被検出部との間隔における最も小さい間隔と最も大きい間隔との差が前記中央値の半分よりも小さくなるように配置され、
前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔が全て異なる場合、複数の前記隣り合うZ相信号立ち上がり被検出部とZ相信号立ち上がり被検出部との間隔における最も小さい間隔と最も大きい間隔との差が前記中央値の半分よりも小さくなるように配置され、
前記隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔が全て異なる場合、複数の前記隣り合うZ相信号立ち下がり被検出部とZ相信号立ち下がり被検出部との間隔における最も小さい間隔と最も大きい間隔との差が前記中央値の半分よりも小さくなるように配置される、
アブソリュートエンコーダ。 - 請求項1から6のいずれか一項に記載のアブソリュートエンコーダにおいて、
前記回転体と一体に回転する回転板を有し、
前記回転板は、前記複数のAB相信号被検出部、前記複数のZ相信号立ち上がり被検出部及び前記複数のZ相信号立ち下がり被検出部を有する、
アブソリュートエンコーダ。 - 請求項1から6に記載のアブソリュートエンコーダにおいて、
前記回転体は、前記複数のAB相信号被検出部、前記複数のZ相信号立ち上がり被検出部及び前記複数のZ相信号立ち下がり被検出部を有する、
アブソリュートエンコーダ。 - 請求項8に記載のアブソリュートエンコーダにおいて、
前記Z相信号被検出部が設けられた前記回転体の変形による前記Z相信号の異常を検出する異常検出部を備える、
アブソリュートエンコーダ。 - 請求項9に記載のアブソリュートエンコーダにおいて、
モータに設けられ、
前記異常検出部は、前記Z相信号の異常を前記モータの電気角に基づいて検出する、
アブソリュートエンコーダ。 - 請求項1から請求項10のいずれか一項に記載のアブソリュートエンコーダにおいて、
前記AB相信号被検出部を検出するAB相信号検出部と、
前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部を検出するZ相信号検出部と、を有し、
前記AB相信号は、前記AB相信号被検出部が前記AB相信号検出部によって検出されることにより生成され、
前記Z相信号は、前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部が前記Z相信号検出部によって検出されることにより生成され、
複数の前記Z相信号における信号波形の立ち上がりから立ち下がりまでの間隔、隣り合う信号波形の立ち上がりから立ち上がりまでの間隔、隣り合う信号波形の立ち下がりから立ち下がりまでの間隔または隣り合う信号波形の立ち下がりから立ち上がりまでの間隔で生成される前記AB相信号の数から前記AB相信号のエラーを訂正するエラー訂正部を備える、
アブソリュートエンコーダ。 - 請求項1から11に記載のアブソリュートエンコーダにおいて、
前記ブレーキ機構によって前記回転体の回転の範囲が制限されている場合、前記回転体が回転可能な範囲内において時計回りと反時計回りとに複数回、回転している際に前記Z相信号検出部が前記Z相信号立ち上がり被検出部及び前記Z相信号立ち下がり被検出部を検出する、
アブソリュートエンコーダ。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021571283A JP7368507B2 (ja) | 2020-01-17 | 2021-01-18 | アブソリュートエンコーダ |
US17/866,369 US12092498B2 (en) | 2020-01-17 | 2022-07-15 | Absolute encoder |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JPPCT/JP2020/001526 | 2020-01-17 | ||
PCT/JP2020/001526 WO2021144965A1 (ja) | 2020-01-17 | 2020-01-17 | アブソリュートエンコーダ及びアブソリュートエンコーダを備えるアクチュエータ |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US17/866,369 Continuation-In-Part US12092498B2 (en) | 2020-01-17 | 2022-07-15 | Absolute encoder |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2021145460A1 true WO2021145460A1 (ja) | 2021-07-22 |
Family
ID=76864079
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2020/001526 WO2021144965A1 (ja) | 2020-01-17 | 2020-01-17 | アブソリュートエンコーダ及びアブソリュートエンコーダを備えるアクチュエータ |
PCT/JP2021/001529 WO2021145460A1 (ja) | 2020-01-17 | 2021-01-18 | アブソリュートエンコーダ |
Family Applications Before (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2020/001526 WO2021144965A1 (ja) | 2020-01-17 | 2020-01-17 | アブソリュートエンコーダ及びアブソリュートエンコーダを備えるアクチュエータ |
Country Status (3)
Country | Link |
---|---|
US (1) | US12092498B2 (ja) |
JP (1) | JP7368507B2 (ja) |
WO (2) | WO2021144965A1 (ja) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63289417A (ja) * | 1987-05-21 | 1988-11-25 | Hitachi Seiko Ltd | パルス・エンコ−ダ |
JP2005207864A (ja) * | 2004-01-22 | 2005-08-04 | Denso Corp | エンコーダ検査装置 |
JP2011120444A (ja) * | 2009-10-29 | 2011-06-16 | Toyota Motor Corp | モータ制御装置 |
JP2017181235A (ja) * | 2016-03-30 | 2017-10-05 | 日本電産サンキョー株式会社 | モータシステム |
JP2020122659A (ja) * | 2019-01-29 | 2020-08-13 | 日本電産株式会社 | 位置検出装置、モータシステム及び位置検出方法 |
Family Cites Families (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6474411A (en) * | 1987-09-16 | 1989-03-20 | Yamaha Corp | Position detector |
US5293107A (en) | 1993-02-24 | 1994-03-08 | Fanuc Robotics North America, Inc. | Motorized rotary joint and method of constructing a modular robot utilizing same |
JPH0740269A (ja) * | 1993-07-30 | 1995-02-10 | Yamaha Motor Co Ltd | 産業用ロボットの原点調整方法および同装置 |
JPH1038557A (ja) * | 1996-07-26 | 1998-02-13 | Alps Electric Co Ltd | 多回転体の回転角検出装置 |
JP2004174704A (ja) | 2002-11-14 | 2004-06-24 | Sony Corp | アクチュエータ装置及び多軸型ロボット |
GB2396671B (en) | 2002-12-23 | 2005-12-14 | Link Treasure Ltd | Brake device of a pushcart |
JP2006329783A (ja) * | 2005-05-25 | 2006-12-07 | Sokkia Co Ltd | インクリメンタルエンコーダ |
KR100863096B1 (ko) * | 2007-07-11 | 2008-10-13 | 현대자동차주식회사 | 조향각 검출 장치 |
DE102008053986A1 (de) * | 2008-10-30 | 2010-05-06 | Dr. Johannes Heidenhain Gmbh | Absolute Winkelcodierung und Winkelmessvorrichtung |
JP2010151269A (ja) | 2008-12-26 | 2010-07-08 | Thk Co Ltd | 回転駆動装置、ロボットの関節構造及びロボットアーム |
JP5869255B2 (ja) | 2011-08-11 | 2016-02-24 | 株式会社ユニバンス | 駆動力断接装置 |
WO2014207846A1 (ja) | 2013-06-26 | 2014-12-31 | 株式会社安川電機 | ストッパ機構、関節機構、およびロボット |
US9300528B2 (en) | 2013-12-13 | 2016-03-29 | International Business Machines Corporation | Trill network with multipath redundancy |
JP6193938B2 (ja) * | 2015-08-31 | 2017-09-06 | ファナック株式会社 | 信号の周波数特性から異物浸入を検知する機能を有する回転角度検出器 |
KR20170053499A (ko) | 2015-11-06 | 2017-05-16 | 삼성중공업 주식회사 | 다관절 매니퓰레이터 |
TWI674179B (zh) | 2016-01-18 | 2019-10-11 | 廣明光電股份有限公司 | 機器手臂解除剎車的方法(二) |
JP6610477B2 (ja) | 2016-03-30 | 2019-11-27 | 日本電産株式会社 | 回転アクチュエータおよびロボット |
WO2017169580A1 (ja) | 2016-03-30 | 2017-10-05 | 日本電産サンキョー株式会社 | 回転アクチュエータおよびロボット |
JP6736679B2 (ja) | 2016-09-26 | 2020-08-05 | ヤマハ発動機株式会社 | 減速機付きモータ及び多関節ロボット |
KR102608950B1 (ko) | 2016-11-28 | 2023-11-30 | 한국전기연구원 | 다관절 로봇의 스토퍼장치 |
US10022861B1 (en) | 2017-04-27 | 2018-07-17 | Engineering Services Inc. | Two joint module and arm using same |
CN207139843U (zh) | 2017-07-20 | 2018-03-27 | 青岛欧开智能系统有限公司 | 一种协作机器人模块化球关节 |
CN207824926U (zh) | 2017-12-28 | 2018-09-07 | 上海电姆机器人有限公司 | 一种具有交叉结构的动力组内嵌式机器人关节 |
JP7181703B2 (ja) | 2018-04-20 | 2022-12-01 | ミネベアミツミ株式会社 | 回転規制機構、回転アクチュエータおよびロボット |
-
2020
- 2020-01-17 WO PCT/JP2020/001526 patent/WO2021144965A1/ja active Application Filing
-
2021
- 2021-01-18 JP JP2021571283A patent/JP7368507B2/ja active Active
- 2021-01-18 WO PCT/JP2021/001529 patent/WO2021145460A1/ja active Application Filing
-
2022
- 2022-07-15 US US17/866,369 patent/US12092498B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63289417A (ja) * | 1987-05-21 | 1988-11-25 | Hitachi Seiko Ltd | パルス・エンコ−ダ |
JP2005207864A (ja) * | 2004-01-22 | 2005-08-04 | Denso Corp | エンコーダ検査装置 |
JP2011120444A (ja) * | 2009-10-29 | 2011-06-16 | Toyota Motor Corp | モータ制御装置 |
JP2017181235A (ja) * | 2016-03-30 | 2017-10-05 | 日本電産サンキョー株式会社 | モータシステム |
JP2020122659A (ja) * | 2019-01-29 | 2020-08-13 | 日本電産株式会社 | 位置検出装置、モータシステム及び位置検出方法 |
Also Published As
Publication number | Publication date |
---|---|
WO2021144965A1 (ja) | 2021-07-22 |
US20220364887A1 (en) | 2022-11-17 |
US12092498B2 (en) | 2024-09-17 |
JPWO2021145460A1 (ja) | 2021-07-22 |
JP7368507B2 (ja) | 2023-10-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10666171B2 (en) | Motor System | |
US9020774B2 (en) | Encoder system, signal processing method, and transmission signal generation and output device | |
EP2372313B1 (en) | Rotation detecting device and bearing having rotation detecting device | |
JP6578499B1 (ja) | 汎用型ロータリーエンコーダ及びそれを用いたサーボモータ | |
JP6224349B2 (ja) | ステッピングモータ制御システム及びステッピングモータ制御方法 | |
CN115211006A (zh) | 具有带绝对编码器的集成致动器的电机和使用方法 | |
JP2022511533A (ja) | デュアルアブソリュートエンコーダ | |
JP2010263777A (ja) | 電気制御アクチュエータ | |
JP4702526B2 (ja) | 角度位置検出装置及び方法 | |
TW202122756A (zh) | 通用型旋轉編碼器 | |
KR101234511B1 (ko) | 자기 엔코더로 로봇의 위치제어를 실시하는 로봇 엑츄에이터 | |
US20140148948A1 (en) | Method For Testing The Plausability Of Output Signals Of A Resolver | |
JPWO2019087364A1 (ja) | 直流モータの制御装置 | |
WO2021145460A1 (ja) | アブソリュートエンコーダ | |
JPWO2021145460A5 (ja) | ||
JP5581100B2 (ja) | モータの磁極位置補正方法 | |
JP2009069092A (ja) | 回転検出装置および回転検出装置付き軸受 | |
JP2007135258A (ja) | ステッピングモータ制御装置とアクチュエータ | |
CN111251334A (zh) | 复合增量式关节电机位置检测装置及协作机器人 | |
JP5006270B2 (ja) | 絶対型エンコーダ装置とその操作方法 | |
WO2024079861A1 (ja) | 位相角検出システム、制御装置及び位相角検出方法 | |
CN110945332A (zh) | 扭矩传感器、致动器和机器人 | |
KR20230171530A (ko) | 전동공구 및 전동공구의 정밀 제어방법 | |
JP2003250295A (ja) | 位置決め装置 | |
CA3210484A1 (en) | Electric motor system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 21740852 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2021571283 Country of ref document: JP Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 21740852 Country of ref document: EP Kind code of ref document: A1 |