A Flying Inverted Pendulum

Total Page:16

File Type:pdf, Size:1020Kb

A Flying Inverted Pendulum A Flying Inverted Pendulum Markus Hehn and Raffaello D’Andrea Abstract— We extend the classic control problem of the inverted pendulum by placing the pendulum on top of a quadrotor aerial vehicle. Both static and dynamic equilib- V ria of the system are investigated to find nominal states of the system at standstill and on circular trajectories. Control laws are designed around these nominal trajectories. A yaw- independent description of quadrotor dynamics is introduced, z using a ‘Virtual Body Frame’. This allows for the time-invariant description of curved trajectories. The balancing performance y of the controller is demonstrated in the ETH Zurich Flying O Machine Arena testbed. Development potential for the future is highlighted, with a focus on applying learning methodology x to increase performance by eliminating systematic errors that were seen in experiments. Fig. 1. The inertial coordinate system O and the vehicle coordinate system V. I. INTRODUCTION The inverted pendulum is a classic control problem, of- in Section VI and conclusions are drawn in Section VII, fering one of the most intuitive, easily describable and re- where an outlook is also presented. alizable nonlinear unstable systems. It has been investigated for several decades (see, for example, [11], and references II. DYNAMICS therein). It is frequently used as a demonstrator to show- We derive the equations of motion of the quadrotor and case theoretical advances, e.g. in reinforcement learning [6], the inverted pendulum for the trajectory-independent general neural networks [14], and fuzzy control [13]. case. In this paper, we develop a control strategy that enables Given that the mass of the pendulum is small compared to an inverted pendulum to balance on top of a quadrotor. the mass of the quadrotor, it is reasonable to assume that the Besides being a highly visual demonstration of the dynamic pendulum’s reactive forces on the quadrotor are negligible. capabilities of modern quadrotors, the solution to such a The dynamics of the quadrotor, then, do not depend on complex control problem offers insight into quadrotor control the pendulum, whereas the dynamics of the pendulum are strategies, and could be adapted to other tasks. influenced by the motion of the quadrotor. This assumption Quadrotors offer exceptional agility. Thanks to the off- is justified by the experimental setup, with the weight of center mounting of the propellers, extraordinarily fast rota- the pendulum being less than 5% of that of the quadrotor tional dynamics can be achieved. This is combined with typ- vehicle. ically high thrust-to-weight ratios, resulting in large achiev- able translational accelerations when not carrying a payload. A. Quadrotor While most early work on quadrotors focused on near- The quadrotor is described by six degrees of freedom: The hover operation (e.g. [5], and references therein), a growing translational position (x, y, z) is measured in the inertial community is working on using the full dynamical potential coordinate system O as shown in Figure 1. The vehicle of these vehicles. Flips have been executed by several groups, attitude V is defined by three Euler angles. From the inertial some focusing on speed and autonomous learning [7] and coordinate system, we first rotate around the z-axis by the some on safety guarantees [3]. Other complex maneuvers, yaw angle α. The coordinate system is then rotated around including flight through windows and perching have been the new y-axis by the pitch angle β, and finally rotated about demonstrated [8]. the new x-axis by the roll angle γ: In Section II, we introduce the dynamic models used in the controller design. Section III presents static and O , (1) dynamic nominal trajectories for the quadrotor to follow. V R(α,β,γ)= Rz (α) Ry (β) Rx (γ) The dynamics are then linearized around these trajectories in where Section IV, and linear state feedback controllers are designed in Section V. The experimental setup and results are shown 1 0 0 The authors are with the Institute for Dynamic Systems and Control, ETH Rx (γ)= 0 cos γ − sin γ , (2) Zurich, Switzerland. {hehnm, rdandrea}@ethz.ch 0 sin γ cos γ cos β 0 sin β the y-axis). For notational simplicity, we describe the relative Ry (β)= 0 1 0 , (3) position of the pendulum along the z-axis as − sin β 0 cos β 2 2 2 cos α − sin α 0 ζ := L − r − s , (8) p Rz (α)= sin α cos α 0 . (4) where L to denotes the length from the base of the pendulum 0 0 1 to its center of mass. We model the pendulum as an iner- The translational acceleration of the vehicle is dictated by tialess point mass that is rigidly attached to the mass center the attitude of the vehicle and the total thrust produced by of the quadrotor, such that rotations of the vehicle do not the four propellers. With a representing the mass-normalized cause a motion of the pendulum base. In the experimental collective thrust, the translational acceleration in the inertial setup, the point that the pendulum is attached to is mounted frame is off-center by about 10% of the length of the pendulum. While this assumption causes modeling errors, it simplifies x¨ 0 0 O the dynamics to such a great extent that the problem becomes y¨ = V R(α,β,γ) 0 + 0 . (5) much more tractable. The Lagrangian [9] of the pendulum z¨ a −g can be written as The vehicle attitude is not directly controllable, but it is subject to dynamics. The control inputs are the desired 1 rr˙ + ss˙ L = (˙x +r ˙)2 +(˙y +s ˙)2 +(˙z − )2 rotational rates about the vehicle body axes, (ωx, ωy, ωz), 2 ζ (9) and the mass-normalized collective thrust, a, as shown in − g (z + ζ) , Figure 2. High-bandwidth controllers on the vehicle track the desired rates using feedback from gyroscopes. The quadrotor where we assume unit pendulum mass without loss of has very low rotational inertia, and can produce high torques generality. The first term represents the kinetic energy of due to the outward mounting of the propellers, resulting in the pendulum, and the second the potential energy. The full, L very high achievable rotational accelerations on the order of nonlinear dynamic equations can be derived from using 200 rad/s2. The vehicle has a fast response time to changes in conventional Lagrangian mechanics: the desired rotational rate (experimental results have shown d ∂L ∂L − = 0 (10) time constants on the order of 20 ms). We will therefore dt ∂r˙ ∂r assume that we can directly control the vehicle body rates d ∂L ∂L and ignore rotational acceleration dynamics. As with the − = 0 , (11) dt ∂s˙ ∂s vehicle body rates, we assume that the thrust can be changed instantaneously. Experimental results have shown that the resulting in a system of equations of the form true thrust dynamics are about as fast as the rotational r¨ dynamics, with propeller spin-up being noticeably faster than = f (r,s, r,˙ s,˙ x,¨ y,¨ z¨) , (12) s¨ spin-down. The rates of the Euler angles are converted to the vehicle where f are the nonlinear equations (13) and (14). body coordinate system V through their respective transfor- C. Combined dynamics mations: The full dynamics of the combined system are described ωx γ˙ 0 0 −1 −1 −1 entirely by Equations (5), (7), and (12). The three body ωy = 0 + R (γ) β˙ + R (γ) R (β) 0 . x x y rate control inputs (ωx,ωy,ωz) control the attitude V of ωz 0 0 α˙ the vehicle in a nonlinear fashion. This attitude, combined (6) The above can be written more compactly by combining the Euler rates into a single vector, calculating the relevant a rows of the rotation matrices, and solving for the Euler angle rates: ωy ωz −1 γ˙ cos β cos γ − sin γ 0 ωx ωx β˙ = cos β sin γ cos γ 0 ωy . (7) α˙ − sin β 0 1 ωz B. Inverted Pendulum The pendulum has two degrees of freedom, which we describe by the translational position of the pendulum center Fig. 2. The control inputs of the quadrotor: The rotational rates ωx, ωy, of mass relative to its base in O (r along the x-axis, s along and ωz are tracked by an on-board controller, using gyroscope feedback. 1 2 r¨ = −r4x¨ − L2 − s2 x¨ − 2r2 sr˙s˙ + −L2 + s2 x¨ + r3 s˙2 + ss¨ − ζ (g +z ¨) + (L2 − s2)ζ2 r −L2ss¨ + s3s¨ + s2 r˙2 − ζ (g +z ¨) + L2 −r˙2 − s˙2 + ζ (g +z ¨) (13) 1 2 s¨ = −s4y¨ − L2 − r2 y¨ − 2s2 rr˙s˙ + −L2 + r2 y¨ + s3 r˙2 + rr¨ − ζ (g +z ¨) + (L2 − r2)ζ2 s −L2rr¨ + r3r¨ + r2 s˙2 − ζ (g +z ¨) + L2 −r˙2 − s˙2 + ζ (g +z ¨) (14) with the thrust a, controls the translational acceleration of To describe the vehicle position, the following coordinate the vehicle. While the acceleration drives the translational system C is introduced, with (u,v,w) describing the position motion of the vehicle linearly, it also drives the motion of in C: the pendulum through nonlinear equations. The combined x u cos Ωt − sinΩt 0 u system consists of thirteen states (three rotational and six y =: Rz (Ωt) v = sinΩt cos Ωt 0 v . translational states of the quadrotor, and four states of the z w 0 0 1 w pendulum), and four control inputs (three body rates, and (19) the thrust). To describe the vehicle attitude, a second set of Euler angles is introduced, describing the ‘virtual body frame’ W and III.
Recommended publications
  • Inverted Pendulum System Introduction This Lab Experiment Consists of Two Experimental Procedures, Each with Sub Parts
    Inverted Pendulum System Introduction This lab experiment consists of two experimental procedures, each with sub parts. Experiment 1 is used to determine the system parameters needed to implement a controller. Part A finds the hardware gains in each direction of motion. Part B requires calculation of system parameters such as the inertia, and experimental verification of the calculations. Experiment 2 then implements a controller. Part A tests the system without the controller activated. Part B then activates the controller and compares the stability to Part A. Part C then has a series of increasing step responses to determine the controller’s ability to track the desired output. Finally Part D has an increasing frequency input into the system to determine the system’s frequency response. Hardware Figure 1 shows the Inverted Pendulum Experiment. It consists of a pendulum rod which supports the sliding balance rod. The balance rod is driven by a belt and pulley which in turn is driven by a drive shaft connected to a DC servo motor below the pendulum rod. There are two series of weights included that affect the physical plant: brass counter weights connected underneath the pivot plate with adjustable height and weight and brass “donut” weights attached to both ends of the balance rod. Figure 1: Model 505 ECP Inverted Pendulum Apparatus 1 Safety - Be careful on the step where students are asked to physically turning the equipment upside-down. Make sure the device is not on the edge of the table after it is inverted. - Make sure the pendulum, when released, will not hit anyone or anything.
    [Show full text]
  • Problem Set 26: Feedback Example: the Inverted Pendulum
    26 Feedback Example: The Inverted Pendulum Recommended Problems P26.1 Consider an inverted pendulum mounted on a movable cart as depicted in Figure P26.1. We have modeled the pendulum as consisting of a massless rod of length L, with a mass m attached at the end. The variable 0(t) denotes the pendulum's angular deflection from the vertical, g is gravitational acceleration, s(t) is the position of the cart with respect to some reference point, a(t) is the acceleration of the cart, and x(t) represents the angular acceleration resulting from any disturbances, such as gusts of wind. NIM L L I x(t) 0(t) N9 a(t) s(t) Figure P26.1 Our goal in this problem is to analyze the dynamics of the inverted pendulum and more specifically to investigate the problem of balancing the pendulum by judi­ cious choice of the cart acceleration a(t). The differential equation relating 0(t), a(t), and x(t) is d20(t) L dt = g sin [(t)] - a(t) cos [(t)] + Lx(t) (P26.1-1) This relation merely equates the actual acceleration of the mass along a direction perpendicular to the rod and the applied accelerations (gravity, the disturbance acceleration due to x(t), and the cart acceleration) along this direction. Note that eq. (P26.1-1) is a nonlinear differential equation relating 0(t), a(t), and x(t). The detailed, exact analysis of the behavior of the pendulum therefore requires that we examine this nonlinear equation; however, we can obtain a great deal of insight into the dynamics of the inverted pendulum by performing a linear analysis.
    [Show full text]
  • The Stability of an Inverted Pendulum
    The Stability of an Inverted Pendulum Mentor: John Gemmer Sean Ashley Avery Hope D’Amelio Jiaying Liu Cameron Warren Abstract: The inverted pendulum is a simple system in which both stable and unstable state are easily observed. The upward inverted state is unstable, though it has long been known that a simple rigid pendulum can be stabilized in its inverted state by oscillating its base at an angle. We made the model to simulate the stabilization of the simple inverted pendulum. Also, the numerical analysis was used to find the stability angle. Introduction The model of the simple pendulum problem is one the most well studied dynamical systems. Imagine a weight attached to the end of weightless rod that is freely swinging back and forth about some pivot without friction. The governing equation for this idealized mathematical model is given as d 2θ 2 + glsinθ = 0, where g is gravitational acceleration, � is the length of the pendulum, and � is the dt angular displacement about downward vertical. If the pendulum starts at any given angle, we can expect € € to see one of the following happen: the pendulum will oscillate about the downward angle,θ = 0; it will continue to rotate around the pivot; or it will stay still, atθ = 0,π , but atθ = π any slight disturbance will € cause the pendulum to swing downward. € € Separatrix Rotations Oscillations The phase portrait above shows that the stability points for the simple pendulum are atθ = πn, for n = 0,±1,±2,.... For even n‘s,θ is a stable point and if given some angular velocity,ω , the pendulum € will always oscillate around it, but for odd n’s,θ is an unstable point, so even the smallest angular € € € € velocity will knock the pendulum off it and it will swing down toward its stable point.
    [Show full text]
  • Model-Based Proprioceptive State Estimation for Spring-Mass Running
    Model-Based Proprioceptive State Estimation for Spring-Mass Running Ozlem¨ Gur¨ and Uluc¸Saranlı Abstract—Autonomous applications of legged platforms will [18] limit their utility for use with fully autonomous mobile inevitably require accurate state estimation both for feedback platforms. Visual state estimation methods by themselves often control as well as mapping and planning. Even though kinematic do not offer sufficient measurement bandwith and accuracy models and low-bandwidth visual localization may be sufficient for fully-actuated, statically stable legged robots, they are in- and when they do, they entail high computational loads that are adequate for dynamically dexterous, underactuated platforms not feasible for autonomous operation [17]. As a consequence, where second order dynamics are dominant, noise levels are a combination of both proprioceptive and exteroceptive sensors high and sensory limitations are more severe. In this paper, we are often used within filter based sensor fusion frameworks to introduce a model based state estimation method for dynamic combine the advantages of both approaches. running behaviors with a simple spring-mass runner. By using an approximate analytic solution to the dynamics of the model within In this paper, we show how the use of an accurate analytic an Extended Kalman filter framework, the estimation accuracy of motion model and additional cues from intermittent kinematic our model remains accurate even at low sampling frequencies. events can be utilized to achieve accurate state estimation for We also propose two new event-based sensory modalities that dynamic running even with a very limited sensory suite. To further improve estimation performance in cases where even this end, we work with the well-established Spring-Loaded the internal kinematics of a robot cannot be fully observed, such as when flexible materials are used for limb designs.
    [Show full text]
  • The Strengths and Weaknesses of Inverted Pendulum
    View metadata, citation and similar papers at core.ac.uk brought to you by CORE provided by University of Salford Institutional Repository THE STRENGTHS AND WEAKNESSES OF INVERTED PENDULUM MODELS OF HUMAN WALKING Michael McGrath1, David Howard2, Richard Baker1 1School of Health Sciences, University of Salford, M6 6PU, UK; 2School of Computing, Science and Engineering, University of Salford, M5 4WT, UK. Email: [email protected] Keywords: Inverted pendulum, gait, walking, modelling Word count: 3024 Abstract – An investigation into the kinematic and kinetic predictions of two “inverted pendulum” (IP) models of gait was undertaken. The first model consisted of a single leg, with anthropometrically correct mass and moment of inertia, and a point mass at the hip representing the rest of the body. A second model incorporating the physiological extension of a head‐arms‐trunk (HAT) segment, held upright by an actuated hip moment, was developed for comparison. Simulations were performed, using both models, and quantitatively compared with empirical gait data. There was little difference between the two models’ predictions of kinematics and ground reaction force (GRF). The models agreed well with empirical data through mid‐stance (20‐40% of the gait cycle) suggesting that IP models adequately simulate this phase (mean error less than one standard deviation). IP models are not cyclic, however, and cannot adequately simulate double support and step‐ to‐step transition. This is because the forces under both legs augment each other during double support to increase the vertical GRF. The incorporation of an actuated hip joint was the most novel change and added a new dimension to the classic IP model.
    [Show full text]
  • (PH003) Classical Mechanics the Inverted Pendulum
    CALIFORNIA INSTITUTE OF TECHNOLOGY PHYSICS MATHEMATICS AND ASTRONOMY DIVISION Freshman Physics Laboratory (PH003) Classical Mechanics The Inverted Pendulum Kenneth G Libbrecht, Virginio de Oliveira Sannibale, 2010 (Revision October 2012) Chapter 3 The Inverted Pendulum 3.1 Introduction The purpose of this lab is to explore the dynamics of the harmonic me- chanical oscillator. To make things a bit more interesting, we will model and study the motion of an inverted pendulum (IP), which is a special type of tunable mechanical oscillator. As we will see below, the IP contains two restoring forces, one positive and one negative. By adjusting the relative strengths of these two forces, we can change the oscillation frequency of the pendulum over a wide range. As usual (see section3.2), we will first make a mathematical model of the IP, and then you will characterize the system by measuring various parameters in the model. Finally, you will observe the motion of the pen- dulum and see if it agrees with the model to within experimental uncer- tainties. The IP is a fairly simple mechanical device, so you should be able to analyze and characterize the system almost completely. At the same time, the inverted pendulum exhibits some interesting dynamics, and it demon- strates several important principles in physics. Waves and oscillators are everywhere in physics and engineering, and one of the best ways to un- derstand oscillatory phenomenon is to carefully analyze a relatively sim- ple system like the inverted pendulum. 27 DRAFT 28 CHAPTER 3. THE INVERTED PENDULUM 3.2 Modeling the Inverted Pendulum (IP) 3.2.1 The Simple Harmonic Oscillator We begin our discussion with the most basic harmonic oscillator – a mass connected to an ideal spring.
    [Show full text]
  • The Inverted Pendulum
    Lab 1 The Inverted Pendulum Lab Objective: We will set up the LQR optimal control problem for the inverted pendulum and compute the solution numerically. Think back to your childhood days when, for entertainment purposes, you'd balance objects: a book on your head, a spoon on your nose, or even a broom on your hand. Learning how to walk was likely your initial introduction to the inverted pendulum problem. A pendulum has two rest points: a stable rest point directly underneath the pivot point of the pendulum, and an unstable rest point directly above. The generic pendulum problem is to simply describe the dynamics of the object on the pendu- lum (called the `bob'). The inverted pendulum problem seeks to guide the bob toward the unstable fixed point at the top of the pendulum. Since the fixed point is unstable, the bob must be balanced relentlessly to keep it upright. The inverted pendulum is an important classical problem in dynamics and con- trol theory, and is often used to test different control strategies. One application of the inverted pendulum is the guidance of rockets and missiles. Aerodynamic insta- bility occurs because the center of mass of the rocket is not the same as the center of drag. Small gusts of wind or variations in thrust require constant attention to the orientation of the rocket. The Simple Pendulum We begin by studying the simple pendulum setting. Suppose we have a pendulum consisting of a bob with mass m rotating about a pivot point at the end of a (massless) rod of length l.
    [Show full text]
  • Computational and Robotic Models of Human Postural Control
    COMPUTATIONAL AND ROBOTIC MODELS OF HUMAN POSTURAL CONTROL by Arash Mahboobin B.S., Azad University, 1998 M.S., University of Illinois at Urbana–Champaign, 2002 Submitted to the Graduate Faculty of the School of Engineering in partial fulfillment of the requirements for the degree of Doctor of Philosophy University of Pittsburgh 2007 UNIVERSITY OF PITTSBURGH SCHOOL OF ENGINEERING This dissertation was presented by Arash Mahboobin It was defended on November 20, 2007 and approved by P. J. Loughlin, Ph.D., Department of Electrical and Computer Engineering M. S. Redfern, Ph.D., Department of Bioengineering C. G. Atkeson, Ph.D., The Robotics Institute, Carnegie Mellon University J. R. Boston, Ph.D., Department of Electrical and Computer Engineering A. A. El–Jaroudi, Ph.D., Department of Electrical and Computer Engineering Z–H. Mao, Ph.D., Department of Electrical and Computer Engineering P. J. Sparto, Ph.D., Department of Physical Therapy Dissertation Director: P. J. Loughlin, Ph.D., Department of Electrical and Computer Engineering ii Copyright c by Arash Mahboobin 2007 iii ABSTRACT COMPUTATIONAL AND ROBOTIC MODELS OF HUMAN POSTURAL CONTROL Arash Mahboobin, PhD University of Pittsburgh, 2007 Currently, no bipedal robot exhibits fully human-like characteristics in terms of its postural control and movement. Current biped robots move more slowly than humans and are much less stable. Humans utilize a variety of sensory systems to maintain balance, primary among them being the visual, vestibular and proprioceptive systems. A key finding of human pos- tural control experiments has been that the integration of sensory information appears to be dynamically regulated to adapt to changing environmental conditions and the available sensory information, a process referred to as “sensory re-weighting.” In contrast, in robotics, the emphasis has been on controlling the location of the center of pressure based on proprio- ception, with little use of vestibular signals (inertial sensing) and no use of vision.
    [Show full text]
  • Inverted Pendulum Introduction
    Inverted Pendulum Objectives The objective of this lab is to experiment with the stabilization of an unstable system. The inverted pendulum problem is taken as an example and the animation program gives a feel for the chal- lenges of manual control. A stabilizing linear controller is designed using root-locus techniques, and the controller is refined to enable stabilization of the inverted pendulum at any position on the track. Introduction The inverted pendulum system is a favorite experiment in control system labs. The highly unstable nature of the plant enables an impressive demonstration of the capabilities of feedback systems. The inverted pendulum is also considered a simplified representation of rockets flying into space. Fig. 8.32 shows a diagram of the experiment. A cart rolls along a track, with its position x being controlled by a motor. A beam is attached to the cart so that it rotates freely at the point of contact with the cart. The angle of the beam with the vertical is denoted θ,and an objective is to keep the angle close to zero. Since the pendulum may be stabilized at any position on the track, a second objective is to specify the track position. However, recovery from non-zero beam angles may require significant movements of the cart along the track, and stabilization may be impossible if an insufficient range of motion remains. A model of the inverted pendulum may be derived using standard techniques. A careful derivation (H. Khalil, Nonlinear Systems, 2nd edition, Prentice Hall, Upper Saddle River, NJ, 1996) shows that d2θ d2x (I + mL2) + mL cos(θ) = mgL sin(θ) (8.39) dt2 dt2 where m is the mass of the beam, 2L is the length of the beam, I = mL2/3 is the moment of inertia of the beam around its center of gravity, and g is the acceleration of gravity.
    [Show full text]
  • Cordingleyz2020m.Pdf (1.899Mb)
    Lakehead University Knowledge Commons,http://knowledgecommons.lakeheadu.ca Electronic Theses and Dissertations Electronic Theses and Dissertations from 2009 2020 The immediate effects of Tai Chi on the postural stability, muscle activity and measures of inferred ankle proprioception of healthy young adults Cordingley, Zachary http://knowledgecommons.lakeheadu.ca/handle/2453/4683 Downloaded from Lakehead University, KnowledgeCommons Running head: EFFECTS OF TAI CHI ON POSTURAL STABILITY AND ANKLE PROPRIOCEPTION The Immediate Effects of Tai Chi on the Postural Stability, Muscle Activity and Measures of Inferred Ankle Proprioception of Healthy Young Adults Zachary Cordingley Supervisor: Dr. Paolo Sanzo Committee: Dr. Carlos Zerpa and Dr. Kathryn Sinden Lakehead University EFFECTS OF TAI CHI ON POSTURAL STABILITY AND ANKLE 2 PROPRIOCEPTION Table of Contents Table of Contents ...................................................................................................................... 2 List of Figures ........................................................................................................................... 6 List of Tables .......................................................................................................................... 10 List of Abbreviations .............................................................................................................. 11 Abstract ..................................................................................................................................
    [Show full text]
  • Double Inverted Pendulum Model of Reactive Human Stance Control
    MULTIBODY DYNAMICS 2011, ECCOMAS Thematic Conference J.C. Samin, P. Fisette (eds.) Brussels, Belgium, 4-7 July 2011 DOUBLE INVERTED PENDULUM MODEL OF REACTIVE HUMAN STANCE CONTROL Georg Hettich, Luminous Fennell and Thomas Mergner Neurology, University of Freiburg, Breisacher Str. 64, 79106 Freiburg, Germany e-mail: [email protected], [email protected], [email protected] Keywords: Human Stance, Balancing, External Disturbances, Foot Support Tilt, Sensory Feedback Control Model, Double Inverted Pendulum Biomechanics. Abstract: When maintaining equilibrium in upright stance, humans use sensory feedback control to cope with unforeseen external disturbances such as support surface motion, this de- spite biological ‘complications’ such as noisy and inaccurate sensor signals and considerable neural, motor, and processing time delays. The control method they use apparently differs from established methods one normally finds in technical fields. System identification recent- ly led us design a control model that we currently test in our laboratory. The tests include hardware-in-the-loop simulations after the model’s embodiment into a robot. The model is called disturbance estimation and compensation (DEC) model. Disturbance estimation is per- formed by on-line multisensory interactions using joint angle, joint torque, and vestibular cues. For disturbance compensation, the method of direct disturbance rejection is used (“Störgrös- senaufschaltung”). So far, biomechanics of a single inverted pendulum (SIP) were applied. Here we extend the DEC concept to the control of a double inverted pendulum (DIP; moving links: trunk on hip joint and legs on ankle joints). The aim is that the model copes in addition with inter-link torques and still describes human experimental data.
    [Show full text]
  • Stabalizing an Inverted Pendulum
    Stabalizing an Inverted Pendulum Student: Kyle Gallagher Advisor: Robert Fersch December 14, 2013 1 Introduction: A pendulum is a simple system, consisting of a mass held aloft by either a string or a rod that is free to pivot about a certain point. This system will naturally over time approach an equilibrium where the center of mass is directly below the pivot point, and thus the energy of the system is at a minimum. However, if we invert the system, we are now presented with an inherently unstable system, the inverted pendulum, henceforth referred to as IP. Figure 1: On the left is a diagram of a simple pendulum. On the right is a diagram of an inverted pendulum. The yellow lines indicate the normal/ reference. While, mathematically speaking it is possible to balance a mass above a pivot point wherein the system will be at equilibrium and thus stable, this proves to be rather arduous and impractical for use beyond academic demonstrations (Figure 2). When viewed from a physics and engineering perspective, the instability of the system requires dynamic external forces for it to remain upright. Some methods for stabilizing the IP system include: applying atorqueatthepivotpoint,displacingthepivotpointalongeithertheverticalorhorizon- tal axis, or oscillating the mass along the pendulum. These methods work by allowing a controller to continually adjust outputs (applied forces) in reaction to changing inputs (an- gle of pendulum), ultimately manipulating the system towards the upright equilibrium point. 1 Figure 2: Two forks balencing on a toothpick. Their center of mass is directly above the point of contact between the toothpick and glass.
    [Show full text]