This application claims benefit of priority to Japanese Patent Application No. 2016-131323 filed on Jul. 1, 2016, which is hereby incorporated by reference in its entirety.
The present disclosure relates to an opening/disclosing control device such as a power widow device that controls the opening/closing operation of an opening/closing body.
A power window device has a function of detecting a trap of a finger or foreign matter according to a change in the torque of a motor. When a trap is detected, control is performed so that an operation to raise the window is changed to an operation to lower the window. In Japanese Unexamined Patent Application Publication No. 2004-278051, the torque τ of a motor is calculated according to the equation below.
In equation (1), V indicates the voltage [V] of the motor, T indicates the cycle [s] of one rotation of the motor, Kt indicates a motor torque constant [N·m/A], Rm indicates a motor resistance [Ω], Ke indicates a counter-electromotive force [V·s/rad], and Tm indicates a motor loss torque [N·m]. The motor is equipped with a pulse generator that generates a pulse each time the motor rotates by a predetermined angle. The cycle T is detected according to this pulse.
A reduction in response speed in trap prevention control is problematic particularly when a hard object is trapped. This is because the harder the trapped object is, the more rapidly the load applied to the object increases.
An opening/closing control device that controls the opening/closing operation of an opening/closing body by driving a motor includes: a current detecting unit that detects a current that flows in the motor; a voltage detecting unit that detects a voltage to be supplied to the motor; a load calculating unit that calculates a load applied during the opening/closing operation of the opening/closing body, according to the current detected by the current detecting unit and the voltage detected by the voltage detecting unit; a trap detecting unit that detects a trap of an object, the trap being caused by the opening/closing body, according to the load calculated by the load calculating unit; and a motor control unit that, when the trap detecting unit detects the trap, performs trap prevention control by which the rotation of the motor is reversed. The load calculating unit calculates the load in which a first load component proportional to the detected current and a second load component proportional to the angular acceleration of the rotation of the motor, the angular acceleration being approximated according to the detected current and detected voltage, are combined together.
In this structure, the trap is detected according to the load in which the first load component proportional to the detected current and the second load component proportional to the angular acceleration are combined together. Since the second load component is included in the result of the calculation of the load, precision in the calculation of the load becomes higher than when only the first load component is included, increasing precision in the detection of the trap. If a relatively hard object is trapped, the second load component is increased immediately, so the trap is detected at an earlier timing.
The angular velocity of the rotation of the motor is preferably approximated according to the detected current and detected voltage. The second load component is preferably proportional to the ratio of a time-varying change in the approximated angular velocity for a predetermined time.
In this structure, the angular acceleration is obtained as the ratio of a time-varying change in the angular velocity, which is approximated according to the detected current and detected voltage, for the predetermined time. A delay in angular acceleration calculation performed when the load is increased is reduced when compared with a case in which angular acceleration is calculated according to the cycle of a pulse generated by, for example, a Hall sensor at every certain angle of rotation. Therefore, an increase in the load is likely to be detected at an early timing.
The motor driving circuit 10 generates a voltage used to drive the motor 6, in response to a control signal created by a motor control unit 53, described later, in the processing unit 50. In the example in
The voltage detecting unit 20 detects a voltage to be supplied to the motor 6. In the example in
The current detecting unit 30 detects a current that flows in the motor 6. In the example in
The manipulating unit 40 is an apparatus manipulated by the user to input a signal to the processing unit 50, the signal being used to open or close the window 3. The manipulating unit 40 includes, for example, a switch and the like.
The processing unit 50 controls the entire operation of the opening/disclosing control device. The processing unit 50 includes, for example, a computer that executes processing in response to operation codes in a program stored in the storage unit 60. The processing unit 50 may execute all processing by using the computer or may execute at least part of processing by using a specific hardware circuit (such as a random logic circuit).
The processing unit 50 has a load calculating unit 51, a trap detecting unit 52, and a motor control unit 53, as functional blocks.
The load calculating unit 51 calculates a load F applied to open or close the window 3, according to a current detected by the current detecting unit 30 (the current will be denoted below as the motor current Im) and a voltage detected by the voltage detecting unit 20 (the voltage will be denoted below as the motor voltage V). That is, the load calculating unit 51 calculates the load F in which a first load component Fl proportional to the motor current Im and a second load component F2 proportional to the angular acceleration of the rotation of the motor 6, the angular acceleration being approximated according to the motor current Im and motor voltage V, are combined together (the load F will be denoted below as the calculated load F). The calculated load F is represented as in the equation below.
F(n)=F1(n)+F2(n) (2)
The load calculating unit 51 preferably calculates the calculated load F at intervals of a predetermined time Ts, according to the motor current Im and motor voltage V that are respectively acquired by the current detecting unit 30 and voltage detecting unit 20 at intervals of the predetermined time Ts. That is, the load calculating unit 51 performs processing to calculate the calculated load F at certain intervals (Ts). In equation (2), n is an integer that indicates an individual processing cycle in cyclic processing to calculate the calculated load F. When the value of n is increased by one, the position of the processing cycle in the sequence advances by one (the time advances by the predetermined time Ts).
The first load component F1(n) is represented as in the equation below.
In equation (3), Kt indicates a motor torque constant [N·m/A] and L indicates the amount of movement of the window 3 per unit angle of rotation [m/rad].
The second load component F2(n) is represented as in the equation below.
In equation (4), C indicates a second load component adjustment parameter [N·s2], ω(n) indicates an angular velocity in an n-th processing cycle, and ω(n−1) indicates an angular velocity in an (n−1)th processing cycle. The second load component F2 is preferably proportional to the ratio of a time-varying change in the angular velocity ω (angular acceleration) for the predetermined time Ts, as indicated in equation (4).
The angular velocity ω(n) is represented as in the equation below.
In equation (5), Ke indicates a counter-electromotive force [N·s/rad], and Rm indicates a motor resistance [Ω]. The angular velocity ω(n) of the rotation of the motor 6 is preferably approximated according to the motor current Im(n) and motor voltage V(n), as indicated in equation (5).
The trap detecting unit 52 detects a trap of an object, the trap being caused by the window 3, according to the calculated load F calculated by the load calculating unit 51. Specifically, if the calculated load F exceeds a criterion value Fth and the ratio of a time-varying change in the calculated load F is within a predetermined range, the trap detecting unit 52 preferably decides that a trap has occurred.
The trap detecting unit 52 sets the criterion value Fth used to make a decision about a trap according to, for example, the moving average of the calculated load F. Specifically, the trap detecting unit 52 preferably sets a value (Fb+ΔTH) obtained by adding a predetermined threshold ΔTH to a reference value Fb, which is the moving average of the calculated load F, as the criterion value Fth. If the calculated load F is relatively slightly increased due to the fitting (sliding resistance) of the door 2 or another reason, the reference value Fb, which is the moving average, is also increased and the criterion value Fth is thereby increased, so the calculated load F does not easily exceed the criterion value Fth. Therefore, the trap detecting unit 52 does not incorrectly detect a slight increase in the calculated load F easily as a trap.
The trap detecting unit 52 calculates the ratio of a time-varying change in the calculated load F from, for example, “F(n)−F(n−1)”. “F(n)−F(n−1)” is equivalent to a change in the calculated load F for the predetermined time Ts. If the value of “F(n)−F(n−1)” is not within the predetermined range, even if the calculated load F exceeds the criterion value Fth, the trap detecting unit 52 does not detect the change as a trap. Therefore, an abnormal change in the calculated load F due to noise is not incorrectly detected easily as a trap.
The motor control unit 53 creates a control signal to control the motor 6 in response to a manipulation signal entered into the manipulating unit 40, and outputs the created control signal to the motor driving circuit 10. Specifically, the motor control unit 53 creates a control signal to be output to the motor driving circuit 10 so as to satisfy conditions such as the rotational direction and rotational speed of the motor 6, which have been set in advance for each of the closing operation and opening operation.
When the trap detecting unit 52 detects a trap of an object, the motor control unit 53 performs trap prevention control by which the rotation of the motor 6 is reversed. When the trap detecting unit 52 detects a trap during, for example, the closing operation, the motor control unit 53 reverses the rotation of the motor 6 to perform the opening operation and stops the window 3 at an appropriate position.
The storage unit 60 stores programs executed by the computer in the processing unit 50, constant data used in processing by the processing unit 50, variable data that is temporarily stored during a process of processing by the processing unit 50, and the like. The storage unit 60 includes a storage device such as, for example, a dynamic random access memory (DRAM), a static random access memory (SRAM), a flash memory, or a hard disk drive.
Next, the operation of the opening/disclosing control device, structured as described above, in this embodiment will be described with reference to the flowchart in
The load calculating unit 51 decides whether the opening/closing operation of the window 3 is currently being performed (ST100). If the opening/closing operation is being performed, the load calculating unit 51 acquires the detected value of the motor current Im from the current detecting unit 30 and also acquires the detected value of the motor voltage V from the voltage detecting unit 20 (ST105). After acquiring the detected values of the motor current Im and motor voltage V, the load calculating unit 51 calculates the calculated load F from equations (2) to (4), according to the acquired detected values (ST110).
The trap detecting unit 52 compares the calculated load F calculated by the load calculating unit 51 with the criterion value Fth (ST115). If the calculated load F does not exceed the criterion value Fth, the trap detecting unit 52 decides that there is no trap and terminates the processing.
If the calculated load F exceeds the criterion value Fth (ST115), the trap detecting unit 52 calculates “F(n)−F(n−1)” as the ratio of a time-varying change in the calculated load F and decides whether the ratio of a time-varying change is within the predetermined range (ST120). If the ratio of a time-varying change is outside the predetermined range, the trap detecting unit 52 decides that there is no trap and terminates the processing.
If the ratio of a time-varying change is within the predetermined range (ST120), the trap detecting unit 52 decides that a trap has occurred. In this case, the motor control unit 53 performs trap prevention control in which the rotation of the motor 6 is reversed and the window 3 is stopped at an appropriate position (at the center of the door frame 4, for example) (ST125).
With the opening/closing control device in this embodiment, the calculated load F is calculated at certain intervals (Ts). Therefore, even if a trap occurs, therefore, the interval Ts in the calculation of the calculated load F remains unchanged. By contrast, when a calculated load is calculated on the basis of pulses, the result of the calculation of the calculated load is obtained on an edge of a pulse. If the cycle of a pulse is prolonged due to the occurrence of a trap, a timing at which the result of the calculation of the calculated load is obtained is delayed. Therefore, a timing (time t1) at which a trap is detected by the opening/closing control device in this embodiment is earlier than a timing (time t2) at which a trap is detected in a case in which the calculated load is calculated on the basis of pulses.
These graphs indicate that when the calculated load F includes the second load component F2 (when C is set to 0.2), the rising of the calculated load F after the occurrence of a trap occurs at an earlier timing than when the calculated load F does not include the second load component F2 (when C is set to 0). In particular, in
As described above, the opening/closing control device in this embodiment detects a trap of an object according to the calculated load F in which the first load component F1 proportional to the motor current Im and the second load component F2 proportional to the angular acceleration are combined together. Since the second load component F2 is included in the result of the calculation of the calculated load F, precision in the calculation of the load F becomes higher than when only the first load component F1 is included, increasing precision in the detection of the trap. If a relatively hard object is trapped, the second load component F2 is increased immediately, so the trap is detected at an earlier timing. Therefore, a time taken from when the trap occurs until trap prevention control is started can be shortened.
The opening/closing control device in this embodiment calculates the calculated load F at intervals of the predetermined time Ts. If a load is calculated according to the cycle of a pulse generated by, for example, a Hall sensor at every certain angle of rotation, as the load is increased, an interval at which the load is calculated is prolonged. With the opening/closing control device in this embodiment, however, the calculated load F is calculated at a fixed interval, regardless of whether the load is increased or decreased. This enables an increase in the load to be detected at an early timing.
With the opening/closing control device in this embodiment, the angular velocity co of the rotation of the motor 6 is approximated by equation (5) according to the motor current Im and motor voltage V, and angular acceleration is obtained as the ratio of a time-varying change in the angular velocity w for the predetermined time Ts. The second load component F2(n) is obtained by multiplying the angular acceleration with a proportionality constant, as indicated in equation (4). If a load is calculated according to the cycle of a pulse generated by, for example, a Hall sensor, as the load is increased, an interval at which the angular velocity is detected is prolonged. With the opening/closing control device in this embodiment, however, the angular velocity is detected at a fixed interval, regardless of whether the load is increased or decreased. This enables an increase in the load to be detected at an early timing.
With the opening/closing control device in this embodiment, even if the calculated load F exceeds the criterion value Fth, if the ratio of a time-varying change in the calculated load F is outside a predetermined range, it is decided that a trap has not occurred. Therefore, even if the calculated load F is temporarily deviates from the predetermined range due to noise or the like, this deviation is not incorrectly decided easily as a trap.
With the opening/closing control device in this embodiment, a value obtained by adding the predetermined threshold ΔTH to the reference value Fb, which is the moving average of the calculated load F, is set as the criterion value Fth. Therefore, even if the calculated load F is slightly increased due to a factor other than a trap such as the fitting of the door 2, the reference value Fb is increased, preventing the calculated load F from easily exceeding the criterion value Fth. Accordingly, it is possible to prevent a slight increase in the calculated load F from being incorrectly detected easily as a trap.
Next, a second embodiment of the present invention will be described.
The angular velocity detecting unit 54 detects the angular velocity of the rotation of the motor 6. Specifically, the angular velocity detecting unit 54 preferably extracts a ripple of the motor current Im, the ripple being generated each time the motor 6 rotates by a predetermined angle, and preferably calculates the angular velocity according to an interval at which a ripple is generated. If the motor 6 has a Hall senor or the like that generates a pulse each time the motor 6 rotates by the predetermined angle, the angular velocity detecting unit 54 may calculate the angular velocity according to an interval at which a pulse is generated. Alternatively, the angular velocity detecting unit 54 may detect the angular velocity by any of other various ways.
The load calculating unit 51 calculates the calculated load F according to equations (2) to (4), as in the first embodiment described above. However, w(n) in equation (4) is the angular velocity detected by the angular velocity detecting unit 54. Therefore, the load calculating unit 51 calculates the calculated load F each time the angular velocity detecting unit 54 detects the angular velocity w(n). Ts in equation (4) is the difference between the time at which the most recent angular velocity w(n) was detected and the time at which the previous angular velocity w(n−1) was detected.
With the opening/closing control device in the second embodiment described above as well, if a relatively hard object is trapped, the second load component F2 is increased immediately, so the trap is detected at an earlier timing. Therefore, a time taken from when a trap occurs until trap prevention control is started can be shortened.
The present invention is not limited only to the embodiment described above. The present invention includes various variations.
In the above embodiment, an example in which the present invention is applied to an opening/closing control device (such as a power window) for a window of a vehicle has been described. However, the present invention is not limited to this. The present invention can be applied to other various opening/closing control devices for sun rooms and sliding doors.
Number | Date | Country | Kind |
---|---|---|---|
2016-131323 | Jul 2016 | JP | national |