Robust Nonlinear Predictive Control for Semiautonomous Ground Vehicles

Size: px
Start display at page:

Download "Robust Nonlinear Predictive Control for Semiautonomous Ground Vehicles"

Transcription

1 14 American Control Conference (ACC) June 4-6, 14. Portland, Oregon, USA Robust Nonlinear Predictive Control for Semiautonomous Ground Vehicles Yiqi Gao, Andrew Gray, Ashwin Carvalho, H. Eric Tseng, Francesco Borrelli Department of Mechanical Engineering, UC Berkeley, USA; Ford Motor Company, USA; Abstract This paper presents a robust control framework for lane-keeping and obstacle avoidance of semiautonomous ground vehicles. It presents a systematic way of enforcing robustness during the MPC design stage. A robust nonlinear Model Predictive Controller (RNMPC) is used to help the driver avoid obstacles and track the road center line. A forceinput nonlinear bicycle vehicle model is developed for the RNMPC control design. A robust invariant set is used in the RNMPC design to ensure robust satisfaction of state and input constraints in the presence of disturbances and model errors. Simulations and experiments on testing vehicles show the effectiveness of the proposed framework. Index Terms vehicle safety; uncertain dynamics; robust control; active safety; autonomous vehicles; robust nonlinear MPC I. INTRODUCTION Autonomous cars and smart active safety systems on cars have been drawing increasing attention recently [1], [], [3]. Such systems usually involve real-time generation and tracking of feasible trajectories for the vehicle. This is challenging when the vehicle travels at the limit of its handling capability. There are two main difficulties. First, trajectories generated by using oversimplified models violate system constraints, while computing trajectories using highfidelity vehicle models is computationally demanding. Second, uncertainties from a variety of sources might prevent the vehicle from following the desired paths and satisfying the safety constraints. Such uncertainties include measurement errors, friction coefficient estimation, driver behaviour and model mismatch. Because of its capability to systematically handle system nonlinearities and constraints, work in a wide operating region and close to the set boundary of admissible states and inputs, Model Predictive Control (MPC) is an attractive method to generate feasible trajectories and track them [4]. Parallel advances in theory and computing systems have enlarged the range of applications where real-time MPC can be applied [5], [6], [7], [8]. Previous work by the authors [9], [1], [11] have accounted the avoidance of pop-up obstacles through a hier- {yiqigao,ajgray,ashwinc,fborrelli}@berkeley.edu. htseng@ford.com. This material is based upon work supported by the National Science Foundation under Grant No. [13933]. Any opinions, findings, and conclusions or recommendations expressed in this material are those of the authors and do not necessarily reflect the views of the National Science Foundation. archical framework. The present work builds on the past success [4] and presents a systematic way of enforcing robustness during the MPC design stage. A robust nonlinear MPC framework [1], [13], [14], [15], [16], [17] is used in this paper. In particular we follow the Tube approach presented in [17] for nonlinear system where the inputs enter linearly in the state update equations. The basic idea is to use a control law of the form u = ū+k(ξ ξ) where ū and ξ are the nominal control input and system state trajectories. For a given linear controller K, a robust invariant set is computed for the error system. The invariant set is used to bound the maximum deviation of the actual states from the nominal states under the linear control action K. A nominal MPC optimizes ū and ξ with tightened state and input constraints. The tightening is computed as a function of the bounds derived from the robust invariant set. In the first part of the paper we propose a force-input nonlinear bicycle vehicle model. In the second part we show how to compute the robust invariant set utilizing the lipschitz constant of the nonlinear system. In the third part we use the robust invariant set computed off-line to tighten the state and input constraints for the nominal nonlinear MPC problem which computes obstacle-free trajectories and corresponding input sequences. Experiments in different scenarios show the effectiveness of the proposed approach. The paper is structured as follows. In section II the force-input nonlinear vehicle model is developed. Section III presents the Robust MPC framework and the computation of the robust invariant set. Section IV presents the safety constraints and section V formulates the Robust MPC problem. Finally, in section VI we present the experimental results showing the performance of the proposed controller. More details on MPC implementation and more test results can be found in [18]. II. MODELING In this section we present the mathematical models used for control design. A. Bicycle vehicle model Consider the vehicle sketch in Figure 1. We use equations (1) to describe the vehicle motion within the lane. In (1), m and denote the vehicle mass and yaw inertia, respectively, a and b denote the distances from the vehicle center of gravity to the front and rear axles, respectively. ẋ and ẏ denote the /$ AACC 4913

2 Fig. 1. Modeling notation depicting the forces in the vehicle body-fixed frame (F x and F y ), the forces in the tire-fixed frame (F l and F c ), and the rotational and translational velocities. The relative coordinates e y and e ψ are illustrated on the sketch of the road as well as the road tangent ψ d. Point P is the center of percussion as will be discussed in section II-B. vehicle longitudinal and lateral velocities, respectively, and ψ is the turning rate around a vertical axis at the vehicle s center of gravity. e ψ and e y in Figure 1 denote the vehicle orientation and lateral position, respectively, in a road aligned coordinate frame and ψ d is the angle of the tangent to the road centerline in a fixed coordinate frame. s is the vehicle longitudinal position along the desired path. mẍ = mẏ ψ + F xf + F xr, mÿ = mẋ ψ + F yf + F yr, ψ = afyf bf yr, ė ψ = ψ ψ d, ė y = ẏ cos(e ψ ) + ẋ sin(e ψ ), ṡ = ẋcos(e ψ ) ẏsin(e ψ ), (1a) (1b) (1c) (1d) (1e) (1f) Assumption 1: Only the steering angle at the front wheels can be controlled. i.e., δ f = δ and δ r =. The longitudinal and lateral tire forces F l and F c are given by Pacejka s model [19]. The nonlinear tire force model increases the computational burden of real-time model-based control techniques. We will approach this issue as follows. For the front wheels, since both slip angle and slip ratio can be controlled, it is valid to assume that any force within the friction circle can be achieved. Thus we will make the front tire forces F xf and F yf as the inputs to the model. For the rear wheels, however, the slip angles are not directly controllable due to Assumption 1 and are functions of the vehicle states. Thus the rear tire forces cannot be treated in the same way as the front tire forces. In the following subsections we will discuss how to simplify the rear tire force model. B. Center of percussion The center of percussion (CoP) is a point along the vehicle longitudinal axis where the rear tire lateral forces do not affect its dynamic evolution ([], [1]). As discussed in [1], the rear tire lateral forces have two effects on dynamics, a constant lateral acceleration on the vehicle body and an angular acceleration around the CoG. At the CoP these two effects cancel each other and thus ẏ p is not influenced by the rear tire forces. Figure 1 illustrates the concept of CoP. Note that ẋ p = ẋ. To find the position of the CoP, we refer to the following dynamic equations ẏ p = ẏ + p ψ ÿ p = ÿ + p ψ By substituting (1b) and (1c) into (b) we obtain (a) (b) ÿ p = ẋ ψ + ( m + ap )F yf + ( m bp )F yr. (3) When p = mb, the F yr term in (3) vanishes. C. Simplifying rear tire forces The use of the CoP eliminates the rear tire force in ÿ p. However, the rear tire forces are still present in the longitudinal and yaw dynamics ẍ p and ψ. We will use a linearized tire model for these terms. Let β r denote the braking/throttle ratio of rear tire (F lr = β r µf zr ), with β r =1 corresponding to max throttle and -1 max braking. In moderate braking, the resultant lateral tire force F c as a function of slip angle α has small sensitivity with respect to β r. Thus a constant linear gain can be used over β [.5 ] and over β [.5]. The remaining rear tire forces in (1a) and (1c) are modeled as: F lr = β r µf zr F cr = C r α r The slip angles α are approximated as follows: α f = ẏ + a ψ ẋ δ, (4a) (4b) α r = ẏ b ψ. (5) ẋ Remark 1: The same linearization could be applied to the F yr term in (1b). We decided to use CoP to eliminate it (Section II-B) to reduce the error introduced by the linearization. D. Force-input nonlinear bicycle model In summary, the nominal vehicle model (1) used for control design is rewritten as in (6) ÿ p = (a + b)µf zf β xf mb ẍ p = µf zf β xf m ψ = aµf zf β yf ė ψ = ψ ψ d, ė y = ẏ p + ẋ p e ψ, ṡ = ẋ p ψẋ p, (6a) + µf zrβ r m + ψẏ p ψ p, (6b) bc rẏ p ẋ p + bc r(b + p) ψ ẋ p, (6c) (6d) (6e) (6f) In (6) the states are ξ = [ẏ p, ẋ p, ψ, e ψ, e y, s] T R 6 1, and the inputs are u = [β xf, β yf, β r ] T R 3. β xf and β yf are the normalized longitudinal and lateral tire forces on the front wheels. 4914

3 III. ROBUST MPC AND INVARIANT SET A. Tube-based robust MPC for nonlinear systems In this section we outline the framework used to develop the robust model predictive controller in section V. We follow a notation similar to [13]. Consider the system: ξ k+1 = Aξ k + g(ξ k ) + Bu k + w k. s.t. ξ k Ξ u k U (7a) (7b) (7c) Where g( ) : R n R n is a nonlinear Lipschitz function and w k W R n is an additive disturbance. We assume that the matrix pair (A, B) is controllable. The control problem is divided into two parts. First a feedforward control input is computed for the system (7). System (7) with the computed feedforward input and a zero disturbance sequence will be called the nominal system. Then, we design a state feedback controller which acts on the error between the actual state of system (7) and the predicted state of the nominal system. Next we formalize the aforementioned ideas. We denote the N-step control sequence and the N- step disturbance sequence for system (7) as u = {u, u 1,..., u N 1 } and w = {w, w 1,..., w N 1 }, respectively. Let Φ(k, x, u, w) denote the solution of (7) at time k controlled by u when x = x. Furthermore, let Φ(k, x, ū) denote the solution of the nominal system: ξ k+i+1 = A ξ k+i + g( ξ k+i ) + Bū k+i, i =, 1,..., N 1. (8) Let e k = ξ k ξ k be the error between the states of system (7) and the nominal system. Let the input u k to system (7) be: u k = ū k + û(e k ), (9) where û(e k ) : R n R m. We define the error dynamics as: e k+1 = Ae k + Bû(e k ) + (g(ξ k ) g( ξ k )) + w k. (1) The authors of [13] proved the following result. Proposition 1: Suppose that Z is a Robust Positively Invariant Set[13] of the error system (1) with control law û( ). If ξ k { ξ k } Z, then ξ k+i { ξ k+i } Z for all i > and all admissible disturbance sequences w k+i W. Proposition 1 states that if the state ξ of system (7) starts close to the nominal state ξ, the control law (9) will keep the state trajectory Φ(k, x, u, w) within the robust positively invariant set Z centered at the predicted nominal states Φ(k, x, ū) for all admissible disturbance sequence w: ξ { ξ } Z ξ k { ξ k } Z w k W, k. (11) Proposition 1 also suggests that if a feasible solution can always be found for the nominal system (8) subject to the tightened constraints Ξ = Ξ Z, Ū = U û(z), (1) then the control law (9) will ensure constraint satisfaction for the controlled uncertain system (7) [15]. Remark : For general nonlinear systems, the controller and invariant set pair (û( ), Z) is usually hard to find. In the following section we will propose an algorithm for computing (û( ), Z) for a system in the form of (7), whose dynamics consist of a linear term Aξ + Bu and a small nonlinear term g(ξ). B. Computation of the robust invariant set The main idea is to bound the nonlinear term (g(ξ) g( ξ)) in (1) by using the Lipschitz constant of g( ), and treat it as part of the disturbance. We use the -norm over R n. The nonlinear function g(ξ) is Lipschitz in the set Ξ with respect to ξ if L > such that g(ξ 1 ) g(ξ ) L ξ 1 ξ, ξ 1, ξ Ξ. (13) The smallest constant L satisfying (13) is called the Lipschitz constant. Let L(Ξ) be the Lipschitz constant of g( ) over Ξ. From (13) we know ξ, ξ Ξ and e = (ξ ξ) E g(ξ) g( ξ) L(Ξ) max e E e, (14) where E is a subset of Ξ containing {}. The inequality in (14) defines a box B(E) = {x R n x L(Ξ) max e } and is used to bound the term (g(ξ k ) e E g( ξ k )) in (1). Equation (1) is then written as: e k+1 = Ae k + Bû(e k ) + w k, (15) where w k W = W B(E). Proposition : For ξ, ξ Ξ, If Z is a robust positively invariant set for system (15) with a control law û( ), then Z is a robust positively invariant set for system (1) with the same control law û( ). Proposition is true because all possible values of (g(ξ) g( ξ)) in (1) lies inside B(E). Since we assumed the matrix pair (A, B) to be controllable, there exists a stabilizing linear feedback gain K such that (A + BK) is Hurwitz. Algorithm 1 is used to compute the robust positively invariant set Z associated with the gain K. If Algorithm 1 terminates in finitely many iterations i t, Algorithm 1 Computation of Z 1: Ω {} : W W 3: i ; 4: repeat 5: i = i+1 6: W = W B(Ωi ); 7: Ω i = Reach fa (Ω i 1, W) Ω i 1. 8: until Ω i == Ω i 1 9: Z Ω i then Z = Ω it is the minimal positively invariant set for the uncertain system (15) []. We choose the stabilizing state feedback gain K to be the infinite horizon LQR solution KLQR for system (A, B). Therefore the controller (9) becomes: u k = ū k + K LQR(ξ k ξ k ). (16) 4915

4 C. Model reformulation The vehicle model (6) can be written in a similar form of (7): ξ = Aξ + g(ξ) + Bu + G + w, (17) The constraints (19)-(1) are compactly written as, h(ξ, u, w), () where is the zero vector with appropriate dimension. In (17), all nonlinear terms are collected in g( ) : R n R n. V. ROBUST PREDICTIVE CONTROL DESIGN The matrices in (17) are given in (18). In this section we present the MPC formulate for the lane keeping and obstacle avoidance problem. At each sampling ẋ p time instant an optimal input sequence is computed by A = bc r bc I ẋ p r (p+b) solving a constrained finite time optimal control problem. I ẋ p 1, The computed optimal control input sequence as well as the corresponding predicted vehicle state trajectory are stored 1 ẋ p as the nominal input and state trajectories, ξ and ū. At the 1 next time step the optimal control problem is solved staring ψ from new state measurements. An algorithm computes the ψẏ p ψ p augmented input u = ū + Ke at each sampling time. The bc r (ẏ p ẋ p (p+b) ψ ẋ p ) MPC and the computation of u can be executed at different g(ξ) = ẋ p( ẋ p+ ẋ p), (18a) sampling times. We discretize the system (17) with a fixed sampling time ẋ p e ψ T s to obtain, µf zf m + x aµf k+1 = f n ( x k, ū k ), (3) zf mb µf zf µf m zr m aµf B = zf and the nominal optimization problem with tightened con-, G = straints is formulated as in (4). In (4), t denotes the ψ d. current time instant and ξ t+k,t denotes the predicted state at time t + k obtained by applying the control sequence ū = {ū t,t,..., ū t+k,t } to (3) with ξ t,t = ξ(t). H p and H c denote the prediction horizon and control horizon, respectively. We (18b) denote by H i the input blocking factor to hold the ū k constant for a length of Hi. This reduces the number of Note ẋ p is rewritten as ẋ p = ẋ p + ẋ p. w represents an optimization variable which is useful in real-time implementation. The safety constraints () have been imposed as soft additive disturbance. We follow the approach described in section III-B to compute the positively invariant set Z. constraints, by introducing the slack variable ε in (4b) and IV. SAFETY CONSTRAINTS (4c). Q, R, S and λ are weights of appropriate dimension penalizing state tracking error, control action, change rate of control, and violation of the soft constraints, respectively. The main objective of the safety system proposed in this paper is to keep the vehicle on the road while avoiding obstacles. In this section, we detail the constraints imposed on the vehicle states and inputs to guarantees safe maneuvers. Road boundary constraint: we constrain the CoG of the vehicle and shrink the road bounds to take the vehicle width into account. The road boundary constraints are written as ē ymin e y ē ymax, (19) where ē ymin and ē ymax are obtained from the tightened state constraint Ξ. Obstacle avoiding constraint: consider ellipsoidal obstacles in the form ( s s obs a obs ) + ( ey y obs b obs ) 1. The obstacle avoiding constraints are written as ( s s obs s Z ) + ( e y y obs y Z ) 1, () a obs b obs where s Z and y Z are the projection of the invariant set onto s and e y axes. Slip angle constraint: we constrain the tire slip angles to belong to the linear region of the tire forces. α min α α max. (1) min ū,ε H p 1 k= ξ t+k,t ξ ref Q + ū t+k,t R ū t+k,t S + λε s.t. ξ t+k+1,t = f n ( ξ t+k,t, ū t+k,t ), k =, 1,..., H p 1 (4a) (4b) h t ( ξ t+k,t, ū t+k,t ) 1ε, k = 1,..., H p (4c) ε, ū t+k,t = ū t+k,t + ū t+k 1,t, (4d) (4e) ū t+k,t Ū, k =, 1,..., H c 1 (4f) ū t+k,t Ū, k =, 1,..., H c 1 (4g) ū t+k,t =, k = H c,..., H p (4h) ū t 1,t = ū(t 1), ξ t,t = ξ(t), (4i) (4j) Remark 3: Because of the system nonlinearities and time varying constraints, it is difficult to guarantee the feasibility of the nominal nonlinear MPC under all possible scenarios. 4916

5 However, if the nominal MPC is feasible, the vehicle is guaranteed to keep the actual trajectory within the robust bounds under any admissible disturbance. VI. EXPERIMENTAL RESULTS The experiments have been performed on two test vehicles with different surface conditions. We first tested the controller on Test Vehicle A at a test center equipped with icy and snowy handling tracks. Test Vehicle A has a mass of 5 Kg and a yaw inertia of 3344 Kg/m. It was equipped with an Active Front Steering (AFS) and Differential Braking system which utilizes an electric drive motor to change the relation between the hand steering wheel and road wheel angles. We used an Oxford Technical Solution R (OTS) RT3 sensing system to measure the vehicle position and orientation in the inertial frame and the vehicle velocities in the vehicle body frame. The OTS RT3 is housed in a small package that contains a differential GPS receiver, Inertial Measurement Unit (IMU) and a DSP. The IMU includes three accelerometers and three angular rate sensors. The DSP receives both the measurements from the IMU and the GPS, utilizes a Kalman filter for sensor fusion, and calculates the position, orientation and other states of the vehicle. The controller was run in a dspace R Autobox R system, equipped with a DS15 processor board and a DS1 I/O board. The sensor, the dspace R Autobox R, and the actuators communicate through a CAN bus. Test Vehicle B was used to test the controller on asphalt tracks. It has a mass of 1544 Kg and a yaw inertia of 3477 Kg/m. Test Vehicle B has similar instrumentation as Test Vehicle A with two main differences. First, it uses an Electric Power Steering system. Second, the longitudinal dynamics are controlled by a low level controller which achieves required longitudinal accelerations. The parameters used in the experiments are summarized in Table I. TABLE I REAL-TIME DESIGN PARAMETERS Param. Value Units Param. Value Units u max [,.5, ] [ ] H p 1 - u min [.5,.5, ] [ ] H c 8 - u max [,, ] [ ]/sec H i - u min [,, ] [ ]/sec T s 1 ms Q (1,, 5, 1) - R (1, 1, 1) - S (1, 1, 1) - Y [m] Actual path Nominal path Tube bound Center line X [m] Fig.. Experimental result: Test Vehicle A enters the maneuver at 8Kph on a snow track (µ.3). The dashed black line and blue line are the nominal and actual vehicle trajectories respectively. The green dot-dashed lines indicate the robust bounds around the nominal trajectory. The actual vehicle path is seen to be very close to the nominal one and within the robust bounds. δf [deg] Tbfl [Nm] Tbrl [Nm] Time [s] Fig. 3. Experimental result: The steering and braking input during the experiment of Fig. B. Robust performance against friction coefficient In this section we test the Test Vehicle A on an ice track with a tire-road friction coefficient around.1. The controller is set up for a nominal µ of.3, as it is on a snow track. The vehicle avoids the obstacle and tracks the center line at a speed of 35 kph. Figure 4 shows the trajectory of the vehicle during the maneuver and Figure 5 shows the inputs. C. Obstacle avoidance on high µ surface This section shows the test results with Test Vehicle B on an asphalt track. The vehicle travels on a two lane road. It avoids an obstacle by partially moving into the other lane. It then turns back and follows the original lane center. The behavior of the controller is consistent with different test vehicles on different surfaces. D. Computational time of the controller One advantage of the proposed controller is its low computational burden compared to other robust approaches we have A. Obstacle avoidance at high speed on low µ surface In this section we show the controller s ability to control the Test Vehicle A to avoid an obstacle on the snow track at high speeds. Figure show the trajectory of the vehicle, where the entering speed is 8kph. The dot-dashed lines denotes the bounds of the invariant set. The vehicle successfully avoids the obstacle and returns back to the lane center. Figure 3 shows the input from the controller in the same trial. We observe a brief braking at the beginning of the maneuver similar as we see in the simulation. Y [m] Actual path Nominal path Tube bound Center line X [m] Fig. 4. Experimental result: Trajectory of Test Vehicle A on an ice track. The vehicle enters the maneuver at 35Kph. The actual µ on the track is.1, while the controller is set up for µ =.3 on snow track. 4917

6 δf [deg] Tbfl [Nm] Tbrl [Nm] Time [s] δf [deg] Tbfl [Nm] Tbrl [Nm] Time [s] Fig. 5. Experimental result: The steering and braking input during the experiment of Fig 4. Fig. 7. Experimental result: The steering and braking input during the experiment of Fig 6. Y [m] 6 4 Actual path Tube bound Center line Lane marker X [m] Fig. 6. Experimental result: Test Vehicle B enters the maneuver at 55Kph on a two lane road. It avoids the obstacle by moving into the adjacent lane and gets back to the original one afterwards. tried in our lab. Since the invariant set was computed offline, the on-line computational burden of the robust controller is almost the same as the nominal MPC. For the four tests reported previously, the average processing time was 59.6 ms and the maximum was 71.6 ms, both below the sampling time of 1ms. VII. CONCLUSIONS This paper presents a robust control framework for lane keeping and obstacle avoidance. The framework formulates the problem as a nonlinear model predictive control problem. A force-input nonlinear bicycle model is developed and used in the control design. A robust positively invariant set is computed for a given control law and a Robust NMPC is used with tightened input and state constraints to ensure constraint satisfaction in the presence of unknown disturbances. Successful results from simulations and experimental tests on test vehicles show the effectiveness of the proposed framework. REFERENCES [1] D. Dolgov, S. T. M. Montemerlo, and J. Diebel, Path planning for autonomous vehicles in unknown semi-structured environments, The International Journal of Robotics Research, 1. [] S. J. Anderson, S. C. Peters, T. E. Pilutti, and K. Iagnemma, An optimal-control-based framework for trajectory planning, threat assessment, and semi-autonomous control of passenger vehicles in hazard avoidance scenarios, International Journal of Vehicle Autonomous Systems, vol. 8, pp , 1. [3] J. Funke and J. C. Gerdes, Simple clothoid paths for autonomous vehicle lane changes at the limits of handling, 6th Annual Dynamic Systems and Control Conference, 13. [4] P. Falcone, F. Borrelli, J. Asgari, H. E. Tseng, and D. Hrovat, Low complexity mpc schemes for integrated vehicle dynamics control problems, 9 th International Symposium on Advanced Vehicle Control, 8. [5] F. Borrelli, A. Bemporad, M. Fodor, and D. Hrovat, An MPC/hybrid system approach to traction control, IEEE Trans. Control Systems Technology, vol. 14, no. 3, pp , May 6. [6] T. Keviczky and G. J. Balas, Flight test of a receding horizon controller for autonomous uav guidance, 5. [7] H. J. Ferrau, H. G. Bock, and M. Diehl, An online active set strategy for fast parametric quadtratic programming in mpc applications, IFAC Workshop on Nonlinear Model Predictive Control for Fast Systems, plenary talk, 6. [8] V. M. Zavala, C. D. Laird, and L. T. Biegler, Fast solvers and rigorous models: Can both be accomodated in nmpc, IFAC Workshop on Nonlinear Model Predictive Control for Fast Systems, 6. [9] Y. Gao, T. Lin, F. Borrelli, E. Tseng, and D. Hrovat, Predictive control of autonomous ground vehicles with obstacle avoidance on slippery roads, Dynamic Systems and Control Conference, 1. [1] Y. Gao, A. Gray, J. V. Frasch, T. Lin, E. Tseng, J. K. Hedrick, and F. Borrelli, Spatial predictive control for agile semi-autonomous ground vehicles, 11th International Symposuim on Advanced Vechile Control,, 1. [11] A. Gray, Y. Gao, T. Lin, J. K. Hedrick, E. Tseng, and F. Borrelli, Predictive control for agile semi-autonomous ground vehicles using motion primitives, American Control Conference,1, 1. [1] W. Langson, I. Chryssochoos, S. V. Rakovic, and D. Mayne, Robust model predictive control using tubes, Automatica, vol. 4(1), pp , 4. [13] D. Q. Mayne, M. M. Seron, and S. V. Rakovic, Robust model predictive control of constrained linear systems with bounded disturbances, Automatica, vol. 41(), pp. 19 4, 5. [14] M. N. Zeilinger, C. N. Jones, D. M. Raimondo, and M. Morari, Real-time mpc stability through robust mpc design, Joint 48th IEEE Conference on Decision and Control and 8th Chinese Control Conference, 9. [15] M. Balandat, Constrained robust optimal trajectory tracking: Model predictive control approaches, Master s thesis, Technische Universitat Darmstadt, 1. [16] D. Q. Mayne, E. C. Kerrigan, E. J. vanwyk, and P. Falugi, Tube-based robust nonlinear model predictive control, International Journal of Robust and Nonlinear Control, vol. 1, pp , 11. [17] S. Yu, H. Chen, and F. Allgower, Tube mpc scheme based on robust control invariant set with application to lipschitz nonlinear systems, 5th IEEE Conference on Decision and Control and European Control Conference, 11. [18] Y. Gao, A. Gray, H. E. Tseng, and F. Borrelli, A tube-based robust nonlinear predictive control approach to semiautonomous ground vehicles, Submitted to Vehicle System Dynamics for publication, to appear 14. [19] H. B. Pacejka, Tyre and Vehicle Dynamics. Elsevier Science, 5. [] W. F. Milliken and D. L. Milliken, Chassis Design: Principles and Analysis. Society of Automotive Engineers,. [1] K. Kritayakirana and J. C. Gerdes, Using the center of percussion to design a steering controller for an autonomous race car, Vehicle System Dynamics: International Journal of Vehicle Mechanics and Mobility, 1. [] S. V. Rakovic, E. C. Kerrigan, K. I. Kouramas, and D. Q. Mayne, Invariant approximations of the minimal robust positively invariant set, IEEE Transactions on Automatic Control, vol. 5,

Spatial Predictive Control for Agile Semi-Autonomous Ground Vehicles

Spatial Predictive Control for Agile Semi-Autonomous Ground Vehicles Spatial Predictive Control for Agile Semi-Autonomous Ground Vehicles Yiqi Gao*, Andrew Gray*, Janick V. Frasch, Theresa Lin*, Eric Tseng, J. Karl Hedrick*, Francesco Borrelli* *Department of Mechanical

More information

Model Predictive Control for Autonomous and Semiautonomous Vehicles. Yiqi Gao

Model Predictive Control for Autonomous and Semiautonomous Vehicles. Yiqi Gao Model Predictive Control for Autonomous and Semiautonomous Vehicles by Yiqi Gao A dissertation submitted in partial satisfaction of the requirements for the degree of Doctor of Philosophy in Engineering

More information

PREDICTIVE CONTROL OF AUTONOMOUS GROUND VEHICLES WITH OBSTACLE AVOIDANCE ON SLIPPERY ROADS

PREDICTIVE CONTROL OF AUTONOMOUS GROUND VEHICLES WITH OBSTACLE AVOIDANCE ON SLIPPERY ROADS PREDICTIVE CONTROL OF AUTONOMOUS GROUND VEHICLES WITH OBSTACLE AVOIDANCE ON SLIPPERY ROADS Yiqi Gao Theresa Lin Francesco Borrelli Department of Mechanical Engineering University of California Berkeley,

More information

Robust Predictive Control for Semi-Autonomous Vehicles with an Uncertain Driver Model

Robust Predictive Control for Semi-Autonomous Vehicles with an Uncertain Driver Model 213 IEEE Intelligent Vehicles Symposium (IV) June 23-26, 213, Gold Coast, Australia Robust Predictive Control for Semi-Autonomous Vehicles with an Uncertain Driver Model Andrew Gray, Yiqi Gao, J. Karl

More information

Semi-Autonomous Vehicle Control for Road Departure and Obstacle Avoidance

Semi-Autonomous Vehicle Control for Road Departure and Obstacle Avoidance Semi-Autonomous Vehicle Control for Road Departure and Obstacle Avoidance Andrew Gray Mohammad Ali, Yiqi Gao J. Karl Hedrick Francesco Borrelli Mechanical Engineering, University of California, Berkeley,

More information

A Model Predictive Control Approach for Combined Braking and Steering in Autonomous Vehicles

A Model Predictive Control Approach for Combined Braking and Steering in Autonomous Vehicles A Model Predictive Control Approach for Combined Braking and Steering in Autonomous Vehicles Paolo Falcone, Francesco Borrelli, Jahan Asgari, H. Eric Tseng, Davor Hrovat Università del Sannio, Dipartimento

More information

Robust Vehicle Stability Control with an Uncertain Driver Model

Robust Vehicle Stability Control with an Uncertain Driver Model 23 European Control Conference (ECC) July 7-9, 23, Zürich, Switzerland. Robust Vehicle Stability Control with an Uncertain Driver Model Ashwin Carvalho, Giovanni Palmieri*, H. Eric Tseng, Luigi Glielmo*,

More information

Low Complexity MPC Schemes for Integrated Vehicle Dynamics Control Problems

Low Complexity MPC Schemes for Integrated Vehicle Dynamics Control Problems AVEC 8 Low Complexity MPC Schemes for Integrated Vehicle Dynamics Control Problems Paolo Falcone, a Francesco Borrelli, b H. Eric Tseng, Jahan Asgari, Davor Hrovat c a Department of Signals and Systems,

More information

Predictive Active Steering Control for Autonomous Vehicle Systems

Predictive Active Steering Control for Autonomous Vehicle Systems IEEE TRANSACTION OF CONTROL SYSTEMS TECHNOLOGY, VOL., NO., JANUARY 7 1 Predictive Active Steering Control for Autonomous Vehicle Systems P. Falcone, F. Borrelli, J. Asgari, H. E. Tseng, D. Hrovat Abstract

More information

Torque Based Lane Change Assistance with Active Front Steering

Torque Based Lane Change Assistance with Active Front Steering Torque Based Lane Change Assistance with Active Front Steering Monimoy Bujarbaruah, Ziya Ercan, Vladimir Ivanovic, H. Eric Tseng, Francesco Borrelli Authors contributed equally. University of California

More information

Analysis and Control of Nonlinear Actuator Dynamics Based on the Sum of Squares Programming Method

Analysis and Control of Nonlinear Actuator Dynamics Based on the Sum of Squares Programming Method Analysis and Control of Nonlinear Actuator Dynamics Based on the Sum of Squares Programming Method Balázs Németh and Péter Gáspár Abstract The paper analyses the reachability characteristics of the brake

More information

EE C128 / ME C134 Feedback Control Systems

EE C128 / ME C134 Feedback Control Systems EE C128 / ME C134 Feedback Control Systems Lecture Additional Material Introduction to Model Predictive Control Maximilian Balandat Department of Electrical Engineering & Computer Science University of

More information

Stochastic Predictive Control for Semi-Autonomous Vehicles with an Uncertain Driver Model

Stochastic Predictive Control for Semi-Autonomous Vehicles with an Uncertain Driver Model Proceedings of the 16th International IEEE Annual Conference on Intelligent Transportation Systems (ITSC 213), The Hague, The Netherlands, October 6-9, 213 WeC62 Stochastic Predictive Control for Semi-Autonomous

More information

Learning Model Predictive Control for Iterative Tasks: A Computationally Efficient Approach for Linear System

Learning Model Predictive Control for Iterative Tasks: A Computationally Efficient Approach for Linear System Learning Model Predictive Control for Iterative Tasks: A Computationally Efficient Approach for Linear System Ugo Rosolia Francesco Borrelli University of California at Berkeley, Berkeley, CA 94701, USA

More information

1 INTRODUCTION 2 PROBLEM DEFINITION

1 INTRODUCTION 2 PROBLEM DEFINITION Autonomous cruise control with cut-in target vehicle detection Ashwin Carvalho, Alek Williams, Stéphanie Lefèvre & Francesco Borrelli Department of Mechanical Engineering University of California Berkeley,

More information

Estimation of Tire-Road Friction by Tire Rotational Vibration Model

Estimation of Tire-Road Friction by Tire Rotational Vibration Model 53 Research Report Estimation of Tire-Road Friction by Tire Rotational Vibration Model Takaji Umeno Abstract Tire-road friction is the most important piece of information used by active safety systems.

More information

Robust Model Predictive Control for Autonomous Vehicle/Self-Driving Cars

Robust Model Predictive Control for Autonomous Vehicle/Self-Driving Cars Robust Model Predictive Control for Autonomous Vehicle/Self-Driving Cars Che Kun Law, Darshit Dalal, Stephen Shearrow A robust Model Predictive Control (MPC) approach for controlling front steering of

More information

A Robust Lateral Vehicle Dynamics Control

A Robust Lateral Vehicle Dynamics Control AVEC 1 A Robust Lateral Vehicle Dynamics Control Giovanni Palmieri*, Miroslav Barić, Francesco Borrelli, Luigi Glielmo* *Engineering Department, Università degli Studi del Sannio, 821, Italy Department

More information

Postprint. This is the accepted version of a paper presented at IEEE Conference on Decision and Control.

Postprint.   This is the accepted version of a paper presented at IEEE Conference on Decision and Control. http://www.diva-portal.org Postprint This is the accepted version of a paper presented at IEEE Conference on Decision and Control. Citation for the original published paper: Lima, P F., Mårtensson, J.,

More information

Robust Learning Model Predictive Control for Uncertain Iterative Tasks: Learning From Experience

Robust Learning Model Predictive Control for Uncertain Iterative Tasks: Learning From Experience Robust Learning Model Predictive Control for Uncertain Iterative Tasks: Learning From Experience Ugo Rosolia, Xiaojing Zhang, and Francesco Borrelli Abstract We present a Robust Learning Model Predictive

More information

Theory in Model Predictive Control :" Constraint Satisfaction and Stability!

Theory in Model Predictive Control : Constraint Satisfaction and Stability! Theory in Model Predictive Control :" Constraint Satisfaction and Stability Colin Jones, Melanie Zeilinger Automatic Control Laboratory, EPFL Example: Cessna Citation Aircraft Linearized continuous-time

More information

Model-Based Threat Assessment in Semi-Autonomous Vehicles with Model Parameter Uncertainties

Model-Based Threat Assessment in Semi-Autonomous Vehicles with Model Parameter Uncertainties Model-Based Threat Assessment in Semi-Autonomous Vehicles with Model Parameter Uncertainties Mohammad Ali, Paolo Falcone and Jonas Sjöberg Abstract In this paper, we consider model-based threat assessment

More information

arxiv: v2 [cs.sy] 30 Nov 2018

arxiv: v2 [cs.sy] 30 Nov 2018 AVEC 18 Adaptive MPC for Autonomous Lane Keeping arxiv:186.4335v2 [cs.sy] 3 Nov 218 Monimoy Bujarbaruah & Xiaojing Zhang & Francesco Borrelli Department of Mechanical Engineering University of California

More information

LTV-MPC Approach for Lateral Vehicle Guidance by Front Steering at the Limits of Vehicle Dynamics

LTV-MPC Approach for Lateral Vehicle Guidance by Front Steering at the Limits of Vehicle Dynamics 2011 50th IEEE Conference on Decision and Control and European Control Conference (CDC-ECC) Orlando, FL, USA, December 12-15, 2011 LTV-MPC Approach for Lateral Vehicle Guidance by Front Steering at the

More information

Vehicle Parameter Identification and its Use in Control for Safe Path Following. Sanghyun Hong

Vehicle Parameter Identification and its Use in Control for Safe Path Following. Sanghyun Hong Vehicle Parameter Identification and its Use in Control for Safe Path Following by Sanghyun Hong A dissertation submitted in partial satisfaction of the requirements for the degree of Doctor of Philosophy

More information

2nd International Conference on Electronic & Mechanical Engineering and Information Technology (EMEIT-2012)

2nd International Conference on Electronic & Mechanical Engineering and Information Technology (EMEIT-2012) Estimation of Vehicle State and Road Coefficient for Electric Vehicle through Extended Kalman Filter and RS Approaches IN Cheng 1, WANG Gang 1, a, CAO Wan-ke 1 and ZHOU Feng-jun 1, b 1 The National Engineering

More information

Single-track models of an A-double heavy vehicle combination

Single-track models of an A-double heavy vehicle combination Single-track models of an A-double heavy vehicle combination PETER NILSSON KRISTOFFER TAGESSON Department of Applied Mechanics Division of Vehicle Engineering and Autonomous Systems Vehicle Dynamics Group

More information

A Unified Framework for Trajectory Planning, Threat Assessment, and Semi-Autonomous Control of Passenger Vehicles

A Unified Framework for Trajectory Planning, Threat Assessment, and Semi-Autonomous Control of Passenger Vehicles A Unified Framework for Trajectory Planning, Threat Assessment, and Semi-Autonomous Control of Passenger Vehicles by Sterling J Anderson Bachelor of Science in Mechanical Engineering Brigham Young University

More information

arxiv: v2 [cs.sy] 23 Jun 2017

arxiv: v2 [cs.sy] 23 Jun 2017 A Simple Dynamic Model for Aggressive, Near-Limits Trajectory Planning Florent Altché,1, Philip Polack 1 and Arnaud de La Fortelle 1 arxiv:173.1v [cs.sy] 3 Jun 17 Abstract In normal on-road situations,

More information

Improving EV Lateral Dynamics Control Using Infinity Norm Approach with Closed-form Solution

Improving EV Lateral Dynamics Control Using Infinity Norm Approach with Closed-form Solution Improving EV Lateral Dynamics Control Using Infinity Norm Approach with Closed-form Solution Alexander Viehweider Dept. of Advanced Energy The University of Tokyo, 5-1-5 Kashiwanoha, Kashiwa, Chiba, Japan

More information

IEOR 265 Lecture 14 (Robust) Linear Tube MPC

IEOR 265 Lecture 14 (Robust) Linear Tube MPC IEOR 265 Lecture 14 (Robust) Linear Tube MPC 1 LTI System with Uncertainty Suppose we have an LTI system in discrete time with disturbance: x n+1 = Ax n + Bu n + d n, where d n W for a bounded polytope

More information

Stochastic Model Predictive Controller with Chance Constraints for Comfortable and Safe Driving Behavior of Autonomous Vehicles

Stochastic Model Predictive Controller with Chance Constraints for Comfortable and Safe Driving Behavior of Autonomous Vehicles Stochastic Model Predictive Controller with Chance Constraints for Comfortable and Safe Driving Behavior of Autonomous Vehicles David Lenz 1 and Tobias Kessler 1 and Alois Knoll Abstract In this paper,

More information

Stochastic Tube MPC with State Estimation

Stochastic Tube MPC with State Estimation Proceedings of the 19th International Symposium on Mathematical Theory of Networks and Systems MTNS 2010 5 9 July, 2010 Budapest, Hungary Stochastic Tube MPC with State Estimation Mark Cannon, Qifeng Cheng,

More information

Time-Optimal Automobile Test Drives with Gear Shifts

Time-Optimal Automobile Test Drives with Gear Shifts Time-Optimal Control of Automobile Test Drives with Gear Shifts Christian Kirches Interdisciplinary Center for Scientific Computing (IWR) Ruprecht-Karls-University of Heidelberg, Germany joint work with

More information

FINITE HORIZON ROBUST MODEL PREDICTIVE CONTROL USING LINEAR MATRIX INEQUALITIES. Danlei Chu, Tongwen Chen, Horacio J. Marquez

FINITE HORIZON ROBUST MODEL PREDICTIVE CONTROL USING LINEAR MATRIX INEQUALITIES. Danlei Chu, Tongwen Chen, Horacio J. Marquez FINITE HORIZON ROBUST MODEL PREDICTIVE CONTROL USING LINEAR MATRIX INEQUALITIES Danlei Chu Tongwen Chen Horacio J Marquez Department of Electrical and Computer Engineering University of Alberta Edmonton

More information

Adaptive Dynamic Inversion Control of a Linear Scalar Plant with Constrained Control Inputs

Adaptive Dynamic Inversion Control of a Linear Scalar Plant with Constrained Control Inputs 5 American Control Conference June 8-, 5. Portland, OR, USA ThA. Adaptive Dynamic Inversion Control of a Linear Scalar Plant with Constrained Control Inputs Monish D. Tandale and John Valasek Abstract

More information

Jurnal Teknologi IMPLEMENTATION OF ROBUST COMPOSITE NONLINEAR FEEDBACK FOR ACTIVE FRONT STEERING BASED VEHICLE YAW STABILITY.

Jurnal Teknologi IMPLEMENTATION OF ROBUST COMPOSITE NONLINEAR FEEDBACK FOR ACTIVE FRONT STEERING BASED VEHICLE YAW STABILITY. Jurnal Teknologi IMPLEMENTATION OF ROBUST COMPOSITE NONLINEAR FEEDBACK FOR ACTIVE FRONT STEERING BASED VEHICLE YAW STABILITY Mohd Hanif Che Hasan a*, Yahaya Md Sam b, Muhamad Khairi Aripin c, Mohamad Haniff

More information

A Control Matching-based Predictive Approach to String Stable Vehicle Platooning

A Control Matching-based Predictive Approach to String Stable Vehicle Platooning Preprints of the 19th World Congress The International Federation of Automatic Control Cape Town, South Africa. August 24-29, 214 A Control Matching-based Predictive Approach to String Stable Vehicle Platooning

More information

Design of a Robust Adaptive Vehicle Observer Towards Delayed and Missing Vehicle Dynamics Sensor Signals by Usage of Markov Chains

Design of a Robust Adaptive Vehicle Observer Towards Delayed and Missing Vehicle Dynamics Sensor Signals by Usage of Markov Chains Design of a Robust Adaptive Vehicle Observer Towards Delayed and Missing Vehicle Dynamics Sensor Signals by Usage of Markov Chains Matthias Korte 1, Gerd Kaiser 1,Frederic Holzmann 1 and Hubert Roth 2

More information

Towards Time-Optimal Race Car Driving using Nonlinear MPC in Real-Time

Towards Time-Optimal Race Car Driving using Nonlinear MPC in Real-Time 53rd IEEE Conference on Decision and Control December 15-17, 214. Los Angeles, California, USA Towards Time-Optimal Race Car Driving using Nonlinear MPC in Real-Time Robin Verschueren, Stijn De Bruyne,

More information

Reference Governor for Constrained Piecewise Affine Systems

Reference Governor for Constrained Piecewise Affine Systems Reference Governor for Constrained Piecewise Affine Systems Francesco Borrelli a,, Paolo Falcone b, Jaroslav Pekar c, Greg Stewart d a Department of Mechanical Engineering, University of California, Berkeley,

More information

Draft 01PC-73 Sensor fusion for accurate computation of yaw rate and absolute velocity

Draft 01PC-73 Sensor fusion for accurate computation of yaw rate and absolute velocity Draft PC-73 Sensor fusion for accurate computation of yaw rate and absolute velocity Fredrik Gustafsson Department of Electrical Engineering, Linköping University, Sweden Stefan Ahlqvist, Urban Forssell,

More information

Distributed Receding Horizon Control of Cost Coupled Systems

Distributed Receding Horizon Control of Cost Coupled Systems Distributed Receding Horizon Control of Cost Coupled Systems William B. Dunbar Abstract This paper considers the problem of distributed control of dynamically decoupled systems that are subject to decoupled

More information

Hierarchical steering control for a front wheel drive automated car

Hierarchical steering control for a front wheel drive automated car Hierarchical steering control for a front wheel drive automated car Sándor Beregi, Dénes Takács, Chaozhe R. He, Sergei S. Avedisov, Gábor Orosz Department of Applied Mechanics, Budapest University of Technology

More information

Autonomous Car Following: A Learning-Based Approach

Autonomous Car Following: A Learning-Based Approach Autonomous Car Following: A Learning-Based Approach Stéphanie Lefèvre, Ashwin Carvalho, Francesco Borrelli Abstract We propose a learning-based method for the longitudinal control of an autonomous vehicle

More information

Fault diagnosis for vehicle lateral dynamics with robust threshold

Fault diagnosis for vehicle lateral dynamics with robust threshold Loughborough University Institutional Repository Fault diagnosis for vehicle lateral dynamics with robust threshold This item was submitted to Loughborough University's Institutional Repository by the/an

More information

ACTIVE DIRECT TILT CONTROL FOR STABILITY ENHANCEMENT OF A NARROW COMMUTER VEHICLE

ACTIVE DIRECT TILT CONTROL FOR STABILITY ENHANCEMENT OF A NARROW COMMUTER VEHICLE International Journal of Automotive Technology, Vol. 5, No. 2, pp. 77 88 (24) Copyright 24 KSAE 1229 9138/24/16 2 ACTIVE DIRECT TILT CONTROL FOR STABILITY ENHANCEMENT OF A NARROW COMMUTER VEHICLE D. PIYABONGKARN,

More information

Lateral Path-Following Control for Automated Vehicle Platoons

Lateral Path-Following Control for Automated Vehicle Platoons Lateral Path-Following Control for Automated Vehicle Platoons Master of Science Thesis Delft Center for Systems and Control Lateral Path-Following Control for Automated Vehicle Platoons Master of Science

More information

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

Handling Roll Constraints for Path Following of Marine Surface Vessels using Coordinated Rudder and Propulsion Control 2010 American Control Conference Marriott Waterfront, Baltimore, MD, USA June 30-July 02, 2010 FrB15.5 Handling Roll Constraints for Path Following of Marine Surface Vessels using Coordinated Rudder and

More information

Comparison of two non-linear model-based control strategies for autonomous vehicles

Comparison of two non-linear model-based control strategies for autonomous vehicles Comparison of two non-linear model-based control strategies for autonomous vehicles E. Alcala*, L. Sellart**, V. Puig*, J. Quevedo*, J. Saludes*, D. Vázquez** and A. López** * Supervision & Security of

More information

On robustness of suboptimal min-max model predictive control *

On robustness of suboptimal min-max model predictive control * Manuscript received June 5, 007; revised Sep., 007 On robustness of suboptimal min-max model predictive control * DE-FENG HE, HAI-BO JI, TAO ZHENG Department of Automation University of Science and Technology

More information

FEEDFORWARD COMPENSATION FOR LATERAL CONTROL OF HEAVY VEHICLES FOR AUTOMATED HIGHWAY SYSTEM (AHS)

FEEDFORWARD COMPENSATION FOR LATERAL CONTROL OF HEAVY VEHICLES FOR AUTOMATED HIGHWAY SYSTEM (AHS) Copyright IFAC 5th Triennial World Congress, Barcelona, Spain FEEDFORWARD COMPENSATION FOR LATERAL CONTROL OF HEAVY VEHICLES FOR AUTOMATED HIGHWAY SYSTEM (AHS) Meihua Tai, Masayoshi Tomizuka Department

More information

Decentralized Formation Control including Collision Avoidance

Decentralized Formation Control including Collision Avoidance Decentralized Formation Control including Collision Avoidance Nopthawat Kitudomrat Fujita Lab Dept. of Mechanical and Control Engineering Tokyo Institute of Technology FL07-16-1 Seminar 01/10/2007 1 /

More information

We provide two sections from the book (in preparation) Intelligent and Autonomous Road Vehicles, by Ozguner, Acarman and Redmill.

We provide two sections from the book (in preparation) Intelligent and Autonomous Road Vehicles, by Ozguner, Acarman and Redmill. We provide two sections from the book (in preparation) Intelligent and Autonomous Road Vehicles, by Ozguner, Acarman and Redmill. 2.3.2. Steering control using point mass model: Open loop commands We consider

More information

The ϵ-capacity of a gain matrix and tolerable disturbances: Discrete-time perturbed linear systems

The ϵ-capacity of a gain matrix and tolerable disturbances: Discrete-time perturbed linear systems IOSR Journal of Mathematics (IOSR-JM) e-issn: 2278-5728, p-issn: 2319-765X. Volume 11, Issue 3 Ver. IV (May - Jun. 2015), PP 52-62 www.iosrjournals.org The ϵ-capacity of a gain matrix and tolerable disturbances:

More information

Stable Hierarchical Model Predictive Control Using an Inner Loop Reference Model

Stable Hierarchical Model Predictive Control Using an Inner Loop Reference Model Stable Hierarchical Model Predictive Control Using an Inner Loop Reference Model Chris Vermillion Amor Menezes Ilya Kolmanovsky Altaeros Energies, Cambridge, MA 02140 (e-mail: chris.vermillion@altaerosenergies.com)

More information

Nonlinear Reference Tracking with Model Predictive Control: An Intuitive Approach

Nonlinear Reference Tracking with Model Predictive Control: An Intuitive Approach onlinear Reference Tracking with Model Predictive Control: An Intuitive Approach Johannes Köhler, Matthias Müller, Frank Allgöwer Abstract In this paper, we study the system theoretic properties of a reference

More information

NONLINEAR BACKSTEPPING DESIGN OF ANTI-LOCK BRAKING SYSTEMS WITH ASSISTANCE OF ACTIVE SUSPENSIONS

NONLINEAR BACKSTEPPING DESIGN OF ANTI-LOCK BRAKING SYSTEMS WITH ASSISTANCE OF ACTIVE SUSPENSIONS NONLINEA BACKSTEPPING DESIGN OF ANTI-LOCK BAKING SYSTEMS WITH ASSISTANCE OF ACTIVE SUSPENSIONS Wei-En Ting and Jung-Shan Lin 1 Department of Electrical Engineering National Chi Nan University 31 University

More information

Nonlinear and robust MPC with applications in robotics

Nonlinear and robust MPC with applications in robotics Nonlinear and robust MPC with applications in robotics Boris Houska, Mario Villanueva, Benoît Chachuat ShanghaiTech, Texas A&M, Imperial College London 1 Overview Introduction to Robust MPC Min-Max Differential

More information

Controllers for an Autonomous Vehicle Treating Uncertainties as Deterministic Values. Chan Kyu Lee

Controllers for an Autonomous Vehicle Treating Uncertainties as Deterministic Values. Chan Kyu Lee Controllers for an Autonomous Vehicle Treating Uncertainties as Deterministic Values by Chan Kyu Lee A dissertation submitted in partial satisfaction of the requirements for the degree of Doctor of Philosophy

More information

IMPROVED MPC DESIGN BASED ON SATURATING CONTROL LAWS

IMPROVED MPC DESIGN BASED ON SATURATING CONTROL LAWS IMPROVED MPC DESIGN BASED ON SATURATING CONTROL LAWS D. Limon, J.M. Gomes da Silva Jr., T. Alamo and E.F. Camacho Dpto. de Ingenieria de Sistemas y Automática. Universidad de Sevilla Camino de los Descubrimientos

More information

Design of observers for Takagi-Sugeno fuzzy models for Fault Detection and Isolation

Design of observers for Takagi-Sugeno fuzzy models for Fault Detection and Isolation Design of observers for Takagi-Sugeno fuzzy models for Fault Detection and Isolation Abdelkader Akhenak, Mohammed Chadli, José Ragot and Didier Maquin Institut de Recherche en Systèmes Electroniques Embarqués

More information

ESTIMATION OF THE LONGITUDINAL AND LATERAL VELOCITIES OF A VEHICLE USING EXTENDED KALMAN FILTERS

ESTIMATION OF THE LONGITUDINAL AND LATERAL VELOCITIES OF A VEHICLE USING EXTENDED KALMAN FILTERS ESTIMATION OF THE LONGITUDINAL AND LATERAL VELOCITIES OF A VEHICLE USING EXTENDED KALMAN FILTERS A Thesis Presented to The Academic Faculty by Juan Camilo Alvarez In Partial Fulfillment of the Requirements

More information

NONLINEAR CONTROLLER DESIGN FOR ACTIVE SUSPENSION SYSTEMS USING THE IMMERSION AND INVARIANCE METHOD

NONLINEAR CONTROLLER DESIGN FOR ACTIVE SUSPENSION SYSTEMS USING THE IMMERSION AND INVARIANCE METHOD NONLINEAR CONTROLLER DESIGN FOR ACTIVE SUSPENSION SYSTEMS USING THE IMMERSION AND INVARIANCE METHOD Ponesit Santhanapipatkul Watcharapong Khovidhungij Abstract: We present a controller design based on

More information

ELEC4631 s Lecture 2: Dynamic Control Systems 7 March Overview of dynamic control systems

ELEC4631 s Lecture 2: Dynamic Control Systems 7 March Overview of dynamic control systems ELEC4631 s Lecture 2: Dynamic Control Systems 7 March 2011 Overview of dynamic control systems Goals of Controller design Autonomous dynamic systems Linear Multi-input multi-output (MIMO) systems Bat flight

More information

On the Inherent Robustness of Suboptimal Model Predictive Control

On the Inherent Robustness of Suboptimal Model Predictive Control On the Inherent Robustness of Suboptimal Model Predictive Control James B. Rawlings, Gabriele Pannocchia, Stephen J. Wright, and Cuyler N. Bates Department of Chemical & Biological Engineering Computer

More information

A Stable Block Model Predictive Control with Variable Implementation Horizon

A Stable Block Model Predictive Control with Variable Implementation Horizon American Control Conference June 8-,. Portland, OR, USA WeB9. A Stable Block Model Predictive Control with Variable Implementation Horizon Jing Sun, Shuhao Chen, Ilya Kolmanovsky Abstract In this paper,

More information

Robust H Design of an Automotive Cruise Control System

Robust H Design of an Automotive Cruise Control System Robust H Design of an Automotive Cruise Control System Balázs Németh Péter Gáspár Rodolfo Orjuela Michel Basset Systems and Control Laboratory, Institute for Computer Science and Control, Hungarian Academy

More information

Chapter 3 Numerical Methods

Chapter 3 Numerical Methods Chapter 3 Numerical Methods Part 3 3.4 Differential Algebraic Systems 3.5 Integration of Differential Equations 1 Outline 3.4 Differential Algebraic Systems 3.4.1 Constrained Dynamics 3.4.2 First and Second

More information

Simple Car Dynamics. Outline. Claude Lacoursière HPC2N/VRlab, Umeå Universitet, Sweden, May 18, 2005

Simple Car Dynamics. Outline. Claude Lacoursière HPC2N/VRlab, Umeå Universitet, Sweden, May 18, 2005 Simple Car Dynamics Claude Lacoursière HPC2N/VRlab, Umeå Universitet, Sweden, and CMLabs Simulations, Montréal, Canada May 18, 2005 Typeset by FoilTEX May 16th 2005 Outline basics of vehicle dynamics different

More information

A Globally Stabilizing Receding Horizon Controller for Neutrally Stable Linear Systems with Input Constraints 1

A Globally Stabilizing Receding Horizon Controller for Neutrally Stable Linear Systems with Input Constraints 1 A Globally Stabilizing Receding Horizon Controller for Neutrally Stable Linear Systems with Input Constraints 1 Ali Jadbabaie, Claudio De Persis, and Tae-Woong Yoon 2 Department of Electrical Engineering

More information

COMBINING LANEKEEPING AND VEHICLE FOLLOWING WITH HAZARD MAPS

COMBINING LANEKEEPING AND VEHICLE FOLLOWING WITH HAZARD MAPS COMBINING LANEKEEPING AND VEHICLE FOLLOWING WITH HAZARD MAPS J. Christian Gerdes, Stanford University, Stanford, CA Ursina Saur, ETH, Zurich Eric J. Rossetter, Stanford University, Stanford, CA Abstract

More information

Investigation of Steering Feedback Control Strategies for Steer-by-Wire Concept

Investigation of Steering Feedback Control Strategies for Steer-by-Wire Concept Master of Science Thesis in Electrical Engineering Department of Electrical Engineering, Linköping University, 2018 Investigation of Steering Feedback Control Strategies for Steer-by-Wire Concept Martin

More information

Decentralized Robust Control Invariance for a Network of Integrators

Decentralized Robust Control Invariance for a Network of Integrators 2010 American Control Conference Marriott Waterfront, Baltimore, MD, USA June 30-July 02, 2010 ThC01.2 Decentralized Robust Control Invariance for a Network of Integrators Miroslav Barić and Francesco

More information

ESC794: Special Topics: Model Predictive Control

ESC794: Special Topics: Model Predictive Control ESC794: Special Topics: Model Predictive Control Nonlinear MPC Analysis : Part 1 Reference: Nonlinear Model Predictive Control (Ch.3), Grüne and Pannek Hanz Richter, Professor Mechanical Engineering Department

More information

Lane Departure Assist: A Formal Approach

Lane Departure Assist: A Formal Approach Lane Departure Assist: A Formal Approach Daniel Hoehener 1, Geng Huang 2 and Domitilla Del Vecchio 3 Abstract We use a controlled invariance approach to design a semi-autonomous lane departure assist system

More information

Backstepping based approach for the combined longitudinal-lateral vehicle control

Backstepping based approach for the combined longitudinal-lateral vehicle control Intelligent Vehicles Symposium Alcalá de Henares, Spain, June 3-7, Backstepping based approach for the combined longitudinal-lateral vehicle control Lamri Nehaoua and Lydie Nouvelière Abstract This paper

More information

Automated Driving The Role of Forecasts and Uncertainty - A Control Perspective

Automated Driving The Role of Forecasts and Uncertainty - A Control Perspective Automated Driving The Role of Forecasts and Uncertainty - A Control Perspective Ashwin Carvalho a,, Stéphanie Lefèvre a, Georg Schildbach a, Jason Kong a, Francesco Borrelli a a Department of Mechanical

More information

Decentralized and distributed control

Decentralized and distributed control Decentralized and distributed control Centralized control for constrained discrete-time systems M. Farina 1 G. Ferrari Trecate 2 1 Dipartimento di Elettronica, Informazione e Bioingegneria (DEIB) Politecnico

More information

Output Regulation of Uncertain Nonlinear Systems with Nonlinear Exosystems

Output Regulation of Uncertain Nonlinear Systems with Nonlinear Exosystems Output Regulation of Uncertain Nonlinear Systems with Nonlinear Exosystems Zhengtao Ding Manchester School of Engineering, University of Manchester Oxford Road, Manchester M3 9PL, United Kingdom zhengtaoding@manacuk

More information

Spacecraft Rate Damping with Predictive Control Using Magnetic Actuators Only

Spacecraft Rate Damping with Predictive Control Using Magnetic Actuators Only C. Böhm a M. Merk a W. Fichter b F. Allgöwer a Spacecraft Rate Damping with Predictive Control Using Magnetic Actuators Only Stuttgart, March 2009 a Institute of Systems Theory and Automatic Control, University

More information

Autonomous Helicopter Flight via Reinforcement Learning

Autonomous Helicopter Flight via Reinforcement Learning Autonomous Helicopter Flight via Reinforcement Learning Authors: Andrew Y. Ng, H. Jin Kim, Michael I. Jordan, Shankar Sastry Presenters: Shiv Ballianda, Jerrolyn Hebert, Shuiwang Ji, Kenley Malveaux, Huy

More information

A study on the use of virtual sensors in vehicle control

A study on the use of virtual sensors in vehicle control Proceedings of the 47th IEEE Conference on Decision and Control Cancun, Mexico, Dec. 9-11, 2008 A study on the use of virtual sensors in vehicle control M. Canale, L. Fagiano, F. Ruiz and M. C. Signorile

More information

Giulio Betti, Marcello Farina and Riccardo Scattolini

Giulio Betti, Marcello Farina and Riccardo Scattolini 1 Dipartimento di Elettronica e Informazione, Politecnico di Milano Rapporto Tecnico 2012.29 An MPC algorithm for offset-free tracking of constant reference signals Giulio Betti, Marcello Farina and Riccardo

More information

Optimal Control for Race Car Minimum Time Maneuvering

Optimal Control for Race Car Minimum Time Maneuvering Optimal Control for Race Car Minimum Time Maneuvering Master of Science Thesis Delft Center for Systems and Control Optimal Control for Race Car Minimum Time Maneuvering Master of Science Thesis For the

More information

Pfadverfolgung Von Normalformen zu prädiktiven Reglern

Pfadverfolgung Von Normalformen zu prädiktiven Reglern Pfadverfolgung Von Normalformen zu prädiktiven Reglern Timm Faulwasser Laboratoire d Automatique, Ecole Polytechnique Fédérale de Lausanne Institut für Angewandte Informatik, Karlsruher Institut für Technologie

More information

Prashant Mhaskar, Nael H. El-Farra & Panagiotis D. Christofides. Department of Chemical Engineering University of California, Los Angeles

Prashant Mhaskar, Nael H. El-Farra & Panagiotis D. Christofides. Department of Chemical Engineering University of California, Los Angeles HYBRID PREDICTIVE OUTPUT FEEDBACK STABILIZATION OF CONSTRAINED LINEAR SYSTEMS Prashant Mhaskar, Nael H. El-Farra & Panagiotis D. Christofides Department of Chemical Engineering University of California,

More information

State-Estimator Design for the KTH Research Concept Vehicle

State-Estimator Design for the KTH Research Concept Vehicle DEGREE PROJECT IN VEHICLE ENGINEERING, SECOND CYCLE, 30 CREDITS STOCKHOLM, SWEDEN 2016 State-Estimator Design for the KTH Research Concept Vehicle FAN GAO KTH ROYAL INSTITUTE OF TECHNOLOGY SCHOOL OF ENGINEERING

More information

Prediction and Prevention of Tripped Rollovers

Prediction and Prevention of Tripped Rollovers Prediction and Prevention of Tripped Rollovers Final Report Prepared by: Gridsada Phanomchoeng Rajesh Rajamani Department of Mechanical Engineering University of Minnesota CTS 12-33 Technical Report Documentation

More information

ROBUST CONSTRAINED PREDICTIVE CONTROL OF A 3DOF HELICOPTER MODEL WITH EXTERNAL DISTURBANCES

ROBUST CONSTRAINED PREDICTIVE CONTROL OF A 3DOF HELICOPTER MODEL WITH EXTERNAL DISTURBANCES ABCM Symposium Series in Mechatronics - Vol 3 - pp19-26 Copyright c 28 by ABCM ROBUST CONSTRAINED PREDICTIVE CONTROL OF A 3DOF HELICOPTER MODEL WITH EXTERNAL DISTURBANCES Marcelo Handro Maia, handro@itabr

More information

MPC Infeasibility Handling

MPC Infeasibility Handling MPC Handling Thomas Wiese, TU Munich, KU Leuven supervised by H.J. Ferreau, Prof. M. Diehl (both KUL) and Dr. H. Gräb (TUM) October 9, 2008 1 / 42 MPC General MPC Strategies 2 / 42 Linear Discrete-Time

More information

Polynomial-Time Verification of PCTL Properties of MDPs with Convex Uncertainties and its Application to Cyber-Physical Systems

Polynomial-Time Verification of PCTL Properties of MDPs with Convex Uncertainties and its Application to Cyber-Physical Systems Polynomial-Time Verification of PCTL Properties of MDPs with Convex Uncertainties and its Application to Cyber-Physical Systems Alberto Puggelli DREAM Seminar - November 26, 2013 Collaborators and PIs:

More information

EXPERIMENTAL COMPARISON OF TRAJECTORY TRACKERS FOR A CAR WITH TRAILERS

EXPERIMENTAL COMPARISON OF TRAJECTORY TRACKERS FOR A CAR WITH TRAILERS 1996 IFAC World Congress San Francisco, July 1996 EXPERIMENTAL COMPARISON OF TRAJECTORY TRACKERS FOR A CAR WITH TRAILERS Francesco Bullo Richard M. Murray Control and Dynamical Systems, California Institute

More information

Automated Turning and Merging for Autonomous Vehicles using a Nonlinear Model Predictive Control Approach

Automated Turning and Merging for Autonomous Vehicles using a Nonlinear Model Predictive Control Approach Automated Turning and Merging for Autonomous Vehicles using a Nonlinear Model Predictive Control Approach Lixing Huang and Dimitra Panagou Abstract Accidents at intersections are highly related to the

More information

Multi-layer Flight Control Synthesis and Analysis of a Small-scale UAV Helicopter

Multi-layer Flight Control Synthesis and Analysis of a Small-scale UAV Helicopter Multi-layer Flight Control Synthesis and Analysis of a Small-scale UAV Helicopter Ali Karimoddini, Guowei Cai, Ben M. Chen, Hai Lin and Tong H. Lee Graduate School for Integrative Sciences and Engineering,

More information

A DISSERTATION SUBMITTED TO THE FACULTY OF THE GRADUATE SCHOOL OF THE UNIVERSITY OF MINNESOTA BY. Gridsada Phanomchoeng

A DISSERTATION SUBMITTED TO THE FACULTY OF THE GRADUATE SCHOOL OF THE UNIVERSITY OF MINNESOTA BY. Gridsada Phanomchoeng State, Parameter, and Unknown Input Estimation Problems in Active Automotive Safety Applications A DISSERTATION SUBMITTED TO THE FACULTY OF THE GRADUATE SCHOOL OF THE UNIVERSITY OF MINNESOTA BY Gridsada

More information

Jackknife stability of a tractor semi-trailer combination

Jackknife stability of a tractor semi-trailer combination TU/e Mechanical Engineering Masterproject 2006-2007 Jackknife stability of a tractor semi-trailer combination Author: J.W.L.H. Maas (0529865) Tutor: Prof. dr. H. Nijmeijer Eindhoven, 11 June 2007 Abstract

More information

Predictive control of hybrid systems: Input-to-state stability results for sub-optimal solutions

Predictive control of hybrid systems: Input-to-state stability results for sub-optimal solutions Predictive control of hybrid systems: Input-to-state stability results for sub-optimal solutions M. Lazar, W.P.M.H. Heemels a a Eindhoven Univ. of Technology, P.O. Box 513, 5600 MB Eindhoven, The Netherlands

More information

CHAPTER 1. Introduction

CHAPTER 1. Introduction CHAPTER 1 Introduction Linear geometric control theory was initiated in the beginning of the 1970 s, see for example, [1, 7]. A good summary of the subject is the book by Wonham [17]. The term geometric

More information

VEHICLE WHEEL-GROUND CONTACT ANGLE ESTIMATION: WITH APPLICATION TO MOBILE ROBOT TRACTION CONTROL

VEHICLE WHEEL-GROUND CONTACT ANGLE ESTIMATION: WITH APPLICATION TO MOBILE ROBOT TRACTION CONTROL 1/10 IAGNEMMA AND DUBOWSKY VEHICLE WHEEL-GROUND CONTACT ANGLE ESTIMATION: WITH APPLICATION TO MOBILE ROBOT TRACTION CONTROL K. IAGNEMMA S. DUBOWSKY Massachusetts Institute of Technology, Cambridge, MA

More information