Fixed Interpreter bugs, optimization for Planner.
Merge branch 'master' of https://github.com/Ramqvist/shrdlite-template