Coord transform new

Do not merge yet, is just there for me to easily track changes - it also depends on the migratin to Eigen3