fixed servo control and messageing