function [F M]=LinkStatics(m,rC,rL,Fp,Mp,g)
F1=-Fp-(m*g);
F=-F1;

M1=-Mp-cross(rC,(m*g))-cross(rL,Fp);
M=-M1;
end