update RTH and add GPS Rescue velocity

Author: ctzsnooze

js/flightlog_fielddefs.js

@@ -339,6 +339,7 @@ var
             "TIMING_ACCURACY",
             "RX_EXPRESSLRS_SPI",
             "RX_EXPRESSLRS_PHASELOCK",
+            "GPS_RESCUE_VELOCITY_PID",
     ]),
 
     SUPER_EXPO_YAW = makeReadOnly([

js/flightlog_fields_presenter.js

@@ -626,6 +626,13 @@ function FlightLogFieldPresenter() {
             'debug[2]':'Frequency Offset',
             'debug[3]':'Phase Shift',
         },
+        'GPS_RESCUE_VELOCITY' : {
+            'debug[all]':'GPS Rescue Velocity PIDs',
+            'debug[0]':'Velocity P',
+            'debug[1]':'Velocity I',
+            'debug[2]':'Velocity D',
+            'debug[3]':'GroundSpeed',
+        },
     };
 
     let DEBUG_FRIENDLY_FIELD_NAMES = null;
@@ -1006,8 +1013,12 @@ function FlightLogFieldPresenter() {
                     }
                 case 'RTH':
                     switch(fieldName) {
+                        case 'debug[0]':
+                            return value.toFixed(0) + 'us';
                         case 'debug[1]':
                             return (value / 100).toFixed(1) + 'deg';
+                        case 'debug[2]':
+                            return value.toFixed(0) + 'us';
                         default:
                             return value.toFixed(0);
                     }
@@ -1063,7 +1074,15 @@ function FlightLogFieldPresenter() {
                             return value.toFixed(0) + "Hz";
                     }
                 case 'GPS_RESCUE_THROTTLE_PID':
-                        return value.toFixed(0);
+                    switch (fieldName) {
+                        // debug 0 = Throttle P
+                        // debug 1 = Throttle I
+                        // debug 3 = Throttle D
+                        case 'debug[3]': // current altitude
+                            return (value / 100).toFixed(2) + 'm';
+                        default:
+                            return value.toFixed(0);
+                    }
                 case 'DYN_IDLE':
                     switch (fieldName) {
                         case 'debug[3]': // minRPS
@@ -1132,6 +1151,16 @@ function FlightLogFieldPresenter() {
                         default:
                             return value.toFixed(0) + 'us';
                     }
+                case 'GPS_RESCUE_VELOCITY':
+                    switch (fieldName) {
+                        // debug 0 = Velocity P
+                        // debug 1 = Velocity I
+                        // debug 2 = Velocity D
+                        case 'debug[3]': // Velocity
+                            return (value / 100).toFixed(0) + 'm/s';
+                        default:
+                            return value.toFixed(0);
+                    }
             }
             return value.toFixed(0);
         }

js/graph_config.js

@@ -736,7 +736,7 @@ GraphConfig.load = function(config) {
                             default:
                                 return getCurveForMinMaxFields(fieldName);
                             }
-                        case 'GPS_RESCUE_THROTTLE_PID':
+                    case 'GPS_RESCUE_THROTTLE_PID':
                         switch (fieldName) {
                             case 'debug[0]': // Throttle P
                                 return {
@@ -759,7 +759,79 @@ GraphConfig.load = function(config) {
                                     inputRange: 500,
                                     outputRange: 1.0,
                                 };
-                            case 'debug[0]': // Altitude
+                            case 'debug[3]': // Altitude
+                                return {
+                                    offset: -10000,
+                                    power: 1.0,
+                                    inputRange: 10000,
+                                    outputRange: 1.0,
+                                };
+                            default:
+                                return getCurveForMinMaxFields(fieldName);
+                            }
+                    case 'GPS_RESCUE_VELOCITY_PID':
+                        switch (fieldName) {
+                            case 'debug[0]': // Throttle P
+                                return {
+                                    offset: 0,
+                                    power: 1.0,
+                                    inputRange: 500,
+                                    outputRange: 1.0,
+                                };
+                            case 'debug[1]': // Throttle I
+                                return {
+                                    offset: 0,
+                                    power: 1.0,
+                                    inputRange: 500,
+                                    outputRange: 1.0,
+                                };
+                            case 'debug[2]': // Throttle D
+                                return {
+                                    offset: 0,
+                                    power: 1.0,
+                                    inputRange: 500,
+                                    outputRange: 1.0,
+                                };
+                            case 'debug[3]': // Velocity cm/s
+                                return {
+                                    offset: -1000,
+                                    power: 1.0,
+                                    inputRange: 1000,
+                                    outputRange: 1.0,
+                                };
+                            default:
+                                return getCurveForMinMaxFields(fieldName);
+                            }
+                        case 'RTH':
+                        switch (fieldName) {
+                            case 'debug[0]': // FailureState
+                                return {
+                                    offset: -5,
+                                    power: 1.0,
+                                    inputRange: 5,
+                                    outputRange: 1.0,
+                                };
+                            case 'debug[1]': // Rescue throttle us
+                                return {
+                                    offset: -1500,
+                                    power: 1.0,
+                                    inputRange: 500,
+                                    outputRange: 1.0,
+                                };
+                            case 'debug[2]': // Rescue angle decidegrees
+                                return {
+                                    offset: 0,
+                                    power: 1.0,
+                                    inputRange: 450,
+                                    outputRange: 1.0,
+                                };
+                            case 'debug[3]': // Throttle adjustment us
+                                return {
+                                    offset: 0,
+                                    power: 1.0,
+                                    inputRange: 500,
+                                    outputRange: 1.0,
+                                };
                             default:
                                 return getCurveForMinMaxFields(fieldName);
                             }