LENS CONTROL SYSTEM AND METHOD FOR COMPENSATING GRAVITY IMBALANCE
20230074396 · 2023-03-09
Inventors
Cpc classification
H04N23/55
ELECTRICITY
H04N23/6812
ELECTRICITY
H04N23/663
ELECTRICITY
International classification
Abstract
A lens control system and a method for compensating a disturbance force acting on a lens group of an optical assembly are provided. The optical assembly includes an actuator configured to move the lens group along an optical axis in response to an optical lens position command received from the camera controller. The lens control system further includes an optical assembly controller with a power driver configured to apply an electrical energy to the actuator to produce a force that acts on the lens group to move the lens group to a commanded position, a current sensor configured to measure a current flowing through the actuator in response to the electrical energy applied to the at least one actuator, and a position sensor configured to generate position information by measuring an actual position of the lens group.
Claims
1. A lens control system for compensating a disturbance force acting on at least one lens group of an optical assembly when the at least one lens group is moved, the lens control system comprising: a camera controller; the optical assembly including the at least one lens group on which the disturbance force acts and at least one actuator, the at least one lens group defining an optical axis and the at least one actuator being configured to move the at least one lens group along the optical axis in response to an optical lens position command received from the camera controller; and an optical assembly controller in communication with the camera controller, the optical assembly controller including: a power driver configured to apply an electrical energy to the at least one actuator to produce a force that acts on the at least one lens group to move the at least one lens group to a commanded position; a current sensor configured to measure a current flowing through the at least one actuator in response to the electrical energy applied to the at least one actuator; and a position sensor configured to generate position information by measuring an actual position of the at least one lens group.
2. The lens control system of claim 1, wherein the optical assembly controller further includes: a closed loop controller configured to determine a correct amount of the electrical energy required to move the at least one lens group to the commanded position based on gravity orientation information and the position information.
3. The lens control system of claim 2, wherein the camera controller includes an inertial measurement unit, and wherein the inertial measurement unit provides the gravity orientation information.
4. The lens control system of claim 2, wherein the gravity orientation information is determined by extracting a component of an entirety of forces acting on the at least one actuator created by gravity without an inertial measurement unit.
5. The lens control system of claim 4, wherein the entirety of forces is directly proportional to the current flowing through the at least one actuator.
6. The lens control system of claim 1, wherein the disturbance force includes a gravitational force, and electrical and mechanical forces resulting from a change in operating conditions.
7. The lens control system of claim 6, wherein the change in the operating conditions includes a change in temperature and a change in a power source capacity.
8. The lens control system of claim 1, wherein the electrical energy includes: a first component required to change the position of the at least one actuator to the commanded position; and a second component required to compensate the disturbance force.
9. The lens control system of claim 1, wherein the at least one actuator includes a linear voice coil actuator.
10. A method for compensating a disturbance force acting on at least one lens group of an optical assembly when the at least one lens group is moved, the at least one lens group defining an optical axis, the optical assembly further including at least one actuator configured to move the at least one lens group along the optical axis in response to an optical lens position command received from a camera controller, the method comprising: applying an electrical energy to the at least one actuator to produce a force that acts on the at least one lens group to move the at least one lens group to a commanded position; measuring, by a current sensor, a current flowing through the at least one actuator in response to the electrical energy applied to the at least one actuator; and generating, by a position sensor, position information by measuring an actual position of the at least one lens group.
11. The method of claim 10, further comprising: determining, by a closed loop controller, an adjusted amount of the electrical energy required to move the at least one lens group to the commanded position based on gravity orientation information and the position information, and applying the adjusted amount of the electrical energy to the at least one actuator.
12. The method of claim 11, wherein the camera controller includes an inertial measurement unit, and wherein the inertial measurement unit provides the gravity orientation information.
13. The method of claim 11, further comprising: determining the gravity orientation information by extracting a component of an entirety of forces acting on the at least one actuator created by gravity without an inertial measurement unit.
14. The method of claim 13, wherein the entirety of forces is directly proportional to the current flowing through the at least one actuator.
15. The method of claim 10, wherein the disturbance force includes a gravitational force, and electrical and mechanical forces resulting from a change in operating conditions.
16. The method of claim 15, wherein the change in the operating conditions includes a change in temperature and a change in a power source capacity.
17. The method of claim 10, wherein the electrical energy includes: a first component required to change the position of the at least one actuator to the commanded position; and a second component required to compensate the disturbance force.
18. The method of claim 10, wherein the at least one actuator includes a linear voice coil actuator.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0020] The invention will now be described with reference to the drawings wherein:
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
[0027]
[0028]
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
[0036]
[0037]
DESCRIPTION OF EXEMPLARY EMBODIMENTS
[0038] Exemplary embodiments of the disclosure will be explained below with reference to the accompanying schematic figures. Features that coincide in their nature and/or function may in this case be provided with the same designations throughout the figures.
[0039] The terms “exhibit”, “have”, “comprise” or “include” or any grammatical deviations therefrom are used in a non-exclusive way. Accordingly, these terms can refer either to situations in which, besides the feature introduced by these terms, no further features are present, or to situations in which one or more further features are present. For example, the expression “A exhibits B”, “A has B”, “A comprises B” or “A includes B” may refer both to the situation in which no further element aside from B is provided in A (that is to say to a situation in which A is composed exclusively of B) and to the situation in which, in addition to B, one or more further elements are provided in A, for example element C, elements C and D, or even further elements.
[0040] Furthermore, the terms “at least one” and “one or more” and grammatical modifications of these terms or similar terms, if they are used in association with one or more elements or features and are intended to express the fact that the element or feature can be provided singly or multiply, in general are used only once, for example when the feature or element is introduced for the first time. When the feature or element is subsequently mentioned again, the corresponding term “at least one” or “one or more” is generally no longer used, without restriction of the possibility that the feature or element can be provided singly or multiply.
[0041] Also, the terms “preferably”, “in particular”, “by way of example” or similar terms are used in conjunction with optional features, without alternative embodiments thereby being restricted. In this regard, features introduced by these terms are optional features, and there is no intention to restrict the scope of protection of the claims, and in particular of the independent claims, by these features. In this regard, the invention, as will be recognized by a person of ordinary skill in the art, can also be carried out using other configurations. Similarly, features introduced by “in one embodiment of the invention” or “in one exemplary embodiment of the invention” are to be understood to be optional features, without this being intended to restrict alternative refinements or the scope of protection of the independent claims. Furthermore, all possibilities of combining the features introduced by these introductory expressions with other features, whether optional or non-optional features, are intended to remain unaffected by said introductory expressions.
[0042]
[0043] Changes in the pitch angle 155 are orthogonal to changes in the yaw angle 135 and the roll angle 155, and result in the optical assembly 110 tilting up or down. A rotation about the yaw axis 130 is a rotation of a plane defined by the pitch axis 150 and the roll axis 140 and is also orthogonal to the pitch axis 150 and the roll axis 140.
[0044]
[0045] Linear voice coil actuators 200 are a type of direct drive mechanism that provides extremely precise positioning of a lens group over small displacements. Like linear motors, linear voice coil actuators 200 work on the principle of a permanent magnet field and a coil winding. When a current is applied to the coil 210, a force is generated (known as the Lorentz force). Operationally, the force produced by a voice coil causes the moving part 220 or linear bearing to travel, e.g., from a first position shown in
[0046]
[0047] As shown in
[0048] The optical assembly 310 further includes imager 330, shutter 333, and iris 335. Shutter 333 is operated by stepper motor 343 and iris 335 is operated by stepper motor 345. Further, optical assembly 310 includes 350 to place the second lens group 325 in a park position. As also shown in
[0049] The optical assembly controller 315 uses closed-loop control of a linear lens position and a voice coil current to smoothly move either lens group. The camera controller 305 also includes an IMU sensor 310 which is conventionally used to maintain the image shown on display 306 in an upright position as the user rotates the camera body 120.
[0050] The first and second lens groups 323, 325 can be independently positioned along the optical axis which corresponds to the roll axis 140. The optical assembly controller 315 receives optical lens position commands from the camera controller 305 via Serial Peripheral Interface (SPI) 393 for each lens group in units of diopters and converts the optical lens position commands to linear lens position commands. Using closed-loop position control of each lens group 323, 325, an electrical current is produced to control the force necessary to move the voice coil with linear bearings 220 that support the lens groups 323, 325 to the desired position measured by a sensor.
[0051] Turning now to
[0052] As shown in
[0053] A linear voice-coil actuator 320 is a type of direct-drive linear motor. The current flowing through the coil assembly 210 interacts with the permanent magnetic field and generates a force vector (torque) perpendicular to the direction of the current, along the lens transport axis of motion which corresponds to the roll axis 140. Voice coil motors are generally brushless and do not utilize commutation. Their structural stability can support high positioning resolutions.
[0054] The linear voice-coil actuator 320, 322 has a non-commutated motor construction which increases reliability. The direct coupling of the linear voice-coil actuator 320, 322 to the load, i.e., the lens group 323, 325 allows for fast acceleration/deceleration such that very high speeds and accelerations can be easily achieved. Closed-loop control of the voice coil current by the current loop 405, which generates a torque or force, overcomes the bandwidth limitations of voice coil electrical resistance and inductance and improves load disturbance rejection. In other words, the current loop 405 normalizes all of the torque disturbances, i.e., the disturbance forces acting on the lens group 323, 325 and/or on the linear voice-coil actuator 320, 322. This includes a torque disturbance or disturbance force, or a component thereof, due to gravity.
[0055] Although the current loop 405 may normalize torque disturbances in any gravity orientation, it has been shown that normalization of torque disturbances in a horizontal gravity orientation, i.e., when the optical assembly 110 is rotated around the pitch axis 150, significantly improves operation of the camera functions, e.g., the zoom function. Thus, by dynamically changing the tuning of the control loops based on the gravity orientation information 460, stability of the system can be improved.
[0056] Closed-loop control of the lens transport position by the position loop 410 is needed to overcome static and dynamic frictional and inertial loads.
[0057] The position loop 410 includes closed loop controller 445. The closed loop controller 445 is configured to determine a correct amount of the electrical energy required to move the at least one lens group 325 to the commanded position based on gravity orientation information 460 and position information generated by the position sensor 440. As shown in
[0058] The position loop 410 is called every 25 μsec when a timer interrupt occurs. It takes 6 passes for all of the calculations to generate a new current and output to each actuator 455.
[0059] On the 1.sup.st pass, the actual lens actuator positions are read via an analog/digital (A/D) converter and a position trajectory for each lens group 323, 325 (in the optical diopter space) is generated. This makes it possible for both lens groups 323, 325 to synchronously maintain a contrast or phase focus mode. On the 2.sup.nd pass, the lens positions are converted from millimeters (mm) to diopters. On the 3.sup.rd pass, the commanded position of the first of two lens groups 323 is subtracted from the actual (feedback) position and the error is multiplied by the PID loop compensation. The output is converted to a duty cycle and applied to the actuator 322.
[0060] On the 4.sup.th pass, a commanded position of the second lens group 325 is subtracted from the actual (feedback) position and the error is multiplied by the PID loop compensation. The output is converted to a duty cycle and applied to the actuator 320. Nothing happens on the 5.sup.th pass. On the 6.sup.th pass, the phase counter is reset so the entire cycle can be repeated.
[0061] On the 3.sup.rd pass, the current gravity orientation angle is compared to a threshold which determines if horizontal, vertical up, or vertical down tuning of the first lens group 323 should be applied. On the 4.sup.th pass, the current gravity orientation angle is compared to a threshold which determines if horizontal, vertical up, or vertical down tuning of the second lens group 325 should be applied.
[0062] As discussed above, as the camera body 100 and the optical assembly 110 are physically tilted up or down about the pitch axis 150, a disturbance force acts upon the lens actuator 320, 322 and the lens group 323, 325 due to the earth's gravitational field. The disturbance force includes a gravitational force, and electrical and mechanical forces resulting from a change in operating conditions. More significantly, it has been determined that the disturbance force differs substantially depending on the gravity orientation of the optical assembly 110. When the optical assembly 110 is in a straight up position (i.e., the pitch angle 155 is at an angle Φ=90.0 degrees), the force to slide or move the lens group 325 is maximum in the direction towards the imager 330. This maximum equals the sliding mass times the acceleration due to gravity. Without any counter force from the voice coil 455, the lens group 325 will side to the end nearest the imager 330.
[0063] As the pitch angle 155 decreases towards a horizontal position (pitch angle Φ=0.0 degrees), the force to slide the lens group 325 decreases by sin(Φ). The lens stops moving when this force is less than the frictional force to slide the lens.
[0064] In the horizontal position (pitch angle Φ=0.0 degrees), there is no force to slide the lens group.
[0065] As the pitch angle 155 decreases towards a straight down position (pitch angle Φ=−90.0 degrees), the force to slide the lens group increases by sin(Φ). The lens group starts moving when this force is larger than the frictional force to slide the lens group. Without any counter force from the voice coil, the lens group will slide to the end farthest from the imager 330.
[0066] In the straight down position (pitch angle Φ=−90.0 degrees), the force to slide the lens group is maximum in the direction away from the imager 330. Thus, the lens control system 400 improves the optical assembly position and velocity command tracking performance by using the camera's pitch angle 155, obtained from the IMU 310 to adjust the closed-loop tuning parameters of the lens group 323 and lens group 325 linear voice coil actuator of actuators 320 and 322, respectively. This is a new utilization of IMU 310 sensor measurements which, as discussed above, are traditionally only used to keep the camera display horizontal as the gravity angle changes.
[0067] This is in particular different from the related art because knowledge of camera pitch angle 155 for tuning enables the same camera performance independent of gravity orientation. In other words, “best” closed-loop actuator tracking performance is realized when control loop tuning parameters adjust the actuator system frequency response to increase low frequency gain and bandwidth while maintaining adequate stability margins. Since a torque disturbance changes the frequency response and changing the gravity orientation of a portable camera causes a torque disturbance, fixed tuning parameters will not yield the same performance at different gravity orientations.
[0068] Using pitch angle 155, commanded position, velocity and servo error measurements to dynamically adjust tuning parameters ensures stability margins are maintained. By applying thresholds to the measured pitch angles which correspond to significant changes in the frequency response, simple efficient tuning adjustments can normalization tracking performance over a wide range of pitch values.
[0069] In addition, there is no need to dynamically stabilize the camera movement. Only the pitch information is needed. Roll angle 145 and yaw angle 135 have no effect on the control system because their forces are orthogonal to the optical assembly movement. Thus, the lens control system 400 is configured to dynamically select and transition to optimized tuning parameters as the system undergoes gravity orientation changes.
[0070]
[0071]
[0072] The third exemplary embodiment shown in
[0073] Thus, unlike in the first exemplary embodiment shown in
[0074] All of the information needed to extract the gravity orientation from the voice coil current is locally available to the control system. By using commanded position, velocity and servo error measurements, tuning parameters can be dynamically adjusted to ensures stability margins are maintained.
[0075] By applying thresholds to the measured pitch angles 155 which correspond to significant changes in the frequency response, simple efficient tuning adjustments can normalization tracking performance over a wide range of pitch values.
[0076] As a result, there is no need to dynamically stabilize the camera movement which makes high-quality performance of the automatic zoom function, for example, possible. Only the pitch information is needed fort this control operation. Roll and Yaw have no effect on the control system because their forces are orthogonal to the optical assembly movement.
[0077] Turning now to
[0078] The frequency response graphs show that the magnitude of the closed-loop tracking response below 40 Hz for horizontal orientation has the lowest gain and results in the worst lens positioning performance.
[0079]
[0080]
[0081] As shown in
[0082] Turning now to
[0083] As shown in
[0084] Changes in gravity orientation result in deterministic mechanical imbalance forces or disturbance forces in the lens control system 300.
[0085] Using Newton's second law of motion, all forces on the center of mass of the optical assembly 110, 310 acting along the optical axis under the influence of gravity can be calculated:
F.sub.D=F.sub.G*SIN(Φ)=M*A*SIN(Φ),
wherein M is the lens group mass/weight, A is the acceleration due to gravity which is 9.8 meters/sec.sup.2, and Φ is the tilt angle between the mechanical optical axis and horizontal plane normal to gravity.
[0086] In the absence of any force produced by the voice coil (F.sub.VC), at a pitch angle 155 of Φ=0 degrees, (horizontal position) static friction keeps the lens from moving.
F.sub.D=F.sub.G*SIN(0)=0<F.sub.SF
[0087] As the pitch angle 155 Φ increases towards 90 degrees (vertical-UP), at same angle Φ=Φ.sub.SLIDE, the static bearing force (F.sub.SF) is exceeded by the force on the optical assembly 110, 310 due to acceleration by gravity along the axis of movement (F.sub.D) and the lens group 323, 325 starts to slide.
F.sub.D=M*A*SIN(Φ.sub.SLIDE)>F.sub.SF
[0088] For the closed-loop control system to position the lens group in the desired position, a restoring force is needed:
F.sub.VCclosed-loop=F.sub.D−F.sub.SF
[0089] Assuming the coefficient of friction is the same, as the pitch angle Φ decreases from horizontal towards −90 degrees (vertical-DOWN), at tilt angle Φ=−Φ.sub.SLIDE, the static bearing force (F.sub.SF) is again exceeded by the force on the lens assembly due to acceleration by gravity along the axis of movement (F.sub.D) and again the lens starts to slide, as shown in
[0090] In the vertical-down position shown in
−F.sub.VCclosed-loop=F.sub.D−F.sub.SF
[0091]
[0092]
[0093] It is understood that the foregoing description is that of the exemplary embodiments of the invention and that various changes and modifications may be made thereto without departing from the spirit and scope of the invention as defined in the appended claims.
LIST OF REFERENCE NUMERALS
[0094] 100 camera [0095] 110 optical assembly [0096] 120 camera body [0097] 130 yaw axis [0098] 135 yaw angle [0099] 140 roll axis [0100] 145 roll angle [0101] 150 pitch axis [0102] 155 pitch angle [0103] 200 linear voice coil actuator [0104] 210 coil [0105] 220 moving part [0106] 300 lens control system [0107] 301 inertial measurement unit [0108] 304 imaging FPGA [0109] 305 camera controller [0110] 306 display [0111] 308 memory [0112] 310 optical assembly [0113] 315 optical assembly controller [0114] 320 actuator [0115] 322 actuator [0116] 323 first lens group [0117] 325 second lens group [0118] 330 imager [0119] 333 shutter [0120] 335 iris [0121] 343 stepper motor [0122] 345 stepper motor [0123] 360 lens control CPU [0124] 370 stepper motor drivers [0125] 380 first lens group control system [0126] 400 lens control system [0127] 401 lens control system [0128] 405 current loop [0129] 410 position loop [0130] 430 power driver [0131] 435 current sensor [0132] 440 position sensor [0133] 445 closed loop controller [0134] 455 voice coil [0135] 460 gravity orientation information [0136] 470 lens transport [0137] 500 lens control system [0138] 510 position loop [0139] 1100 method [0140] 1105 step [0141] 1110 step [0142] 1120 step [0143] 1130 step [0144] 1140 step