adds test code for right wall following
Revert "adds test code for right wall following"

This reverts commit 020238bd4aaa09427fa4d0c09ad0b4aebf83b97d.
adds changes that can be used for right wall following
Merge pull request #3 from friscis/right-wall-following

Right wall following