Added/updated line following test code
Added several versions of final code