US20140036332A1 - System and Method for Positioning a Mirror in a Lidar System Using Open Loop and Closed Loop Control - Google Patents
System and Method for Positioning a Mirror in a Lidar System Using Open Loop and Closed Loop Control Download PDFInfo
- Publication number
- US20140036332A1 US20140036332A1 US13/956,961 US201313956961A US2014036332A1 US 20140036332 A1 US20140036332 A1 US 20140036332A1 US 201313956961 A US201313956961 A US 201313956961A US 2014036332 A1 US2014036332 A1 US 2014036332A1
- Authority
- US
- United States
- Prior art keywords
- signal
- control
- implementations
- output
- open loop
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Abandoned
Links
Images
Classifications
-
- G—PHYSICS
- G02—OPTICS
- G02B—OPTICAL ELEMENTS, SYSTEMS OR APPARATUS
- G02B7/00—Mountings, adjusting means, or light-tight connections, for optical elements
- G02B7/18—Mountings, adjusting means, or light-tight connections, for optical elements for prisms; for mirrors
- G02B7/182—Mountings, adjusting means, or light-tight connections, for optical elements for prisms; for mirrors for mirrors
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/481—Constructional features, e.g. arrangements of optical elements
- G01S7/4811—Constructional features, e.g. arrangements of optical elements common to transmitter and receiver
- G01S7/4812—Constructional features, e.g. arrangements of optical elements common to transmitter and receiver transmitted and received beams following a coaxial path
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/481—Constructional features, e.g. arrangements of optical elements
- G01S7/4817—Constructional features, e.g. arrangements of optical elements relating to scanning
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
Definitions
- the invention is generally related to control systems, and more particularly to, increasing tracking bandwidth in control systems.
- Control systems are employed in many applications where the input to a subsystem (referred to as the “plant” herein) has to be generated such that its output (one or more physical, measurable quantities) follows a desired value over time, even in the presence of disturbing influences on the subsystem.
- This desired value of the system output represents the input to the entire control system and is referred to as “desired system output” or in the description of an implementation example as “command position signal” herein.
- the generation of the controlling input signal to the plant can be optimized to generate the desired output with high bandwidth, low error or some other optimization criterion. At the same time, it may be desirable to optimize suppression of disturbing influences on the plant. Optimization for more than one of these criteria can generally not be achieved and the resulting implementation necessarily represents a compromise.
- Control systems are typically implemented in a closed-loop configuration where the output of the subsystem to be controlled is measured and compared to a desired system output. The difference between desired and measured system output constitutes the “error”, which is used to generate the input to the controlled subsystem.
- control system bandwidth in a three dimensional system, for example.
- the control system bandwidth is improved without affecting the optimization for any of the other criteria (for example, minimizing error, suppression of disturbing influences (loop disturbances) on the plant, or other optimization criteria).
- a first control signal in the control system is generated from the desired system output.
- the first control signal is provided as input to the plant.
- the first control signal is generated from the desired system output but not the measured system output.
- a second control signal in the control system is generated from the desired system output.
- the control system is configured to use the second control signal to generate the “error” signal (indicative of the difference between the second control signal and the measured system output.
- FIG. 1 illustrates a combined lidar and video camera system according to various implementations of the invention.
- FIG. 2 illustrates a scan pattern of a lidar beam according to various implementations of the invention.
- FIG. 3 illustrates a block diagram of a controller according to various implementations of the invention.
- FIG. 4 illustrates a block diagram for open loop control for a second-order system according to various implementations of the invention.
- FIG. 5A illustrates components of controlled-acceleration trajectory for open loop control according to various implementations of the invention.
- FIG. 5B illustrates an open loop drive signal according to various implementations of the invention.
- FIG. 6 illustrates a block diagram for an example controller using a PID algorithm according to various implementations of the invention.
- FIG. 7 illustrates a block diagram for a combined open loop and closed loop control according to various implementations of the invention.
- FIG. 8 illustrates an open loop system response according to various implementations of the invention.
- FIG. 9 illustrates an open loop system response with a delay-corrected error signal according to various implementations of the invention.
- FIG. 10 illustrates a block diagram for a combined open loop and closed loop control with delayed error signal according to various implementations of the invention.
- FIG. 11 illustrates a block diagram of a conventional closed-loop controller/control system.
- FIG. 12 illustrates a block diagram of a conventional closed-loop controller/control system wherein the representation of one or more component blocks is partitioned into a minimum-phase transfer function and a delay.
- FIG. 13 illustrates a block diagram of a combined controller/control system according to various implementations of the invention.
- FIG. 1 illustrates a combined lidar and video camera system 100 (three dimensional system 100 ) according to various implementations of the invention.
- Various implementations of the invention utilize synergies between lidar measurements and video images to resolve six degrees of freedom for motion of a target to a degree not otherwise possible with either a lidar or video camera alone.
- lidar subsystem 130 includes two or more lidar beam outputs 112 (illustrated as a beam 112 A, a beam 112 B, a beam 112 ( n - 1 ), and a beam 112 n ); two or more reflected beam inputs 114 each corresponding to one of beams 112 (illustrated as a reflected beam 114 A, a reflected beam 114 B, a reflected beam 114 ( n - 1 ), and a reflected beam 114 n ); two or more lidar outputs 116 each associated with a pair of beam 112 /reflected beam 114 (illustrated as a lidar output 116 A associated with beam 112 A/reflected beam 114 A, a lidar output 116 B associated with beam 112 B/reflected beam 114 B, a lidar output 116 ( n - 1 ) associated with beam 112 (
- beam steering mechanism 140 may be employed to steer one or more beams 112 toward target 190 .
- beam steering mechanism 140 may include individual steering mechanisms, such as a steering mechanism 140 A, a steering mechanism 140 B, a steering mechanism 140 C, and a steering mechanism 140 D, each of which independently steers a beam 112 toward target 190 .
- one beam steering mechanism 140 may independently steer pairs or groups of beams 112 toward target 190 .
- beam steering mechanism 140 may include one or more mirrors, each of which may or may not be separately controlled, each mirror steering one or more beams 112 toward target 190 .
- beam steering mechanism 140 may directly steer an optical fiber of beam 112 without use of a mirror.
- beam steering mechanism 140 may be controlled to steer beams 112 in azimuth and/or elevation. Various techniques may be used by beam steering mechanism 140 to steer beam(s) 112 toward target 190 as would be appreciated.
- beam steering mechanism 140 may be used to control both an azimuth angle and an elevation angle of two beams 112 toward the target. By controlling both the azimuth angle and the elevation angle, the two beams 112 may be used to scan a volume for potential targets or track particular targets such as target 190 . Other scanning mechanisms may be employed as would be apparent.
- the two beams 112 may be offset from one another. In some implementations of the invention, the two beams 112 may be offset vertically (e.g., in elevation) or horizontally (e.g., in azimuth) from one another by a predetermined offset and/or a predetermined angle, either of which may be adjustable or controlled.
- beam steering mechanism 140 may be used to control both an azimuth angle and an elevation angle and employ an implementation of the invention as a control algorithm to achieve high tracking bandwidth.
- each beam 112 may be reflected back from target 190 to lidar subsystem 130 as reflected beam 114 .
- reflected beam 114 follows the same optical path (though in reverse) as beam 112 .
- a separate optical path may be provided in lidar subsystem 130 or in combined system 100 to accommodate reflected beam 114 .
- lidar subsystem 130 receives a reflected beam 114 corresponding to each beam 112 , processes reflected beam 114 , and outputs lidar output 116 to processing system 160 .
- Video subsystem 150 may include a video camera for capturing two dimensional images 155 of target 190 . Various video cameras may be used as would be apparent. In some implementations of the invention, the video camera may output images 155 as pixels at a particular resolution and at a particular image or frame rate. Video images 155 captured by video subsystem 150 are forwarded to processing system 160 . In some implementations of the invention, lidar subsystem 130 and video subsystem 150 are offset from one another in terms of position and orientation. In particular, lidar measurements typically correspond to three dimensions (e.g., x, y, and z) whereas video images typically correspond to two dimensions (e.g., x and y).
- Combined system 110 may include one or more optional video subsystems (not otherwise illustrated) for capturing additional two-dimensional images 155 of target 190 from different positions, perspectives or angles as would be apparent.
- processing system 160 receives lidar outputs 116 from lidar subsystem 130 and images 155 from video subsystem 150 and stores them in a memory or other storage device 165 for subsequent processing. Processing system 160 processes lidar outputs 116 and images 155 to generate a three-dimensional image of target 190 . In some implementations of the invention, processing system 160 determines a trajectory of target 190 from a combination of lidar outputs 116 and images 155 and uses the trajectory to generate a motion stabilized three-dimensional image of target 190 , as described in co-pending U.S. application Ser. No. 12/710,057, entitled “System and Method for Generating Three Dimensional Images Using Lidar and Video Measurements”, which is incorporated herein by reference in its entirety.
- a scan pattern 240 may be used to scan a volume for targets.
- scan pattern 240 represents a pattern of measurements taken by a single beam.
- scan pattern 240 includes individual points 210 measured left to right in azimuth at a first elevation 231 , right to left in azimuth at a second elevation 232 , left to right in azimuth at a third elevation 233 , etc., until a particular scan volume is scanned.
- scan pattern 240 may be divided into intervals corresponding to various timing aspects associated with combined system 100 .
- scan pattern 240 may be divided into time intervals associated with a frame rate of video subsystem 150 .
- scan pattern 240 may be divided into time intervals associated with scanning a particular elevation (i.e., an entire left-to-right or right-to-left scan).
- scan pattern 240 may be divided into time intervals associated with a roundtrip scan 220 (illustrated in FIG. 2 as a roundtrip scan 220 A, a roundtrip scan 220 B, and a roundtrip scan 220 C) at one or more elevations (i.e., a left-to-right and a return right-to-left scan at either the same or different elevations).
- Similar timing aspects may be used in implementations that scan vertically in elevation (as opposed to horizontally in azimuth). Other timing aspects may be used as well.
- a single line of the scan pattern is used to illustrate the operation of a control system configured according to an implementation of the invention.
- beam steering mechanism 140 may include a controller/control system that is configured to control a position (e.g., angle) of a steering mirror (also referred to herein as a controlled device or subsystem, i.e., a controlled device or subsystem that is to be controlled by the controller).
- the controller uses a combination of model-based open loop and closed loop control. While the controller is described herein as a controller that controls the steering mirror of a lidar subsystem 130 , other devices or subsystems may be controlled by similar controllers implemented in accordance with the invention as would be appreciated.
- beam steering mechanism 140 may include a single controller configured to control all mirrors used. In some implementations, beam steering mechanism 140 may include a dedicated controller for each mirror.
- FIG. 3 illustrates a block diagram of a controller 300 used to control such a controlled device according to various implementations of the invention.
- the trajectory generation component 305 generates a desired trajectory command signal 306 that indicates desired positioning of the controlled device 340 over time (also referred to as command position signal 306 or desired system output 306 ).
- the command position signal 306 is input to the open loop control component 310 and the closed loop control component 320 .
- open loop control component 310 may generate an open loop drive signal 315 and provide the open loop drive signal 315 to the drive stage 330 .
- the closed loop control component 320 receives as input the command position signal 306 and an actual position output signal 308 (also, referred to as, the measured system output 308 ) from the controlled device 340 .
- closed loop control component 320 may generate a closed loop drive signal 325 and provide the closed loop drive signal 325 to drive stage 330 .
- the drive stage 330 may generate and provide a combined drive signal (combined open loop and closed loop drive signal) to controlled device 340 to control the position of the controlled device 340 .
- extension of the architecture described in FIG. 3 to a multi-dimensional controller and/or to implementation of a piece-wise linearization for devices with non-linear transfer functions will be apparent to those having skill in the art and are not described in further detail herein.
- the controlled device 340 may be described as a system with a single input signal, the “drive” signal drv(t), and a single output signal, the “position” signal pos(t).
- the dependence of the position signal from the applied drive signal is expressed as a transfer function T.
- pos′(t) is the derivative of pos(t) and pos′′(t) is the second derivative.
- the steady-state system gain will be 1/c 1 and the other terms describe the dynamic behavior of the system.
- the goal of the controller is to make position pos(t) equal the command signal cmd(t):
- FIG. 4 illustrates a block diagram 400 for open loop control for a second-order system according to various implementations of the invention.
- Block diagram 400 illustrates an implementation of the open loop control component 310 of FIG. 3 .
- the open loop control component structure of FIG. 4 represents the differential equation (3).
- One of ordinary skill in the art would appreciate how to extend this structure to implement any other ordinary linear differential equations, be it of first, second or higher order.
- a drive stage of a real, implementable system shows a limited range of output values beyond which saturation sets in and rate of change of the output (slew rate) is limited.
- the position output signal of a system driven according to equation (5) equals the desired trajectory cmd(t) if the drive stage behaves as linear element, i.e. saturation and slew rate limitation are avoided. This places constraints on the possible trajectories the open-loop system can accurately follow.
- the drive signal components depend on the command signal following a controlled-acceleration trajectory.
- the second-order case of a simple linear movement with limited and constant acceleration results in a sigmoid trajectory.
- FIG. 5A illustrates components of this controlled-acceleration trajectory, for example, acceleration 515 , velocity 510 and command 505 .
- FIG. 5B illustrates the resulting open loop drive signal 520 generated with arbitrary coefficients.
- FIG. 6 illustrates a block diagram 600 for closed loop control component 320 according to various implementations of the invention.
- the open loop control component 310 may show a difference between the command position signal (cmd(t)) and the actual position signal (pos(t)) due to inaccuracies in the controller itself and due to disturbances of the controlled device by external influences.
- closed loop control component 320 may generate a difference signal (i.e., error signal err(t)) based on the command position signal and the actual position signal and may drive the system such that the error signal is minimized.
- the closed loop control component 320 may include a PID (proportional-integral-derivative) controller which is used to describe an example implementation of the invention.
- the invention may be applied to any other type of controller using the error signal as described to generate a controlling input signal to the plant/controlled device and is not limited to controllers of the PID type.
- the proportional, integral, and derivative of the error signal are combined to form the closed loop drive signal.
- stability analysis and derivation of the parameters (k p, k i and k d in the case of a PID controller) are understood by one of ordinary skill in the art.
- the achievable bandwidth of the closed-loop system is limited by the stability requirement.
- fast loop tuning is often accomplished by cancellation of poles in the transfer function of the open-loop system; this introduces a sensitivity of loop stability to parameter changes and drift.
- FIG. 7 illustrates a block diagram 700 for a combined open loop and closed loop control according to various implementations of the invention.
- the controlled device may exhibit a delay when following the commanded trajectory (i.e., desired trajectory command signal/command position signal).
- FIG. 8 illustrates an open loop system response of a second order system using open loop control according to various implementations of the invention.
- the controlled device may follow the commanded trajectory 810 accurately, but with a delay indicated by actual position signal 820 (which is indicative of system response).
- the resulting error signal 830 (command minus actual) may not be used in the open loop control component, but may be provided as input to the closed loop control component of FIG. 7 . This resulting error signal may cause the closed loop control component of the controller to contribute to the drive signal, thus affecting dynamic behavior of the system.
- the error signal input to the closed loop control component may be generated as the difference of ideal system response and actual system response.
- the ideal system response may be the command position signal delayed by an expected system delay.
- FIG. 9 illustrates an open loop system response with a corrected error signal 930 according to various implementations of the invention.
- FIG. 10 illustrates a block diagram 1000 for a combined open loop and closed loop control with corrected error signal generated from actual system response and delayed command signal according to various implementations of the invention.
- a corrected error signal is input to the closed loop control component.
- the resulting error is treated as a system disturbance and the closed loop control component of the controller may be optimized for load disturbances without impacting the system response to command inputs (tracking performance). Since the corrected error does not cause the closed loop control component to significantly contribute to the tracking performance, system tracking bandwidth may be determined by the open-loop coefficients without stability constraints.
- FIGS. 11 and 12 illustrate generalized block diagrams of a conventional closed-loop controller/control system.
- the behavior of the individual blocks may best be represented with a continuous-time transfer function.
- a discrete-time, sampled representation may be used.
- a combination of these methods may be used.
- a transfer function is the quotient of output signal of a component divided by the input signal of that component, using an appropriate transform description, such as Laplace transform, z-transform, or any other applicable transform descriptions.
- a linear approximation of that transfer function at a certain operating point may be used.
- a multitude of system output signals is generated from a multitude of internal signals and, ultimately, from a multitude of desired system output signals.
- the individual signals described herein each consist of a multitude of signals.
- transfer functions are then replaced with transfer matrices, as appropriate. The invention applies equally to these types of systems using the mentioned extended notation without other changes.
- FIG. 11 illustrates a conventional closed-loop control system 1100 .
- the controlled device or system includes plant 1145 with its input signal 1140 , d(t) (the “drive signal”), generating the system output signal 1150 , y(t) (measured system output).
- the system output is observed by block 1155 , generating signal 1160 , r(t) (the “feedback” signal).
- This feedback signal 1160 is subtracted from signal 1120 using adder block 1125 with the inversion of signal 1160 indicated by the “ ⁇ ” sign at the corresponding input to the adder 1125 .
- the difference signal 1130 (e(t) (the “error” signal), is an indication for how much the measured system output 1150 deviates from the desired system output 1110 .
- This error signal 1130 is used by the controller 1135 to create a corrected input signal 1140 which is provided as input to the plant 1145 .
- the desired system output 1110 , x(t), is fed through a scaling block 1115 to generate signal 1120 , s(t).
- this scaling block is used to apply an operation similar to the transfer function of the observation block 1155 .
- the desired system output 1110 and the measured system output 1150 are directly comparable and of the same scaling.
- the transfer function of scaling block 1115 differs from the observation block 1155 in that the desired system output 1110 is of different scaling as compared to the measured system output 1150 .
- it is assumed that the desired system output 1110 has the same scaling as the measured system output 1150 .
- an additional scaling may be applied to the system input to create signal 1110 with scaling identical to the measured system output 1150 without departing from the scope of the invention.
- the transfer function of the control system in FIG. 11 is given by:
- the measured system output 1150 y(t) follows the desired system output 1110 x(t) identically, which means that the transfer function of such an ideal system would be equal to 1.
- Practical implementations of such ideal systems will nonetheless show a delay from system input 1110 to its output 1150 ; therefore, the best case of a system transfer function is the identity transfer function with this delay.
- Various implementations of the invention attempt to achieve this “best case”.
- FIG. 12 illustrates an extension of the conventional control system of FIG. 11 .
- the representation of one or more component blocks is partitioned into a minimum-phase transfer function and a delay.
- the delay blocks exhibit a frequency-dependent group delay.
- this delay is chosen such that the cascade of transfer function and delay accurately represents the system behavior.
- the separation into minimum-phase transfer function and delay serves as a reminder that not only a certain amplitude response of the individual system components has to be achieved by the control system implementation but also the resulting group delays have to be taken into account.
- the plant block may be represented as a cascade of a minimum-phase plant function 1245 and a delay 1246 .
- the scaling block is represented as minimum-phase scaling 1215 followed by delay 1216 and the observation block is represented as a minimum-phase observation function 1255 followed by delay 1256 .
- the signal flow and associated description provided with respect to FIG. 11 applies to FIG. 12 without further changes.
- the transfer function of the control system in FIG. 12 is given by:
- the block transfer functions Gs, Gp and Gr in this equation are the minimum-phase versions of the block transfer functions Gs, Gp and Gr used in the system transfer function given for the control system of FIG. 11 .
- ⁇ s, ⁇ p and ⁇ r represent the delays 1216 , 1246 , and 1256 , respectively.
- FIG. 13 illustrates a block diagram of a combined controller/control system according to various implementations of the invention.
- the combined controller uses a combination of open loop and closed loop control.
- the control system of FIG. 13 includes a feed forward path (represented by block 1365 and delay 1366 ) that is added to the control system of FIG. 12 to generate a “drive” signal component d(t) directly derived from the desired system output x(t).
- the feed forward signal f(t) 1370 is generated from the desired system output and provided as input to plant 1345 .
- knowledge of the plant transfer function Gp creates a system output y(t) that closely follows the desired system output x(t).
- a control signal s(t) 1320 is generated from the desired system output 1310 .
- the control system is configured to use the control signal s(t) to generate the “error” signal e(t) 1330 (indicative of the difference between the control signal s(t) and the measured system output r(t)).
- the control signal s(t) accounts for group delays associated with one or more control system components (for example, group delays associated with the cascade of Gf, ⁇ f, Gp, ⁇ p, Gr and ⁇ r).
- the control system is configured to add corrections for the group delays of the various control system components to achieve the desired degree of independence of tracking performance from the closed-loop part of the controller implementation.
- control system generates a corrected control signal c(t) 1340 based on the error signal e(t).
- the corrected control signal c(t) and the feed forward signal f(t) are provided as inputs to the plant 1345 , thereby controlling the plant.
- the transfer function of the control system in FIG. 13 is given by:
- the transfer function for Gf is chosen as a direct inversion of the plant transfer function Gp:
- the product ⁇ f* ⁇ p describes a block with an amplitude transfer function of unity and a delay equal to the sum of the delays of Gf and Gp.
- the transfer function Gs of the scaling block can be made equal to the transfer function of the observation block:
- ⁇ s be made equal to ⁇ f* ⁇ p* ⁇ r means that the implementation of the cascade of Gs and ⁇ s shows the same group delay as the cascade of Gf, ⁇ f, Gp, ⁇ p, Gr and ⁇ r.
- the design choices expressed in equations 9, 11 and 13 do not have to be implemented perfectly; the increase in tracking performance of the controlled system can be realized with approximations of one or more of these design choices.
- the group delay ⁇ s of block Gs as calculated in equation 13 may be approximated with a fixed, frequency-independent delay without regard to the frequency-dependent nature of system group delays.
- the inversion of transfer function Gp in equation 9 may be approximated, especially in cases where the implementation of a perfect inversion is not feasible. The quality and nature of these approximations determine the degree to which the benefits of the invention can be realized.
- the implementation and properties of the controller Gc are not relevant to achieving the optimum transfer function for the tracking behavior of the loop, given by y(t)/x(t).
- the actual type of controller is also not relevant to the applicability of this invention; the controller can be of the PID type, or a state space implementation or any other, appropriate implementation using the error signal as described to generate an input signal to the plant.
- the design of the controller Gc does not have to optimize or at least preserve a certain performance with respect to the tracking behavior and can be optimized to suppress loop disturbances, minimize long-term settling errors or any other criterion while ignoring the tracking performance of the conventional closed-loop controller.
- the stability of the closed-loop system is determined by the design of the system controller Gc in the presence of Gp and Gr.
- the combined control system does not affect the closed-loop stability of the system and is independent of it.
Abstract
Description
- This application claims priority to U.S. Provisional Patent Application No. 61/678,147, which was filed on Aug. 1, 2012, and is incorporated herein by reference as if reproduced below in its entirety.
- The invention is generally related to control systems, and more particularly to, increasing tracking bandwidth in control systems.
- Control systems are employed in many applications where the input to a subsystem (referred to as the “plant” herein) has to be generated such that its output (one or more physical, measurable quantities) follows a desired value over time, even in the presence of disturbing influences on the subsystem. This desired value of the system output represents the input to the entire control system and is referred to as “desired system output” or in the description of an implementation example as “command position signal” herein.
- The generation of the controlling input signal to the plant can be optimized to generate the desired output with high bandwidth, low error or some other optimization criterion. At the same time, it may be desirable to optimize suppression of disturbing influences on the plant. Optimization for more than one of these criteria can generally not be achieved and the resulting implementation necessarily represents a compromise.
- Control systems are typically implemented in a closed-loop configuration where the output of the subsystem to be controlled is measured and compared to a desired system output. The difference between desired and measured system output constitutes the “error”, which is used to generate the input to the controlled subsystem.
- The use of a measure of the system output signal to generate the controlling input to the plant creates a signal-flow loop. Systems containing such loops are subject to stability limits, i.e. the components of the loop have to satisfy certain criteria to ensure stability of the loop and thus controllability of the system. These criteria impose additional constraints on the optimization of the system implementation.
- What is needed are systems and methods for improving control system bandwidth that do not constrain optimization for the other criteria mentioned and do not affect the stability of the closed-loop system.
- Various implementations of the invention include systems and methods for improving control system bandwidth (in a three dimensional system, for example). In some implementations, the control system bandwidth is improved without affecting the optimization for any of the other criteria (for example, minimizing error, suppression of disturbing influences (loop disturbances) on the plant, or other optimization criteria).
- In some implementations, a first control signal in the control system is generated from the desired system output. The first control signal is provided as input to the plant. In some implementations, the first control signal is generated from the desired system output but not the measured system output.
- In some implementations, a second control signal in the control system is generated from the desired system output. In some implementations, the control system is configured to use the second control signal to generate the “error” signal (indicative of the difference between the second control signal and the measured system output.
- These implementations, their features and other aspects of the invention are described in further detail below.
-
FIG. 1 illustrates a combined lidar and video camera system according to various implementations of the invention. -
FIG. 2 illustrates a scan pattern of a lidar beam according to various implementations of the invention. -
FIG. 3 illustrates a block diagram of a controller according to various implementations of the invention. -
FIG. 4 illustrates a block diagram for open loop control for a second-order system according to various implementations of the invention. -
FIG. 5A illustrates components of controlled-acceleration trajectory for open loop control according to various implementations of the invention. -
FIG. 5B illustrates an open loop drive signal according to various implementations of the invention. -
FIG. 6 illustrates a block diagram for an example controller using a PID algorithm according to various implementations of the invention. -
FIG. 7 illustrates a block diagram for a combined open loop and closed loop control according to various implementations of the invention. -
FIG. 8 illustrates an open loop system response according to various implementations of the invention. -
FIG. 9 illustrates an open loop system response with a delay-corrected error signal according to various implementations of the invention. -
FIG. 10 illustrates a block diagram for a combined open loop and closed loop control with delayed error signal according to various implementations of the invention. -
FIG. 11 illustrates a block diagram of a conventional closed-loop controller/control system. -
FIG. 12 illustrates a block diagram of a conventional closed-loop controller/control system wherein the representation of one or more component blocks is partitioned into a minimum-phase transfer function and a delay. -
FIG. 13 illustrates a block diagram of a combined controller/control system according to various implementations of the invention. -
FIG. 1 illustrates a combined lidar and video camera system 100 (three dimensional system 100) according to various implementations of the invention. Various implementations of the invention utilize synergies between lidar measurements and video images to resolve six degrees of freedom for motion of a target to a degree not otherwise possible with either a lidar or video camera alone. - Combined
system 100 includes alidar subsystem 130, avideo subsystem 150, and aprocessing system 160. As illustrated,lidar subsystem 130 includes two or more lidar beam outputs 112 (illustrated as abeam 112A, abeam 112B, a beam 112(n-1), and abeam 112 n); two or morereflected beam inputs 114 each corresponding to one of beams 112 (illustrated as areflected beam 114A, areflected beam 114B, a reflected beam 114(n-1), and areflected beam 114 n); two ormore lidar outputs 116 each associated with a pair ofbeam 112/reflected beam 114 (illustrated as alidar output 116A associated withbeam 112A/reflected beam 114A, alidar output 116B associated withbeam 112B/reflected beam 114B, a lidar output 116(n-1) associated with beam 112(n-1)/reflected beam 114(n-1), and alidar output 116 n associated withbeam 112n/reflected beam 114 n). - In some implementations of the invention, beam steering mechanism 140 may be employed to steer one or
more beams 112 towardtarget 190. In some implementations of the invention, beam steering mechanism 140 may include individual steering mechanisms, such as asteering mechanism 140A, asteering mechanism 140B, asteering mechanism 140C, and asteering mechanism 140D, each of which independently steers abeam 112 towardtarget 190. In some implementations of the invention, one beam steering mechanism 140 may independently steer pairs or groups ofbeams 112 towardtarget 190. - In some implementations of the invention, beam steering mechanism 140 may include one or more mirrors, each of which may or may not be separately controlled, each mirror steering one or
more beams 112 towardtarget 190. In some implementations of the invention, beam steering mechanism 140 may directly steer an optical fiber ofbeam 112 without use of a mirror. In some implementations of the invention, beam steering mechanism 140 may be controlled to steerbeams 112 in azimuth and/or elevation. Various techniques may be used by beam steering mechanism 140 to steer beam(s) 112 towardtarget 190 as would be appreciated. - In some implementations of the invention, beam steering mechanism 140 may be used to control both an azimuth angle and an elevation angle of two
beams 112 toward the target. By controlling both the azimuth angle and the elevation angle, the twobeams 112 may be used to scan a volume for potential targets or track particular targets such astarget 190. Other scanning mechanisms may be employed as would be apparent. In some implementations of the invention, the twobeams 112 may be offset from one another. In some implementations of the invention, the twobeams 112 may be offset vertically (e.g., in elevation) or horizontally (e.g., in azimuth) from one another by a predetermined offset and/or a predetermined angle, either of which may be adjustable or controlled. - As an example for an implementation of the invention, beam steering mechanism 140 may be used to control both an azimuth angle and an elevation angle and employ an implementation of the invention as a control algorithm to achieve high tracking bandwidth.
- A certain portion of each
beam 112 may be reflected back fromtarget 190 tolidar subsystem 130 asreflected beam 114. In some implementations of the invention and as illustrated inFIG. 1 ,reflected beam 114 follows the same optical path (though in reverse) asbeam 112. In some implementations of the invention, a separate optical path may be provided inlidar subsystem 130 or in combinedsystem 100 to accommodatereflected beam 114. - In some implementations of the invention,
lidar subsystem 130 receives areflected beam 114 corresponding to eachbeam 112, processes reflectedbeam 114, andoutputs lidar output 116 toprocessing system 160. - Combined
system 100 also includesvideo subsystem 150.Video subsystem 150 may include a video camera for capturing twodimensional images 155 oftarget 190. Various video cameras may be used as would be apparent. In some implementations of the invention, the video camera mayoutput images 155 as pixels at a particular resolution and at a particular image or frame rate.Video images 155 captured byvideo subsystem 150 are forwarded toprocessing system 160. In some implementations of the invention,lidar subsystem 130 andvideo subsystem 150 are offset from one another in terms of position and orientation. In particular, lidar measurements typically correspond to three dimensions (e.g., x, y, and z) whereas video images typically correspond to two dimensions (e.g., x and y). Various implementations of invention calibratelidar subsystem 130 withvideo subsystem 150 to ensure that data provided by each system refers to the same location in a given coordinate system as would be apparent. Combined system 110 may include one or more optional video subsystems (not otherwise illustrated) for capturing additional two-dimensional images 155 oftarget 190 from different positions, perspectives or angles as would be apparent. - In some implementations of the invention,
processing system 160 receiveslidar outputs 116 fromlidar subsystem 130 andimages 155 fromvideo subsystem 150 and stores them in a memory orother storage device 165 for subsequent processing.Processing system 160 processeslidar outputs 116 andimages 155 to generate a three-dimensional image oftarget 190. In some implementations of the invention,processing system 160 determines a trajectory oftarget 190 from a combination oflidar outputs 116 andimages 155 and uses the trajectory to generate a motion stabilized three-dimensional image oftarget 190, as described in co-pending U.S. application Ser. No. 12/710,057, entitled “System and Method for Generating Three Dimensional Images Using Lidar and Video Measurements”, which is incorporated herein by reference in its entirety. - As illustrated in
FIG. 2 , in some implementations of a lidar system, ascan pattern 240 may be used to scan a volume for targets. For purposes of explanation,scan pattern 240 represents a pattern of measurements taken by a single beam. As illustrated,scan pattern 240 includes individual points 210 measured left to right in azimuth at afirst elevation 231, right to left in azimuth at asecond elevation 232, left to right in azimuth at athird elevation 233, etc., until a particular scan volume is scanned. In some implementations,scan pattern 240 may be divided into intervals corresponding to various timing aspects associated with combinedsystem 100. For example, in some implementations of the invention,scan pattern 240 may be divided into time intervals associated with a frame rate ofvideo subsystem 150. In some implementations of the invention,scan pattern 240 may be divided into time intervals associated with scanning a particular elevation (i.e., an entire left-to-right or right-to-left scan). In some implementations of the invention,scan pattern 240 may be divided into time intervals associated with a roundtrip scan 220 (illustrated inFIG. 2 as aroundtrip scan 220A, aroundtrip scan 220B, and aroundtrip scan 220C) at one or more elevations (i.e., a left-to-right and a return right-to-left scan at either the same or different elevations). Similar timing aspects may be used in implementations that scan vertically in elevation (as opposed to horizontally in azimuth). Other timing aspects may be used as well. A single line of the scan pattern is used to illustrate the operation of a control system configured according to an implementation of the invention. - In some implementations, beam steering mechanism 140 may include a controller/control system that is configured to control a position (e.g., angle) of a steering mirror (also referred to herein as a controlled device or subsystem, i.e., a controlled device or subsystem that is to be controlled by the controller). In some implementations, the controller uses a combination of model-based open loop and closed loop control. While the controller is described herein as a controller that controls the steering mirror of a
lidar subsystem 130, other devices or subsystems may be controlled by similar controllers implemented in accordance with the invention as would be appreciated. In some implementations, beam steering mechanism 140 may include a single controller configured to control all mirrors used. In some implementations, beam steering mechanism 140 may include a dedicated controller for each mirror. - In some implementations, using an example of a one-dimensional displacement stage as the controlled device, a form of trajectory generation suitable for this type of control is derived.
FIG. 3 illustrates a block diagram of acontroller 300 used to control such a controlled device according to various implementations of the invention. In some implementations, thetrajectory generation component 305 generates a desiredtrajectory command signal 306 that indicates desired positioning of the controlleddevice 340 over time (also referred to as command position signal 306 or desired system output 306). In some implementations, thecommand position signal 306 is input to the openloop control component 310 and the closedloop control component 320. In some implementations, openloop control component 310 may generate an openloop drive signal 315 and provide the openloop drive signal 315 to thedrive stage 330. In some implementations, the closedloop control component 320 receives as input thecommand position signal 306 and an actual position output signal 308 (also, referred to as, the measured system output 308) from the controlleddevice 340. In some implementations, closedloop control component 320 may generate a closedloop drive signal 325 and provide the closedloop drive signal 325 to drivestage 330. Thedrive stage 330 may generate and provide a combined drive signal (combined open loop and closed loop drive signal) to controlleddevice 340 to control the position of the controlleddevice 340. - In some implementations, extension of the architecture described in
FIG. 3 to a multi-dimensional controller and/or to implementation of a piece-wise linearization for devices with non-linear transfer functions will be apparent to those having skill in the art and are not described in further detail herein. - A continuous-time system and implementation have been described herein. However, in some implementations, extension to a discrete-time system and implementation may be achieved by one skilled in the art through replacing differential equations with difference equations and functional blocks of the implementation with their discrete-time equivalent functions as would be appreciated.
- In some implementations, using the example of a one-dimensional displacement stage as shown in
FIG. 3 , the controlleddevice 340 may be described as a system with a single input signal, the “drive” signal drv(t), and a single output signal, the “position” signal pos(t). The dependence of the position signal from the applied drive signal is expressed as a transfer function T. - One of the classes of transfer functions allowing implementation with the controller structure described herein are ordinary linear differential equations with constant coefficients. For the purpose of illustration of an example of the invention, a plant/controlled device with a transfer function of this type is chosen, but the applicability of the invention is not limited to plants with transfer functions of this type. An example second-order
system following equation 3 may be used: -
c 3*pos″(t)+c 2*pos′(t)+c 1*pos(t)=drv(t) Eq. (3) - where the prime denotes differentiation; pos′(t) is the derivative of pos(t) and pos″(t) is the second derivative. The steady-state system gain will be 1/c1 and the other terms describe the dynamic behavior of the system.
- In some implementations, the goal of the controller is to make position pos(t) equal the command signal cmd(t):
-
pos(t)=cmd(t) Eq. (4) - The appropriate drive signal to achieve this condition then becomes:
-
drv(t)=c 3*cmd″(t)+c 2*cmd′(t)+c 1*cmd(t) Eq. (5) -
FIG. 4 illustrates a block diagram 400 for open loop control for a second-order system according to various implementations of the invention. Block diagram 400 illustrates an implementation of the openloop control component 310 ofFIG. 3 . The open loop control component structure ofFIG. 4 represents the differential equation (3). One of ordinary skill in the art would appreciate how to extend this structure to implement any other ordinary linear differential equations, be it of first, second or higher order. - In some implementations, a drive stage of a real, implementable system shows a limited range of output values beyond which saturation sets in and rate of change of the output (slew rate) is limited. The position output signal of a system driven according to equation (5) equals the desired trajectory cmd(t) if the drive stage behaves as linear element, i.e. saturation and slew rate limitation are avoided. This places constraints on the possible trajectories the open-loop system can accurately follow.
- One approach consists of individually limiting the contributing summands of equation (5). For a second-order system as in the example, this means placing constraints on the maximum values of acceleration and velocity; maximum position cannot be exceeded no matter which control is applied. In case of a third-order system, the trajectory generation has to also control the third derivative of cmd(t), the “jerk”, and so on for higher order systems.
- In some implementations, the drive signal components (in the example of a single scan line) depend on the command signal following a controlled-acceleration trajectory. In some implementations, the second-order case of a simple linear movement with limited and constant acceleration results in a sigmoid trajectory.
FIG. 5A illustrates components of this controlled-acceleration trajectory, for example,acceleration 515,velocity 510 andcommand 505.FIG. 5B illustrates the resulting openloop drive signal 520 generated with arbitrary coefficients. -
FIG. 6 illustrates a block diagram 600 for closedloop control component 320 according to various implementations of the invention. In some implementations, the openloop control component 310 may show a difference between the command position signal (cmd(t)) and the actual position signal (pos(t)) due to inaccuracies in the controller itself and due to disturbances of the controlled device by external influences. In some implementations, closedloop control component 320 may generate a difference signal (i.e., error signal err(t)) based on the command position signal and the actual position signal and may drive the system such that the error signal is minimized. - In some implementations, the closed
loop control component 320 may include a PID (proportional-integral-derivative) controller which is used to describe an example implementation of the invention. The invention may be applied to any other type of controller using the error signal as described to generate a controlling input signal to the plant/controlled device and is not limited to controllers of the PID type. In some implementations, the proportional, integral, and derivative of the error signal are combined to form the closed loop drive signal. In some implementations, stability analysis and derivation of the parameters (kp, ki and kd in the case of a PID controller) are understood by one of ordinary skill in the art. In some implementations, the achievable bandwidth of the closed-loop system is limited by the stability requirement. - In some implementations, fast loop tuning is often accomplished by cancellation of poles in the transfer function of the open-loop system; this introduces a sensitivity of loop stability to parameter changes and drift.
-
FIG. 7 illustrates a block diagram 700 for a combined open loop and closed loop control according to various implementations of the invention. By combining both open loop and closed loop control the interdependence of control bandwidth and loop stability is removed. As long as a desired trajectory command signal does not saturate the drive stage, the control bandwidth depends only on the open-loop coefficients while the remaining positioning error is determined by the closed-loop tuning. - In some implementations, the controlled device may exhibit a delay when following the commanded trajectory (i.e., desired trajectory command signal/command position signal).
FIG. 8 illustrates an open loop system response of a second order system using open loop control according to various implementations of the invention. In some implementations, with a drive signal of equation (5), the controlled device may follow the commandedtrajectory 810 accurately, but with a delay indicated by actual position signal 820 (which is indicative of system response). The resulting error signal 830 (command minus actual) may not be used in the open loop control component, but may be provided as input to the closed loop control component ofFIG. 7 . This resulting error signal may cause the closed loop control component of the controller to contribute to the drive signal, thus affecting dynamic behavior of the system. - In some implementations, by accounting for the system delay in the architecture of the controller, the error signal input to the closed loop control component may be generated as the difference of ideal system response and actual system response. In some implementations, the ideal system response may be the command position signal delayed by an expected system delay.
FIG. 9 illustrates an open loop system response with a correctederror signal 930 according to various implementations of the invention. -
FIG. 10 illustrates a block diagram 1000 for a combined open loop and closed loop control with corrected error signal generated from actual system response and delayed command signal according to various implementations of the invention. In some implementations, a corrected error signal is input to the closed loop control component. The resulting error is treated as a system disturbance and the closed loop control component of the controller may be optimized for load disturbances without impacting the system response to command inputs (tracking performance). Since the corrected error does not cause the closed loop control component to significantly contribute to the tracking performance, system tracking bandwidth may be determined by the open-loop coefficients without stability constraints. -
FIGS. 11 and 12 illustrate generalized block diagrams of a conventional closed-loop controller/control system. In some implementations, the behavior of the individual blocks may best be represented with a continuous-time transfer function. In some other implementations, a discrete-time, sampled representation may be used. In yet other implementations, a combination of these methods may be used. - The concept of a transfer function is applied to the individual system components to create a characterization of the combination of these components as a linear system. A transfer function is the quotient of output signal of a component divided by the input signal of that component, using an appropriate transform description, such as Laplace transform, z-transform, or any other applicable transform descriptions. In the case of non-linear transfer function of one or more components, a linear approximation of that transfer function at a certain operating point may be used.
- In some implementations, a multitude of system output signals is generated from a multitude of internal signals and, ultimately, from a multitude of desired system output signals. For these implementations, the individual signals described herein each consist of a multitude of signals. In the mathematical description, transfer functions are then replaced with transfer matrices, as appropriate. The invention applies equally to these types of systems using the mentioned extended notation without other changes.
- In some implementations,
FIG. 11 illustrates a conventional closed-loop control system 1100. In some implementations, the controlled device or system includesplant 1145 with itsinput signal 1140, d(t) (the “drive signal”), generating thesystem output signal 1150, y(t) (measured system output). The system output is observed byblock 1155, generatingsignal 1160, r(t) (the “feedback” signal). Thisfeedback signal 1160 is subtracted fromsignal 1120 usingadder block 1125 with the inversion ofsignal 1160 indicated by the “−” sign at the corresponding input to theadder 1125. Thedifference signal 1130, e(t) (the “error” signal), is an indication for how much the measuredsystem output 1150 deviates from the desiredsystem output 1110. Thiserror signal 1130 is used by thecontroller 1135 to create a correctedinput signal 1140 which is provided as input to theplant 1145. - The desired
system output 1110, x(t), is fed through ascaling block 1115 to generatesignal 1120, s(t). In some implementations, this scaling block is used to apply an operation similar to the transfer function of theobservation block 1155. For these implementations, the desiredsystem output 1110 and the measuredsystem output 1150 are directly comparable and of the same scaling. For other implementations, the transfer function of scalingblock 1115 differs from theobservation block 1155 in that the desiredsystem output 1110 is of different scaling as compared to the measuredsystem output 1150. For the remainder of the description of the invention, it is assumed that the desiredsystem output 1110 has the same scaling as the measuredsystem output 1150. For implementations where the desiredsystem output 1110 has a different scaling as compared to the measuredsystem output 1150, an additional scaling may be applied to the system input to createsignal 1110 with scaling identical to the measuredsystem output 1150 without departing from the scope of the invention. - The transfer function of the control system in
FIG. 11 is given by: -
- In an ideal case, the measured system output 1150 y(t) follows the desired system output 1110 x(t) identically, which means that the transfer function of such an ideal system would be equal to 1. Practical implementations of such ideal systems will nonetheless show a delay from
system input 1110 to itsoutput 1150; therefore, the best case of a system transfer function is the identity transfer function with this delay. Various implementations of the invention attempt to achieve this “best case”. -
FIG. 12 illustrates an extension of the conventional control system ofFIG. 11 . In this system, the representation of one or more component blocks is partitioned into a minimum-phase transfer function and a delay. As discussed above, practical implementations of such systems exhibit a delay. The delay blocks exhibit a frequency-dependent group delay. In the case of the “plant” and “observation” blocks this delay is chosen such that the cascade of transfer function and delay accurately represents the system behavior. For the other blocks the separation into minimum-phase transfer function and delay serves as a reminder that not only a certain amplitude response of the individual system components has to be achieved by the control system implementation but also the resulting group delays have to be taken into account. - In some implementations, the plant block may be represented as a cascade of a minimum-
phase plant function 1245 and adelay 1246. Similarly, the scaling block is represented as minimum-phase scaling 1215 followed bydelay 1216 and the observation block is represented as a minimum-phase observation function 1255 followed bydelay 1256. The signal flow and associated description provided with respect toFIG. 11 applies toFIG. 12 without further changes. - The transfer function of the control system in
FIG. 12 is given by: -
- The block transfer functions Gs, Gp and Gr in this equation are the minimum-phase versions of the block transfer functions Gs, Gp and Gr used in the system transfer function given for the control system of
FIG. 11 . δs, δp and δr represent thedelays -
FIG. 13 illustrates a block diagram of a combined controller/control system according to various implementations of the invention. The combined controller uses a combination of open loop and closed loop control. In some implementations, the control system ofFIG. 13 includes a feed forward path (represented byblock 1365 and delay 1366) that is added to the control system ofFIG. 12 to generate a “drive” signal component d(t) directly derived from the desired system output x(t). The feed forward signal f(t) 1370 is generated from the desired system output and provided as input toplant 1345. In some implementations, knowledge of the plant transfer function Gp creates a system output y(t) that closely follows the desired system output x(t). - In some implementations, a control signal s(t) 1320 is generated from the desired
system output 1310. In some implementations, the control system is configured to use the control signal s(t) to generate the “error” signal e(t) 1330 (indicative of the difference between the control signal s(t) and the measured system output r(t)). The control signal s(t) accounts for group delays associated with one or more control system components (for example, group delays associated with the cascade of Gf, δf, Gp, δp, Gr and δr). In some implementations, the control system is configured to add corrections for the group delays of the various control system components to achieve the desired degree of independence of tracking performance from the closed-loop part of the controller implementation. - In some implementations, the control system generates a corrected control signal c(t) 1340 based on the error signal e(t). The corrected control signal c(t) and the feed forward signal f(t) are provided as inputs to the
plant 1345, thereby controlling the plant. - The transfer function of the control system in
FIG. 13 is given by: -
- The transfer function for Gf is chosen as a direct inversion of the plant transfer function Gp:
-
Gf=1/Gp. Eq. (9) - The implementation of this inversion shows a group delay which cannot become negative due to the required causality of any implementation. δf is chosen such that the cascade of Gf and δf shows a particular, frequency-dependent delay, thus absorbing the fact that the inversion of Gp will invert the amplitude response vs. frequency for a given plant but may not create negative group delays. The system transfer function then becomes:
-
- The product δf*δp describes a block with an amplitude transfer function of unity and a delay equal to the sum of the delays of Gf and Gp.
- The transfer function Gs of the scaling block can be made equal to the transfer function of the observation block:
-
Gs=Gr. Eq. (11) - In conjunction with multiplying both numerator and denominator with δf*δp, the system transfer function changes to:
-
- Further, the following is chosen:
-
δs=δf*δp*δr Eq. (13) - with the resulting system transfer function becoming an identity transfer function with a delay from the system input to its output (as mentioned above):
-
- The condition that δs be made equal to δf*δp*δr means that the implementation of the cascade of Gs and δs shows the same group delay as the cascade of Gf, δf, Gp, δp, Gr and δr.
- In some implementations, the design choices expressed in equations 9, 11 and 13 do not have to be implemented perfectly; the increase in tracking performance of the controlled system can be realized with approximations of one or more of these design choices. As an example, the group delay δs of block Gs as calculated in equation 13 may be approximated with a fixed, frequency-independent delay without regard to the frequency-dependent nature of system group delays. Similarly, the inversion of transfer function Gp in equation 9 may be approximated, especially in cases where the implementation of a perfect inversion is not feasible. The quality and nature of these approximations determine the degree to which the benefits of the invention can be realized.
- As the derivation of the resulting system transfer function shows, the implementation and properties of the controller Gc are not relevant to achieving the optimum transfer function for the tracking behavior of the loop, given by y(t)/x(t). The actual type of controller is also not relevant to the applicability of this invention; the controller can be of the PID type, or a state space implementation or any other, appropriate implementation using the error signal as described to generate an input signal to the plant. Similarly, the design of the controller Gc does not have to optimize or at least preserve a certain performance with respect to the tracking behavior and can be optimized to suppress loop disturbances, minimize long-term settling errors or any other criterion while ignoring the tracking performance of the conventional closed-loop controller.
- The stability of the closed-loop system is determined by the design of the system controller Gc in the presence of Gp and Gr. The combined control system does not affect the closed-loop stability of the system and is independent of it.
- While the invention has been described herein in terms of various implementations, it is not so limited and is limited only by the scope of the following claims, as would be apparent to one skilled in the art. These and other implementations of the invention will become apparent upon consideration of the disclosure provided above and the accompanying figures. In addition, various components and features described with respect to one implementation of the invention may be used in other implementations as well.
Claims (2)
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US13/956,961 US20140036332A1 (en) | 2012-08-01 | 2013-08-01 | System and Method for Positioning a Mirror in a Lidar System Using Open Loop and Closed Loop Control |
US15/581,081 US10197765B2 (en) | 2012-08-01 | 2017-04-28 | System and method for positioning a mirror in a lidar system using open loop and closed loop control |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US201261678147P | 2012-08-01 | 2012-08-01 | |
US13/956,961 US20140036332A1 (en) | 2012-08-01 | 2013-08-01 | System and Method for Positioning a Mirror in a Lidar System Using Open Loop and Closed Loop Control |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US15/581,081 Continuation US10197765B2 (en) | 2012-08-01 | 2017-04-28 | System and method for positioning a mirror in a lidar system using open loop and closed loop control |
Publications (1)
Publication Number | Publication Date |
---|---|
US20140036332A1 true US20140036332A1 (en) | 2014-02-06 |
Family
ID=50025229
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US13/956,961 Abandoned US20140036332A1 (en) | 2012-08-01 | 2013-08-01 | System and Method for Positioning a Mirror in a Lidar System Using Open Loop and Closed Loop Control |
US15/581,081 Active US10197765B2 (en) | 2012-08-01 | 2017-04-28 | System and method for positioning a mirror in a lidar system using open loop and closed loop control |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US15/581,081 Active US10197765B2 (en) | 2012-08-01 | 2017-04-28 | System and method for positioning a mirror in a lidar system using open loop and closed loop control |
Country Status (1)
Country | Link |
---|---|
US (2) | US20140036332A1 (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019179184A (en) * | 2018-03-30 | 2019-10-17 | キヤノン株式会社 | Drive device, optical device, system, image capturing device, and lens device |
US20220053435A1 (en) * | 2020-08-17 | 2022-02-17 | Qualcomm Incorporated | Calibration of group delay in a mobile device |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11556000B1 (en) | 2019-08-22 | 2023-01-17 | Red Creamery Llc | Distally-actuated scanning mirror |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4760586A (en) * | 1984-12-29 | 1988-07-26 | Kyocera Corporation | Spread spectrum communication system |
US20030150961A1 (en) * | 2001-10-05 | 2003-08-14 | Boelitz Frederick Wall | Load relief system for a launch vehicle |
DE102008039400A1 (en) * | 2008-08-22 | 2010-02-25 | Iav Gmbh Ingenieurgesellschaft Auto Und Verkehr | Environment sensor e.g. optical sensor, reproducible testing device for vehicle assistance system, has control and/or regulating unit for independently controlling and/or regulating vehicle and obstacle |
US20100165322A1 (en) * | 2006-06-27 | 2010-07-01 | Kane David M | Camera-style lidar setup |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5216729A (en) * | 1991-11-18 | 1993-06-01 | Harmonic Lightwaves, Inc. | Active alignment system for laser to fiber coupling |
JP3930187B2 (en) * | 1999-03-03 | 2007-06-13 | 株式会社日立コミュニケーションテクノロジー | Synchronization control method, receiver, base station, and mobile terminal |
US7739823B2 (en) * | 2003-11-24 | 2010-06-22 | Soreq Nuclear Research Center | Fire control system using a LIDAR (laser identification, detection and ranging) unit |
US7638959B2 (en) * | 2007-12-14 | 2009-12-29 | Hamilton Sundstrand Corporation | Method of operating a brushless motor wherein open loop and closed loop controllers utilize different commutation methods |
US7940490B2 (en) * | 2008-04-26 | 2011-05-10 | Magnecomp Corporation | Apparatus and method for improving bandwidth of a fine positioning mechanism data storage manufacturing and test equipment |
EP2399150B1 (en) * | 2009-02-20 | 2020-10-07 | StereoVision Imaging, Inc. | System and method for generating three dimensional images using lidar and video measurements |
US20100243916A1 (en) * | 2009-03-30 | 2010-09-30 | Lockheed Martin Corporation | Modular optical diagnostic platform for chemical and biological target diagnosis and detection |
FR2952722B1 (en) * | 2009-11-18 | 2011-12-09 | Onera (Off Nat Aerospatiale) | MEASUREMENT OF VELOCIMETRIC OR VIBROMETRIC CHARACTERISTICS USING A HETERODYNE DETECTION LIDAR TYPE DEVICE |
US8948497B2 (en) * | 2012-09-04 | 2015-02-03 | Digital Signal Corporation | System and method for increasing resolution of images obtained from a three-dimensional measurement system |
EP2818739B1 (en) * | 2013-06-28 | 2018-06-13 | Skf Magnetic Mechatronics | Improved active magnetic bearings control system |
-
2013
- 2013-08-01 US US13/956,961 patent/US20140036332A1/en not_active Abandoned
-
2017
- 2017-04-28 US US15/581,081 patent/US10197765B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4760586A (en) * | 1984-12-29 | 1988-07-26 | Kyocera Corporation | Spread spectrum communication system |
US20030150961A1 (en) * | 2001-10-05 | 2003-08-14 | Boelitz Frederick Wall | Load relief system for a launch vehicle |
US20100165322A1 (en) * | 2006-06-27 | 2010-07-01 | Kane David M | Camera-style lidar setup |
US8958057B2 (en) * | 2006-06-27 | 2015-02-17 | Arete Associates | Camera-style lidar setup |
DE102008039400A1 (en) * | 2008-08-22 | 2010-02-25 | Iav Gmbh Ingenieurgesellschaft Auto Und Verkehr | Environment sensor e.g. optical sensor, reproducible testing device for vehicle assistance system, has control and/or regulating unit for independently controlling and/or regulating vehicle and obstacle |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019179184A (en) * | 2018-03-30 | 2019-10-17 | キヤノン株式会社 | Drive device, optical device, system, image capturing device, and lens device |
JP7114301B2 (en) | 2018-03-30 | 2022-08-08 | キヤノン株式会社 | Driving devices, optical devices, systems, imaging devices, and lens devices |
US20220053435A1 (en) * | 2020-08-17 | 2022-02-17 | Qualcomm Incorporated | Calibration of group delay in a mobile device |
US11889436B2 (en) * | 2020-08-17 | 2024-01-30 | Qualcomm Incorporated | Calibration of group delay in a mobile device |
Also Published As
Publication number | Publication date |
---|---|
US10197765B2 (en) | 2019-02-05 |
US20180074286A1 (en) | 2018-03-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10197765B2 (en) | System and method for positioning a mirror in a lidar system using open loop and closed loop control | |
US7868577B2 (en) | Electric motor control apparatus | |
TWI504131B (en) | Motor control device | |
US20060113946A1 (en) | Controller | |
KR102470721B1 (en) | Motor system | |
Fradkov et al. | Combined adaptive controller for UAV guidance | |
WO2014167808A1 (en) | Motor drive device | |
US20140292248A1 (en) | Motor controller and motor system | |
JP5747129B2 (en) | Stage device and sample observation device | |
Yang et al. | INDI-based aggressive quadrotor flight control with position and attitude constraints | |
Saragih et al. | Visual servo application using model predictive control (mpc) method on pan-tilt camera platform | |
JP2008097334A (en) | Servo controller and control method therefor | |
Oliveira et al. | Global stability and simultaneous compensation of state and output delays for nonlinear systems via output-feedback sliding mode control | |
JP3943061B2 (en) | Servo control device | |
CN109459926B (en) | Displacement tracking control method and system for high-order flexible electromechanical moving object | |
KR101434310B1 (en) | Stabilization enhancement method of drive unit mounted on moving equipment and system, that moving equipment | |
CN110635710A (en) | Active disturbance rejection repetitive control method for high-precision periodic tracking of piezoelectric driver | |
JP2008015610A (en) | Controller | |
US20080004724A1 (en) | Method and device for controlling backlash | |
JP2010086395A (en) | Two-degree-of-freedom digital controller | |
JPWO2008018496A1 (en) | Control method and control apparatus | |
US11199822B2 (en) | Control device | |
Pyrkin et al. | Simple output controller for nonlinear systems with multisinusoidal disturbance | |
Sharkey et al. | Coping with delays for real-time gaze control: the fall and rise of the SmithPredictor' | |
KR101489593B1 (en) | Method for controlling micro robot using coil system and method thereof |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AS | Assignment |
Owner name: HORIZON TECHNOLOGY FINANCE CORPORATION, CONNECTICUT Free format text: SECURITY INTEREST;ASSIGNOR:DIGITAL SIGNAL CORPORATION;REEL/FRAME:037450/0001 Effective date: 20151221 Owner name: HORIZON TECHNOLOGY FINANCE CORPORATION, CONNECTICU Free format text: SECURITY INTEREST;ASSIGNOR:DIGITAL SIGNAL CORPORATION;REEL/FRAME:037450/0001 Effective date: 20151221 |
|
STCB | Information on status: application discontinuation |
Free format text: ABANDONED -- FAILURE TO PAY ISSUE FEE |
|
AS | Assignment |
Owner name: DIGITAL SIGNAL CORPORATION, VIRGINIA Free format text: RELEASE BY SECURED PARTY;ASSIGNOR:HORIZON TECHNOLOGY FINANCE CORPORATION;REEL/FRAME:045588/0705 Effective date: 20180214 Owner name: DSC ABC, LLC, CALIFORNIA Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:DIGITAL SIGNAL CORPORATION;REEL/FRAME:045967/0293 Effective date: 20161208 |
|
AS | Assignment |
Owner name: STEREOVISION IMAGING, INC., CALIFORNIA Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:DSC ABC, LLC;REEL/FRAME:045972/0417 Effective date: 20180214 |
|
AS | Assignment |
Owner name: HORIZON TECHNOLOGY FINANCE CORPORATION, CONNECTICUT Free format text: SECURITY INTEREST;ASSIGNOR:STEREOVISION IMAGING, INC.;REEL/FRAME:045966/0780 Effective date: 20180214 Owner name: HORIZON TECHNOLOGY FINANCE CORPORATION, CONNECTICU Free format text: SECURITY INTEREST;ASSIGNOR:STEREOVISION IMAGING, INC.;REEL/FRAME:045966/0780 Effective date: 20180214 |
|
AS | Assignment |
Owner name: DIGITAL SIGNAL CORPORATION, VIRGINIA Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:SCHULZ, STEPHAN;REEL/FRAME:046932/0711 Effective date: 20130801 |
|
AS | Assignment |
Owner name: MVI (ABC), LLC, MICHIGAN Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:STEREOVISION IMAGING, INC.;REEL/FRAME:058520/0078 Effective date: 20210921 |
|
AS | Assignment |
Owner name: AEVA, INC., CALIFORNIA Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:MVI (ABC), LLC;REEL/FRAME:058533/0549 Effective date: 20211123 Owner name: STEREOVISION IMAGING, INC., CALIFORNIA Free format text: RELEASE BY SECURED PARTY;ASSIGNOR:HORIZON TECHNOLOGY FINANCE CORPORATION;REEL/FRAME:058533/0569 Effective date: 20211123 |