Gelöste Aufgaben/JUMP/Car-Body

← Back to Start

Scope

Car-Body

In common simulation applications - especially for full-size commercial cars - the pitch-angle of the car is assumed to be small to allow for a linearization of geometry and most parts of the equations of motion. We drop this limitation so we can do more fancy stuff with our model - like climbing steep roads or jumping across ditches.

Block Diagram.

We employ a spatial x-y coordinate system, x in horizontal, y in vertical, upwards direction. And we’ll briefly employ the z-axis as rotation direction - which is towards you following the “right-hand-rule“ for coordinate systems.

Structure

The driver controls the car's motion via the position of the "gas"-pedal, which is being translated into a torque M_W at the wheel.

This toque will change velocities and thus the position of the car. These state-variables will then create - via info - a feedback to the driver.

We’ll need to invest significant efforts in describing the kinematics of the car-motion and to derive its equations of body-motion since we do not want to limit our study on small pitch-angles of the car. Key accessory will be vectors, which map locations like the center of mass:

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{r}_C(t)} .

This vector has - in 2D - two coordinates Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle u_1(t), u_2(t)} , measured in the inertial x-y frame:

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{r}_C(t) = \vec{\underline{e}}_0 \cdot \left(\begin{array}{c} u_1\\u_2\end{array}\right)} with Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{\underline{e}}_0 = \left(\vec{e}_x, \vec{e}_y \right)} .

representing the unit vectors spanning the x-y space. If we refer to a specific frame, we may drop the vector-notation Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle (\vec{.})} and refer to the column-matrix of coordinates Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle (\underline{.})} only, so

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \underline{r}_C = \left( \begin{array}{c}u_1\\u_2\end{array}\right)} .

We’ll also employ coordinate transformations using Euler-rotations.

The car with front-wheel drive consists of the car-body with center of mass “C“, the front wheels “A“ and the rear wheel “B“. Masses of car-body and wheel-sets are M and m respectively.The geometry of the car is described by

• a₀: the wheel base;
• a₁: longitudinal distance between center of mass and front-wheel-hub;
• a₂ = a₀ - a₁ and
• a₃: vertical distance between center of mass and front-wheel-hub (relaxed springs).

tmp

Body

We use five coordinates to describe the motion of the car:

• Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle u_1(t), u_2(t), \varphi(t)} for the location of the center of mass of the car-body and its pitch-angle
  ,
• Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle u_3, u_4} for the "vertical" motion of the wheel hubs relative to the car-body - which is synonym to the compression of the springs
  
  and
• Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \psi(t)} as the rotation angle of the front-wheel - we'll not account for the rotation of the rear-wheel.

So the center of mass of the car-body is

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{r}_M = \vec{\underline{e}}_0\cdot\left(\begin{array}{c}u_1(t)\\u_2(t)\end{array}\right)} ,

the coordinate system of the car is

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{\underline{e}}_C = \vec{\underline{e}}_0 \cdot \underline{\underline{D}}(\varphi(t))}

where

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \underline{\underline{D}}(\varphi) = \left( \begin{array}{rr} \cos(\varphi)&-\sin(\varphi)\\ +\sin(\varphi)&\cos(\varphi)\\ \end{array}\right)} .

So the location of the front-wheel “A“ is

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{r}_A = \vec{r}_M + \vec{r}_{MA}}

or

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \underline{r}_A = \underline{r}_M + \underline{\underline{D}}(\varphi(t)) \cdot \left(\begin{array}{c}a_1\\-a_3+u_3(t)\end{array}\right)} .

Likewise, the location of the rear-wheel “B“ is

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \underline{r}_B = \underline{r}_M + \underline{\underline{D}}(\varphi(t)) \cdot \left(\begin{array}{c}- a_2\\-a_3+u_4(t)\end{array}\right)}

and in the following, we’ll be using the abbreviations

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \left(\begin{array}{c}U_3\\U_4\end{array}\right) =: \underline{r}_A}

and

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \left(\begin{array}{c}U_5\\U_6\end{array}\right) =: \underline{r}_B} .

tmp

Track

Tack specification

We describe the road by road-sections, which we call tracks. We start by defining each track as a line-segment, i.e. a first-order polynomial. The road is thus defined by pairs of track-endpoints, i.e. (x_i, y_i).

The track-polynomials are

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \begin{array}{ll} t_i(x) &= y_i \cdot \tilde{x}_i + y_{i-1}\cdot \left(1- \tilde{x}_i \right) \text{ for } \tilde{x}_i = \frac{\displaystyle x - x_{i-1}}{\displaystyle x_i - x_{i-1}}\\ &=T_{i,1}\cdot x + T_{i,0} \end{array}} .

During the numerical integration of the initial-value-problem - when the car runs along the track - the solver needs to cope with the transition between two straight lines - which is numerically more efficient if we convert the road in a continuously differentiable function.

Rounding the edges.

For this purpose, we define transition polynomials p_i of second degree - parabolas - as

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle p_i(x) = \displaystyle \sum_{j=0}^2 P_{i,j}\cdot x^j}

which connect two neighboring tracks.

The boundary conditions for the parabolas (red) and the neighboring lines (blue) yield

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \begin{array}{ll} \color{blue} t_i(x_i-\Delta x_i) &= \color{red} p_{i}(x_i-\Delta x_i),\\ \color{blue} \left.\frac{\displaystyle d t_i}{\displaystyle d x_i}\right\vert_{x_i-\Delta x_i} &= \color{red} \left.\frac{\displaystyle d p_i}{\displaystyle d x_i}\right\vert_{x_i-\Delta x_i},\\ \color{blue} t_{i+1}(x_i+\Delta x_i) &= \color{red} p_{i}(x_i+\Delta x_i),\\ \color{blue} \left.\frac{\displaystyle d t_{i+1}}{\displaystyle d x_{i+1}}\right\vert_{x_i+\Delta x_i} &= \color{red} \left.\frac{\displaystyle d p_i}{\displaystyle d x_i}\right\vert_{x_i+\Delta x_i}. \end{array}}

And though we have four boundary conditions, they allow for a solution with three unknown polynomial coefficients P_i if Δx_i is identical left and right from x_i - which we have already implied.

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \begin{array}{ll} {b_3}&=0,\\ {b_2}&=\frac{\displaystyle {a_{2,1}}-{a_{1,1}}}{\displaystyle 4 \mathit{\Delta x_i}},\\ {b_1}&=\frac{\displaystyle \left( {a_{2,1}}+{a_{1,1}}\right) \, \mathit{\Delta x_i}-{x_i}\, {a_{2,1}}+{x_i}\, {a_{1,1}}}{\displaystyle 2 \mathit{\Delta x_i}},\\ {b_0}&=\frac{\displaystyle \left( {a_{2,1}}-{a_{1,1}}\right) \, {{\mathit{\Delta x_i}}^{2}}+\left( -2 {x_i}\, {a_{2,1}}-2 {x_1}\, {a_{1,1}}+4 {y_i}\right) \, \mathit{\Delta x_i}+{{x}_{i}^{2}}\, {a_{2,1}}-{{x}_{i}^{2}}\, {a_{1,1}}}{\displaystyle 4 \mathit{\Delta x_i}} \end{array}}

and

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \begin{array}{ll} {a_{1,0}}&={y_i}-{x_i}\, {a_{1,1}},\\ {a_{1,1}}&=\frac{\displaystyle {y_{i-1}}-{y_i}}{\displaystyle {x_{i-1}}-{x_i}}\operatorname{,}\\ {a_{2,0}}&={y_i}-{x_i}\, {a_{2,1}},\\ {a_{2,1}}&=\frac{\displaystyle {y_i}-{y_{i+1}}}{\displaystyle {x_i}-{x_{i+1}}} \end{array}}

But instead of employing the above, we solve the linear systems of equations for the coefficients numerically.

Now each polynomial creates new endpoints x_i - Δx_i and x_i + Δx_i which substitute for the initial x_i-point. The tracks are represented by a succession of lines and parabolas.

Next we need to find the contact point between wheel and road!

/*******************************************************/
/* MAXIMA script                                       */
/* version: wxMaxima 16.04.2                           */
/* author: Andreas Baumgart                            */
/* last updated: 2021-02-08                            */
/* ref: Modelling and Simulation (TUAS)                */
/* description: Rounding between straight line-segments*/
/*******************************************************/

/*******************************************************/
/* declarations                                        */
/*******************************************************/
declare("Δ",alphabetic);

params: [x[0] = 0, x[1] = 10, x[2]=15,
         y[0] = 0, y[1] =  1, y[2]=-1,
	 eps = 0.2];

/*******************************************************/
/* polynomials                                         */
/*******************************************************/
/* polynomial coefficiets of two consecutive straigt lines */
P : [[a[1,1],a[1,0]],[a[2,1],a[2,0]]];
/* polynomials of cubic and two consecutive linear polynomials */
p : [a[1,1]*x+a[1,0],
     b[3]*x^3+b[2]*x^2+b[1]*x+b[0],
     a[2,1]*x+a[2,0]];

/* compute polynomial coefficients from (x[i]/y[i])-points*/
linear : solve([subst([x=x[0]],p[1]) = y[0],
                subst([x=x[1]],p[1]) = y[1],
		subst([x=x[1]],p[3]) = y[1],
		subst([x=x[2]],p[3]) = y[2]], [a[1,0],a[1,1],a[2,0],a[2,1]])[1];
/* equations to continuously fit cubic function to lines */
equs : [subst([x=x[1]-Δx], p[1]) = subst([x=x[1]-Δx], p[2]),
        subst([x=x[1]+Δx], p[3]) = subst([x=x[1]+Δx], p[2]),
	subst([x=x[1]-Δx], diff(p[1],x)) = subst([x=x[1]-Δx], diff(p[2],x)),
	subst([x=x[1]+Δx], diff(p[3],x)) = subst([x=x[1]+Δx], diff(p[2],x))];
/* unknowns */
Q : [b[3],b[2],b[1],b[0]];

/* solve for unknowns */
sol : ratsimp(subst(linear,solve(equs,Q)[1]));

/* solve linear system of equations for unknown coefficients */
ACM : augcoefmatrix(equs,Q);
print(submatrix(ACM,5)," * ",transpose(Q)," = ",col(ACM,5))$


/* or - more simple when doing it numerically  .... */

/* coefficients of straigt line polynomials */
s : makelist(a[i,1] = (y[i-1]-y[i])/(x[i-1]-x[i]),i,1,2);

P : [[a[1,1],a[1,0]],[a[2,1],a[2,0]]];
p : [a[1,1]*x+a[1,0],
     b[3]*x^3+b[2]*x^2+b[1]*x+b[0],
     a[2,1]*x+a[2,0]];

linear : solve([subst([x=x[1]],p[1]) = y[1],
		subst([x=x[1]],p[3]) = y[1]], [a[1,0],a[2,0]])[1];

equs : [subst([x=x[1]-Δx], p[1]) = subst([x=x[1]-Δx], p[2]),
        subst([x=x[1]+Δx], p[3]) = subst([x=x[1]+Δx], p[2]),
	subst([x=x[1]-Δx], diff(p[1],x)) = subst([x=x[1]-Δx], diff(p[2],x)),
	subst([x=x[1]+Δx], diff(p[3],x)) = subst([x=x[1]+Δx], diff(p[2],x))];
Q : [b[3],b[2],b[1],b[0]];

sol : ratsimp(subst(linear,solve(equs,Q)))[1];

/* check with parameters */
subst(params,subst(s,subst(linear,solve(equs,Q))));

tmp

Contact-Point and -Normal

Contact conditions.

Finding the contact between wheel and road is our next challenge. We need to differentiate between the straight lines and the parabolas - but in both cases, we are looking for the equation of the normal “N“ to the road-surface, which cuts through the wheel-hub.

From the car-coordinates, we know the location of the wheel - e.g. “A” - expressed by its hub-vector

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{r}_A = \vec{\underline{e}}_0 \cdot \left(\begin{array}{c}U_3(t)\\U_4(t) \end{array}\right)} .

And we can also define

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{r}_A(t) = \vec{r}_a(t) + \vec{N}_A(t)} .

where Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{r}_A}  is the vector to the contact point “a“ of wheel “A“ and Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{N}_A} is the vector from “a“ to the wheel hub “A“. Since "a" is a point on a track - if wheel and road have contact - and the direction of N_A is known to be perpendicular to this track in “a”, we have two equations for the two unknowns “point on track“ and “length of normal Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{N}_A} “.

Contact angles

However, it remains tricky to find the material coordinate of the wheel that is at “a“. The picture below explains how first rotate the car by φ - positive about the z-axis, then rotate the wheel in negative direction by ψ and by κ in positive direction back to vertical. From there it is the known angle γ_A to “a“.

This succession of rotations is expressed by

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \gamma_A(t) = \varphi(t) - \psi(t) + \kappa(t) }

and we find contact point “a“ from

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \begin{array}{ll} \underline{r}_a &= \underline{r}_A + \underline{\underline{D}}(\gamma_A(t))\cdot \left(\begin{array}{c}0\\-R\end{array}\right)\\ &= \begin{pmatrix}+ R \sin{\left( \operatorname{\gamma}_A (t)\right) }-\left( {u_3}(t)-{a_3}\right) \sin{\left( \operatorname{\varphi }(t)\right) }+{a_1} \cos{\left( \operatorname{\varphi }(t)\right) }+{u_1}(t)\\ -R \cos{\left( \operatorname{\gamma}_A(t)\right) }+{a_1} \sin{\left( \operatorname{\varphi }(t)\right) }+\left( {u_3}(t)-{a_3}\right) \cos{\left( \operatorname{\varphi }(t)\right) }+{u_2}(t)\end{pmatrix} \end{array}}

and “b“ from

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \begin{array}{ll} \underline{r}_b &= \underline{r}_B + \underline{\underline{D}}(\gamma_B(t))\cdot \left(\begin{array}{c}0\\-R\end{array}\right)\\ &= \begin{pmatrix}+\sin{\left( {\gamma_B}\right) } R - \left( {u_4}(t)-{a_3}\right) \sin{\left( \operatorname{\varphi }(t)\right) }-{a_2} \cos{\left( \operatorname{\varphi }(t)\right) }+{u_1}(t)\\ -\cos{\left( {\gamma_B }\right) } R - {a_2} \sin{\left( \operatorname{\varphi }(t)\right) }+\left( {u_4}(t)-{a_3}\right) \cos{\left( \operatorname{\varphi }(t)\right) }+{u_2}(t)\end{pmatrix} \end{array}} .

For wheel A und B, the angles ψ and κ are not identical - but we have dropped the indices here for brevity.

Track is a Line

If the track is line “i“, we have

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{r}_a = \vec{\underline{e}}_0 \cdot \left[ \right. \underbrace{\left(\begin{array}{c}x_{i-1}\\y_{i-1} \end{array}\right)}_{\displaystyle := \underline{P}_{i-1}} + \xi \cdot \underbrace{\left(\begin{array}{c}x_{i} - x_{i-1}\\y_{i} - y_{i-1} \end{array}\right)}_{:= \displaystyle \underline{\Delta P}_{i}}\left. \right]}

with

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \underline{P}_{i-1}, \underline{P}_i}

being start- end end-points of the line with coordinates [x_i, h_i] and ξ naming the coordinate of point “C“. For the track-normal, we have

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{N}_A = \eta \cdot R \cdot \vec{n}_A}

with the unit-normal , the wheel-radius R and the unknown η. For the unit-normal

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \vec{N}_A \cdot \Delta\vec{P}_{i} = 0 \text{ and } \vec{n}_A \cdot \vec{n}_A = 1}

holds.

And for the contact angles γ_A/B we employ

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \tan \gamma_A(t) = \frac{\displaystyle N_{A,y}}{\displaystyle N_{A,x}}} .

Track is a Parabola

If the track is defined by a second-order polynomial p_i, we proceed accordingly. However, the track inclination is linearly dependent on “x” and we find that the normal is proportional to:

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \underline{\tilde{N}} = \left( \begin{array}{c} 1\\ -\frac{\displaystyle 1}{\displaystyle 2\; P_{i,2}\; x+P_{i,1}}\end{array} \right).}

From

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \underline{r}_A = \left( \begin{array}{c} x\\p_{i}(x) \end{array}\right) + \eta \cdot \underline{\tilde{N}} \text{ with } \underline{r}_A = \left( \begin{array}{c} U_3\\ U_4 \end{array}\right)}

we get two equations for the unknowns “x“ and “η“ as

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \begin{array}{ll} u_3 & = \eta +x,\\ u_4 & = -\frac{\displaystyle \eta }{\displaystyle 2 P_{i,2} \; x+P_{i,1}}+P_{i,2}\, {{x}^{2}}+P_{i,1} x+P_{i,0} \end{array}} .

And we get a third-degree polynomial in “x“ from the second equation. The three solutions for point “C” usually comprise complex (they have a real and imaginary part) solutions depending on the curvature (convex or concave) of the parabola. That’s not a problem but increases computational cost significantly - because we will need to solve this equation for each value of U₃, U₄ again and again.

tmp

Contact Forces

Wheel kinematics

At contact “a” between road and wheel, the motor-torque must be transformed into a propulsion force of the car.

In the freebody-diagram for wheel “A“ below, we account for the contact forces

• normal force N_a and
• traction force F.

The interaction between road and wheel is a complex relationship between these two forces and the relative velocity v_rel of the wheel in point C relative to the road.

Contact forces F, N

For the normal force N_A we assume a characteristic which depends on the dimensionless compression of the wheel e = 1-η, where - obviously -

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle N_a = \left\{ \begin{array}{l} 0 \text{ for } e < 0 \\ \text{'positive' for } e > 0 \end{array} \right.}

To have a continuously differentiable function N_A as in this contact-characteristic, we choose a parabola for 0<e<ε with continuous transitions to

• e=0 for e<0 and
• e=k_C η for e>ε:
  

  

  Characteristic for contact force.

And - for the sake of simplicity - let

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle N_a(\varepsilon) = m\cdot g} .

Now, for the traction force, we assume

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \begin{array}{ll} F &= F(N_a,v_{rel})\\ & = \mu(v_{rel})\cdot N_a \end{array}}

and introduce a point-symmetric characteristic for this relationship μ(v_rel):

Friction characteristic

It mimics the key properties of dry friction with a stick-coefficient μ₀ for very low relative velocities and μ else. To simplify implementation, we’ll be using the same mechanism as for the tracks to compose this characteristic from lines and transition parabolas.

Model

For this geometrically nonlinear system, it is a challenge to derive the equations of motion. We’ll be employing the Principle of Virtual Work with the equilibrium condition stating that the sum of all virtual work at the point of equilibrium vanishes:

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \begin{array}{ll} \delta W &= \delta W^a - \delta \Pi\\ &\stackrel{!}{=} 0 \end{array}}

with the virtual strain energy δΠ and the virtual work of external forces δW^a. These equilibrium conditions will deliver the nonlinear equations of motion for the minimal-coordinates of the car

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \underline{q}_C(t) := \left( \begin{array}{c}u_1(t)\\u_2(t)\\u_3(t)\\u_4(t)\\\varphi(t)\\\psi(t)\end{array}\right)} .

The inertia-forces for the equilibrium conditions result form accelerations, i.e. second order time-derivatives of these coordinates. Thus, we have their velocities as further state variables. Well, except for the wheel-rotation-angle ψ(t), which we are not interested in. With

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \frac{\displaystyle \psi(t)}{\displaystyle d t} =: \omega(t)}

we collect all state variables of the system as

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \underline{Q}_C(t) := \left( \begin{array}{c} \frac{\displaystyle d u_1(t)}{\displaystyle d t}\\ \frac{\displaystyle d u_2(t)}{\displaystyle d t}\\ \frac{\displaystyle d u_3(t)}{\displaystyle d t}\\ \frac{\displaystyle d u_4(t)}{\displaystyle d t}\\ \frac{\displaystyle d \varphi(t)}{\displaystyle d t}\\ \omega(t)\\ u_1(t)\\ u_2(t)\\ u_3(t)\\ u_4(t)\\ \varphi(t) \end{array}\right)} .

When deriving the equations of motion with the principle of virtual displacements we also need the variations of r_C, r_A, r_B with respect to Q_C,. They come from

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \delta \underline{r}_J(q_{C,1}, \ldots, q_{C,i}, \ldots, q_{C,6}) = \displaystyle \sum_{j=1}^6 \left. \frac{\displaystyle \partial \underline{r}_J (q_{C,1}, \ldots, q_{C,j}+\varepsilon \cdot \delta q_{C,j}, \ldots, q_{C,6})}{\displaystyle \partial \varepsilon}\right\vert_{\;\displaystyle \varepsilon=0}, J \in \left\{A, B, C\right\}} ,

thus

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \delta \underline{r}_M = \left( \begin{array}{c} \delta u_1\\\delta u_2\end{array}\right)} ,

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \delta \underline{r}_A = \begin{pmatrix}-{a_1} \sin{\left( \operatorname{\varphi }(t)\right) } \mathit{\delta \varphi }-\left( {u_3}(t)-{a_3}\right) \cos{\left( \operatorname{\varphi }(t)\right) } \mathit{\delta \varphi }-{{\mathit{\delta u}}_3} \sin{\left( \operatorname{\varphi }(t)\right) }+{{\mathit{\delta u}}_1}\\ -\left( {u_3}(t)-{a_3}\right) \sin{\left( \operatorname{\varphi }(t)\right) } \mathit{\delta \varphi }+{a_1} \cos{\left( \operatorname{\varphi }(t)\right) } \mathit{\delta \varphi }+{{\mathit{\delta u}}_3} \cos{\left( \operatorname{\varphi }(t)\right) }+{{\mathit{\delta u}}_2}\end{pmatrix}} ,

Fehler beim Parsen (SVG (MathML kann über ein Browser-Plugin aktiviert werden): Ungültige Antwort („Math extension cannot connect to Restbase.“) von Server „https://wikimedia.org/api/rest_v1/“:): {\displaystyle \delta \underline{r}_B = \begin{pmatrix}{a_2} \sin{\left( \operatorname{\varphi }(t)\right) } \mathit{\delta \phi }-\left( {u_4}(t)-{a_3}\right) \cos{\left( \operatorname{\varphi }(t)\right) } \mathit{\delta \varphi }-{{\mathit{\delta u}}_4} \sin{\left( \operatorname{\varphi }(t)\right) }+{{\mathit{\delta u}}_1}\\ -\left( {u_4}(t)-{a_3}\right) \sin{\left( \operatorname{\varphi }(t)\right) } \mathit{\delta \varphi }-{a_2} \cos{\left( \operatorname{\varphi }(t)\right) } \mathit{\delta \varphi }+{{\mathit{\delta u}}_4} \cos{\left( \operatorname{\varphi }(t)\right) }+{{\mathit{\delta u}}_2}\end{pmatrix}} ,

$\delta {\underline {r}}_{a}={\begin{pmatrix}-R\cos {\left({{\gamma }_{A}}(t)\right)}{\mathit {\delta \psi }}+\left(-{a_{1}}\sin {\left(\operatorname {\phi } (t)\right)}+\left({a_{3}}-{u_{3}}(t)\right)\cos {\left(\operatorname {\phi } (t)\right)}+R\cos {\left({{\gamma }_{A}}(t)\right)}\right)\,{\mathit {\delta \phi }}-{{\mathit {\delta u}}_{3}}\sin {\left(\operatorname {\phi } (t)\right)}+{{\mathit {\delta u}}_{1}}\\-R\sin {\left({{\gamma }_{A}}(t)\right)}{\mathit {\delta \psi }}+\left(\left({a_{3}}-{u_{3}}(t)\right)\sin {\left(\operatorname {\phi } (t)\right)}+{a_{1}}\cos {\left(\operatorname {\phi } (t)\right)}+R\sin {\left({{\gamma }_{A}}(t)\right)}\right)\,{\mathit {\delta \phi }}+{{\mathit {\delta u}}_{3}}\cos {\left(\operatorname {\phi } (t)\right)}+{{\mathit {\delta u}}_{2}}\end{pmatrix}}$

and - not accounting for ψ and κ - as

$\delta {\underline {r}}_{b}={\begin{pmatrix}{a_{2}}\sin {\left(\operatorname {\varphi } (t)\right)}{\mathit {\delta \varphi }}-\left({u_{4}}(t)-{a_{3}}\right)\cos {\left(\operatorname {\varphi } (t)\right)}{\mathit {\delta \varphi }}-{{\mathit {\delta u}}_{4}}\sin {\left(\operatorname {\varphi } (t)\right)}+{{\mathit {\delta u}}_{1}}\\-\left({u_{4}}(t)-{a_{3}}\right)\sin {\left(\operatorname {\varphi } (t)\right)}{\mathit {\delta \varphi }}-{a_{2}}\cos {\left(\operatorname {\varphi } (t)\right)}{\mathit {\delta \varphi }}+{{\mathit {\delta u}}_{4}}\cos {\left(\operatorname {\varphi } (t)\right)}+{{\mathit {\delta u}}_{2}}\end{pmatrix}}$.

tmp

Virtual Strain Energy

The only elastic elements in our car are the two springs, thus

$\delta \Pi =k_{A}\cdot u_{3}\cdot \delta u_{3}+k_{B}\cdot u_{4}\cdot \delta u_{4}$.

/* in next section ... */

tmp

Virtual Work of External Forces - including D'Alembert Forces

The components of virtual work of external forces are

$\delta W^{a}=\delta W_{g}^{a}+\delta W_{A}^{a}+\delta W_{d}^{a}+\delta W_{F}^{a}$

where

• δW^a_g: virtual work of gravitational forces,
• δW^a_A: virtual work of D'Alembert inertia forces,
• δW^a_d: virtual work of dissipative forces (dampers parallel to the suspension springs / rotational damping) and
• 'δW^a_F': virtual work of implied forces and moments like N_A, N_B, F and M_W.

With the principle of virtual work, we phrase

$\delta W_{g}^{a}=-m_{C}\;g\;{\vec {e}}_{y}\cdot \delta {\vec {r}}_{C}-m_{A}\;g\;{\vec {e}}_{y}\cdot \delta {\vec {r}}_{A}-m_{B}\;g\;{\vec {e}}_{y}\cdot \delta {\vec {r}}_{B}$,

$\delta W_{A}^{a}=-m_{C}\;{\ddot {\vec {r}}}_{C}\cdot \delta {\vec {r}}_{C}-m_{A}\;{\ddot {\vec {r}}}_{A}\cdot \delta {\vec {r}}_{A}-m_{B}\;{\ddot {\vec {r}}}_{B}\cdot \delta {\vec {r}}_{B}-J_{C}\;{\ddot {\varphi }}\cdot \delta \varphi -J_{A}\;{\ddot {\psi }}\cdot \delta \psi$,

$\delta W_{d}^{a}=b_{3}\,{\dot {u}}_{3}\cdot \delta u_{3}+b_{4}\,{\dot {u}}_{4}\cdot \delta u_{4}+B\,\left(\omega (t)+\Omega (t)\right)\cdot \left(\delta \psi +\delta \varphi \right)$

and

$\delta W_{F}^{a}={\underline {\underline {D}}}(\gamma _{A})\cdot \left({\begin{array}{c}T\\N_{A}\end{array}}\right)\cdot \delta {\underline {r}}_{a}+{\underline {\underline {D}}}(\gamma _{B})\cdot \left({\begin{array}{c}0\\N_{B}\end{array}}\right)\cdot \delta {\underline {r}}_{b}+M_{W}\cdot \delta \psi ;$.

We group all components of by their virtual displacements , the coefficient of each virtual displacement being one equilibrium condition. The resultant equations have this form:

$\delta W=\delta {\underline {q}}_{C}\cdot \left(-{\underline {\underline {M}}}\cdot {\ddot {\underline {q}}}+{\underline {f}}({\dot {\underline {q}}},{\underline {q}})\right)$.

/*******************************************************/
/* MAXIMA script                                       */
/* version: wxMaxima 16.04.2                           */
/* author: Andreas Baumgart                            */
/* last updated: 2021-02-08                            */
/* ref: Modelling and Simulation (TUAS)                */
/* description: Rounding between straight line-segments*/
/*******************************************************/

/*******************************************************/
/* declarations                                        */
/*******************************************************/
declare("λ", alphabetic);
declare("Δ", alphabetic);
declare("δ", alphabetic,"ε", alphabetic);
declare("Π", alphabetic);
declare("φ", alphabetic);
declare("ψ", alphabetic);
declare("κ", alphabetic);
declare("α", alphabetic);
declare("γ", alphabetic);
declare("ω", alphabetic);

/*******************************************************/
/* body centers                                        */
/*******************************************************/
/* car body */
r[C] : [u[1](t),u[2](t)];
D[1](α) := matrix([cos(α),-sin(α)],[sin(α),cos(α)]);

/* wheel centers - reference configuration */
r[A] : r[C] + D[1](φ(t)).matrix([+a[1]],[-a[3]+u[3](t)]);
r[B] : r[C] + D[1](φ(t)).matrix([-a[2]],[-a[3]+u[4](t)]);

/* wheel contacts */

local : [γ[A](t) = φ(t) + (κ(t)-ψ(t))];
r[a] : r[A] + D[1](γ[A](t)).matrix([0],[-R]);
r[b] : r[B] + D[1](γ[B](t)).matrix([0],[-R]);

varia: append(makelist(u[i](t) =  u[i](t) + ε*δu[i],i,1,4),[φ(t) = φ(t) + ε*δφ, ψ(t) = ψ(t) + ε*δψ]); 

q  : append(makelist( u[i](t),i,1,4), [ φ(t), ψ(t)]);
δq : append(makelist(δu[i]   ,i,1,4), [δφ   ,δψ   ]);
nuller : makelist(q[i]=0, i,1,length(q));

δr[C] : sum(subst([ε=0],diff(subst(varia[i],r[C]),ε)),i,1,length(varia));
δr[A] : sum(subst([ε=0],diff(subst(varia[i],r[A]),ε)),i,1,length(varia));
δr[B] : sum(subst([ε=0],diff(subst(varia[i],r[B]),ε)),i,1,length(varia));
δr[a] : sum(subst([ε=0],diff(subst(varia[i],subst(local,r[a])),ε)),i,1,length(varia));
δr[b] : sum(subst([ε=0],diff(subst(varia[i],subst(local,r[b])),ε)),i,1,length(varia));

/* d'Alembert Forces */
δW[I] : expand(-m[1]*diff(r[C],t,2).δr[C] - m[2]*diff(r[A],t,2).δr[A] - m[2]*diff(r[B],t,2).δr[B] - J[1]*diff(φ(t),t,2)*δφ - J[2]*diff(ψ(t),t,2)*δψ);
δW[I] : expand(subst(['diff(φ(t),t,1)^2=0],δW[I]));

/* Springs / Dampers*/
δΠ : (k[1]*u[3](t)+b[1]*diff(u[3](t),t))*δu[3]+(k[2]*u[4](t)+b[2]*diff(u[4](t),t))*δu[4];
δΠ : expand(δΠ);

/* Motor (δφ has the opposite orientation of δψ) */
δW[m] : MW*δψ;

/* Weight */
δW[G] : -m[1]*g*δu[2] - m[2]*g*δr[A][2] - m[2]*g*δr[B][2];

/* Contact*/
δW[c] : δr[a].(D[1](γ[A]).[F[T],F[N1]]) + δr[b].(D[1](γ[2]).[0,F[N2]]);
δW[c] : expand(subst(solve(local,κ(t))[1],δW[c]));

/*--------------------------------------------------*/
δW[total] : expand(δW[I] - δΠ + δW[G] + δW[c] + δW[m]);

eom : expand(makelist(coeff(δW[total][1],δq[i]),i,1,length(δq)));
δW[rest] : expand(δW[total][1] -sum(eom[i]*δq[i],i,1,length(δq)));

M : funmake('matrix,makelist(makelist(coeff(eom[row],diff(q[col],t,2)),col,1,length(q)),row,1, length(q)));
trigRepl : [solve(cos(γ[B]-φ(t)) = trigexpand(cos(γ[B]-φ(t))),sin(γ[B]))[1],
            solve(cos(γ[A]-φ(t)) = trigexpand(cos(γ[A]-φ(t))),sin(γ[A]))[1],
            solve(sin(γ[A]-φ(t)) = trigexpand(sin(γ[A]-φ(t))),cos(γ[A]))[1]];

rightHandS : expand(makelist(eom[row] - sum(M[row,col]*diff(q[col],t,2),col,1,length(q)),row,1, length(q)));
/* neglect the impact of deflections u[3], u[4] on the mass moment of the total car */
/* further simplifications of intertial forces */
rightHandS[1]:ratsimp(trigsimp(subst(['diff(u[3](t),t,1)=0,'diff(u[4](t),t,1)=0],rightHandS[1])));
rightHandS[2]:ratsimp(trigsimp(subst(['diff(u[3](t),t,1)=0,'diff(u[4](t),t,1)=0],rightHandS[2])));

tmp          : F[N1]*subst(trigRepl[2],coeff(rightHandS[3],F[N1]))+
               F[T] *subst(trigRepl[3],coeff(rightHandS[3],F[T] ));
rightHandS[3]: tmp+ratsimp(trigexpand(rightHandS[3]-tmp));
rightHandS[4]: ratsimp(subst(trigRepl,rightHandS[4]));

rightHandS[5]:subst(['diff(u[3](t),t,1)=0,'diff(u[4](t),t,1)=0],rightHandS[5]);
trigRepl : [cos(γ[A]-φ(t)) = trigexpand(cos(γ[A]-φ(t))),
            cos(γ[B]-φ(t)) = trigexpand(cos(γ[B]-φ(t))),
	    sin(γ[A]-φ(t)) = trigexpand(sin(γ[A]-φ(t))),
	    sin(γ[B]-φ(t)) = trigexpand(sin(γ[B]-φ(t)))];
/* need to get rid of the Minus-signs .... */
assume(cos(γ[A])>0,cos(γ[B])>0,sin(γ[A])>0,sin(γ[B])>0,sin(φ(t))>0,cos(φ(t))>0);
for i:1 thru 4 do
    (trigRepl[i] : trigRepl[i] - part(rhs(trigRepl[i]),1),
     trigRepl[i] : rhs(trigRepl[i]) = lhs(trigRepl[i]),
     if is(lhs(trigRepl[i])<0) then
     	trigRepl[i] : -trigRepl[i]);
abbrev : solve([a[3]-u[3](t)=Δu[3], a[3]-u[4](t)=Δu[3]],[u[3](t),u[4](t)])[1];
collector : [[F[N1],F[N2],F[T]],[a[1],a[2],a[3]]];
tmp : makelist(makelist(coeff(coeff(rightHandS[5],collector[1][i]),collector[2][j]),j,1,3),i,1,3);
tmp : subst(trigRepl,tmp);
tmp : sum(sum(tmp[i][j]*collector[1][i]*collector[2][j],j,1,3),i,1,3);
rightHandS[5]: trigsimp(ratsimp(expand(tmp+ratsimp(trigexpand(rightHandS[5]-tmp)))));

/* ... now simplify mass matrix */
M : -subst(nuller,M);
for row:1 thru 5 do
    (for col:row thru 5 do
    	print("M(",row,",",col,") = ",M[row][col]))$

/* and print right-hand-side */
for i:1 thru length(q)  do
   (grind(trigsimp(ratsimp(rightHandS[i]))),
    print("---------------------------------------------------"))$

/* tnslate */
toDyDt : [cos(γ[A]) = cosgamma[1],cos(γ[B]) = cosgamma[2],
          sin(γ[A]) = singamma[1],sin(γ[B]) = singamma[2],
	  cos(φ(t)) = cosphi, sin(φ(t)) = sinphi, 	  
          'diff(u[3](t),t,1) = v[3],	  
          'diff(u[4](t),t,1) = v[4]]
for i:1 thru length(q)  do
   (print(trigsimp(ratsimp(subst(toDyDt,rightHandS[i])))),
    print("---------------------------------------------------"))$
/************************************************************************/
/* start vector */
starter : append(makelist('diff(u[i](t),t,1)=0,i,1,4),
   	       	 [sin(φ(t))=0,cos(φ(t))=1,'diff(φ(t),t,1)=0],
	       	 [F[N1]=0,F[N2]=0,F[T]=0, MW=0]);

atStart : makelist(subst(starter,eom)[i]=0,i,1,length(q));
TT : append(makelist(diff(u[i](t),t,2),i,1,4),['diff(φ(t),t,2),'diff(ψ(t),t,2)]);
START : solve(atStart, TT)[1];

makelist(lhs(START[i])=subst([u[3](t)=0,u[4](t)=0],rhs(START[i])),i,1,length(q));

/************************************************************************/
/* translate to first-order DGL */
toDyDt: ['diff(u[1](t),t,1) = Q[ 1],
      	 'diff(u[2](t),t,1) = Q[ 2],
      	 'diff(u[3](t),t,1) = Q[ 3],
      	 'diff(u[4](t),t,1) = Q[ 4],
      	 'diff(   φ(t),t,1) = Q[ 5],
      	 'diff(   ψ(t),t,1) = Q[ 6],
	       u[1](t) 	    = Q[ 7],
      	       u[2](t) 	    = Q[ 8],
      	       u[3](t) 	    = Q[ 9],
      	       u[4](t) 	    = Q[10],
      	       φ(t)    	    = Q[11],
      	    sin(Q[11])      = sinphi,
      	    cos(Q[11])      = cosphi];

rhside : ratsimp(subst(toDyDt,rightHandS));

for i:1 thru 6  do
   (print("rhs(",i,") = ",ratsimp(rhside[i])),
    print("---------------------------------------------------"))$


taylor : [cos(φ(t)) = 1-φ(t)^2/2!,sin(φ(t)) = φ(t)-φ(t)^3/3!];plot2d([sin(phi), phi-phi^3/3!],[phi, -%pi/2, %pi/2])$



/* velocity in contact point */
/* of axles ..... */
/* im Reference-System */
v[A] : trigsimp(diff(r[A],t));
v[B] : trigsimp(diff(r[B],t));

/* Transformation ins surface-system*/
V[a] : D[1](-γ[A]).[V[3],V[4]]+[-R*ω,0];
V[v] : D[1](-γ[B]).[V[5],V[6]];

/***************************** using formal approach ******************************/
/* in reference-coordinates */
/* axle "1" */
reverse : solve(local,κ(t))[1];
v[a] : subst([reverse, diff(reverse,t)], diff(subst(local,r[a]),t));
v[a] : subst([diff(ψ(t),t)=ω(t)], subst(subst(['diff(κ(t),t,1)=0],diff(local,t,1)), ev(v[a],nouns)));
/* in surface - coordinates */
V[a] : trigsimp(expand(D[1](-γ[A]).v[a]));

/* axle "2" */
v[b] : diff(subst(local,r[b]),t);
/* in surface - coordinates */
V[b] : trigsimp(expand(D[1](-γ[B]).v[b]));

The components of this equation are

${\underline {\underline {M}}}={\begin{pmatrix}2{m_{2}}+{m_{1}}&0&0&0&2{m_{2}}\,{a_{3}}&0\\0&2{m_{2}}+{m_{1}}&{m_{2}}&{m_{2}}&{a_{1}}\,{m_{2}}-{a_{2}}\,{m_{2}}&0\\0&{m_{2}}&{m_{2}}&0&{a_{1}}\,{m_{2}}&0\\0&{m_{2}}&0&{m_{2}}&-{a_{2}}\,{m_{2}}&0\\2{m_{2}}\,{a_{3}}&{a_{1}}\,{m_{2}}-{a_{2}}\,{m_{2}}&{a_{1}}\,{m_{2}}&-{a_{2}}\,{m_{2}}&2{m_{2}}\,{{a}_{3}^{2}}+{{a}_{2}^{2}}\,{m_{2}}+{{a}_{1}^{2}}\,{m_{2}}+{J_{1}}&0\\0&0&0&0&0&{J_{2}}\end{pmatrix}}$

and

${\underline {f}}=\left({\begin{array}{l}\cos {\left({{\gamma }_{A}}\right)}{F_{T}}-\sin {\left({{\gamma }_{2}}\right)}{F_{\mathit {N2}}}-\sin {\left({{\gamma }_{A}}\right)}{F_{\mathit {N1}}}\\\left(-2{m_{2}}-{m_{1}}\right)g+\sin {\left({{\gamma }_{A}}\right)}{F_{T}}+\cos {\left({{\gamma }_{2}}\right)}{F_{\mathit {N2}}}+\cos {\left({{\gamma }_{A}}\right)}{F_{\mathit {N1}}}\\-{F_{T}}\sin {\left(\operatorname {\varphi } (t)-{{\gamma }_{A}}\right)}+{F_{\mathit {N1}}}\cos {\left(\operatorname {\varphi } (t)-{{\gamma }_{A}}\right)}-{m_{2}}g\cos {\left(\operatorname {\varphi } (t)\right)}-{b_{1}}\,{\dot {u}}_{3}-{k_{1}}{u_{3}}(t)\\\sin {\left({{\gamma }_{2}}\right)}{F_{\mathit {N2}}}\sin {\left(\operatorname {\varphi } (t)\right)}+\left(\cos {\left({{\gamma }_{2}}\right)}{F_{\mathit {N2}}}-{m_{2}}g\right)\cos {\left(\operatorname {\varphi } (t)\right)}-{b_{2}}\,{\dot {u}}_{4}-{k_{2}}{u_{4}}(t)\\\left({a_{3}}\,{F_{\mathit {N1}}}-{a_{1}}\,{F_{T}}\right)\sin {\left(\operatorname {\varphi } (t)-{{\gamma }_{A}}\right)}+\left({a_{3}}\,{F_{T}}+{a_{1}}\,{F_{\mathit {N1}}}\right)\cos {\left(\operatorname {\varphi } (t)-{{\gamma }_{A}}\right)}+\sin {\left(\operatorname {\varphi } (t)\right)}+\left(\sin {\left({{\gamma }_{2}}\right)}{F_{\mathit {N2}}}{u_{4}}(t)+\left(\sin {\left({{\gamma }_{A}}\right)}{F_{\mathit {N1}}}-\cos {\left({{\gamma }_{A}}\right)}{F_{T}}\right){u_{3}}(t)+\left({a_{2}}-{a_{1}}\right)\,{m_{2}}g+\left(-{a_{3}}\sin {\left({{\gamma }_{2}}\right)}-{a_{2}}\cos {\left({{\gamma }_{2}}\right)}\right)\,{F_{\mathit {N2}}}\right)\cos {\left(\operatorname {\varphi } (t)\right)}+\left(\sin {\left({{\gamma }_{A}}\right)}R\,{F_{T}}+\cos {\left({{\gamma }_{A}}\right)}{F_{\mathit {N1}}}R\right)\sin {\left({{\gamma }_{A}}(t)\right)}+\left(\cos {\left({{\gamma }_{A}}\right)}R\,{F_{T}}-\sin {\left({{\gamma }_{A}}\right)}{F_{\mathit {N1}}}R\right)\cos {\left({{\gamma }_{A}}(t)\right)}+B\,\left(\omega (t)+\Omega (t)\right)\\\left(-\sin {\left({{\gamma }_{A}}\right)}R\,{F_{T}}-\cos {\left({{\gamma }_{A}}\right)}{F_{\mathit {N1}}}R\right)\sin {\left({{\gamma }_{A}}(t)\right)}+\left(\sin {\left({{\gamma }_{A}}\right)}{F_{\mathit {N1}}}R-\cos {\left({{\gamma }_{A}}\right)}R\,{F_{T}}\right)\cos {\left({{\gamma }_{A}}(t)\right)}+B\,\left(\omega (t)+\Omega (t)\right)+M_{W}\end{array}}\right)$

Later we’ll see that this representation has a small structural fault: the wheel torque M_W depends on the angular acceleration of the motor and gears. It implies that M_W is a function of

${\ddot {\psi }}(t){\text{ or }}{\dot {\omega }}(t)$

and needs to be transferred to the left-hand-side of the equations. That fault will be corrected when the E-Motor and Drive-Train-components are integrated.

Variables

name	symbol	unit
mC

Parameter

name	symbol	unit
mass of car-body	mC	kg
mass of wheel-pair "A"	mA	kg
mass of wheel-pair "A"	mB	kg
mass-moment of car-body	JC	kg m2

next workpackage: driver-controls →

---

References

• ...