Refactor methods to add helper.py with reference classes
Add repeated forward/backward a* algorithms and minor bug fixes