Reformatted and changed to 400 default
Motor code working and tested
pre-swtich to Keil