A Simplified Vehicle and Driver Model for Vehicle Systems Development

Similar documents
Chapter 4 Dynamics. Part Constrained Kinematics and Dynamics. Mobile Robotics - Prof Alonzo Kelly, CMU RI

Engineering Tool Development

Multi-objective optimization of the geometry of a double wishbone suspension system

Role of Kinematic Analysis in tuning the Dynamic Behavior of a Formula Car

Chapter 3 Path Optimization

Applications. Human and animal motion Robotics control Hair Plants Molecular motion

Controllable Suspension Design Using Magnetorheological Fluid

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

MTRX4700 Experimental Robotics

COMPUTATIONAL DYNAMICS

Force Modeling, Quaternion PID, and Optimization

Ride Analysis of Three Wheeled Vehicle Using MATLAB/Simulink

Connection Elements and Connection Library

A simple example. Assume we want to find the change in the rotation angles to get the end effector to G. Effect of changing s

Parallel Robots. Mechanics and Control H AMID D. TAG HI RAD. CRC Press. Taylor & Francis Group. Taylor & Francis Croup, Boca Raton London NewYoric

CHAPTER 3 MATHEMATICAL MODEL

VIBRATION ISOLATION USING A MULTI-AXIS ROBOTIC PLATFORM G.

Design and Development of Unmanned Tilt T-Tri Rotor Aerial Vehicle

Development of the Compliant Mooring Line Model for FLOW-3D

Physics Tutorial 2: Numerical Integration Methods

Using RecurDyn. Contents

COPYRIGHTED MATERIAL INTRODUCTION CHAPTER 1

Best Practices for Maneuvering

Adaptive Control of 4-DoF Robot manipulator

AUTONOMOUS PLANETARY ROVER CONTROL USING INVERSE SIMULATION

Goals: Course Unit: Describing Moving Objects Different Ways of Representing Functions Vector-valued Functions, or Parametric Curves

Proceedings of the 2013 SpaceVision Conference November 7-10 th, Tempe, AZ, USA ABSTRACT

Chapter 5 Modeling and Simulation of Mechanism

INSTITUTE OF AERONAUTICAL ENGINEERING

Kinematics, Kinematics Chains CS 685

SIMPACK - A Tool for Off-Line and Real- Time Simulation

METR 4202: Advanced Control & Robotics

Lecture VI: Constraints and Controllers

Table of Contents Introduction Historical Review of Robotic Orienting Devices Kinematic Position Analysis Instantaneous Kinematic Analysis

Chapter 3: Kinematics Locomotion. Ross Hatton and Howie Choset

Structural Configurations of Manipulators

What Is SimMechanics?

Aircraft Stability and Performance 2nd Year, Aerospace Engineering. Dr. M. Turner

INTRODUCTION CHAPTER 1

Model Library Mechanics

Simulation of Overhead Crane Wire Ropes Utilizing LS-DYNA

1. Introduction 1 2. Mathematical Representation of Robots

Lecture VI: Constraints and Controllers. Parts Based on Erin Catto s Box2D Tutorial

1. INTRODUCTION. Constrained Control Allocation for Systems with Redundant Control Effectors

MODELLING OF MOTORCYCLES AND THEIR COMPONENTS

Finite Element Models for Dynamic Analysis of Vehicles and Bridges under Traffic Loads

Kinematics. Kinematics analyzes the geometry of a manipulator, robot or machine motion. The essential concept is a position.

SUPPORTING LINEAR MOTION: A COMPLETE GUIDE TO IMPLEMENTING DYNAMIC LOAD SUPPORT FOR LINEAR MOTION SYSTEMS

EE565:Mobile Robotics Lecture 2

Example: Modeling a Cruise Control System in Simulink

DYNAMIC SIMULATION OF A FORMULA SAE RACING CAR FOR DESIGN AND DEVELOPMENT PURPOSES

Robust Controller Design for an Autonomous Underwater Vehicle

Parametric Study of Engine Rigid Body Modes

Modelling of Torsion Beam Rear Suspension by Using Multibody Method

VERSION 5.01 VERSION 5.03

Lesson 1: Introduction to Pro/MECHANICA Motion

Design & Optimization Fuzzy Logic Controller for General Helicopter Model

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

AC : AN ALTERNATIVE APPROACH FOR TEACHING MULTIBODY DYNAMICS

SIMULATION ENVIRONMENT PROPOSAL, ANALYSIS AND CONTROL OF A STEWART PLATFORM MANIPULATOR

Solution for Euler Equations Lagrangian and Eulerian Descriptions

Darshan Vijay Wale 1

Chapter 4: Kinematics of Rigid Bodies

Design of a Three-Axis Rotary Platform

Sensor Accuracy in Vehicle Safety

NMT EE 589 & UNM ME 482/582 ROBOT ENGINEERING. Dr. Stephen Bruder NMT EE 589 & UNM ME 482/582

Development of a Ground Based Cooperating Spacecraft Testbed for Research and Education

Kinematics of Wheeled Robots

CFD MODELING FOR PNEUMATIC CONVEYING

Comparative Analysis Of Vehicle Suspension System in Matlab-SIMULINK and MSc- ADAMS with the help of Quarter Car Model

θ x Week Date Lecture (M: 2:05p-3:50, 50-N202) 1 23-Jul Introduction + Representing Position & Orientation & State 2 30-Jul

240AR059 - Geometric Fundamentals for Robot Design

We are IntechOpen, the world s leading publisher of Open Access books Built by scientists, for scientists. International authors and editors

UNIVERSITY OF OSLO. Faculty of Mathematics and Natural Sciences

Adaptive back-stepping control applied on octocopter under recoil disturbance

BIOMECHANICAL MODELLING

Jacobians. 6.1 Linearized Kinematics. Y: = k2( e6)

Human Motion. Session Speaker Dr. M. D. Deshpande. AML2506 Biomechanics and Flow Simulation PEMP-AML2506

Geometric Transformations

Research on time optimal trajectory planning of 7-DOF manipulator based on genetic algorithm

Math Section 4.2 Radians, Arc Length, and Area of a Sector

Configuration Space. Chapter 2

Lecture «Robot Dynamics»: Kinematics 3

Yaw Control for 20MW Offshore Multi Rotor System

2. Motion Analysis - Sim-Mechanics

Beams. Lesson Objectives:

MECHATRONICS SYSTEM ENGINEERING FOR CAE/CAD, MOTION CONTROL AND DESIGN OF VANE ACTUATORS FOR WATER ROBOT APPLICATIONS

Solution for Euler Equations Lagrangian and Eulerian Descriptions

Mechanical System and SimMechanics Simulation

Alternative approach for teaching multibody dynamics

UNIVERSITY OF OSLO. Faculty of Mathematics and Natural Sciences

TOPOLOGICAL OPTIMIZATION OF STEERING KNUCKLE BY USING ADDITIVE MANUFACTURING PROCESS

Support for Multi physics in Chrono

MAJOR IMPROVEMENTS IN STORES SEPARATION ANALYSIS USING FLEXIBLE AIRCRAFT

Mobile Robot Kinematics

MEM380 Applied Autonomous Robots Winter Robot Kinematics

Inverse Kinematics Analysis for Manipulator Robot With Wrist Offset Based On the Closed-Form Algorithm

NONCIRCULAR GEAR DESIGN AND GENERATION BY RACK CUTTER

Kinematics and dynamics analysis of micro-robot for surgical applications

To Measure a Constant Velocity. Enter.

Transcription:

A Simplified Vehicle and Driver Model for Vehicle Systems Development Martin Bayliss Cranfield University School of Engineering Bedfordshire MK43 0AL UK Abstract For the purposes of vehicle systems controller development it is required to have an accurate vehicle model both for virtual simulation of algorithm performance and to develop state and parameter estimator models for use within the system controllers. With the advent of new sensors it will become possible to use full order vehicle models within the controller estimator. Therefore, the purpose behind the work presented in this paper is to develop a parametric vehicle model that can be used for vehicle simulations and within integrated system controllers. An objective of the vehicle model is for it to utilise a straight forward longitudinal and lateral driver model and to use inputs and state variables that can be easily sensed on a production or prototype vehicle. 10

Introduction The vehicle model presented in this paper was designed to allow for coupled ride and handling simulation of the vehicle response to driver and road inputs. The 14 degrees of freedom in the model include the translation of the sprung mass z axis road intercept x and y coordinates and the sprung mass vertical position and the three rotational degrees of freedom about the translational axes of the sprung mass. The remaining 8 degrees of freedom are the un-sprung mass (wheel) vertical deflections and their angular rotations. The active degrees of freedom in the vehicle model and their sign convention are summarised in figure 1. ψ φ z θ x Zrl Zfr Zrr y Figure 1: Vehicle local coordinate system and sign convention The inputs to the model are the wheel steer angles, braking and accelerating wheel torques and the vertical wheel road displacements. The outputs from the vehicle model are the degrees of freedom, their first two derivatives, the longitudinal and lateral tyre slips per wheel and the vertical reactions at each wheel. The equations of motion for the model were derived using the Lagrange approach. In order to simplify the derivation the equations of motion were derived with reference to the local reference frame. This avoids the algebraic complication of expressing the local state variables used for the Lagrange functional as globally referenced variables and hence simplifies the derivation of each Euler-Lagrange equation of motion. However, the formulation of the equations of motion in the local reference frame implies that a transformation of some of the state variables back into a global reference frame is required for the driver model and inclusion of centripetal cornering forces which otherwise do not arise in the Lagrange formulation. In this work, for planar motion of the vehicle and a track following driver model only road plane x and y degrees of freedom were required to be transformed into the global reference frame. The coordinate transformation can be assumed to be a function of the sprung mass yaw angle alone. The 11

sprung mass rotational degrees of freedom and the un-sprung mass vertical and rotational degrees of freedom were left in the local coordinate reference frame. In this paper the equation of motion formulation for the vehicle model is presented and the longitudinal and lateral driver models described. The manoeuvre test case presented is for a vehicle negotiating a closed loop sequence of eight 45 turns at a constant speed. Aerodynamic drag in the longitudinal and lateral directions has been included in the simulation as well as sprung mass roll control. Vehicle model derivation The vehicle model was derived from first principles using the Lagrange formulation approach where the Lagrange functional was formed for the dynamic system in terms of the generalized coordinates in the local vehicle reference frame [1,2]. The Lagrange functional can be stated as: L ( q, q& ) = T( q& ) U( q) Where L ( q, q& ) is the Lagrange functional as a function of the generalized coordinates and their derivatives, T ( q& ) the kinetic energy and U ( q) the potential energy. The equations of motion are then formulated by evaluating the Euler-Lagrange equation by differentiation of the Lagrange functional with respect to the generalized coordinates. The Euler-Lagrange functional can be stated as: d dt L L F + q& q q& = Q q Where F represents the non-conservative energy and Q are the non-conservative generalized forces inputting energy into the system (tyre forces etc). Hence, the Lagrange functional can be expressed as a function of the 14 generalized coordinates and their derivatives: L ( q, q& ) x, x&, y, y&, z, z&, z fl, z& fl, z fr, z& fr, = L zrl, z& rl, zrr, z& rr, θ & fl, θ fl, θ & fr, θ fr, θ & rl, θ rl, θ & rr, θ rr In order to formulate the kinetic energy terms of the Lagrange functional the x and y translation velocities of the sprung mass centre of mass and the four wheels need to be expressed in terms of the road plane z axis intercept x and y component velocities. Therefore, the Lagrangian functional can be expressed entirely in terms of the local vehicle reference frame coordinates. The Lagrangian functional is then repeatedly differentiated with respect to each generalized coordinate for each of the 14 degrees of freedom in turn. 12

Generalised forces: The generalised forces are derived using the principle of virtual work where by an expression for the work performed by the system due to an infinitesimal displacement by the external forces is formulated. For this model only the tyre forces were used as the external forces acting on the dynamic system. By assuming the vehicle is in a state of dynamic equilibrium at each time step of the solution the response state variables can be used to formulate the vertical wheel load generalised forces. Note, in the derivation of the generalised forces, for simplicity the suspension parameters [1] that capture the suspension kinematic behaviour were omitted. Tyre longitudinal and lateral slip: The lateral tyre slip angles can be derived as functions of the local road plane sprung mass z axis intercept x and y coordinate velocities, yaw rate and wheel steer angles. Similarly the longitudinal wheel slip values in the plane of each wheel are derived from the circumferential speed of the tyre contact patch and the translational speed of the wheel station in the plane of the wheel. Note: The longitudinal and lateral forces are therefore obtained by multiplying the tyre slip values by the corresponding tyre stiffness. For simplicity the lateral and longitudinal tyre stiffness was assumed linear and given constant values in this model. Centripetal forces: Because the Lagrangian model derivation detailed above is formulated in the local vehicle reference frame there remains one complication required to make the model accurately represent actual vehicle behaviour. Consider the vehicle negotiating a steady state turn. In vehicle referenced coordinates, as per the equations so far detailed, the result will be that the y coordinate velocity will have a constant value. This is not the case in global coordinates as the vehicle is in fact continuously accelerating laterally towards the centre of rotation. Therefore, in this model the x and y coordinate velocity responses are transformed back into the global reference frame. The centripetal acceleration component of the vehicle towards the centre of rotation can then be evaluated. The vehicle model can be modified so that a lateral acceleration due to cornering is subtracted from the y generalised force and then added by including a corresponding lateral tyre slip angle on all four wheels, leading to a lateral tyre force. Therefore, the lateral tyre slip due to centripetal acceleration is included in the model but the net lateral acceleration still does not include the centripetal component, hence the locally referenced equations of motion can be used. The calculated centripetal acceleration is also used to augment the sprung mass roll angle generalised force and hence induce body roll during cornering. Note: The internal tyre slip angles used in the model need to be augmented by the centripetal acceleration induced slip angles for display purposes. These are easily computed from the state variable response and individual tyre lateral stiffness. To take 13

account of the sprung mass centre of gravity not being symmetrically located the centripetal acceleration induced slip angles used internally in the vehicle model and for display purposes need to be factored according the centre of mass position such that the centripetal acceleration induced slip angles do not result in a net yaw moment on the vehicle. It is only the tyre slip angles arising due to translational accelerations that should induce yaw moments for use with the locally referenced vehicle. Aerodynamic loading: A simple longitudinal and lateral aerodynamic model has been included in the model in that additional generalised force terms have been added to the x and y equations of motion based on the drag formula given below: Q w = 1 2 ρv 2 C D A Where CD is the directional drag coefficient, ρ the air density, A the resistance area and v the velocity magnitude, which for this model will be the locally referenced x and y velocity component response magnitudes. Roll control: In the results given in this paper a PID feedback roll control loop was added. The response sprung mass roll angle was subtracted from the demand roll angle (zero for these simulations), factored by the PID gain and fed into the vehicle model as an additional generalised force term in the sprung mass roll angle equations of motion. Numerical considerations: It is the case that some of the vehicle model expressions involve terms that have quotients where the denominator is solely a function of one or more of the state variables. Therefore, in order to avoid division by zero and the ensuing numerical singularities, conditional if statements were included in the algorithm to force the quotients to evaluate to zero, as opposed to infinity, under these circumstances. Vehicle model implementation: The equations of motion and the supporting expressions, i.e., tyre slip terms, planar to local transformations and centripetal acceleration evaluation, were implemented in a nonlinear Simulink model. The Matlab linmod command was then used to linearise the Simulink vehicle model into state space format. A further Simulink model was then created which incorporated the linearised state space model into the vehicle simulation environment. The vehicle simulation environment included the longitudinal and lateral driver model, roll control, aerodynamic drag and the vertical road profile. The whole Simulink simulation was called from a master Matlab file which also defined all the 14

physical parameters required for the vehicle model. The physical parameter set was based on a generic vehicle created with reference to standard texts in the literature [3,4]. Note: the non-linear model is linearised into a state space format to permit the vehicle model to be passed to Simulink S-functions as parameter arguments, thus enabling the use of Matlab script control toolbox functions and bespoke user defined codes in other languages if need be (C, FORTRAN etc) within the S-function script files. This capability is essential if any control algorithms developed using this model are to be converted to real time code for hardware in the loop work. The results given in this paper were generated by running the simulation using the default Simulink ordinary differential equation 45 Dormond-Prince solver in variable step mode. The default solver used for this simulation quickly converged on a solution (for the results given in this paper the simulation ran for about 30 seconds on a Pentium 4, 1 GHz PC) without numerical instability. Driver model: The driver model consists of longitudinal and lateral PID controllers outputting a longitudinal generalised force and an averaged steer angle to the steered wheels. Longitudinal driver model: The vehicle model response x velocity component represents the forward speed of the vehicle directly. Therefore, this signal is subtracted from the demand forward speed to give the error signal to feed into the PID controller. The PID controller output is input to the vehicle model as an additional term of the driven wheels generalised force. Note: The resultant velocity magnitude is evaluated from the locally referenced road plane velocity components. The resulting velocity magnitude signal is then integrated in Simulink to give the absolute distance travelled. The absolute distance travelled evaluated in this way is then used as the indexing variable in look up tables included in the lateral driver model for the demand vehicle track data. Lateral driver model: Generally, for driver models used in vehicle simulation software the instantaneous lateral vehicle response is defined in terms of the response radius of curvature and yaw angle [5]. Further, the instantaneous response yaw angle and radius of curvature are derived by relating the vehicle s current position in the global reference frame to its position as if exactly on the prescribed track but slightly ahead of where it should be based on the absolute distance travelled. In this model the track for the vehicle to follow is defined in terms of the sprung mass yaw angle indexed against the absolute distance travelled. This data can either be generated analytically or measured on an instrumented vehicle. The yaw angle response can be obtained from the driver model. Hence, the yaw angle can be subtracted from the demand yaw angle based on the response absolute distance travelled, 15

and a yaw error signal obtained. Note: steer angle damping is included by feeding back the time integral of the steer angle error signal, factored by a time constant. Simulation Results The manoeuvre test case presented is for a vehicle negotiating a closed loop sequence of eight 45 turns at a constant speed. The demand track is run for four different sets of roll, longitudinal speed and lateral driver PID gains. The figures that show state variable results with one trace per plot represent the final simulation for the test case where the best PID gains were used to control speed, roll and path following response performance. The best PID gains were not selected by any optimal or classical approach but set according to observation of the vehicle model response. 16

Closed loop turn sequence test case: Figure 2: Input yaw angle verses absolute distance travelled data set Figure 3: Planar global track (chain dot) and vehicle responses (solid lines) Figure 4: Vehicle sprung mass roll and pitch responses 17

Figure 5: Vehicle forward speed and sprung mass vertical displacement responses Figure 6: Vehicle yaw and planar response in the local reference frame Figure 7: Wheel vertical deflection responses 18

Figure 8: Front wheels steer angle from lateral driver model Figure 2 shows the input data set for the closed loop turn sequence, which consists of yaw angle verses absolute track position. The effect of the lateral driver gains and time constant value on the ability of the vehicle to follow the demand track are demonstrated in figures 3. Figure 4 shows the roll and pitch responses for the closed loop track for varying roll and forward speed controller gains. The reduced roll response for higher roll controller gains would be significant if a non-linear tyre model was included in the model and the effect of load transfer taken into account. Figure 5 shows the forward speed and sprung mass vertical velocity responses for the closed loop track. As expected, the higher forward speed controller gains result in a quicker rise time and some initial overshoot of the speed response and greater sprung mass deflections. Figure 6 shows some of the planer local frame of reference responses for the closed loop manoeuvre. Note: the close correlation between the yaw response and the lateral y coordinate displacement. As expected for a near constant forward speed the local reference frame x coordinate displacement builds up linearly with time. Figure 7 shows the vertical deflections of the wheels. As expected the front wheels lift and the rear squat down during acceleration. Figure 8 shows the steer angle on the front wheels as output from the lateral driver controller for the closed loop manoeuvre. Note that the steer angle is the steer angle at the wheel. Conclusions A locally referenced 14 DOF combined ride and handling parameterised vehicle model has been derived and validated. Numerical factors have been discussed relating to generation of tyre slip values internally within the vehicle model and the necessity of transforming some of the vehicle model state variables into the global reference frame to account for centripetal effects and generating longitudinal and lateral driver model input. The vehicle state variable responses have been examined for a representative vehicle parameter set and found to agree with intuitively expected vehicle responses. Such a vehicle model approach enables the researcher to have access to the full order model for incorporation into controller simulations for state estimation. The model presented in this paper can be viewed as a basic skeletal vehicle model enabling front/rear/all wheel 19

drive, two/four wheel steer and any number of active system control algorithms utilising the state variable set to be simulated. The model can be extended to include suspension kinematic effects by the addition of suspension derivatives in the generalised force expressions within the equations of motion. Non-linear tyre models can also be included in the model. Therefore, the vehicle modelling approach presented in this paper offers the vehicle dynamic systems developer the ability to build vehicle models for inclusion within state and parameter estimator controller algorithms that whilst being far less complex than used with commercial vehicle simulation packages, represent an increase in the order of the vehicle models conventionally built into dynamic vehicle system controllers. References [1] R. S. Sharp, A Mathematical Model for the Simulation of Vehicle Motions. Journal of Engineering Math., Vol. 3, pp 219-237, 1969. [2] E. T. Whittaker, Analytical Dynamics of Particles and Rigid Bodies. New York Dover Publications, 4 th Ed, 1944. [3] T. D. Gillespie, Fundamentals of Vehicle Dynamics. SAE Publication, ISBN 1-56091-199-9, 1992. [4] D. Bastow, G. Howard, J. P. Whitehead, Car Suspension and Handling. SAE International Publication, ISBN 0-7680-0872-7, 2004. [5] R. S. Sharp, A mathematical model for driver steering control, with design, tuning and performance results, Vehicle System Dynamics, Vol: 33, pp289-326, 2000. 20