【新手贴】发一个乐高8547分色机器人的NXC代码。

luo_12yan

RT：
一直喜欢用Lejos写写乐高程序。由于一此原因，必须用回原版固件。第三方语言只能使用NXC了！
发一个练手的代码。请批评指正！

1. int count=0;//计数
   
2. 
   
3. /******************
   
4. 让一个球掉进分色器
   
5. *******************/
   
6. void runB()
   
7. {
   
8.     OnFwd(OUT_B,50);
   
9.     until (SENSOR_1==1);
   
10.     RotateMotor(OUT_B,50,288);
    
11. }
    
12. 
    
13. /*********************
    
14. 主程序
    
15. **********************/
    
16. task main()
    
17. {
    
18.   SetSensorTouch(IN_1);//初始化触碰传感器,给进球器使用
    
19.   SetSensorTouch(IN_2);//初始化触碰传感器,给分色器使用
    
20.   SetSensorColorFull(IN_3);//初始化颜色传感器。
    
21.   OnFwd(OUT_C,50);
    
22.   until (SENSOR_2==1);
    
23.   RotateMotor(OUT_C,50,45);//分色器系统复位
    
24.   while (true)//分球开始
    
25.   {
    
26.       switch(SENSOR_3)
    
27.       {
    
28.            case 2://蓝色球使用0度篮筐
    
29.               runB();
    
30.               Wait(300);
    
31.            break;
    
32.            case 3://绿色球使用90度篮筐
    
33.                RotateMotor(OUT_C,40,90);
    
34.                runB();
    
35.                RotateMotor(OUT_C,40,270);//归位到0度篮筐
    
36.            break;
    
37.            case 4://黄色球使用180度篮筐
    
38.                RotateMotor(OUT_C,40,180);
    
39.                runB();
    
40.                RotateMotor(OUT_C,40,180);
    
41.            break;
    
42.            case 5://红色球使用270度篮筐
    
43.                RotateMotor(OUT_C,40,270);
    
44.                runB();
    
45.                RotateMotor(OUT_C,40,90);
    
46.            break;
    
47.            default:
    
48.               runB();
    
49.               count++;
    
50.               if(count==5)//如果系统循环5次仍然没找到球就停止程序
    
51.               {StopAllTasks();}
    
52.            break;
    
53.       }
    
54.   }
    
55. }

复制代码

xielego

沙发，顶一下，比我强。