那英特灭火程序.docVIP

那英特灭火程序 #pragma config(Sensor, in1, hrr1, sensorDigitalIn) #pragma config(Sensor, in2, hqr1, sensorDigitalIn) #pragma config(Sensor, in3, hzz1, sensorDigitalIn) #pragma config(Sensor, in4, hql1, sensorDigitalIn) #pragma config(Sensor, in5, hll1, sensorDigitalIn) #pragma config(Sensor, in6, fll1, sensorDigitalIn) #pragma config(Sensor, in7, fql1, sensorDigitalIn) #pragma config(Sensor, in8, fzz1, sensorDigitalIn) #pragma config(Sensor, in9, fqr1, sensorDigitalIn) #pragma config(Sensor, in10, frr1, sensorDigitalIn) #pragma config(Sensor, in11, dp1, sensorLineFollower) #pragma config(Sensor, in12, dh1, sensorLineFollower) #pragma config(Sensor, in13, ft1, sensorAccelerometer) #pragma config(Sensor, in14, fp1, sensorAccelerometer) #pragma config(Sensor, in15, aa, sensorDigitalIn) //*!!Code automatically generated by ROBOTC configuration wizard !!*// #pragma platform(VEX) //Competition Control and Duration Settings #pragma competitionControl(Competition) #pragma autonomousDuration(20) #pragma userControlDuration(180) #define mot(a,b) motor(port2)=a; motor(port3)=b;/*左马达接0，右马达接1*/ #define hrr SensorValue(hrr1)/*后右红外*/ #define hqr SensorValue(hqr1)/*后右45度红外*/ #define hzz SensorValue(hzz1)/*后中间红外*/ #define hql SensorValue(hql1)/*后左45度红外*/ #define hll SensorValue(hll1)/*后左红外*/ #define fll SensorValue(fll1)/*后左红外*/ #define fql SensorValue(fql1)/*左45度红外*/ #define fzz SensorValue(fzz1)/*前中间红外*/ #define fqr SensorValue(fqr1)/*右45度红外*/ #define frr SensorValue(frr1)/*右红外*/ #define dp SensorValue(dp1)/*前灰度*/ #define dh SensorValue(dh1)/*后灰度*/ #define ft SensorValue(ft1) #define fp SensorValue(fp1) #define p 1000 int valTime1; #define stop() motor(port2)=0; motor(port3)=0; #define reset_system_time() Cle