Clean up PyTrees related code
User Story/Description
Currently the py_trees.py file and other files are very cluttered with debugging code which needs to be cleaned up. The file system is also incredibly horrid and needs to be touched up as well.
Definition of Done
When it doesn't melt someones brain when trying to understand the code or find a file in the lhw_intelligence package.
How
Refactor code and move files.