Synopsis and Discussion of "Derivation of Lineof-Sight Stabilization Equations for Gimbaled-Mirror Optical Systems

Similar documents
Monday, 12 November 12. Matrices

OPTI 421/521 Introductory Optomechanical Engineering. 6. Mirror matrices. Matrix formalism is used to model reflection from plane mirrors.

CS354 Computer Graphics Rotations and Quaternions

VIBRATION ISOLATION USING A MULTI-AXIS ROBOTIC PLATFORM G.

Mobile Robotics. Mathematics, Models, and Methods. HI Cambridge. Alonzo Kelly. Carnegie Mellon University UNIVERSITY PRESS

A Comparison of Allocation Policies in Wavelength Routing Networks*

LCLS Undulator Quadrupole Fiducialization Plan

Analysis of Euler Angles in a Simple Two-Axis Gimbals Set

MTRX4700 Experimental Robotics

Game Mathematics. (12 Week Lesson Plan)

Line of Sight Stabilization Primer Table of Contents

Math 443/543 Graph Theory Notes 2: Transportation problems

RE<C: Heliostat Orientation Estimation Using a 3-Axis Accelerometer

Quaternions & Rotation in 3D Space

3D Transformations. CS 4620 Lecture Kavita Bala w/ prior instructor Steve Marschner. Cornell CS4620 Fall 2015 Lecture 11

Design of a Three-Axis Rotary Platform

METR 4202: Advanced Control & Robotics

Using Computer Graphics for Descriptive Geometry-style Problems in a Freshman Graphics Course

Today. Today. Introduction. Matrices. Matrices. Computergrafik. Transformations & matrices Introduction Matrices

Orientation & Quaternions

ME 597: AUTONOMOUS MOBILE ROBOTICS SECTION 2 COORDINATE TRANSFORMS. Prof. Steven Waslander

Object Representation Affine Transforms. Polygonal Representation. Polygonal Representation. Polygonal Representation of Objects

Interesting Application. Linear Algebra

This was written by a designer of inertial guidance machines, & is correct. **********************************************************************

Motivation. Parametric Curves (later Surfaces) Outline. Tangents, Normals, Binormals. Arclength. Advanced Computer Graphics (Fall 2010)

Shortest-route formulation of mixed-model assembly line balancing problem

PROCEEDINGS OF SPIE. Kiarash Tajdaran, Larry D. Dewell, Eric V. Eason, Raymond M. Bell, Kuo-Chia Liu, et al.

Synopsis of Risley Prism Beam Pointer

Using Classical Mechanism Concepts to Motivate Modern Mechanism Analysis and Synthesis Methods

Chapter 4: Kinematics of Rigid Bodies

Chapter 38 Wave Optics (II)

Derivative Of Rotation Matrix Direct Matrix Derivation

Anatomical Descriptions That Compute Functional Attributes

CALCULATING TRANSFORMATIONS OF KINEMATIC CHAINS USING HOMOGENEOUS COORDINATES

Lecture 4: 3D viewing and projections

Answers. Chapter 2. 1) Give the coordinates of the following points:

INSTITUTE OF AERONAUTICAL ENGINEERING

Strapdown inertial navigation technology

Surfaces. U (x; y; z) = k. Indeed, many of the most familiar surfaces are level surfaces of functions of 3 variables.

Strapdown system technology

Time series representations: a state-of-the-art

Short on camera geometry and camera calibration

Math 443/543 Graph Theory Notes 5: Planar graphs and coloring

Basic Polarization Techniques and Devices 1998, 2003 Meadowlark Optics, Inc

Contents Systems of Linear Equations and Determinants

Operation Trajectory Control of Industrial Robots Based on Motion Simulation

Math background. 2D Geometric Transformations. Implicit representations. Explicit representations. Read: CS 4620 Lecture 6

Dimensional Optimization for the Crank-Rocker Mechanism using TK Solver

+ i a y )( cosφ + isinφ) ( ) + i( a x. cosφ a y. = a x

Aligning Parallelism of Rolls Has Never Been Faster. L-732 Precision Dual-Scan Roll Alignment System

AP Physics: Curved Mirrors and Lenses

Modeling and Control of Non Linear Systems

Integration of automatic differentiation tools within object-oriented codes: accuracy and timings

Structure from Motion. Prof. Marco Marcon

Thermal Imaging Systems.

Geometric Transformations

Integrated Estimation, Guidance & Control II

APPLICATIONS FOR COORDINATED MOTION IN RADOME TESTING

Relating Local Vision Measurements to Global Navigation Satellite Systems Using Waypoint Based Maps

Ceilbot vision and mapping system

Vector Algebra Transformations. Lecture 4

ROTATIONAL DEPENDENCE OF THE SUPERCONVERGENT PATCH RECOVERY AND ITS REMEDY FOR 4-NODE ISOPARAMETRIC QUADRILATERAL ELEMENTS

Generalization of the Coddington Equations to Include Hybrid Diffractive Surfaces

Design of fully rotatable, roller-crank-driven, cam mechanisms for arbitrary motion speci cations

3D Transformations. CS 4620 Lecture 10. Cornell CS4620 Fall 2014 Lecture Steve Marschner (with previous instructors James/Bala)

CW High School. Advanced Math A. 1.1 I can make connections between the algebraic equation or description for a function, its name, and its graph.

INTEGRATED TECH FOR INDUSTRIAL POSITIONING

E80. Experimental Engineering. Lecture 9 Inertial Measurement

Limitations of laser diagonal measurements

Rigid Body Motion and Image Formation. Jana Kosecka, CS 482

Camera Models and Image Formation. Srikumar Ramalingam School of Computing University of Utah

Math 443/543 Graph Theory Notes 11: Graph minors and Kuratowski s Theorem

Calibration of Inertial Measurement Units Using Pendulum Motion

Matrices. Chapter Matrix A Mathematical Definition Matrix Dimensions and Notation

To do this the end effector of the robot must be correctly positioned relative to the work piece.

Camera Models and Image Formation. Srikumar Ramalingam School of Computing University of Utah

(Refer Slide Time: 00:04:20)

SCREW-BASED RELATIVE JACOBIAN FOR MANIPULATORS COOPERATING IN A TASK

Selection and Integration of Sensors Alex Spitzer 11/23/14

Topology and the Four Color Theorem

Math 443/543 Graph Theory Notes

Orientation Capture of a Walker s Leg Using Inexpensive Inertial Sensors with Optimized Complementary Filter Design

An Efficient Method for Solving the Direct Kinematics of Parallel Manipulators Following a Trajectory

Robots are built to accomplish complex and difficult tasks that require highly non-linear motions.

Lecture Outlines Chapter 26

Stray light calculation methods with optical ray trace software

Piezo Mechanisms in Optics and Laser Technology

Inertial Navigation Systems

COMPUTATIONAL DYNAMICS

RobotEye RELW60 Thermal Two-Axis High Performance LWIR Thermal Vision System. Product Datasheet

Friday, 11 January 13. Interpolation

Parallel and perspective projections such as used in representing 3d images.

To Do. Outline. Translation. Homogeneous Coordinates. Foundations of Computer Graphics. Representation of Points (4-Vectors) Start doing HW 1

Matlab Simulator of a 6 DOF Stanford Manipulator and its Validation Using Analytical Method and Roboanalyzer

Chapter 13. Vision Based Guidance. Beard & McLain, Small Unmanned Aircraft, Princeton University Press, 2012,

Review of paper Non-image-forming optical components by P. R. Yoder Jr.

Mathematics 308 Geometry. Chapter 9. Drawing three dimensional objects

ξ ν ecliptic sun m λ s equator

Strapdown Inertial Navigation Technology

Theory of Machines Course # 1

Transcription:

Synopsis and Discussion of "Derivation of Lineof-Sight Stabilization Equations for Gimbaled-Mirror Optical Systems Keith B. Powell OPTI-51 Project 1 Steward Observatory, University of Arizona Abstract This paper is a synopsis and commentary on the technical paper by DeBruin (1991) on the derivation of stabilization equations for gimbaled-mirror systems. The relevance of the paper is discussed followed by the basic derivation of the stabilization equations using two distinct algorithmic methods. One method which is completely general but somewhat cumbersome and another that is simpli ed but restricted to a subset of possible implementations. Examples of stabilized optical systems are discussed. 1 Introduction: Why This Paper is Relevant This paper provides a synopsis and commentary on the technical paper "Derivation of line-of-sight stabilization equations for gimbaled-mirror optical systems". The paper was written by James C. DeBruin at Control Systems Technology Center, Texas Instruments in 1991. I found this particular paper both interesting and practical for a variety of reasons. First, the basic equations for gimbal mounted mirror stabilization are still quite valid and give the user signi cant insight into the dynamics involved in gimbaled mirror systems. In many ways, these equations are more applicable today then they were when the paper was written. As computing power has increased signi cantly and the cost of sensing and actuating devices has decrease, the past decade has seen a proliferation of smaller, less expensive, stabilized optical systems. A common example of these are image stabilization systems for hand held cameras which would have been unthinkable back in the early nineties. Another reason why I found this paper quite interesting is that is serves as a benchmark to changes that have occurred in the science of optical system stabilization in the recent past. At the time this paper was written, computing hardware and software were much more restrictive on the size and speed of matrix manipulations required for transformation of reference frames. Many excellent real time software programs now exist which can easily manipulate the matrices for multiple coordinate transformations. Modern sensing and actuating devices have also changed the way stabilization is performed on optical systems. When this paper was written, optical stabilization systems required large and expensive gyroscopic instruments which were only practical to implement on large and expensive programs. Advances in MEMS technology, 1

particularly of accelerometers, has seen tremendous reduction in size and cost of sensing instruments, making optical stabilization systems practical for much smaller and less costly systems. Derivation of the LOS Stability Equations.1 Derivation of the LOS Reference Frames The paper begins by introducing the concept of a line-of-sight reference frame and how that is de ned. The author de nes the LOS reference frame as the combination of a line-of-sight vector and two mutually normal image plane vectors. This is simply an orthonormal triad which has one unit vector along the boresight of the optical system, the other two unit vector orientations must be orthogonal but the rotation is somewhat arbitrary and is usually left as a matter of convenience. The transformation of the incoming LOS vector ~r 1 to the outgoing LOS vector ~s 1 is given by ~s 1 = M ~r1 where M is the matrix found from the mirror normal vector components, n i M = 4 1 n 1 n 1 n 1 n n 1 n n n 1 1 n n n n n n 1 n n 1 n n In this paper, the author allows the handedness of the reference frames to change due to parity changes of the mirror. My experience in control algorithm design suggests this is not wise as it will almost certainly cause confusion during implementation and testing of the software. It seems that it would be better to de ne a conventional right handed coordinate frame at each transformation and live with the fact that the sign of a particular matrix element may be reversed. Once the LOS reference frame has been de ned, the stabilization equations can then be derived and used to relate the gimbal rotational rates to the angular velocity of the platform on which the optical system is mounted. The relations given by the stabilization equations are useful for so-called feedforward control systems in which the angular velocities of the platform are measured, then solved for the gimbal angle rates. The computed gimbal angle rates are then used as commanded inputs (feedforward) to the gimbal servo loops which attempt to drive the line-of-sight angular rate error to zero.. Angular Velocity of an LOS Reference Frame From basic dynamics, the time rate of change of a rotating coordinate system V relative to a Newtonian reference frame N is given from [] as 5

N d~v N ~v = + N ~! V ~v dt t and for angular motion relative to the platform on which the optical system is mounted N d~v dt = N ~! V ~v Using some vector algebra, this leads to the de nition of angular velocity given in the paper N ~! V ~v 1 d~v dt ~v + ~v d~v dt ~v 1 + ~v d~v 1 dt ~v where the author de nes the Newtonian reference frame as the base frame. It is often desirable to use intermediate reference frames for the computation of angular velocity in which case we can employ the addition theorem. For example, if we know the angular velocity of frame N with respect to P and the angular velocity of frame P with respect to V, then we can compute the angular velocity of N with respect to V by simply adding the two known angular velocities. N ~! P = N ~! P + P ~! V One other useful concept used in the derivation of the stabilization equations is the idea of simple angular velocity. If a unit vector ^k is xed in both reference frames A and B then we can say that A rotates about B along the axis de ned by ^k through angle given by N ~! P = _ ^k. LOS Stabilization The line-of-sight is often de ned as stabilized if the orthogonal components of the LOS angular velocity are zero. The author of this paper uses an alternate de nition. He states that the di erence between commanded slew rates and actual rates should be zero which includes cases where the optical system is tracking or slewing. This de nition is also somewhat problematic in that the di erence (e.g. the error signal) is never actually zero as the control system always lags behind the commanded rates. So from this de nition, the LOS is never completely stabilized. This is more of a mathematical concept and less of an actual concern to the practicing controls engineer who is more interested in the overall system response. At any rate (pun intended), this leads to stabilization of the LOS frame if the following two conditions are satis ed

N ~! V ~v = 0 N ~! V ~v = 0 where ~v forms the line-of-sight and image vectors of the LOS reference frame V, and N ~! P is the angular velocity of V with respect to N. and are the commanded slew rates in N about ~v 1 and ~v 1 respectively..4 Stabilization Equations Using the results from the previous sections, we can now derive the equation for line-of-sight stability. The form of the equations follow directly from the stabilization conditions. Let V represent an outgoing LOS reference frame from an optical system attached to platform P: Frame V is steered by a gimbaled mirror on the platform and has the angular velocity P ~! V. The platform is in motion with respect to the inertial frame N with angular velocity N ~! P. Using the two stability conditions and the addition theorem leads directly to N ~! P + P ~! V ~v = 0 N ~! P + P ~! V ~v = 0 Setting the commanded slew rates to zero, we get the stabilization equation given in the paper N ~! P + P ~! V ~v = 0 N ~! P + P ~! V ~v = 0 The angular velocity of the platform in inertial space N ~! P acts as a perturbation to the system. However, we have control over P ~! V which is some function of the gimbal angle rates _ i. Thus, the stabilization equations are used to control the line-of-sight by changing _ i as a function of the platform angular velocities which drive the system to satisfy the stabilization conditions..5 Two Di erent Methods The paper presents two di erent methods for formulating the stabilization equations. The methods di er only in the manner in which P ~! V is computed and in there applicability to speci c problems. The rst method, called direct differentiation, uses the direct calculation based on the time rate of change of the vector basis xed in the platform frame. The second method of intermediate reference frames involves nding adjacent reference frames between the platform and the outgoing LOS frame, each of which moves with simple angular velocity in the adjacent frame. The addition theorem is then employed to compute P ~! V. This method considerably simpli- es the matrix transformations and, therefore, reduces the required computing power. However, it is only applicable if, for each gimbaled mirror and for all mirror orientations, a vector (~u) exists that is both xed in the plane of the mirror and orthogonal to the incoming line-of-sight. 4

Examples Although the examples provided by the author are helpful in understanding the detailed process of deriving the stabilization equations for speci c cases, what is most important are the conclusions that the author draws from the two examples provided.. Using the method of direct di erentiation results in a somewhat complex by array of sines and cosines. The matrix must be transposed and the matrix elements must be di erentiated using N ~! V ~v 1 d~v dt ~v + ~v d~v dt ~v 1 + ~v d~v 1 dt ~v This is, of course, algebraically complex if one is to attempt the calculations by hand. Even for the computers of the day, this would be di cult to implement in a real-time system at a reasonable update rate. The second example using intermediate reference frames is signi cantly simpler than the method of direct di erentiation in terms of required computation. Even though the simpli cations required limit the types of gimbaled system which this method can be used, it would have been much more tractable and easier to implement on the available computers and software of the day. The author therefore concludes that the second method is preferred if at all possible. The author does note that the use of computers using symbolic algebra greatly facilitates the process of direct di erentiation. 4 Conclusions The reviewed paper presented some very interesting results and practical tools for dealing with line-of-sight stabilization of optical systems. The basic stabilization equations are still applicable today and give great insight into the physical processes of more complex stabilization problems. Recent advances in computers and real time software make manipulation of large matrices and complex trigonometric functions much easier to deal with. Most systems today would have no problem in implementing the method of direct di erentiation for solving the stabilization equations, which provides a general solution applicable to any gimbaled system. Advances in MEMS technology have made accelerometers more preferable than gyroscopes as sensing devices for many applications. With the dramatic increase in computing power, the development of excellent real-time software systems, and the decrease in cost and size of sensing and actuating devices, the use of the line-of-sight stabilization equations are more relevant now than ever. Once reserved for large and expensive optical systems, line-of-sight stabilization is now used in a wide variety of application including hand held cameras, video equipment, laser tracking and metrology, as well as the occasional 6.4 meter telescope. 5

5 References [1] Derivation of line-of-sight stabilization equations for gimbaled-mirror optical systems, DeBruin, James C., SPIE Vol.154, 1991 [] Principles of Mechanics rd ed.,mcgraw-hill, 1959, Synge, John L. and Gri th, Byron A. [] Dynamics: Theory and Application McGraw Hill, 1985, Kane, Thomas R [4] Matrix Analysis of Gimbaled Mirror and Prism Systems, Polasek, John, C, JOSA vol. 57, num 10 [5] OPTI-51 class notes, Burge, J. 6