Pytest Fail fix
Fixed the pytest failures because fp was closed too early inside the to3D function. Labels for the handle were changed since that could cause an error in display. The function to convert a rotation matrix to a unit vector angle form was rewritten to avoid a warning from numpy.