task usercontrol(){ while(true){ if(disabled != false){ //while functioning correctly power_drive(get_motor_power(vexRT[L_Y_JOY], 127), get_motor_power(vexRT[R_Y_JOY], 127)); if(vexRT[R_U_BTN]){ power_lift(50); } else if(vexRT[R_D_BTN]){ power_lift(-50); } else power_lift(0); } if(vexRT[L1] && vexRT[R1]){disabled = true;} //disable robot if(vexRT[L2] && vexRT[R2]){disabled = false;} //enable robot } }
void bt_packet_get_motor_power(bt_packet_t *p, uint8_t port) { get_motor_power(&p->packets[0], port); }