function dotq = one_dim_link_P (t, q)
    global J P Kp thetad
    theta = q(1);
    omega = q(2);
    dottheta = omega;
    dotomega = (1/J)*(-P*cos(theta) -Kp*(theta-thetad));
    dotq = [ dottheta; dotomega ];
end
