Fix gatt_server_add_service fail issue