Get rid of min/max angles. Fix optimization function. Super slow many-joint arm.