add ks/kd feedback
(1) add ks, kd feedback to both bead and double pendulum
(2) play/stop control for bead
(3) draw constraints