WIP: bugs fixed, compiled and run successfully
WIP: rigid transform written to disk successfully