This application is based on Japanese Patent Application No. 2010-255290 filed on Nov. 15, 2010, the disclosure of which is incorporated herein by reference.
The present invention relates to a motor control system and an apparatus, according to which an output shaft is connected to a rotor shaft of an electric motor via a rotation transmitting device (such as, a speed reduction gear) and a controlled system is operated by the output shaft.
In recent years, a mechanical driving system is changed to an electrical driving system having an electric motor in automotive vehicles, in order to fulfill requirements for space-saving, improvements of assembling performance, increase of controllability and so on. As one of examples of such electrical driving systems, it is known in the art that a shift-range changing device of an automatic transmission apparatus for a vehicle is operated by an electric motor. According to such a system, an output shaft is connected to a rotor shaft of the electric motor via a speed reduction gear and the shift-range changing device is driven by the output shaft so as to change a shift range of the automatic transmission apparatus. In this system, an encoder is provided in the electric motor in order to detect a rotational angle (a rotational position). And when the shift range is changed, the electric motor is rotated to a target rotational angle (a target counting value) corresponding to a target shift range, based on a counting value of output pulses from the encoder, so that the shift range of the automatic transmission apparatus is changed to the target range by the shift-range changing device.
A rotational amount (a rotational angle) of the motor is converted into an operational amount for the shift-range changing device via a driving power transmitting system (such as, the speed reduction gear). There exists a play (a clearance) among parts constituting the driving power transmitting system. For example, the speed reduction gear has a play (so-called a back-lash) among multiple gears. In addition, a forward end (a coupling portion) of an output shaft of the speed reduction gear, which is formed in a non-circular shape in cross-section (for example, a square shape, a D-shape, a spline shape, and so on), is inserted into a fitting hole of the shift-range changing device, so that the speed reduction gear is connected to the shift-range changing device. Therefore, it is necessary to provide a clearance between the forward end of the output shaft and the fitting hole, in order to smoothly insert the forward end into the fitting hole.
As above, the play (the back-lash, the clearance, or the like) exists in the driving power transmitting system for converting the rotational amount of the motor into the operational amount of the shift-range changing device. As a result, even when the rotational angle of the motor can be precisely controlled based on a detection signal from a rotational angle sensor, the operational amount for the shift-range changing device may include a control error corresponding to the play of the driving power transmitting system. It is, therefore, not possible to precisely control the operational amount for the shift-range changing device.
According to a prior art, for example, as disclosed in Japanese Patent Publication No. 2005-198449, a rotational angle detecting device for an output shaft is provided for detecting a rotational angle of the output shaft, in order that a target rotational angle of a motor is corrected by use of a detected rotational angle of the output shaft (detected by the rotational angle detecting device for the output shaft)
According to a structure, in which an output shaft of a motor is connected to a shift-range changing device via a coupling device having a play, it is not possible to eliminate an influence of the play included in the coupling device between the output shaft and the shift-range changing device, even when a rotational angle detecting sensor is provided for detecting a rotational angle of the output shaft of the motor.
According to another prior art, for example, as disclosed in Japanese Patent Publication No. 2006-136035, a bumping control is carried out. More exactly, a motor is rotated until an engaging portion of a detent lever bumps into a limit position (a wall) of a movable range of a shift-range changing device, in order to learn an amount of a play included in a driving power transmitting system. Then, a target rotational angle is corrected based on such a learning value.
When the above bumping control is carried out, namely when the engaging portion of the detent lever is moved to bump into the limit position (the wall) of the movable range of the shift-range changing device, in order to learn the amount of the play, a load is applied to respective portions of the driving power transmitting system and thereby a durability of the shift-range changing device may be decreased.
According to a further prior art, for example, as disclosed in Japanese Patent Publication No. 2009-177965, an electric motor is rotated in a forward direction and in a backward direction with such a small torque, that a shift range of a shift-range changing device can not be moved and remains in the current position, for example, in a P-range. In this operation, the motor is rotated until an output shaft of the motor bumps into an opposite side of a play included in a coupling device, so as to detect (learn) both sides of the play. Then, a target rotational angle is corrected based on such learning value.
According to the above prior arts (JP No. 2006-136035, JP No. 2009-177965), however, the amount of the play is detected (learned) and the target rotational angle is corrected based on such learning value. Therefore, it is necessary in the above prior arts to carry out a process for learning the amount of the play. It is a problem that a calculating load for a control circuit may be increased. In addition, it is difficult to accurately learn the amount of the play. When an error in a learning process for the amount of the play (a detection error) is increased, a control accuracy for the shift-range changing device is correspondingly decreased. It may become difficult to assure the control accuracy for the shift-range changing device.
The present invention is made in view of the above problems. It is an object of the present invention to provide a motor control apparatus, according to which a calculation load to a control circuit will be reduced and a control accuracy for a controlled system is assured.
According to a feature of the invention, a motor control system has an electric motor; a motor position detecting device for detecting a rotational angle of the electric motor; an output shaft connected to a rotor shaft of the electric motor via a rotation transmitting system; and a controlled device connected to the output shaft via a coupling device.
The motor control system further has a motor control apparatus. When an operational position of the controlled device is moved to a target operational position, the motor control apparatus sets a target rotational angle for the electric motor, which corresponds to the target operational position of the controlled device, and the motor control apparatus further drives the electric motor until a detected rotational angle of the electric motor detected by the motor position detecting device becomes equal to or closer to the target rotational angle for the electric motor.
The motor control apparatus has a motor position setting portion for setting the target rotational angle for the electric motor so that the target rotational angle for the electric motor includes a basic rotational angle for the output shaft necessary for moving the operational position of the controlled device to the target operational position and a correction amount.
According to another feature of the invention, a motor control system has an electric motor; a motor position detecting device for detecting a rotational angle of the electric motor; an output shaft connected to a rotor shaft of the electric motor via a rotation transmitting system; and a controlled device connected to the output shaft via a coupling device having a play.
The motor control system further has a motor control apparatus. When an operational position of the controlled device is moved to a target operational position, the motor control apparatus sets a target rotational angle for the electric motor, which corresponds to the target operational position and drives the electric motor until a detected rotational angle of the electric motor detected by the motor position detecting device becomes equal to or closer to the target rotational angle for the electric motor. The motor control apparatus has a motor position setting portion for setting the target rotational angle for the electric motor by use of a correction amount which is calculated based on a predetermined amount of the play.
According to the above feature, since the target rotational angle for the motor is set by the correction amount, which is calculated based on a predetermined amount of the play, it is not necessary to carryout a learning process for the amount of the play and thereby to reduce a calculating load of a control circuit. In addition, since the correction amount (a constant amount) based on the predetermined amount of the play is used, the motor control system of the present invention may not receive any influence, which would be caused by a learning error (a detection error) for the amount of the play in a conventional system. It is, therefore, possible to prevent a control accuracy of the controlled system from largely becoming worse, and thereby to properly assure the control accuracy of the controlled system.
According to a further feature of the invention, the motor control system has an output-shaft position detecting device for detecting a rotational angle of the output shaft, and an output-shaft position setting portion for setting a target rotational angle for the output shaft, corresponding to the target operational position. The motor position setting portion corrects the target rotational angle for the output shaft by use of the correction amount, calculates a deviation between a corrected target rotational angle for the output shaft and a detected rotational angle of the output shaft detected by the output-shaft position detecting device, multiplies the deviation by a reduction ratio of the rotation transmitting system, and calculates the target rotational angle for the electric motor by use of such a multiplied value.
According to such a feature of the invention, it is possible to precisely set the target rotational angle for the electric motor by use of the correction amount, which is calculated based on the predetermined amount of the play.
According to a further feature of the invention, the correction amount is set at such an amount of the rotational angle, which corresponds to a half of the play, and the motor position setting portion corrects the target rotational angle for the output shaft in such a manner that the output shaft is further rotated by the correction amount in addition to the target rotational angle for the output shaft, when the motor position setting portion corrects the target rotational angle for the output shaft by use of the correction amount.
According to such a feature of the invention, it is possible to change the operational position of the controlled system to the target position with a proper accuracy.
According to a still further feature of the invention, the predetermined amount of the play is set to be a value, which corresponds to an amount of a play included in the coupling device having a maximum production tolerance. In other words, the correction amount is set at an amount of the rotational angle, which corresponds to a half amount of the play included in the coupling device having the maximum production tolerance.
According to such a feature, it is possible to suppress the control accuracy of the controlled system less than the half amount of the play of the coupling device having the maximum production tolerance, irrespectively of an actual size of the amount of the play.
According to a still further feature of the invention, a motor control system has; an electric motor; a motor position detecting device for detecting a rotational angle “θ1” of the electric motor; an output shaft connected to a rotor shaft of the electric motor via a rotation transmitting system; an output-shaft position detecting device for detecting a rotational angle “θ2” of the output shaft; a controlled device connected to the output shaft via a coupling device having a play; and a motor control apparatus for controlling the rotational angle “θ1” of the electric motor so that an operational position of the controlled device is moved to a target operational position.
In the above motor control system, the motor control apparatus calculates a target rotational angle “θ3tg” for the output shaft, which corresponds to the target operational position, and the motor control apparatus calculates a virtual target rotational angle “θ2tg” in accordance with a following formula 1;
θ2tg=θ3tg±θBmax/2, formula 1:
wherein θ“θBmax/2” is a correction amount calculated based on a predetermined amount of the play included in the coupling device.
The motor control apparatus further calculates a target rotational angle “θ1tg” for the electric motor in accordance with a following formula 2;
θ1tg=(θ2−θ2tg)×Kg+θ1, formula 2:
wherein “Kg” is a reduction ratio of the rotation transmitting system.
The motor control apparatus drives the electric motor in a feed-back control so that a detected rotational angle “θ1” of the electric motor becomes equal to or closer to the target rotational angle “θ1tg” for the electric motor.
The above and other objects, features and advantages of the present invention will become more apparent from the following detailed description made with reference to the accompanying drawings. In the drawings:
The present invention will be explained hereinafter by way of an embodiment, in which the present invention is applied to a shift-range changing device of a motor-driven type.
A structure of the shift-range changing device 11 will be explained with reference to
The shift-range changing device 11 is a device for changing a gear range of an automatic transmission apparatus 12 to one of the gear ranges, such as, a parking range (P), a reverse range (R), a neutral range (N), and a drive range (D). An electric motor 13, which is a driving source of the shift-range changing device 11, is composed of a synchronous motor, such as, a switched reluctance motor (SR motor) and houses a speed reduction gear 14 (
A control rod 15 of the shift-range changing device 11 is connected to the output shaft 14a of the speed reduction gear 14 via a coupling portion 15a (
A detent lever 18, which changes a manual valve 17 of a hydraulic circuit for the automatic transmission apparatus 12, is fixed to the control rod 15. A parking rod 19 of an L-letter shape is connected to the detent lever 18. A conical member 20 formed at a forward end of the parking rod 19 is in contact with a locking lever 21.
The locking lever 21 is rotated at a shaft 22 in accordance with a position of the conical member 20. In other words, the locking lever 21 is moved in a vertical direction (in an upward or a downward direction), so that it locks or unlocks a parking gear 23. The parking gear 23 is provided at a drive shaft of the automatic transmission apparatus 12. When the parking gear 23 is locked by the locking lever 21, driving wheels of a vehicle are maintained in a condition (a parking condition) that the driving wheels can not be rotated.
A spool valve 24 of the manual valve 17 is connected to the detent lever 18. When the output shaft 14a is rotated by the motor 13, the detent lever 18 is rotated together with the control rod 15. An operational amount of the manual valve 17 (that is, a position of the spool valve 24) is changed so as to change the shift range of the automatic transmission apparatus 12 to one of the P-range, the R-range, the N-range and the D-range. Four recessed portions 25 are formed at the detent lever 18 in order to hold the spool valve 24 at such positions, each of which respectively corresponds to the above shift ranges.
As shown in
When the shift range is in the P-range, the parking rod 19 is moved in a direction closer to the locking lever 21, so that a thicker portion of the conical member 20 pushes up the locking lever 21. A projection 21a of the locking lever 21 is brought into an engagement with the parking gear 23 so as to lock the parking gear 23. As a result, the drive shaft of the automatic transmission apparatus 12 (that is, the driving wheels) is held in the locked condition (the parking condition).
When the shift range is in the other ranges than the P-range, the parking rod 19 is moved in a direction away from the locking lever 21, so that the thicker portion of the conical member 20 is brought out of contact with the locking lever 21. Namely, the locking lever 21 is moved in the downward direction, so that the projection 21a of the locking lever 21 comes out of the engagement with the parking gear 23. The locked condition of the parking gear 23 is thereby released and the drive shaft of the automatic transmission apparatus 12 is maintained in a condition that the drive shaft is rotatable (in a condition that the vehicle can run).
According to the present embodiment, the output-shaft sensor 16 is composed of a rotational angle sensor (for example, a potentiometer), an output voltage of which is changed in a linear manner depending on the rotational angle of the output shaft 14a of the speed reduction device for the motor 13. Based on the output voltage, it is possible to detect and confirm a current rotational angle of the output shaft 14a, namely it is possible to detect a current shift range, among the P-range, the R-range, the N-range and the D-range.
An encoder 31 (a motor position detecting device) is provided in the electric motor 13 for detecting a rotational angle of a rotor. The encoder 31 is, for example, composed of a magnetic type rotary encoder. The encoder 31 generates pulse signals of A-phase and B-phase in synchronism with the rotation of the rotor of the motor 13. The pulse signals are outputted to a control device 32 for changing the shift range. An ECU 33 of the control device 32 counts both of rising edges and falling edges of the pulse signals of A-phase and B-phase from the encoder 31. The ECU 33 changes current supply phases of the motor 13 in a predetermined order by motor driver circuits 34 and 35, depending on such encoder counting value, so that the motor 13 is driven to rotate.
In the above operation, the ECU 33 determines a rotational direction based on an order of generation of the pulse signals of A-phase and B-phase. In a case of the rotation in a forward direction (that is, the rotation in a direction from the P-range to the D-range), the encoder counting value is increased (counted up). In a case of the rotation in a backward direction (that is, the rotation in a direction from the D-range to the P-range), the encoder counting value is decreased (counted down). According to such a process, it is possible to maintain a relationship between the encoder counting value and the rotational angle of the motor 13, in the case the motor 13 is rotated in either direction of the forward or the backward direction. Accordingly, when the motor 13 is rotated in either of the forward direction or the backward direction, the ECU 33 can detect the rotational angle of the motor 13 based on the encoder counting value and carry out the current supply to such winding, a phase of which corresponds to the rotational angle, so as to rotate the motor 13.
Now, an outline of a feed-back control system (a F/B control system) for the motor 13 will be explained with reference to
θ1tg=(θ2−θ2tg)×Kg+θ1
In the above formula, “Kg” is a speed reduction ratio of a rotation transmitting system (the speed reduction gear 14), and “θ1” is a detected rotational angle of the motor based on the encoder 31.
In other words, the first F/B control system is a sub F/B control system, according to which the target rotational angle “θ1tg” for the motor is corrected based on the deviation (θ2-θ2tg) between the detected rotational angle “θ2” of the output shaft detected by the output-shaft sensor 16 and the virtual target rotational angle “θ2tg” of the output shaft.
On the other hand, a second F/B control system is a main F/B control system, according to which a motor F/B control is carried out in order to drive the motor 13 to the target rotational angle “θ1tg” for the motor. In the above motor F/B control, the winding phases of the motor 13 for the current supply are sequentially changed based on the detected rotational angle “θ1” of the motor based on the encoder 31 (that is, the encoder counting value).
An example of the control for the motor 13 by the above two F/B control systems will be explained with reference to
During a period shortly after the start of operation for the motor 13, in other words, in a period by such a time point in which the motor 13 is rotated by an angle corresponding to a play “A” of the speed reduction device 14 (shown in
At a time point t2, at which the motor 13 has been rotated by the play “A” of the speed reduction device 14, the output shaft 14a starts rotation together with the motor 13. Then, the detected rotational angle “θ2” of the output shaft likewise starts its change. After this time point t2, since the output shaft 14a integrally rotates with the motor 13, the target rotational angle “θ1tg” for the motor is maintained at a constant value.
At a time point t3, at which the detected rotational angle “θ1” of the motor by the encoder 31 becomes equal to the target rotational angle “θ1tg” for the motor, the motor operation is stopped. According to the above process, the change of the shift range is completed.
As shown in
According to the present embodiment, such an amount of a rotational angle, which corresponds to a half (½) of a predetermined amount of the play, is set as a correction amount. The predetermined amount of the play is set to be, for example, a value corresponding to an amount of the play “θBmax” of such a coupling portion (15a) which has a maximum production tolerance (that is, the coupling portion having an upper limit of the production tolerance). The amount of the play “θBmax” is also referred to as “a maximum amount of the play”. Accordingly, the correction amount is set at such an amount of the rotational angle (θBmax/2), which corresponds to a half (½) of the maximum amount of the play “θBmax”.
The detent lever 18 is so formed that a slide-off range of each recessed portion 25 is larger than the maximum amount of the play “θBmax”. The slide-off range is a distance (or a width) of each recessed portion 25 in a rotational direction, within which the roller 27 slides off into the recessed portion 25 to a center bottom portion thereof by itself or a spring force of the detent spring 26. More exactly, the slide-off range includes such a range, which has a width of a half of the maximum amount of the play “θBmax” (=θBmax×½) with respect to the center bottom portion of the recessed portion 25.
As shown in
Namely, the target rotational angle “θ3tg” for the output shaft is so corrected and the virtual target rotational angle “θ2tg” for the output shaft is so decided that the output shaft 14a is rotated further by the correction amount (θBmax/2) in addition to the target rotational angle “θ3tg” for the output shaft.
The above target rotational angle “θ3tg” for the output shaft is also referred to as a basic rotational angle “θ3tg” for the output shaft necessary for moving the current shift range (an operational position) to the target range (a target operational position).
The above virtual target rotational angle “θ2tg” for the output shaft is also referred to as a corrected target rotational angle for the output shaft. The above center bottom position of the recessed portion 25 for the target shaft range is also referred to as a basic position, which corresponds to the target rotational angle “θ3tg” (the basic rotational angle “θ3tg”) for the output shaft.
For example, when the shift range is changed from the P-range to the D-range, the virtual target rotational angle “θ2tg” for the output shaft is set at such a position, which is displaced from a position of the target rotational angle “θ3tg” for the output shaft in a direction to the D-range (in the direction from the P-range to the D-range) by the correction amount (θBmax/2).
θ2tg=θ3tg+θBmax/2
On the other hand, when the shift range is changed from the D-range to the P-range, the virtual target rotational angle “θ2tg” for the output shaft is set at such a position, which is displaced from the position of the target rotational angle “θ3tg” for the output shaft in a direction to the P-range (in the direction from the D-range to the P-range) by the correction amount (θBmax/2).
θ2tg=θ3tg−θBmax/2
According to a conventional method, the play “B” of the coupling portion 15a is not taken into consideration and the rotational angle of the output shaft 14a is so controlled as to be the target rotational angle “θ3tg” for the output shaft corresponding to the target shift range. Therefore, as shown in
According to the present embodiment, however, as shown in
For example,
On the other hand, as shown in
As above, in case of
As shown in
On the other hand, as shown in
As shown in
In
According to the present embodiment, as above, it is possible to control the control error for the stop position of the roller 27 within the range equal to or smaller than the half (½) of the maximum amount of the play “θBmax”. In other words, it is possible to surely bring the stop position of the roller 27 within the slide-off range. As a result, the roller 27 can be surely moved to the center bottom position of the recessed portion 25.
The above F/B control for the motor 13 is carried out by the ECU 33 in accordance with the processes shown in
The main routine of
The routine of
When the routine starts, at a step 101, a routine of
Then, the process goes to a step 102, to read the detected rotational angle “θ2” of the output shaft detected by the output-shaft sensor 16. Then, at a next step 103, the ECU reads the detected rotational angle “θ1” of the motor detected by the encoder 31. The process goes to a step 104 to calculate (and set) the target rotational angle “θ1tg” for the motor in accordance with the following formula:
θ1tg=(θ2−θ2tg)×Kg+θ1
As understood from the above formula, the deviation (θ2-θ2tg) (between the detected rotational angle “θ2” of the output shaft detected by the output-shaft sensor 16 and the virtual target rotational angle “θ2tg” for the output shaft) is multiplied by the reduction ratio “Kg” of the speed reduction gear 14. And then the detected rotational angle “θ1” of the motor detected by the encoder 31 is added to the above multiplied amount to finally get the target rotational angle “θ1tg” for the motor.
The routine of
Thereafter, when the detected rotational angle “θ1” of the motor detected by the encoder 31 becomes equal to the target rotational angle “θ1tg” for the motor, the ECU 33 determines YES at the step 111 and the process goes to a step 114, at which the motor operation is stopped. As above, the operation for changing the shift range of the shift-range changing device is completed.
(Routine for Calculating the Virtual Target Rotational Angle “θ2tg” for the Output Shaft)
The routine of
Thereafter, when the target range is changed, the process goes to a step 121, at which the ECU 33 calculates and sets the target rotational angle “θ3tg” for the output shaft depending on the target range. The target rotational angle “θ3tg” for the output shaft is calculated (set) based on the current rotational position of the output shaft 14a (that is, the detected rotational angle “θ2” of the output shaft detected by the output-shaft sensor 16) and the target amount of the rotational angle for the output shaft 14a necessary for changing the shift range to the target range (that is, the amount of the rotational angle from the center bottom position of the recessed portion 25 for the current shift range to the center bottom position of the recessed portion 25 for the target shift range).
The process goes to a step 122, at which the ECU 33 determines whether the shift range is changed in a direction from the P-range to the D-range. When it is the shift range change in the direction from the P-range to the D-range, the process goes to a step 123, at which the virtual target rotational angle “θ2tg” for the output shaft is set at such a position, which is displaced from the target rotational angle “θ3tg” for the output shaft for the target range by the correction amount (θBmax/2) in the direction to the D-range:
θ2tg=θ3tg+θBmax/2
On the other hand, when the ECU 33 determines at the step 122 that it is the shift range change in the direction from the D-range to the P-range, the process goes to a step 124, at which the virtual target rotational angle “θ2tg” for the output shaft is set at such a position, which is displaced from the target rotational angle “θ3tg” of the output shaft for the target range by the correction amount (θBmax/2) in the direction to the P-range:
θ2tg=θ3tg−θBmax/2
According to the present embodiment explained as above, the target rotational angle for the motor is set by use of the correction amount, which is in advance decided based on the amount of the play. Therefore, it is not necessary to carry out a process for learning the amount of the play. A calculating load for the ECU 33 can be thereby reduced. In addition, since the correction amount (that is, the constant amount) decided in advance based on the amount of the play is used, a problem of the conventional system, in which a learning error or a detection error for the amount of the play might have occurred, will not occur. It is, therefore, possible to prevent a control accuracy of the shift-range changing device 11 (that is, the control error for the stop position of the roller 27) from largely decreasing. Accordingly, the control accuracy for the shift-range changing device 11 can be properly maintained.
In addition, according to the present embodiment, the amount (θBmax/2) of the rotational angle, which corresponds to the half (½) of the maximum amount of the play “θBmax” (the amount of the play of the coupling portion having the maximum production tolerance), is set as the correction amount. The control accuracy of the shift-range changing device 11 (that is, the control error for the stop position of the roller 27) can be always suppressed to a value equal to or smaller than the half (½) of the maximum amount of the play “θBmax”, irrespectively of an actual size of the amount of the play.
The correction amount should not be limited to the amount of the rotational angle corresponding to the half of the maximum amount of the play “θBmax, but may be modified. For example, the correction amount maybe set to be a value, which is slightly larger or smaller than the amount of the rotational angle corresponding to the half of the maximum amount of the play “θBmax.
According to the shift-range changing device of the present embodiment, the shift range is changed to either one of the P-range, the R-range, the N-range and the D-range. However, shift ranges of a second range (2-range) or a low range (L-range) may be added. Alternatively, the present invention may be further applied to a shift-range changing device having only two shift ranges, which are the P-range and Not-P-range.
The present invention should not be limited to the shift-range changing device, but may be applied to various apparatuses having an electric motor as a driving source.
In the above embodiment, the amount of the play included in the coupling portion 15a is taken into consideration when the target rotational angle “θ1tg” is calculated. However, a mechanical gap, which includes not only the play in the coupling portion (the coupling device) but also a play (a back-lash) and/or a clearance included in the electric motor and/or the speed reduction device (that is, the rotation transmitting system) may be also taken into consideration when calculating the target rotational angle for the electric motor.
Number | Date | Country | Kind |
---|---|---|---|
2010-255290 | Nov 2010 | JP | national |