Session fixes

A set of fixes of some bugs discovered after using the pathplanner on the real world.