Added backward and forward substitution.

* Todo : add tests.
Added another example for elbow manipulator.