X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=altosui%2FAltosSerial.java;h=ff1a91a5dedb1206e95376cff310bbad31b7b7bf;hb=d77a4ea206d627635159f35c76c744687d4e633b;hp=0a531aa96faa8b2b0b27fc0f412b78c920648231;hpb=746d6a472a20243a8c0eacc8edf8e81e0641bc17;p=fw%2Faltos

diff --git a/altosui/AltosSerial.java b/altosui/AltosSerial.java
index 0a531aa9..ff1a91a5 100644
--- a/altosui/AltosSerial.java
+++ b/altosui/AltosSerial.java
@@ -323,8 +323,10 @@ public class AltosSerial implements Runnable {
 		}
 		altos = device.open();
 		if (altos == null) {
+			final String	message = device.getErrorString();
 			close();
-			throw new FileNotFoundException(device.toShortString());
+			throw new FileNotFoundException(String.format("%s (%s)",
+								      device.toShortString(), message));
 		}
 		if (debug)
 			System.out.printf("Open %s\n", device.getPath());
@@ -361,12 +363,26 @@ public class AltosSerial implements Runnable {
 		}
 	}
 
+	private void set_radio_freq(int frequency) {
+		if (altos != null) {
+			if (monitor_mode)
+				printf("m 0\nc F %d\nm %x\n",
+				       frequency, telemetry_len());
+			else
+				printf("c F %d\n", frequency);
+			flush_output();
+		}
+	}
+
 	public void set_radio_frequency(double frequency,
+					boolean has_frequency,
 					boolean has_setting,
 					int cal) {
 		if (debug)
-			System.out.printf("set_radio_frequency %7.3f %b %d\n", frequency, has_setting, cal);
-		if (has_setting)
+			System.out.printf("set_radio_frequency %7.3f (freq %b) (set %b) %d\n", frequency, has_frequency, has_setting, cal);
+		if (has_frequency)
+			set_radio_freq((int) Math.floor (frequency * 1000));
+		else if (has_setting)
 			set_radio_setting(AltosConvert.radio_frequency_to_setting(frequency, cal));
 		else
 			set_channel(AltosConvert.radio_frequency_to_channel(frequency));
@@ -376,6 +392,7 @@ public class AltosSerial implements Runnable {
 		frequency = in_frequency;
 		config_data();
 		set_radio_frequency(frequency,
+				    config_data.radio_frequency != 0,
 				    config_data.radio_setting != 0,
 				    config_data.radio_calibration);
 	}