Skip to content

Homework 1 Problem 2

Mq¨+Cq˙+G(q)+K(q−θ)=0(1) link dynamicJmθ¨+Bmθ˙−K(q−θ)=τm(2) motor dynamic\begin{align*} M\ddot{q} + C\dot{q} + G(q) + K(q - \theta) &= 0 \quad \text{(1) link dynamic} \\ J_m\ddot{\theta} + B_m\dot{\theta} - K(q - \theta) &= \tau_m \quad \text{(2) motor dynamic} \end{align*}

The transmitted elastic torque:

τc=K(θ−q)\tau_c = K(\theta - q)

So we simplify this system to:

q¨=M−1(τc−Cq˙−G(q))\ddot{q} = M^{-1}(\tau_c - C\dot{q} - G(q)) θ¨=Jm−1(τm−τc−Bmθ˙)\ddot{\theta} = J_m^{-1}(\tau_m - \tau_c - B_m\dot{\theta} )

Compute the second derivative of τc\tau_c:

τ˙c=K(θ˙−q˙)\dot{\tau}_c = K(\dot{\theta} - \dot{q}) \quad τ¨c=K(θ¨−q¨)\ddot{\tau}_c = K(\ddot{\theta} - \ddot{q})

τ¨c=K[Jm−1(τm−τc−Bmθ˙)−M−1(τc−Cq˙−G(q))]\ddot{\tau}_c = K \left[ J_m^{-1}(\tau_m - \tau_c - B_m\dot{\theta}) - M^{-1}(\tau_c - C\dot{q} - G(q)) \right]

link-side motion appears in the torque dynamics:

τ¨c+K(Jm−1+M−1)τc=KJm−1τm−KJm−1Bmθ˙+KM−1(Cq˙+G(q))\ddot{\tau}_c + K(J_m^{-1} + M^{-1})\tau_c = K J_m^{-1}\tau_m - K J_m^{-1}B_m\dot{\theta} + K M^{-1}(C\dot{q} + G(q))

Task b. The influence of stiffness K from motor torque τm\tau_m to elastic torque τc\tau_c

Section titled “Task b. The influence of stiffness K from motor torque τm\tau_mτm​ to elastic torque τc\tau_cτc​”
τ¨c+K(Jm−1+M−1)τc=KJm−1τm−KJm−1Bmθ˙+KM−1(Cq˙+G(q))\ddot{\tau}_c + K(J_m^{-1} + M^{-1})\tau_c = K J_m^{-1}\tau_m - K J_m^{-1}B_m\dot{\theta} + K M^{-1}(C\dot{q} + G(q))

so the function becomes:

(Jm−1+M−1)τc=Jm−1τm−Jm−1Bmθ˙+M−1(Cq˙+G(q))(J_m^{-1} + M^{-1})\tau_c = J_m^{-1}\tau_m - J_m^{-1}B_m\dot{\theta} + M^{-1}(C\dot{q} + G(q))

at the same time, as there is no deformation, the movement of the motor and the link is completely synchronised θ=q,θ˙=q˙,θ¨=q¨\theta = q, \dot{\theta} = \dot{q}, \ddot{\theta} = \ddot{q}.

(Mq¨+Jmθ¨)+Cq˙+Bmθ˙+G(q)=τm(M\ddot{q} + J_m\ddot{\theta}) + C\dot{q} + B_m\dot{\theta} + G(q) = \tau_m (M+Jm)q¨+(C+Bm)q˙+G(q)=τm\mathbf{(M + J_m)\ddot{q} + (C + B_m)\dot{q} + G(q) = \tau_m}

from the torque dynamics above, K→0K \rightarrow 0, then

τ¨c=0  ⟹  τc=0\ddot{\tau}_c = 0 \implies \tau_c = 0

From the :

Mq¨+Cq˙+G(q)=0link sideJmθ¨+Bmθ˙=τmmotor side\begin{align*} M\ddot{q} + C\dot{q} + G(q) &= 0 \quad \text{link side}\\ J_m\ddot{\theta} + B_m\dot{\theta} &= \tau_m \quad \text{motor side} \end{align*}

The motor and the connecting rod are completely decoupled. The torque cannot be transmitted to the connecting link side (τc=0)(\tau_c = 0) because the intermediate medium is too soft. The connecting link will simply drop straight down under its own weight, whilst the motor spins idly at the other end.