Create main.cpp

First upload to new fork which I will then pull request into the UBC Snowbots repo