commander: tunes cleanup and fixes

1 files changed, 15 insertions, 17 deletions

diff --git a/src/modules/commander/commander_helper.cpp b/src/modules/commander/commander_helper.cpp
index 265c0134c..fe6c9bfaa 100644
--- a/src/modules/commander/commander_helper.cpp
+++ b/src/modules/commander/commander_helper.cpp
@@ -82,20 +82,20 @@ bool is_rotary_wing(const struct vehicle_status_s *current_status)
 	       || (current_status->system_type == VEHICLE_TYPE_COAXIAL);
 }
 
-static int buzzer;
+static int buzzer = -1;
 static hrt_abstime blink_msg_end = 0;	// end time for currently blinking LED message, 0 if no blink message
 static hrt_abstime tune_end = 0;		// end time of currently played tune, 0 for repeating tunes or silence
-static int tune_current = 0;		// currently playing tune, can be interrupted after tune_end
-static int tune_durations[TONE_NUMBER_OF_TUNES];
+static int tune_current = TONE_STOP_TUNE;		// currently playing tune, can be interrupted after tune_end
+static unsigned int tune_durations[TONE_NUMBER_OF_TUNES];
 
 int buzzer_init()
 {
 	tune_end = 0;
 	tune_current = 0;
 	memset(tune_durations, 0, sizeof(tune_durations));
-	tune_durations[TONE_NOTIFY_POSITIVE_TUNE] = 700000;
-	tune_durations[TONE_NOTIFY_NEGATIVE_TUNE] = 700000;
-	tune_durations[TONE_NOTIFY_NEUTRAL_TUNE] = 700000;
+	tune_durations[TONE_NOTIFY_POSITIVE_TUNE] = 800000;
+	tune_durations[TONE_NOTIFY_NEGATIVE_TUNE] = 900000;
+	tune_durations[TONE_NOTIFY_NEUTRAL_TUNE] = 500000;
 	tune_durations[TONE_ARMING_WARNING_TUNE] = 3000000;
 
 	buzzer = open(TONEALARM_DEVICE_PATH, O_WRONLY);
@@ -105,8 +105,6 @@ int buzzer_init()
 		return ERROR;
 	}
 
-	ioctl(buzzer, TONE_SET_ALARM, TONE_STOP_TUNE);
-
 	return OK;
 }
 
@@ -116,15 +114,15 @@ void buzzer_deinit()
 }
 
 void set_tune(int tune) {
-	int new_tune_duration = tune_durations[tune];
+	unsigned int new_tune_duration = tune_durations[tune];
 	/* don't interrupt currently playing non-repeating tune by repeating */
-	if (tune_end == 0 || new_tune_duration > 0 || hrt_absolute_time() > tune_end) {
+	if (tune_end == 0 || new_tune_duration != 0 || hrt_absolute_time() > tune_end) {
 		/* allow interrupting current non-repeating tune by the same tune */
-		if (tune != tune_current || new_tune_duration > 0) {
+		if (tune != tune_current || new_tune_duration != 0) {
 			ioctl(buzzer, TONE_SET_ALARM, tune);
 		}
 		tune_current = tune;
-		if (new_tune_duration > 0) {
+		if (new_tune_duration != 0) {
 			tune_end = hrt_absolute_time() + new_tune_duration;
 		} else {
 			tune_end = 0;
@@ -133,7 +131,7 @@ void set_tune(int tune) {
 }
 
 /**
- * Blink green LED and play positive tune (if use_busser == true).
+ * Blink green LED and play positive tune (if use_buzzer == true).
  */
 void tune_positive(bool use_buzzer)
 {
@@ -146,7 +144,7 @@ void tune_positive(bool use_buzzer)
 }
 
 /**
- * Blink white LED and play neutral tune (if use_busser == true).
+ * Blink white LED and play neutral tune (if use_buzzer == true).
  */
 void tune_neutral(bool use_buzzer)
 {
@@ -159,7 +157,7 @@ void tune_neutral(bool use_buzzer)
 }
 
 /**
- * Blink red LED and play negative tune (if use_busser == true).
+ * Blink red LED and play negative tune (if use_buzzer == true).
  */
 void tune_negative(bool use_buzzer)
 {
@@ -185,8 +183,8 @@ int blink_msg_state()
 	}
 }
 
-static int leds;
-static int rgbleds;
+static int leds = -1;
+static int rgbleds = -1;
 
 int led_init()
 {