Add handling of servo responses