Remove panic from servo_driver
Update leap package error handling