Cam profile
Origin
Pulley
Construction line
F(theta) = (F0 + k·u)·r2, u = r2·theta
Ymass = TCOCM - MinCL
Potential Energy: UpW = (CounterMass*g)*(Ymass - Ymass(0)), UpC = F0*r2*theta + 1/2*k*r2^2*theta^2 (theta in rad), Utotal = UpW - UpC