The present invention is directed to a control system for a power-operated moving object, such as a vehicle window more particularly to a control system that detects a possible pinch condition in the moving object.
Systems for moving objects (e.g., sliding vehicle doors, lift gates, trunks, windows, and the like) often incorporate a pinch detection system that detects when a obstacle is in the path of the moving object. Currently known systems compare the motor force or torque with a reference force or torque and determines that a pinch condition exists if the actual force is greater than the reference force by a certain amount.
The reference force used to detect the pinch condition is normally obtained from a reference field that ideally represents the force profile of the moving object. Customizing the force profile for each individual object is time-consuming and costly, so some current systems use a pre-determined reference field that is obtained from a theoretical design value or a pre-calculated average of force profiles from several samples. Even with these calculations, manufacturing variances from object to object will create inevitable errors between the predetermined reference field and the actual force profile of the object. These variations require the pinch detection threshold to be increased to avoid false detection of pinch conditions, but increasing the pinch threshold undesirably increases the pinching force as well. Further, if the reference field collapses or is unavailable for any reason, pinch detection in current systems is rendered impossible.
There is desire for a system that can adapt to different force profiles to optimize pinch detection for a given moving object without obtaining force profiles of each sample. There is also a desire for a system that can keep pinching force constant regardless of the pinch detection threshold value.
The present invention is directed to a system and method for pinch detection. The invention controls the speed of a motor moving the object by first calculating the actual motor force and then comparing the actual motor force with a reference force value in a reference field. A pinch condition is indicated if the difference between the actual force and the reference force exceeds a selected pinch threshold. The difference is also used to update the reference field so that the reference field will eventually reflect the actual force profile of the object even as the profile changes due to age and wear. The difference is also used to update the pinch threshold to minimize pinch force while preventing false motor reversals. The updated pinch threshold also causes the desired speed of the motor, and therefore the object, so that the pinch force in the system will be kept constant. In one embodiment, initial values for the reference field, pinch threshold and desired speed are stored so that they can be used for pinch detection if the updated values are lost or otherwise unavailable.
By updating the reference value and based on the actual force characteristics of the moving object and changing the pinch threshold based on the reference value, the inventive system ensures accurate pinch detection even when there are manufacturing variances between systems. Further, updating the pinch threshold allows the pinching force to remain constant regardless of the pinch threshold value.
a and 3b are graphs illustrating a comparison between an actual force profile and a reference force profile along with an associated difference value profile according to one embodiment of the invention; and
The system 100 includes a motor 104 that is actuatable by a motor actuator 106, such as a bi-directional relay, H-bridge power transistor or other actuation device. The motor actuator connects and disconnects the motor 104 to and from a power source 108. A speed sensor 110 detects the rotational speed of the motor 104. The speed sensor 110 can be any type of speed sensor appropriate for monitoring the speed of the motor 104, such as an encoder, Hall effect sensor, or other type of sensor. In one embodiment, the speed sensor 110 sends an output to a motor regulator 112 to control the motor speed.
A voltage sensor 114 measures the voltage across the motor 104 and sends this information to the motor regulator 112 as well. The voltage sensor 114 also sends its output to a force calculator 116, which calculates the motor force (e.g., motor torque) according to the equation:
where V is the motor voltage sensed by the voltage sensor 114, R is the motor resistance, and km and kn are motor constants associated with the motor 104.
The force calculator 116 sends an output to a reference field manager 118. The reference field manager 118 reflects an expected motor force at each object 102 position, as shown in
A pinch detector 120 receives inputs from the force calculator 116 and the reference field 118 and determines whether a pinch condition exists based on the two received inputs. The pinch detector 120 detects a pinching condition if the actual force calculated by the force calculator 116 is greater by a selected pinch detection threshold value Tthr than the corresponding reference force from the reference field 118. The corresponding reference force is, for example, the reference force value in the reference field corresponding to the object's position at a given time. In one embodiment, the pinch detector 120 sets a pinch detection flag (not shown). In other words:
ΔT=T−Tref[k] (2)
where fpinch is the pinch detection flag and Tref[k] is the reference force value at a given object position k. The pinch detector 120 can be any device, such as a microprocessor, that can conduct calculations and store updated pinch threshold values for determining pinch conditions.
The pinch detector 120 sends the pinch detection threshold value Tthr to the motor regulator 112 so that the motor regulator 112 can adjust the desired motor speed ω based on the pinch detection threshold value Tthr. In one embodiment, the motor regulator 112 controls the motor speed by adjusting the voltage applied to the motor 104 according to any control method such as, for example:
Vmot*=kmω−Kp(ω−ω*) (4)
where ω* is the desired motor speed, Vmot* is the voltage to be applied to the motor, and Kp is the feedback gain. Of course, any other control method may be used to regulate the motor speed. Regardless of the specific motor regulation method, the desired motor speed ω* is determined and updated based on the pinch detection threshold Tthr, which will be explained in greater detail below. The motor regulator 112 also will stop and reverse the motor 104 if the pinch detecting flag fpinch is set by the pinch detector 120.
If the difference ΔT is less than the pinch detection threshold Tthr, it indicates that the object 102 successfully moved its full distance (e.g., a window or door moving to a closed position) without encountering any obstacles that would cause a pinch condition. The reference field is therefore updated (block 208) according to the equation:
Tref=Tref[k]+αΔT[k] (5)
where α is a selected “forgetting factor” between 0 and 1 and k is an integer value representing an object position. The value for α can be varied depending on how quickly the system wishes to disregard old data. As can be seen in Equation 5, the updated reference field value is proportional to the difference ΔT between the actual force and the reference force so that the reference can be updated quickly. Large differences will cause faster updates to the reference field 118. A small difference value ΔT indicates that the reference force Tref value is close to the actual force T value, making large changes unnecessary when the reference field 118 is updated (block 208). Updating the reference field in this manner ensures that the reference field will quickly match the actual force profile of the object 102.
When the reference field 118 is updated (block 208), the pinch detection Tthr threshold is also updated by first determining the maximum difference ΔT between the actual force T and the reference force Tref along the entire movement of the object 102 (block 210). As shown in
Once the maximum difference ΔTmax has been determined, the pinch detector 120 calculates a threshold update value ΔTthr according to the following equation
ΔTthr=min(ΔTmax, oldΔTmax+δ) (6)
As can be seen in Equation 6, ΔTthr equals the maximum difference ΔTmax as long as the maximum difference ΔTmax changes less than a selected change value δ. This equation recognizes that the maximum difference ΔTmax will become smaller as the reference field moves closer to the actual force profile. The change value δ can be any predetermined amount to allow for, for example, changes in the actual profile due to aging of the object 102. In one embodiment, the initial value of ΔTthr is set so that ΔTmax will be selected when the ΔTthr is determined by the pinch detector 120 for the first time. This ensures that the reference field 118 can still be initialized for pinch detection if the original reference field collapses or is otherwise not available.
Tthr=Tthr0+ΔTthr(ΔTmax) (7)
where Tthr0 is the base threshold value and ΔTthr is the additional threshold value determined from the maximum difference ΔTmax, as explained above.
The additional threshold value is also used to calculated a desired motor speed (block 214) according to the following equation
ω*=ω0*−βΔTthr (8)
where ω0 is a nominal desired speed and β is a proportional factor that causes the desired speed to become proportionally smaller as the additional threshold ΔTthr becomes larger. The proportional factor β can be determined through experimentation or through any other known method. Regardless of the specific value for the proportional factor β, the factor β varies the effect of the additional threshold value ΔTthr on the desired speed so that as the additional threshold value ΔTthr becomes larger, the desired speed ω* becomes proportionally smaller. By varying the speed of the motor 104 moving the object 102, the pinching force remains constant regardless of the pinching threshold value Tthr. In one embodiment, the initial speed ω0 and the base threshold value Tthr0 are stored in a memory (e.g., in the pinch detector 120) so that they can be used, in conjunction with the initial value of ΔTthr=ΔTmax, for pinch detection if the original reference field collapses or is otherwise not available.
Once the desired speed has been updated (block 214), the process may return back to comparing the actual force with the reference force (block 202) to monitor the movement of the object 102 at its next position and continue pinch detection as the object 102 travels along its path.
As a result, the inventive system and method updates the reference field quickly and optimizes the pinching threshold value Tthr based on the updated reference field, thereby preventing false detections of pinching conditions while still minimizing the pinching force. Further, the invention varies the motor speed, and therefore the speed of the object 102, based on the pinch threshold value to keep the pinching force constant regardless of the pinch threshold value. Also, as noted above, storing an initial nominal desired speed and base threshold value and setting the additional threshold difference to be the maximum difference between the reference force and the actual force allows pinch detection even if the reference field 118 is rendered unavailable for any reason.
It should be understood that various alternatives to the embodiments of the invention described herein may be employed in practicing the invention. It is intended that the following claims define the scope of the invention and that the method and apparatus within the scope of these claims and their equivalents be covered thereby.
This application claims the benefit of U.S. Provisional Appln. No. 60/318,923, filed Sep. 13, 2001, and U.S. Provisional Appln. No. 60/402,719, filed Aug. 12, 2002, the disclosures of which are incorporated herein by reference.
Number | Name | Date | Kind |
---|---|---|---|
5399950 | Lu et al. | Mar 1995 | A |
5436539 | Wrenbeck et al. | Jul 1995 | A |
5530329 | Shigematsu et al. | Jun 1996 | A |
6183040 | Imaizumi et al. | Feb 2001 | B1 |
6408238 | Lamm et al. | Jun 2002 | B1 |
6573677 | Gerbetz | Jun 2003 | B2 |
Number | Date | Country |
---|---|---|
0590227 | Apr 1994 | EP |
0945953 | Sep 1999 | EP |
Number | Date | Country | |
---|---|---|---|
20030051555 A1 | Mar 2003 | US |
Number | Date | Country | |
---|---|---|---|
60318923 | Sep 2001 | US | |
60402719 | Aug 2002 | US |