refactor to be consistent with pep-8
added collection of functions to align trajectories: SE3, Sim3, Hand-Eye-Calib
added small library to deal with homogeneous transformation matrices and quaternions
added a new file for math utils