Removing maestro servo controller code to its own library