nearly complete
This commit is contained in:
		
							parent
							
								
									f76e1f5594
								
							
						
					
					
						commit
						3510e3cd16
					
				|  | @ -6,13 +6,14 @@ bool flag=false; | |||
| SoftwareSerial sendingSerial(5,6); | ||||
| SoftwareSerial bluetoothSerial(7,8); | ||||
| String sending="",received=""; | ||||
| const int Rp=0,Rr=1,interval=100;//Rp,Rr 分别为两个遥杆的接口
 | ||||
| const int Rp=3,Rr=2,interval=100;//Rp,Rr 分别为两个遥杆的接口
 | ||||
| long propeller=0,rudder=0,dist;//propeller为螺旋桨(0-1023,512为静止),rudder为舵(0-1023,512为静止)
 | ||||
| long sending_signal=0;//发送的信号
 | ||||
| long response=0; | ||||
| //const byte addresser[6]={"00001"};//创建通信通道地址,6用来写,8用来读
 | ||||
| long time=0; | ||||
| void setup() { | ||||
| 
 | ||||
|   Serial.begin(9600); | ||||
|   sendingSerial.begin(38400); | ||||
|   bluetoothSerial.begin(57600); | ||||
|  | @ -37,6 +38,8 @@ void loop() { | |||
|   sending_signal=0; | ||||
|   propeller=analogRead(Rp); | ||||
|   rudder=analogRead(Rr); | ||||
|   propeller=propeller*1.41; | ||||
|   rudder=rudder*1.41; | ||||
|   if(propeller>=1000)propeller=999; | ||||
|   if(rudder>=1000)rudder=999; | ||||
|   sending_signal+=propeller; | ||||
|  |  | |||
|  | @ -2,7 +2,7 @@ | |||
| #include<SoftwareSerial.h> | ||||
| #include "Ucglib.h" | ||||
| #define interruptPin 2 | ||||
| SoftwareSerial sendingSerial(6,7); | ||||
| SoftwareSerial sendingSerial(5,6); | ||||
| int Ymax = 128;               //屏幕的竖向像素数
 | ||||
| int Xmax = 160;               //屏幕的横向像素数
 | ||||
| int Xcent = Xmax / 2;         //x中位
 | ||||
|  | @ -67,6 +67,7 @@ void loop() { | |||
|     else{ | ||||
|       rec=true; | ||||
|       sendingSerial.read();//把换行符读掉
 | ||||
|       Serial.println(received); | ||||
|       if(received[0]=='1'){ | ||||
|         ignoreClr=false; | ||||
|         distance=received.substring(4).toInt();//个十百3位数
 | ||||
|  |  | |||
|  | @ -70,8 +70,8 @@ long confirm(long x){ | |||
| } | ||||
| void loop() { | ||||
|   int distance=0; | ||||
|   Serial.print("s: "); | ||||
|   Serial.println(status);  | ||||
|  // Serial.print("s: ");
 | ||||
|  // Serial.println(status); 
 | ||||
|   if(status==0){ | ||||
|     if(x<180){ | ||||
|       x+=2; | ||||
|  | @ -86,11 +86,11 @@ void loop() { | |||
|     //response=1000000+x*1000+distance;
 | ||||
|     response=0; | ||||
|     response+=distance; | ||||
|     Serial.println(response); | ||||
|     //Serial.println(response);
 | ||||
|     response+=(long)x*1000; | ||||
|     Serial.println(response); | ||||
|     //Serial.println(response);
 | ||||
|     response+=1000000; | ||||
|     Serial.println(response); | ||||
|     //Serial.println(response);
 | ||||
|   } | ||||
|   else if(status==1){ | ||||
|     if(x>0){ | ||||
|  | @ -105,11 +105,11 @@ void loop() { | |||
|     //response=1000000+x*1000+distance;
 | ||||
|     response=0; | ||||
|     response+=distance; | ||||
|     Serial.println(response); | ||||
|     //Serial.println(response);
 | ||||
|     response+=(long)x*1000; | ||||
|     Serial.println(response); | ||||
|     //Serial.println(response);
 | ||||
|     response+=1000000; | ||||
|     Serial.println(response); | ||||
|     //Serial.println(response);
 | ||||
|     //send distance
 | ||||
|   } | ||||
|   else if(status=2){ | ||||
|  | @ -128,11 +128,11 @@ void loop() { | |||
|   } | ||||
|   sending=String(response); | ||||
| 
 | ||||
|   Serial.print("x: "); | ||||
|   Serial.println(x); | ||||
|   Serial.print("d: "); | ||||
|   Serial.println(distance); | ||||
|   Serial.println(response);   | ||||
|   // Serial.print("x: ");
 | ||||
|   // Serial.println(x);
 | ||||
|   // Serial.print("d: ");
 | ||||
|   // Serial.println(distance);
 | ||||
|   // Serial.println(response);  
 | ||||
|   Serial.println(sending); | ||||
|   bluetoothSerial.println(sending); | ||||
|   delay(interval); | ||||
|  | @ -147,7 +147,7 @@ void loop() { | |||
|     } | ||||
|     else{ | ||||
|       bluetoothSerial.read();//把换行符读掉
 | ||||
|       //Serial.println(received);
 | ||||
|       Serial.println(received); | ||||
|       //Serial.println(received.length());
 | ||||
|       //content=toInt(received);
 | ||||
|       if(received[0]=='1'&&received.length()-1==7){ | ||||
|  | @ -160,8 +160,8 @@ void loop() { | |||
|             digitalWrite(IN1,LOW); | ||||
|             analogWrite(PWM,zheng); | ||||
|             z=zheng; | ||||
|             //Serial.println("forward propelling");
 | ||||
|             //Serial.println(z);
 | ||||
|             Serial.println("forward propelling"); | ||||
|             Serial.println(z); | ||||
|           } | ||||
|           else if(propeller<449){ | ||||
|             long fan=255-0.568*propeller; | ||||
|  | @ -169,15 +169,15 @@ void loop() { | |||
|             digitalWrite(IN2,LOW); | ||||
|             analogWrite(PWM,fan); | ||||
|             z=fan; | ||||
|             //Serial.println("back propelling");
 | ||||
|             //Serial.println(z);
 | ||||
|             Serial.println("back propelling"); | ||||
|             Serial.println(z); | ||||
|           } | ||||
|         } | ||||
|         else if(propeller<=550||propeller>=449){ | ||||
|           z=0; | ||||
|           analogWrite(PWM,0); | ||||
|           //Serial.println("stop propelling");
 | ||||
|           //Serial.println(z);
 | ||||
|           Serial.println("stop propelling"); | ||||
|           Serial.println(z); | ||||
|         }  | ||||
|         //Serial.println("inputing ruddering");
 | ||||
|         if(rudder>550||rudder<449) | ||||
|  |  | |||
		Loading…
	
		Reference in New Issue