Starting to add unit tests for each py file. Also removed old test as it was outdated.
Added TODO note for future optimizations.