Physics constraint solver TODO: Implement proper sle solver (done) Double pendulum (done) Fix drift with correction term (done) Proper rendering Collision detection + resolution Optional: optimization