I am trying to formulate an optimization problem for determining link lengths of 3R manipulator shown in picture below,
Following are the constraints,
Robot arm should be reachable at point x = 100, y =0
Link 3 should sweep minimum 60 deg. angle at the end point (i.e. min Φ = 240 deg, max Φ = 300 deg)
$ 20°\leq\theta_{1}\leq160°$, $ 200°\leq\theta_{2}\leq340°$, $ 200°\leq\theta_{3}\leq340°$
Objective is to minimize $l_{1} + l_{2} + l_{3}$
How can I define 2nd constraint of minimum sweep angle mathematically?
Reference for 3R Robot kinematics: http://www.seas.upenn.edu/~meam520/notes/planarkinematics.pdf
Current Formulation:
$Minimize f(x) = l_{1} + l_{2} + l_{3}$
$Subject \:to \: \: l_{1}\cos(\theta_{1})+l_{2}\cos(\theta_{1}+\theta_{2})+l_{3}\cos(\theta_{1}+\theta_{2}+\theta_{3}) = 100$
$ \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \:l_{1}\sin(\theta_{1})+l_{2}\sin(\theta_{1}+\theta_{2})+l_{3}\sin(\theta_{1}+\theta_{2}+\theta_{3}) = 0$
$ \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: 20°\leq\theta_{1}\leq160°$
$ \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: 200°\leq\theta_{2}\leq340°$
$ \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: \: 200°\leq\theta_{3}\leq340°$