Quaternion-Based Tracking Control Law Design For Tracking Mode

Similar documents
SATELLITE ATTITUDE CONTROL SYSTEM DESIGN WITH NONLINEAR DYNAMICS AND KINEMTICS OF QUATERNION USING REACTION WHEELS

Sliding Mode Control Strategies for Spacecraft Rendezvous Maneuvers

Tracking Rigid Body Motion Using Thrusters and Momentum. Wheels

MAE 142 Homework #5 Due Friday, March 13, 2009

3D Pendulum Experimental Setup for Earth-based Testing of the Attitude Dynamics of an Orbiting Spacecraft

WEIGHTING MATRICES DETERMINATION USING POLE PLACEMENT FOR TRACKING MANEUVERS

Mixed Control Moment Gyro and Momentum Wheel Attitude Control Strategies

IAA-CU A Simulator for Robust Attitude Control of Cubesat Deploying Satellites

An Attitude Control System and Commissioning Results of the SNAP-1 Nanosatellite

Robot Control Basics CS 685

FIBER OPTIC GYRO-BASED ATTITUDE DETERMINATION FOR HIGH- PERFORMANCE TARGET TRACKING

REACTION WHEEL CONFIGURATIONS FOR HIGH AND MIDDLE INCLINATION ORBITS

Spacecraft Attitude Control with RWs via LPV Control Theory: Comparison of Two Different Methods in One Framework

Lecture Module 5: Introduction to Attitude Stabilization and Control

Design of Sliding Mode Attitude Control for Communication Spacecraft

Mechatronics Assignment # 1

Attitude Control Simulator for the Small Satellite and Its Validation by On-orbit Data of QSAT-EOS

Visual Feedback Attitude Control of a Bias Momentum Micro Satellite using Two Wheels

TTK4150 Nonlinear Control Systems Solution 6 Part 2

IAC-04-A.P.12 NONLINEAR ATTITUDE CONTROL OF THE MICRO-SATELLITE ESEO

Satellite Attitude Control System Design Using Reaction Wheels Bhanu Gouda Brian Fast Dan Simon

Attitude Regulation About a Fixed Rotation Axis

Model Reference Adaptive Control of Underwater Robotic Vehicle in Plane Motion

ATTITUDE CONTROL MECHANIZATION TO DE-ORBIT SATELLITES USING SOLAR SAILS

Chapter 1. Introduction. 1.1 System Architecture

IAC-11-C1.5.9 INERTIA-FREE ATTITUDE CONTROL OF SPACECRAFT WITH UNKNOWN TIME-VARYING MASS DISTRIBUTION

A Miniaturized Satellite Attitude Determination and Control System with Autonomous Calibration Capabilities

CONTROL OF ROBOT CAMERA SYSTEM WITH ACTUATOR S DYNAMICS TO TRACK MOVING OBJECT

Video 8.1 Vijay Kumar. Property of University of Pennsylvania, Vijay Kumar

Design and modelling of an airship station holding controller for low cost satellite operations

Pointing Control for Low Altitude Triple Cubesat Space Darts

Control of Mobile Robots

Attitude Determination and. Attitude Control

Stabilization of Angular Velocity of Asymmetrical Rigid Body. Using Two Constant Torques

CHAPTER 4 CONVENTIONAL CONTROL FOR SATELLITE ATTITUDE

An Inverse Dynamics Attitude Control System with Autonomous Calibration. Sanny Omar Dr. David Beale Dr. JM Wersinger

SATELLITE ATTITUDE TRACKING BY QUATERNION-BASED BACKSTEPPING. Raymond Kristiansen,1 Per Johan Nicklasson,2 Jan Tommy Gravdahl,3

QUATERNION FEEDBACK ATTITUDE CONTROL DESIGN: A NONLINEAR H APPROACH

Exam - TTK 4190 Guidance & Control Eksamen - TTK 4190 Fartøysstyring

ONE of the challenges in the design of attitude control

Spinning Satellites Examples. ACS: Gravity Gradient. ACS: Single Spin

Adaptive Backstepping Control for Optimal Descent with Embedded Autonomy

Spacecraft Bus / Platform

Simplified Filtering Estimator for Spacecraft Attitude Determination from Phase Information of GPS Signals

AS3010: Introduction to Space Technology

Robust Adaptive Attitude Control of a Spacecraft

COUPLED ORBITAL AND ATTITUDE CONTROL SIMULATION

Attitude Control of a Bias Momentum Satellite Using Moment of Inertia

Mathematical Models for the Triaxial Attitude Control Testbed

Satellite Attitude Determination with Attitude Sensors and Gyros using Steady-state Kalman Filter

SPACE SHUTTLE ROLL MANEUVER

Quadrotor Modeling and Control

Attitude Tracking Control of a Small Satellite in Low Earth Orbit

Attitude control of a hopping robot: a feasibility study

Experiments in Control of Rotational Mechanics

Spacecraft Attitude and Power Control Using Variable Speed Control Moment Gyros. Hyungjoo Yoon

Jitter and Basic Requirements of the Reaction Wheel Assembly in the Attitude Control System

Rigid bodies - general theory

Inertia-Free Spacecraft Attitude Control Using. Reaction Wheels

East West GEO Satellite Station-Keeping with Degraded Thruster Response

Quadcopter Dynamics 1

Orbital Environment Simulator

FAULT DETECTION for SPACECRAFT ATTITUDE CONTROL SYSTEM. M. Amin Vahid D. Mechanical Engineering Department Concordia University December 19 th, 2010

sc Control Systems Design Q.1, Sem.1, Ac. Yr. 2010/11

Attitude Control Strategy for HAUSAT-2 with Pitch Bias Momentum System

CHAPTER 5 FUZZY LOGIC FOR ATTITUDE CONTROL

Control of the MARES Autonomous Underwater Vehicle

D-SAT Simplified Magnetic Attitude Control

, respectively to the inverse and the inverse differential problem. Check the correctness of the obtained results. Exercise 2 y P 2 P 1.

Zero Reaction Maneuver: Flight Validation with ETS-VII Space Robot and Extension to Kinematically Redundant Arm

A Blade Element Approach to Modeling Aerodynamic Flight of an Insect-scale Robot

An Attitude Control System for a Low-Cost Earth Observation Satellite with Orbit Maintenance Capability

Artificial Intelligence & Neuro Cognitive Systems Fakultät für Informatik. Robot Dynamics. Dr.-Ing. John Nassour J.

Approach based on Cartesian coordinates

Goddard Space Flight Center

Mixed Control Moment Gyro and Momentum Wheel Attitude Control Strategies

MECH 3140 Final Project

Perturbed Feedback Linearization of Attitude Dynamics

Manipulator Dynamics 2. Instructor: Jacob Rosen Advanced Robotic - MAE 263D - Department of Mechanical & Aerospace Engineering - UCLA

Spacecraft Attitude Control using CMGs: Singularities and Global Controllability

Handling Roll Constraints for Path Following of Marine Surface Vessels using Coordinated Rudder and Propulsion Control

Satellite Attitude Control by Quaternion-Based Backstepping

Spacecraft Attitude Dynamics for Undergraduates

Autonomous Helicopter Landing A Nonlinear Output Regulation Perspective

Nonlinear Landing Control for Quadrotor UAVs

Design and Development of an Unrestricted Satellite Motion Simulator

Chapter 4 The Equations of Motion

Passive Magnetic Attitude Control for CubeSat Spacecraft

Today. Why idealized? Idealized physical models of robotic vehicles. Noise. Idealized physical models of robotic vehicles

Übersetzungshilfe / Translation aid (English) To be returned at the end of the exam!

Predictive Control of Gyroscopic-Force Actuators for Mechanical Vibration Damping

Lecture AC-1. Aircraft Dynamics. Copy right 2003 by Jon at h an H ow

Experiments on Stabilization of the Hanging Equilibrium of a 3D Asymmetric Rigid Pendulum

Attitude Determination and Control

Chapter 2 Coordinate Systems and Transformations

Mech 6091 Flight Control System Course Project. Team Member: Bai, Jing Cui, Yi Wang, Xiaoli

THE REACTION WHEEL PENDULUM

*School of Aeronautics and Astronautics, Purdue University, West Lafayette, IN

TTK4190 Guidance and Control Exam Suggested Solution Spring 2011

Control of industrial robots. Centralized control

Transcription:

A. M. Elbeltagy Egyptian Armed forces Conference on small satellites. 2016 Logan, Utah, USA

Paper objectives Introduction Presentation Agenda Spacecraft combined nonlinear model Proposed RW nonlinear attitude tracking controller Stability analysis Kinematic of fixed ground target tracking Design example and simulation results Summary and conclusions 2

Paper objectives Introduce a modified robust nonlinear tracking control law used with RW actuator for a tracking complex mode. Derive a ground target attitude,rate and acceleration relative to orbit reference frame in details. Demonstrate the validity of the proposed controller and target data generator using MATLAB/SIMULINK environment. 3

Introduction pointing modes : Inertial pointing mode Earth or nadir pointing mode Orbital object pointing mode 4

Introduction Tracking a fixed target on the Earth for a certain period of time is one of the most important requirements for Earth-pointing satellites in order to provide improved long-period up-down-link communication, low-distortion imaging and accurate observation. 5

Introduction open loop schemes require a predetermined pointing maneuver and are typically determined using optimal control techniques. sensitive to spacecraft parameter uncertainty and unexpected disturbances. closed loop schemes account for parameter uncertainties and disturbances more robust design methodology. 6

Introduction Most of the control algorithms introduced previously in the open literature care about pointing accuracy and ignore the time elapsed to reach these strict requirements. Actually there is an increasing demand from customers for a fast ground-target tracking even on the expense of pointing accuracy itself. 7

Introduction When the target locations and satellite ground station are both within the satellite s footprint, it may be much more important for the ground station to steer the main imager bore sight towards the immediate required target areas before capturing the imaging data. Quick satellite response allows for the military intelligence data gathering and downloading in the same communication session. 8

Spacecraft combined nonlinear model Dynamic in orbital reference coordinate(orc) (1) Where 9

Spacecraft combined nonlinear model Kinematic in orbital reference coordinate(orc) (2) Where,, 10

Spacecraft combined nonlinear model (3) Where N eff is effective RW torque input 11

Proposed RW nonlinear attitude tracking controller (4) Where δq - attitude error quaternion vector between spacecraft attitude q and target attitude q c w.r.t ORC. D, K are constant gains. ORC ORC ω c, ω c are target rate and acceleration w.r.t ORC. 12

Proposed RW nonlinear attitude tracking controller (5) Substituting (4) into (2) gives (6) 13

Proposed RW nonlinear attitude tracking controller Eq. (6) and Eq. (2) represent the closed-loop time varying nonlinear dynamic system of the spacecraft attitude with the proposed control law (4) (6) (2) 14

Stability analysis It is clear that the following is a solution of Eq.(2) and Eq.(6) (7) Solution (7) means theoretically that it is possible for the spacecraft to follow the commanded attitude and attitude rate. Including the terms N ωo, Ω(ω B I )(Jω B I + h) and Jω c ORC ensure that the solution (7) always exists. 15

Stability analysis Generally asymptotic stability analysis is required to ensure that the spacecraft can follow the commanded attitude with commanded attitude rate from any condition of both ω B ORC and q. The stability analysis is started by studying the local asymptotic stability, at which the initial values of both and are near the solution (7). Once this local stability is confirmed, a global asymptotic stability, at which any values of both are assumed, is further searched. 16

Stability analysis The tracking error dynamics are employed for the indirect stability analysis alternatively to the nonconvenient direct analysis of solution (7). Defining state variable x to represent the tracking error dynamics as follows: x = x 13 x 46 x 7 = x 1 x 2 x 3 x 4 x 5 x 6 x 7 T (8) 17

Stability analysis Where (9) 18

Stability analysis With (10) Substituting Eq. (9) and Eq. (10) into Eq.(6) and Eq. (2) gives tracking error dynamics model Eq. (11) which is equivalent to Eq. (2) and Eq. (4). 19

Stability analysis Tracking error dynamics model (11) 20

Stability analysis where,, 21

Stability analysis Eq. (11), which represents the tracking error dynamics model, has an equilibrium point, which corresponds to solution (7). Therefore, instead of studying the deviation of ω B ORC and q from ω c ORC and q c for Eq. (2) and Eq. (4), we may simply study the stability of the tracking error Eq. (11) with respect to the equilibrium point x = 0. A Lyapunov function based global stability analysis of the time-varying non-linear tracking error dynamics Eq. (11) is employed. 22

Stability analysis The candidate Lyapunov function V, which is independent of time and is radially unbound, is defined by where (12) P is a symmetric and positive definite matrix. I 4 4 is an identity matrix. 23

Stability analysis Global stability is confirmed when (13) Assuming D and K are diagonal matrices, the dynamic behavior of the nonlinear system (11) can be controlled around the equilibrium point in the direction of the eigenvalues with non zeros real parts of the Jacobian matrix. 24

Stability analysis Expressing the characteristic equation by the desired damping ratio ξ and natural frequency ω n for the special case ω c ORC = 0 allows to relate the gains matrices directly to the desired response. (14) 25

Stability analysis Since actuator constraints are considered in this paper, these gain matrices figured using Eq. (14) can be used as initial guide values. A Matlab/Simulink Optimization tool is used to adjust the dynamic behavior of the nonlinear system Eq. (11) around the equilibrium point. Tracking error is the selected parameter to be optimized within short time. 26

Kinematic of fixed ground target tracking Since the nominal mode of earth orbiting satellite usually maintains the satellite body frame aligned with orbital (ORC) frame, it is preferable to describe the kinematics of the ground target with respect to the in-orbit satellite in ORC frame. The vector from the satellite to the ground target represented in ORC will specify the tracking direction of the selected pointing axis which may be the positive mounting axis of a camera or antenna. 27

Kinematic of fixed ground target tracking The vector from the satellite to the target in orbit frame is (15) Where A ORC EIC, is the transformation matrix from EIC frame to ORC frame and defined by (16),, (17) hence the unit vector must be calculated by normalizing X ORC S T, thus (18) 28

Kinematic of fixed ground target tracking Target tracking task requires that the mounting axis of the commissioned payload being controlled to point towards the direction of u ORC S T. In most cases, the commissioned payload, SBC u Com such as a camera, antenna or telescope is usually mounted along the z-axis of the satellite body to allow controlling the rotation around this axis. Paper considers the case of constant yaw angle ψ during tracking. 29

Kinematic of fixed ground target tracking The commanded angular rate ω c ORC is deduced in details and was found The commanded angular acceleration ω ORC c deduced in details and was found (19) is (20) Where (21) 30

Kinematic of fixed ground target tracking The commanded angular rate ω c ORC is deduced in details and was found The commanded angular acceleration ω ORC c deduced in details and was found (19) is (20) Where (21) 31

Kinematic of fixed ground target tracking (22) (23) 32

Kinematic of fixed ground target tracking (24) (25) (26) (27) Details of target parameters are derived straight forward as explained in the proposed paper 33

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results An imaginary satellite in a low-earth-eccentric orbit is used as an example during these simulations. In order to investigate the attitude change of the satellite, we define the roll, pitch and yaw angles respectively to represent the rotations of the satellite body x, y and z axes with respect to the ORC coordinates. The simulation parameters are given in the following Table. 34

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results Assumption perfect attitude knowledge. Perfect measurements of spacecraft position and velocity. 35

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results Matlab/ Simulink Optimization tools is used to search almost best gains to allow the tracking process meets the required rapid pointing to the target with a little relaxed accuracy which yields : 36

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results The controller succeeded to maneuver spacecraft through a large angle to a predetermined attitude. 37

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results The proposed tracking controller succeeded to maneuver satellite through a large angle to a predetermined attitude with the required relaxed accuracy (0.280) within only (40) sec which is well below the requirements. 38

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results Both orbit referenced satellite attitude and desired attitude are almost coincide within only (30) sec. 39

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results The orbit referenced angular velocity of the spacecraft body does track the desired angular rate command with acceptable limits during the tracking period at which the target is within the FOV of the spacecraft. 40

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results The reaction wheels will apply maximum torque (0.02 Nm.) to provide a bangbang control maneuver to meet the required target tracking within specified limited time with relaxed pointing accuracy. 41

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results The wheel momentums are kept well away below the permissible limits (4 Nms). 42

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results Robustness against model uncertainties up to ±20% error in the moment of inertia tensor of the satellite. 43

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results The pointing accuracy can reach (0.120) and further enhancement can be carried out. 44

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Design example and simulation results The enhancement in tracking accuracy will be on the expense of the time elapsed to track the fixed ground target and actuator effort. 45

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Summary and conclusions The simulation results show that RW non-linear controller is capable to achieve a fast ground target tracking maneuver once the target is being in the satellite FOV. Quick satellite response allows for the military intelligence data gathering and downloading in the same communication session. 46

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Summary and conclusions The reaction wheels will apply maximum torque to provide bang-bang control maneuvers to meet the required target tracking within specified limited time with relaxed pointing accuracy. The wheel momentum is kept well away below the permissible limits. The simulation results also show well and considerable robustness behavior of the proposed controller. 47

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws Summary and conclusions The enhancement in tracking accuracy is possible but it will be on the expense of the time elapsed to track the fixed ground target and actuator effort. 48

Modeling And Simulation of Spacecraft Pointing Modes Using Quaternion-Based Nonlinear Control Laws 49