void start_arm() { arm.connect(); if (!arm.connected()) { printf("[ARM TEST] Not connected to anything, disconnecting...\n"); arm.disconnect(); exit(1); } arm.load_calibration_params("calib_params.json"); if (!arm.calibrated()) { arm.disconnect(); exit(1); } }
void stop_arm() { arm.disconnect(); }