Test Wall Follow Code

Code for testing wall following