diff --git a/main.c b/main.c
index ee6a760..9af1424 100644
--- a/main.c
+++ b/main.c
@@ -2093,8 +2093,8 @@ static const VNAShellCommand commands[] =
    { "u", cmd_u,    CMD_WAIT_MUTEX },
 #endif
 #ifdef TINYSA4
-   { "g", cmd_g,    CMD_WAIT_MUTEX },
    { "q", cmd_q,    CMD_WAIT_MUTEX },
+   { "g", cmd_g,    CMD_WAIT_MUTEX },
    { "n", cmd_n,    CMD_WAIT_MUTEX },
    { "z", cmd_z,    CMD_WAIT_MUTEX },
 #endif
diff --git a/nanovna.h b/nanovna.h
index 31f6cdd..43569c2 100644
--- a/nanovna.h
+++ b/nanovna.h
@@ -18,7 +18,7 @@
  */
 #include "ch.h"
 
-//#ifdef TINYSA_F303
+#ifdef TINYSA_F303
 #ifdef TINYSA_F072
 #error "Remove comment for #ifdef TINYSA_F303"
 #endif
@@ -26,7 +26,7 @@
 #define TINYSA4
 #endif
 #define TINYSA4_PROTO
-//#endif
+#endif
 
 #ifdef TINYSA_F072
 #ifdef TINYSA_F303
@@ -343,14 +343,14 @@ extern bool ultra;
 #ifdef TINYSA4
 extern float measured_noise_figure;
 extern float *drive_dBm;
+extern bool level_error;
+#else
+extern const int8_t drive_dBm [];
 extern int test_output;
 extern int test_output_switch;
 extern int test_output_drive;
 extern int test_output_attenuate;
 extern int test_path;
-extern bool level_error;
-#else
-extern const int8_t drive_dBm [];
 #endif
 extern uint8_t signal_is_AM;
 extern const uint32_t reffer_freq[];
@@ -1272,7 +1272,7 @@ typedef char assert_setting[sizeof(setting_t)> SAVE_PROP_CONFIG_SIZE ? -1 : 1];
 // Should include all save slots
 #define SAVE_CONFIG_AREA_SIZE   (SAVE_CONFIG_SIZE + SAVEAREA_MAX * SAVE_PROP_CONFIG_SIZE)
 
-typedef char assert_flash[ SAVE_CONFIG_ADDR + SAVE_CONFIG_AREA_SIZE >= FLASH_END ? -1 : 1];
+typedef char assert_flash[ SAVE_CONFIG_ADDR + SAVE_CONFIG_AREA_SIZE > FLASH_END ? -1 : 1];
 
 #else
 #define SAVEAREA_MAX 4
diff --git a/sa_cmd.c b/sa_cmd.c
index ab6ef67..bab2188 100644
--- a/sa_cmd.c
+++ b/sa_cmd.c
@@ -1154,7 +1154,7 @@ VNA_SHELL_FUNCTION(cmd_caloutput)
     set_refer_output(m - 1);
 }
 
-#ifdef TINYSA4
+#if 0
 VNA_SHELL_FUNCTION(cmd_q)
 {
   if (argc < 1) {
@@ -1182,10 +1182,15 @@ again:
   case 's':  test_output_switch = *a - '0'; break;
   case 'd': test_output_drive = atoi(a); break;
   case 'a': test_output_attenuate = atoi(a); break;
+#ifdef TINYSA4
   case 'p': test_path = *a - '0'; break;
+#endif
   }
   goto again;
 }
+#endif
+
+#ifdef TINYSA4
 
 extern float Si446x_get_temp(void);
 VNA_SHELL_FUNCTION(cmd_k)
diff --git a/sa_core.c b/sa_core.c
index cde1a7a..dd32d9e 100644
--- a/sa_core.c
+++ b/sa_core.c
@@ -3185,12 +3185,12 @@ void clock_at_48MHz(void)
   }
 }
 
-#ifdef TINYSA4
 int test_output = false;
 int test_output_switch = false;
 int test_output_drive = 0;
 int test_path = 0;
 int test_output_attenuate = 0;
+#ifdef TINYSA4
 bool level_error = false;
 static float old_temp = 0.0;
 #endif
@@ -3345,8 +3345,9 @@ pureRSSI_t perform(bool break_on_operation, int i, freq_t f, int tracking)     /
 #ifdef TINYSA4
     if (setting.mode == M_LOW)
       set_input_path(f);
+    else
 #endif
-    else if (setting.mode == M_GENLOW) {// if in low output mode and level sweep or frequency weep is active or at start of sweep
+    if (setting.mode == M_GENLOW) {// if in low output mode and level sweep or frequency weep is active or at start of sweep
         float ls=setting.level_sweep;                                           // calculate and set the output level
         if (ls > 0)
           ls += 0.5;
@@ -3354,9 +3355,17 @@ pureRSSI_t perform(bool break_on_operation, int i, freq_t f, int tracking)     /
           ls -= 0.5;
         float a = ((int)((setting.level + ((float)i / sweep_points) * ls)*2.0)) / 2.0 /* + get_level_offset() */ ;
 #ifdef TINYSA4
-        {
-          set_output_path(f, a);
+        set_output_path(f, a);
 #else
+        int d;
+#if 0
+        if (test_output) {
+          setting.atten_step = test_output_switch;
+          d = test_output_drive;
+          setting.attenuate_x2 = test_output_attenuate;
+          goto set_path;
+        }
+#endif
         correct_RSSI_freq = get_frequency_correction(f);
         a += PURE_TO_float(correct_RSSI_freq);
         if (a != old_a) {
@@ -3364,14 +3373,11 @@ pureRSSI_t perform(bool break_on_operation, int i, freq_t f, int tracking)     /
           a = a - level_max();                 // convert to all settings maximum power output equals a = zero
           if (a < -SWITCH_ATTENUATION) {
             a = a + SWITCH_ATTENUATION;
-            SI4432_Sel = SI4432_RX ;
-            set_switch_receive();
+            setting.atten_step = true;
           } else {
-            SI4432_Sel = SI4432_RX ;
-            set_switch_transmit();
+            setting.atten_step = false;
           }
 #define LOWEST_LEVEL MIN_DRIVE
-          int d;
           d = MAX_DRIVE-3;        // Start in the middle
           float blw =  BELOW_MAX_DRIVE(d);
           while (a > blw && d < MAX_DRIVE) { // Increase if needed
@@ -3383,18 +3389,24 @@ pureRSSI_t perform(bool break_on_operation, int i, freq_t f, int tracking)     /
             blw =  BELOW_MAX_DRIVE(d);
           }
           a -= blw;
-          SI4432_Sel = SI4432_RX ;
-          SI4432_Drive(d);
-          if (a > 0) {
+          if (a > 0)
             a = 0;
           if (a < -31.5)
             a = -31.5;
           a = -a - 0.25;        // Rounding
           setting.attenuate_x2 = (int)(a * 2);
+//        set_path:
+          SI4432_Sel = SI4432_RX ;
+          SI4432_Drive(d);
+          SI4432_Sel = SI4432_RX ;
+          if ( setting.atten_step)
+            set_switch_receive();
+          else
+            set_switch_transmit();
           PE4302_Write_Byte(setting.attenuate_x2);
 #if 0
           if (SDU1.config->usbp->state == USB_ACTIVE)
-             shell_printf ("level=%f, d=%d, a=%f, s=%d\r\n", setting.level, d, a, (setting.atten_step ? 1 : 0));
+             shell_printf ("level=%f, d=%d, a=%d, s=%d\r\n", setting.level, d, setting.attenuate_x2, (setting.atten_step ? 1 : 0));
 #endif
 #endif
       }