Changed baud rate to 115200 and updated Makefile and syscalls.c
Added software servo limits
Cleaned up syscalls.c and startup.c