Fixed signedness of MPL temperature
Added servo command watchdog

If the servo is enabled and hasn't had a command in 1 second it will
default to the center actively. Fixes #55

Also cleaned up debug servo limiting