set raycast hit point
fix heading bug
fix theta correction when wall on left side
remove debug outputs
Merge pull request #40 from mlosch/master

Fix odometry correction