X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=altoslib%2FAltosLink.java;h=77b400fc01bf541779860aed2f74513edde223ae;hb=7a19d6790a9800f925c8de24aac71796351e2c04;hp=9b80e9166f473241855eaa28cbf56e0d373f4089;hpb=f86dac643081987c8994ab57a96640d5e91b342a;p=fw%2Faltos

diff --git a/altoslib/AltosLink.java b/altoslib/AltosLink.java
index 9b80e916..77b400fc 100644
--- a/altoslib/AltosLink.java
+++ b/altoslib/AltosLink.java
@@ -141,6 +141,31 @@ public abstract class AltosLink {
 		return AltosLib.telemetry_len(telemetry);
 	}
 
+	private void set_radio_freq(int frequency) {
+		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 (freq %b) (set %b) %d\n", frequency, has_frequency, has_setting, cal);
+		if (frequency == 0)
+			return;
+		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));
+	}
+
 	public void set_telemetry(int in_telemetry) {
 		telemetry = in_telemetry;
 		if (monitor_mode)