Extras and Start of main code

Getting ready to use FreeRTOS