Add Initial position and orientation

This branch adds the ability to specify an initial orientation and position for the root.

It also solves 2 bugs:

• InputSolve() function must take the index of the input it solves, otherwise the extrapolation is wrong
• For the Python interface, passing pointer for a fortran array does not work. ND_ARRAY_3x3 must be used instead