From a251d0010adc11e7d4158961667252b1fbe43d20 Mon Sep 17 00:00:00 2001
From: Niels Joubert <njoubert@gmail.com>
Date: Sun, 1 Jun 2014 01:07:20 -0700
Subject: [PATCH] AP_NOTIFY: RTK GPS visual notification through faster blink

---
 libraries/AP_Notify/ToshibaLED.cpp | 34 ++++++++++++++++++++++++++++++
 1 file changed, 34 insertions(+)

diff --git a/libraries/AP_Notify/ToshibaLED.cpp b/libraries/AP_Notify/ToshibaLED.cpp
index 7789ab09a7..d280bad862 100644
--- a/libraries/AP_Notify/ToshibaLED.cpp
+++ b/libraries/AP_Notify/ToshibaLED.cpp
@@ -209,9 +209,25 @@ void ToshibaLED::update_colours(void)
             // flashing blue if disarmed with no gps lock
             switch(step) {
                 case 0:
+                    if (AP_Notify::flags.gps_status >= AP_GPS::GPS_OK_FIX_3D_DGPS) {
+                        _green_des = brightness;
+                    }
+                    break;
                 case 1:
+                    if (AP_Notify::flags.gps_status >= AP_GPS::GPS_OK_FIX_3D_DGPS) {
+                        _green_des = TOSHIBA_LED_OFF;
+                    }
+                    break;
                 case 2:
+                    if (AP_Notify::flags.gps_status >= AP_GPS::GPS_OK_FIX_3D_DGPS) {
+                        _green_des = brightness;
+                    }
+                    break;
                 case 3:
+                    if (AP_Notify::flags.gps_status >= AP_GPS::GPS_OK_FIX_3D_DGPS) {
+                        _green_des = TOSHIBA_LED_OFF;
+                    }
+                    break;
                 case 4:
                     _red_des = TOSHIBA_LED_OFF;
                     if (AP_Notify::flags.gps_status >= AP_GPS::GPS_OK_FIX_3D) {
@@ -225,9 +241,27 @@ void ToshibaLED::update_colours(void)
                     }
                     break;
                 case 5:
+                    if (AP_Notify::flags.gps_status >= AP_GPS::GPS_OK_FIX_3D_DGPS) {
+                        _green_des = TOSHIBA_LED_OFF;
+                    }
+                    break;
+
                 case 6:
+                    if (AP_Notify::flags.gps_status >= AP_GPS::GPS_OK_FIX_3D_DGPS) {
+                        _green_des = brightness;
+                    }
+                    break;
+
                 case 7:
+                    if (AP_Notify::flags.gps_status >= AP_GPS::GPS_OK_FIX_3D_DGPS) {
+                        _green_des = TOSHIBA_LED_OFF;
+                    }
+                    break;
                 case 8:
+                    if (AP_Notify::flags.gps_status >= AP_GPS::GPS_OK_FIX_3D_DGPS) {
+                        _green_des = brightness;
+                    }
+                    break;
                 case 9:
                     // all off
                     _red_des = TOSHIBA_LED_OFF;