X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=altosdroid%2Fsrc%2Forg%2Faltusmetrum%2FAltosDroid%2FTelemetryService.java;h=8e5c7903149c6648ef016ad953d4f878c3ab378b;hp=4ec353e30e88ff2d298b8bea8cb7005607061699;hb=bc3fbcb35090be3856284ccf4d908ebf39d02bec;hpb=0b70ea04e807c69a987d5976ab217f9f65fb1e09

diff --git a/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryService.java b/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryService.java
index 4ec353e3..8e5c7903 100644
--- a/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryService.java
+++ b/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryService.java
@@ -115,6 +115,10 @@ public class TelemetryService extends Service implements LocationListener {
 					if (s.last_state      != null) msg.replyTo.send(Message.obtain(null, AltosDroid.MSG_TELEMETRY, s.last_state     ));
 					if (s.last_location   != null) msg.replyTo.send(Message.obtain(null, AltosDroid.MSG_LOCATION , s.last_location  ));
 					if (s.last_crc_errors != 0   ) msg.replyTo.send(Message.obtain(null, AltosDroid.MSG_CRC_ERROR, s.last_crc_errors));
+					if (s.state == STATE_CONNECTED) {
+						msg.replyTo.send(s.frequency_message());
+						msg.replyTo.send(s.telemetry_rate_message());
+					}
 				} catch (RemoteException e) {
 					s.mClients.remove(msg.replyTo);
 				}
@@ -131,13 +135,17 @@ public class TelemetryService extends Service implements LocationListener {
 				break;
 			case MSG_CONNECTED:
 				if (D) Log.d(TAG, "Connected to device");
-				s.connected();
+				try {
+					s.connected();
+				} catch (InterruptedException ie) {
+				}
 				break;
 			case MSG_CONNECT_FAILED:
 				if (D) Log.d(TAG, "Connection failed... retrying");
 				s.startAltosBluetooth();
 				break;
 			case MSG_DISCONNECTED:
+				Log.d(TAG, "MSG_DISCONNECTED");
 				// Only do the following if we haven't been shutdown elsewhere..
 				if (s.device != null) {
 					if (D) Log.d(TAG, "Disconnected from " + s.device.getName());
@@ -158,6 +166,8 @@ public class TelemetryService extends Service implements LocationListener {
 				if (s.state == STATE_CONNECTED) {
 					try {
 						s.mAltosBluetooth.set_radio_frequency((Double) msg.obj);
+						s.mAltosBluetooth.save_frequency();
+						s.sendMessageToClients(s.frequency_message());
 					} catch (InterruptedException e) {
 					} catch (TimeoutException e) {
 					}
@@ -166,6 +176,8 @@ public class TelemetryService extends Service implements LocationListener {
 			case MSG_SETBAUD:
 				if (s.state == STATE_CONNECTED) {
 					s.mAltosBluetooth.set_telemetry_rate((Integer) msg.obj);
+					s.mAltosBluetooth.save_telemetry_rate();
+					s.sendMessageToClients(s.telemetry_rate_message());
 				}
 				break;
 			default:
@@ -184,6 +196,16 @@ public class TelemetryService extends Service implements LocationListener {
 		}
 	}
 
+	private Message frequency_message() {
+		if (D) Log.d(TAG, String.format("frequency_message %f\n", mAltosBluetooth.frequency()));
+		return Message.obtain(null, AltosDroid.MSG_FREQUENCY, mAltosBluetooth.frequency());
+	}
+
+	private Message telemetry_rate_message() {
+		if (D) Log.d(TAG, String.format("telemetry_rate_message %d\n", mAltosBluetooth.telemetry_rate()));
+		return Message.obtain(null, AltosDroid.MSG_TELEMETRY_RATE, mAltosBluetooth.telemetry_rate());
+	}
+
 	private void stopAltosBluetooth() {
 		if (D) Log.d(TAG, "stopAltosBluetooth(): begin");
 		setState(STATE_READY);
@@ -241,12 +263,14 @@ public class TelemetryService extends Service implements LocationListener {
 		sendMessageToClients(Message.obtain(null, AltosDroid.MSG_STATE_CHANGE, state, -1, acd));
 	}
 
-	private void connected() {
+	private void connected() throws InterruptedException {
 		try {
 			if (mAltosBluetooth == null)
 				throw new InterruptedException("no bluetooth");
 			mConfigData = mAltosBluetooth.config_data();
-		} catch (InterruptedException e) {
+			if (D) Log.d(TAG, "send frequency/rate messages\n");
+			sendMessageToClients(frequency_message());
+			sendMessageToClients(telemetry_rate_message());
 		} catch (TimeoutException e) {
 			// If this timed out, then we really want to retry it, but
 			// probably safer to just retry the connection from scratch.
@@ -258,10 +282,12 @@ public class TelemetryService extends Service implements LocationListener {
 
 		mTelemetryReader = new TelemetryReader(mAltosBluetooth, mHandler);
 		mTelemetryReader.start();
-		
+
 		mTelemetryLogger = new TelemetryLogger(this, mAltosBluetooth);
-	}
 
+		sendMessageToClients(frequency_message());
+		sendMessageToClients(telemetry_rate_message());
+	}
 
 	private void onTimerTick() {
 		if (D) Log.d(TAG, "Timer wakeup");