示例#1
0
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
	}
}
示例#2
0
void bt_packet_get_motor_power(bt_packet_t *p, uint8_t port)
{
	get_motor_power(&p->packets[0], port);

}