Stripped out some of the older irrelevant code and added Step / Dir tester

Signed-off-by: Seb Lee-Delisle <sebleedelisle@gmail.com>
Merge branch 'master' of github.com:sebleedelisle/freeservo