Add servo.cpp to ble_firmata example project