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¨=M1(τcCq˙G(q))\ddot{q} = M^{-1}(\tau_c - C\dot{q} - G(q)) θ¨=Jm1(τmτcBmθ˙)\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[Jm1(τmτcBmθ˙)M1(τcCq˙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(Jm1+M1)τc=KJm1τmKJm1Bmθ˙+KM1(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(Jm1+M1)τc=KJm1τmKJm1Bmθ˙+KM1(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:

(Jm1+M1)τc=Jm1τmJm1Bmθ˙+M1(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, K0K \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.