stmhal: Remove servo LED debugging.
stmhal: Improved interface to accelerometer.