Start building up a test sample for the path following behaviour
Continue implementing path following