Registration visualizations added. PC normalization added. PC transformation added. Pose write added. Bugs remain.