Finish new functions to find distance to nearest wall, begin reorganising files in a more sane manner. Write setup file and modify motion.py to use it