Replace internal Transform representation with an Eigen::Isometry3d

@nick.laurenson

Replace internal Transform representation with an Eigen::Isometry3d. This allows faster computation, easier manipulation, and fixes euler angles conventions.