|
发表于 2010-5-23 19:14:22
|
显示全部楼层
- #define Distance 1 // 定义一个名字为distance的常量,值为1
- #define Sonar S4 //定义Sonar为S4(输入口4)
- #define Touch S1 //定义TOUCH为S1(输入口1)
- #define Time 2000 // 定义一个名字为TIME的常量,值为2000(等待2秒)
- task main()
- {
- SetSensorLowspeed(Sonar); //设置传感器类型为超声波传感器
- SetSensorTouch(Touch); //设置传感器类型为触碰传感器
- while(SensorUS(Sonar) != Distance) //等待距离小于DISTANCE
- OnFwd(OUT_BC,100);
- Off(OUT_BC); //停止马达BC
- OnFwd (OUT_A,100); //启动马达A
- Wait(Time); //等待时间TIME(2秒)
- Off(OUT_A); //关闭马达A
- while(Sensor(Touch) != 1) // 等待触碰被按下
- OnFwd(OUT_BC,100); //马达BC向前走,速度为100
- OnRev (OUT_A,100); //马达A向后退,速度100
- Wait(Time); //等待2秒
- Off(OUT_A); //关闭马达A
- OnRev(OUT_BC,100); // 马达BC后退,速度100
- Wait(5000); //等待5秒
- }
复制代码 |
|