* Initialize state.
* Minor improvements to keep mutation consistancy.
* Added function to create Lie algebras for prismatic joints.
* Added prismatic joints.
* Update for newer versions of cminpack.