fixed bug in intrinsic reward formulation.
more testing and fixed bug with intrinsic reward
Merge branch 'external_vi' of https://github.com/utexas-bwi/bwi_guidance into external_vi