Fix macro bug.
Clean elbow example.
Added jacobian method.
Added matrix row filling from twist.

* Todo : check matrix dim.
Working jacobian computation.
Clean code.