Electromechanical device provided with controlled motor and rotation control method
10454400 ยท 2019-10-22
Assignee
Inventors
Cpc classification
H02P2205/07
ELECTRICITY
G05B19/416
PHYSICS
G05G1/08
PHYSICS
H02P2203/03
ELECTRICITY
H02P29/032
ELECTRICITY
International classification
Abstract
When a rotation start position of a rotation shaft 132 is a middle start position 31a (i.e., when rotation of the rotation shaft 132 is stopped in the middle and the rotation is restarted), target rotational speed (relative target rotational speed) is defined using a relative pattern 31 that uses the middle start position 31a as a reference, without using an absolute pattern 33 that is defined using a normal rotation start position 33a as a reference. Upon detecting that a condition that absolute target rotational speed corresponding to an angular position detected by a rotation sensor 134 is greater than the relative target rotational speed is not satisfied, motor control is switched so that the absolute pattern 33 is used.
Claims
1. An electromechanical device comprising: a motor that includes a rotation shaft and that applies, to the rotation shaft, a torque toward an angular position in accordance with control; a rotation sensor that detects the angular position of the rotation shaft; and a motor controller that controls rotational speed of the rotation shaft depending on the angular position detected by the rotation sensor, wherein the motor controller determines, based on a detection result by the rotation sensor, whether a rotation start position of the rotation shaft is a predetermined normal rotation start position, wherein, upon determining that the rotation start position is a middle start position other than the normal rotation start position, the motor controller identifies the relative target rotational speed corresponding to the detected angular position using a relative pattern that defines, using the middle start position as a starting point of the relative pattern, relations between the angular position and relative target rotational speed, and the motor controller controls the rotational speed of the rotation shaft using the identified relative target rotational speed, and the motor controller uses an absolute pattern that defines, using the normal rotation start position as a starting point of the absolute pattern, relations between the angular position and an absolute target rotational speed to identify the absolute target rotational speed corresponding to the detected angular position, wherein, upon detecting that a condition that the identified absolute target rotational speed is greater than the relative target rotational speed corresponding to the detected angular position is not satisfied, the motor controller controls the rotational speed of the rotation shaft using the identified absolute target rotational speed, and the motor controller generates the relative pattern based on the absolute pattern in a way that the relative pattern and the absolute pattern have an identical shape at all middle start positions.
2. The electromechanical device according to claim 1, wherein, upon determining that the rotation start position of the rotation shaft is the normal rotation start position based on the detection result by the rotation sensor, the motor controller controls the rotational speed of the rotation shaft using the identified absolute target rotational speed achieved.
3. The electromechanical device according to claim 1, further comprising: an operation knob; and a moving system that moves the operation knob along a predetermined path as the rotation shaft rotates, wherein a transmission is switched by the operation knob.
4. A motor control method for controlling rotational speed of a motor that includes a rotation shaft and that applies, to the rotation shaft, a torque toward an angular position in accordance with control, the motor control method comprising: determining, based on a detection result by a rotation sensor that detects the angular position of the rotation shaft, whether a rotation start position of the rotation shaft is a predetermined normal rotation start position, wherein, upon determining that the rotation start position is a middle start position other than the normal rotation start position, identifying the relative target rotational speed corresponding to the detected angular position using a relative pattern that defines, using the middle start position as a starting point of the relative pattern, relations between the angular position and relative target rotational speed, and controlling the rotational speed of the rotation shaft using the identified relative target rotational speed; identifying the absolute target rotational speed corresponding to the detected angular position, using an absolute pattern that defines, using the normal rotation start position as a starting point of the absolute pattern, relations between the angular position and an absolute target rotational speed; and upon detecting that a condition that the identified absolute target rotational speed is greater than the relative target rotational speed corresponding to the detected angular position is not satisfied, controlling the rotational speed of the rotation shaft using the identified absolute target rotational speed, wherein the relative pattern is generated based on the absolute pattern in a way that the relative pattern and the absolute pattern have an identical shape at all middle start positions.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
DETAILED DESCRIPTION
(11) An electromechanical device 100 provided with a controlled motor according to an embodiment is an electronic shifter provided with functions for raising, lowering, and rotating an operation knob. Speed curve control of a motor for the raising and lowering drive is executed in a condition in which parameters are optimized, and, in the speed curve control, even if raising and lowering of the operation knob is restarted at any position, no large torque is rapidly generated, and the operation knob can be accurately positioned at a predetermined position.
(12) (Configuration)
(13) In the following, an electromechanical device provided with a controlled motor according to the embodiment of the present disclosure is described.
(14)
(15) As illustrated in
(16) Upon receiving user's rotational operation, the operation knob 120 switches a transmission. The operation knob 120 moves between the protruding position of
(17) As illustrated in
(18)
(19) The motor 130 is controlled by a method similar to a generic control method for a three-phase brushless motor. The rotation direction and the rotational speed are determined by a time-dependent variation of a control signal applied to the coils forming the stator 133.
(20) The motor 130 applies, to the rotation shaft 132, a torque toward an angular position in accordance with control by a controller 180, which is described below. During stop control, one of twelve angular positions, which are arranged at respective angular ranges obtained by dividing one rotation of the rotation shaft 132 into twelve equal parts, is set to be a stop target. Depending on a difference of a signal to be applied to the stator 133, the stop target is determined. Namely, the motor 130 is controlled so that the motor 130 applies, to the rotation shaft 132, a torque toward the set stop target, in response to switching of signals from the outside.
(21) Note that, the same signals are applied to the coil U1 and the coil U2, the same signals are applied to the coil V1 and the coil V2, and the same signals are applied to the coil W1 and the coil W2. Namely, symmetrical signals are applied to the stator 133 every 180 degrees around the center line 135. Additionally, the arrangement of the poles of the rotation shaft 132 is cyclic around the center line 135 with a period of 180 degrees. Accordingly, setting an angular position as a stop target implies setting another angular position that is obtained by rotating the position by 180 degrees around the center line 135 as a stop target. For example, if one of the S-poles is within a range of 90 degrees from the coil V1 as the center, a torque toward the coil V1 is applied to the one of the S-poles. If the one of the S-poles is outside the range of 90 degrees from the coil V1 as the center, the one of the S-pole receives a torque toward the coil V2. In this specification, a case is described in which the rotation shaft 132 does not rotate beyond the range of 90 degrees from the stop target, which is to be sequentially set.
(22) The motor 130 further includes three rotation sensors 134 that are disposed at 60 degree intervals around the center line 135. The rotation sensor 134 is a magnetic sensor, and, more specifically, the rotation sensor 134 is a Hall element utilizing Hall effect. The rotation sensors 134 detect an angular position of the rotation shaft 132. The rotation sensor 134 (HU) is disposed between the coil W2 and the coil U1. The rotation sensor 134 (HV) is disposed between the coil U1 and the coil V1. The rotation sensor 134 (HW) is disposed between the coil V1 and the coil W1.
(23) Based on a pattern of signals output from the three rotation sensors 134, a rotation direction and an angular position of the rotation shaft 132 can be detected. The angular position corresponds to an angle of rotation of the rotation shaft 132. The rotation sensors 134 detects the angular position of the rotation shaft 132 on a basis of a unit of an angular range with a predetermined width. The angular range corresponding to one unit is referred to as a detection range.
(24) As illustrated in
(25) When the rotation shaft 132 rotates, the driven gear piece 143 vertically moves without rotating. As the rotation shaft 132 rotates, the driven gear piece 143, the lifting stand 142, the elevation shaft 141, and the operation knob 120 integrally move in the vertical direction. While the driven gear piece 143 and the lifting stand 142 are unable to rotate around the center line 135, the operation knob 120 and the elevation shaft 141 can rotate around the center line 135 in both directions. The operation knob 120 and the elevation shaft 141 can be rotated independently of the rotation of the rotation shaft 132. As the rotation shaft 132 rotates, the worm gear of the rotation shaft 132 and the driven gear piece 143 function as a moving mechanism for moving the operation knob 120 along a predetermined path. The predetermined path is a straight line that is parallel with the center line 135.
(26) The lifting stand 142 is provided with two light shielding pieces, which are a lower light shielding piece 144a and an upper light shielding piece 144b described below (hereinafter, they may be referred to as light shielding pieces 144 without distinction). The lower light shielding piece 144a protrudes downward from a part of the lifting stand 142, and the upper light shielding piece 144b protrudes upward from a part of the lifting stand 142. A movement amount of the light shielding piece 144 in the vertical direction is equal to a movement amount of the operation knob 120.
(27) The electromechanical device 100 provided with the controlled motor further includes a circuit board 150. The circuit board 150 is disposed to partition the space inside the case body 110 in the vertical direction. The circuit board 150 is disposed between the operation knob 120 and the lifting stand 142, and the circuit board 150 is disposed so that the elevation shaft 141 passes through the circuit board 150 without touching it.
(28) The electromechanical device 100 provided with the controlled motor further includes a lower position sensor 151a and an upper position sensor 151b (which may be referred to as the position sensors 151 without distinction, hereinafter). The position sensor 151 is a photo sensor for indirectly detecting a position of the operation knob 120 by detecting the position of the light shielding piece 144. The lower position sensor 151a is disposed on a bottom surface inside the case body 110, and the lower position sensor 151a detects a position of the lower light shielding piece 144a. The upper position sensor 151b is disposed on a lower surface of the circuit board 150, and the upper position sensor 151b detects a position of the upper light shielding piece 144b.
(29) The position sensor 151 defines an internal space having an opening at one of an upper side and a lower side. The position sensor 151 detects whether an object exists in the internal space by light. When the light shielding piece 144 exists inside the internal space, the position sensor 151 is turned on, and when the light shielding piece 144 does not exist inside the internal space, the position sensor 151 is turned off. In the vertical direction, a moving amount of the light shielding piece 144 is equal to a moving amount of the operation knob 120. The position sensor 151 indirectly detects a position of the operation knob 120 through the light shielding piece 144. The operation knob 120 moves in the vertical direction between the retracted position at which the light shielding piece 144 causes the lower position sensor 151a to turn on and the protruding position at which the light shielding piece 144 causes the upper position sensor 151b to turn on.
(30) The electromechanical device 100 provided with the controlled motor further includes an operation detection unit 160 mounted on the circuit board 150. The operation detection unit 160 includes two rotating disks 161 disposed on both sides of the circuit board 150 and an operation amount sensor 162 of the rotating disks 161. The elevation shaft 141 is disposed so that the elevation shaft 141 passes through the rotating disks 161. On a cylindrical side surface of the elevation shaft 141, a groove is formed that extends in the vertical direction, and an engaging piece of the rotating disks 161 engages with the groove of the elevation shaft 141. While the rotating disks 161 are rotatable around the center line 135 by components, which are not depicted, the rotating disks 161 are restricted by the circuit board 150 so that the rotating disks 161 do not move in the vertical direction.
(31) When the elevation shaft 141 moves in the vertical direction, an engaging piece of the rotating disks 161 slides in the groove of the elevation shaft 141, and, thus, the rotating disks 161 do not move in the vertical direction. When the elevation shaft 141 rotates around the center line 135, the engaging piece of the rotating disks 161 is pressed by the groove of the elevation shaft 141, and the rotating disks 161 rotate together with the elevation shaft 141. A rotation amount of the rotating disks 161 is detected by the operation amount sensor 162 that is formed of a magnetic sensor. Namely, the rotation operation of the operation knob 120 is detected by the operation amount sensor 162 through the elevation shaft 141 and the rotating disks 161. Note that the detection method of the rotation operation of the operation knob 120 is not limited to this.
(32) (Control System)
(33)
(34) The motor drive circuit 170 controls the motor 130 based on an indication from the controller 180 to rotate the rotation shaft 132 (
(35) The controller 180 is a central processing unit. The storage 190 is, for example, a random access memory (RAM; random access memory). The storage 190 may be another device that can store information.
(36) The controller 180 executes various controls of the electromechanical device 100 provided with the controlled motor by reading and executing a program stored in the storage 190. The controller 180 may be formed of another component, and the controller 180 may be an application specific integrated circuit (ASIC; application specific integrated circuit).
(37) The controller 180 is connected to the motor drive circuit 170, the lower position sensor 151a, the upper position sensor 151b, the rotation sensor 134 (HU), the rotation sensor (HV), and the rotation sensor 134 (HW).
(38) The controller 180 functions as a motor controller by reading and executing a program stored in the storage 190. Additionally, the controller 180 generates drive waveforms and performs three-phase drive control on the motor drive circuit 170. Additionally, the controller 180 executes a process for calculating a rotational position, rotational speed, and rotational acceleration of the rotation shaft 132 based on a detection result from the rotation sensors 134, and the controller 180 generates drive waveforms based on these results.
(39) For causing the rotation shaft 132 to rotate, the controller 180 applies a torque to the rotation shaft 132 so that the rotational speed becomes target rotational speed toward an angular position that is a stop target, based on the angular position of the rotation shaft 132 detected by the rotation sensors 134.
(40)
(41) In the embodiment, an angular position (rotational position) between a normal rotation start position 33a that is an angular position of the rotation shaft 132 at a time at which the operation knob 120 is at the retracted position illustrated in
(42) The relative pattern 31 defines the relation between the angular position and the relative target rotational speed of the rotation shaft 132 using the middle start position 31a as a reference. The absolute pattern 33 defines, in advance, the relation between the angular position and the absolute target rotational speed of the rotation shaft 132 using the normal rotation start position 33a as a reference.
(43) Note that, in the embodiment, the relative pattern 31 and the absolute pattern 33 are patterns having the same shapes. The controller 180 creates the relative pattern 31 based on the absolute pattern 33. For example, the controller 180 reads out pattern data of the absolute pattern 33 stored in the storage 190, and the controller 180 creates the relative pattern 31 by processing the absolute pattern 33 so that the middle start position 31a becomes the start position. The data amount can be reduced, as it is unnecessary to maintain patterns from all the middle start positions 31a.
(44) In the relative pattern 31 and the absolute pattern 33, maximum target rotational speed wmax and acceleration from initial rotational speed wmin until the maximum target rotational speed wmax is reached are the same. Additionally, the middle start position 31a that is an increment start angular position of the relative target rotational speed in the relative pattern 31 is greater than the normal rotation start position 33a that is an increment start angular position of the absolute target rotational speed in the absolute pattern. Additionally, a decrement start angular position 31b from the maximum target rotational speed wmax of the relative target rotational speed in the relative pattern 31 is greater than a decrement start angular position 33b from the maximum target rotational speed of the absolute target rotational speed in the absolute pattern 33. In the embodiment, the shapes of the relative pattern 31 and the absolute pattern 33 are the same, and the increment start angular positions are shifted.
(45) The relative pattern 31 and the absolute pattern 33 are defined so that all the required specifications on a target position arrival time from the normal rotation start position 33a to a normal rotation end position of the operation knob 120, noise, a stopping precision, and a drive electric current can be satisfied. Each of the relative pattern 31 and the absolute pattern 33 may be implemented, for example, as table data stored in the storage 190, or may be implemented as a function for outputting the target rotational speed using the rotational position as a variable.
(46) When the rotation shaft 132 starts rotation from the normal rotation start position 33a, namely, when the operation knob 120 moves upward from the retracted position illustrated in
(47) When the rotation shaft 132 start rotation from the middle start position 31a, namely, when the operation knob 120 moves upward from a position between the retracted position illustrated in
(48) Additionally, while controlling the rotation of the rotation shaft 132 in the relative mode, the controller 180 identifies the absolute rotational speed corresponding to the angular position detected by the rotation sensors 134 using the absolute pattern 33. Then, if a condition is not satisfied such that the identified absolute rotational speed is greater than the relative target rotational speed identified corresponding to the detected angular position, the controller 180 switches the rotation control mode from the relative mode to the absolute mode. As a result, as illustrated in
(49) The rotation control method of the rotation shaft 132 by the controller 180, which is depicted in
(50) Step ST1:
(51) The controller 180 determines whether the lifting operation of the operation knob 120 is from the middle start position, based on a detection result of the position sensor 151. The controller 180 moves to step ST2, if the determination is positive, and the controller 180 moves to step ST3, if the determination is negative.
(52) Step ST2:
(53) The controller 180 sets the rotation control mode to the relative mode. At this time, for example, the counter value of the rotation sensors 134 at the time at which the lifting operation of the operation knob 120 is stopped last time is used as the middle start position 31a.
(54) Step ST3:
(55) The controller 180 sets the rotation control mode to the absolute mode. At this time, the count value 0 of the rotation sensors 134 at the retracted position illustrated in
(56) Step ST4:
(57) In the relative mode, the controller 180 identifies, using the relative pattern 31, the relative target rotational speed corresponding to the angular position detected by the rotation sensors 134. Additionally, the controller 180 identifies, using the absolute pattern 33, the absolute target rotational speed corresponding to the angular position detected by the rotation sensors 134.
(58) Step ST5:
(59) If the rotation control mode is the relative mode, the controller 180 moves to step ST6, and if the rotation control mode is the absolute mode, the controller 180 moves to step ST9.
(60) Step ST6:
(61) The controller 180 determines whether the absolute rotational speed is greater than the relative target rotational speed identified at step ST4. If the determination is positive, the controller 180 moves to step ST7, and if the determination is negative, the controller 180 moves to step ST8.
(62) Step ST7:
(63) The controller 180 controls the rotation of the rotation shaft 132 using the relative target rotational speed identified at step ST4 as the target speed.
(64) Step ST8:
(65) The controller 180 switches the rotation control mode from the relative mode to the absolute mode.
(66) Step ST9:
(67) The controller 180 controls the rotation of the rotation shaft 132 using the absolute target rotational speed identified at step ST4 as the target speed.
(68) Step ST10:
(69) The controller 180 waits for a predetermined processing cycle after completing the process of step ST7 or step ST9, and, then, returns to the process of step ST4.
(70) As described above, when the rotation start position of the rotation shaft 132 is the middle start position 31a (namely, when the rotation of the rotation shaft 132 is stopped in the middle, and, then, the rotation is restarted), the electromechanical device 100 provided with the controlled motor according to the embodiment defines the target rotational speed (the relative target rotational speed) using the relative pattern 31 for which the middle start position 31a is used as the reference, instead of using the absolute pattern 33 that is defined using the normal rotation start position 33a as the reference.
(71) As described above, when the rotation is restarted from the middle start position 31a, by using the relative pattern 31 illustrated in
(72) Further, according to the electromechanical device 100 provided with the controlled motor, while the rotation control is performed using the relative pattern 31, if it is detected that a condition is not satisfied such that the absolute target rotational speed corresponding to the angular position detected by the rotation sensors 134 is greater than the relative target rotational speed, the motor control is switched so that the absolute pattern 33 is used. Accordingly, after the relative target rotational speed reaches the absolute target rotational speed, the target rotational speed can be made equal to that of a case in which the rotation of the rotation shaft 132 does not stop in the middle. As a result, the target rotational speed in the vicinity of the position at which the rotation is stopped can be made constant.
(73) Furthermore, in the electromechanical device 100 provided with the controlled motor, if it is determined that the rotation start position of the rotation shaft 132 is the normal rotation start position 33a based on the detection result by the rotation sensors 134, the controller 180 controls the motor 130 using the absolute pattern 33 so that the absolute target rotational speed corresponding to the detected angular position can be achieved. As a result, if the rotation start position of the rotation shaft 132 is the normal rotation start position 33a, the motor 130 can be controlled using the absolute pattern 33, without using the relative pattern 31.
(74) Furthermore, in the electromechanical device 100 provided with the controlled motor, the maximum target rotational speed and the acceleration until the maximum target rotational speed is reached are the same for the relative pattern 31 and the absolute pattern 33, which are depicted in
(75) Further, as illustrated in
(76) Further, in the electromechanical device 100 provided with the controlled motor, the relative pattern 31 is created using the absolute pattern 33. Further, in the electromechanical device 100 provided with the controlled motor, the relative pattern 31 and the absolute pattern 33 have the same shapes. As a result, it is unnecessary to prepare relative patterns 31 for all the middle start positions 31a, and it can be implemented by a simple and inexpensive configuration. Further, if the rotation is restarted from the middle start position 31a, a rotational acceleration pattern can be achieved that is the same as that of a case in which the rotation is started from the normal rotation start position 33a.
(77) The present invention is not limited to the above-described embodiment. Namely, a person ordinarily skilled in the art may make various modifications, combinations, sub-combinations, and substitutions for the components of the above-described embodiment within the technical scope of the present invention or the equivalent thereof. In the above-described embodiment, a case is exemplified in which the operation knob 120 moves from the retracted position illustrated in
(78) The present disclosure can be applied to various electromechanical devices in which various components are moved by rotation of rotation shafts of motors. For example, it can be applied to shift devices that are installed in various vehicles, such as an automobile, an aircraft, and a ship.
DESCRIPTION OF THE REFERENCE NUMERALS
(79) 31: relative pattern 31a: middle start position 31b: decrement start angular position 33: absolute pattern 33a: normal rotation start position 33b: decrement start angular position 35: dynamic pattern 100: electromechanical device provided with controlled motor 120: operation knob 130: motor 132: rotor 133: stator 134: rotation sensor 144: light shielding piece 144a: lower light shielding piece 144b: upper light shielding piece 145: tip 151: position sensor 151a: lower position sensor 151b: upper position sensor 170: motor drive circuit 180: controller 190: storage wmax: maximum target rotational speed wmin: initial rotational speed