Convenience function to go between matrix and point list
Helper transform to write current mat as image on disk
Currently debugging (pushing for backup)