function df = der(q)
global Xnew L ell
df=[L*sin(q(1))+ell*sin(q(1)+q(2)),ell*sin(q(1)+q(2));
     -L*cos(q(1))-ell*cos(q(1)+q(2)),-ell*cos(q(1)+q(2))];
end