DNM px4_fmu-v5x Using Probes

boards/px4/fmu-v5x/nuttx-config/nsh/defconfig

@@ -75,6 +75,7 @@ CONFIG_BOARD_ASSERT_RESET_VALUE=0
 CONFIG_BOARD_CRASHDUMP=y
 CONFIG_BOARD_LOOPSPERMSEC=22114
 CONFIG_BOARD_RESET_ON_ASSERT=2
+CONFIG_BOARD_USE_PROBES=y
 CONFIG_BUILTIN=y
 CONFIG_CDCACM=y
 CONFIG_CDCACM_IFLOWCONTROL=y

src/drivers/pwm_out/PWMOut.cpp

@@ -319,5 +319,19 @@ px4io driver is used for main ones.
 
 extern "C" __EXPORT int pwm_out_main(int argc, char *argv[])
 {
+#if defined(CONFIG_BOARD_USE_PROBES)
+#pragma message "warning PWM will not Function when CONFIG_BOARD_USE_PROBES is set"
+  PROBE_INIT(0xff);
+  PROBE(1,1);
+  PROBE(2,1);
+  PROBE(3,1);
+  PROBE(4,1);
+  PROBE(5,1);
+  PROBE(6,1);
+  PROBE(7,1);
+  PROBE(8,1);
+  return 0;
+#else
 	return PWMOut::main(argc, argv);
+#endif
 }

src/modules/logger/logger.cpp

@@ -115,6 +115,9 @@ static void timer_callback(void *arg)
 
 }
 
+extern "C" int dump_holder(void);
+extern volatile int g_pi_ndx;
+extern volatile int g_pi_sample;
 
 int logger_main(int argc, char *argv[])
 {
@@ -126,6 +129,13 @@ int logger_main(int argc, char *argv[])
 		return 1;
 	}
 
+	if (argc == 2 && strcmp(argv[1], "-d") == 0) {
+
+		dump_holder();
+		g_pi_ndx = 0;
+		return 0;
+	}
+
 	return Logger::main(argc, argv);
 }