split main.c, added util.c
Merge branch 'master' of github.com:strongwillow/robotcar