fixed PID errors, incorrect logic in message_parser and replaced boost::array in pid_error, fixed uninitialized variable in mainapp
removed unused mainappinterface
changed pid to now use atomics
clean up of messageparser
updated servo_switch to start using atomics