added a kill command in pxh console to kill the whole process including gz server

platforms/posix/src/px4/common/px4_daemon/pxh.cpp

@@ -49,6 +49,7 @@
 #include <poll.h>
 #include <fcntl.h>
 #include <unistd.h>
+#include <stdlib.h>
 
 #include "pxh.h"
 
@@ -124,6 +125,9 @@ int Pxh::process_line(const std::string &line, bool silently_fail)
 		list_builtins(_apps);
 		return 0;
 
+	} else if (command == "kill") {
+		return shutdown_handler(0, nullptr);
+
 	} else if (command.length() == 0 || command[0] == '#') {
 		// Do nothing
 		return 0;
@@ -551,4 +555,18 @@ void Pxh::_tab_completion(std::string &mystr)
 	}
 }
 
+int Pxh::shutdown_handler(int argc, char *argv[])
+{
+	printf("Force shutting down...\n");
+	fflush(stdout);
+
+	// Force kill all child processes
+	int ret = system("pkill -9 -f gz");
+	(void)ret;  // Suppress warning about unused return value
+	printf("Killed gz...\n");
+	ret = system("pkill -9 -f px4");
+	(void)ret;  // Suppress warning about unused return value
+	return 0;
+}
+
 } // namespace px4_daemon

platforms/posix/src/px4/common/px4_daemon/pxh.h

@@ -81,6 +81,7 @@ class Pxh
 	 */
 	static void stop();
 
+	static int shutdown_handler(int argc, char *argv[]);
 private:
 	void _print_prompt();
 	void _move_cursor(int position);