POSIX: Changed px4_debug.h to px4_log.h

Also changed use of printf to PX4_WARN or PX4_INFO in posix and
qurt tests.

Signed-off-by: Mark Charlebois <charlebm@gmail.com>

src/platforms/qurt/px4_layer/px4_qurt_tasks.cpp

@@ -53,11 +53,13 @@
 #include <string>
 
 #include <px4_tasks.h>
+#include <px4_log.h>
 #include <hexagon_standalone.h>
 
 #define MAX_CMD_LEN 100
 
-#define PX4_MAX_TASKS 100
+#define PX4_MAX_TASKS 5
+
 struct task_entry
 {
 	int pid;
@@ -73,28 +75,28 @@ typedef struct
 {
 	px4_main_t entry;
 	int argc;
-	char *argv[];
-	// strings are allocated after the 
+	char * argv[];
+	// strings are allocated after  
 } pthdata_t;
 
 static void entry_adapter ( void *ptr )
 {
-	printf("entry_adapter\n");
 	pthdata_t *data = (pthdata_t *) ptr;
+	PX4_DEBUG("entry_adapter %p %p entry %p %d %p\n", ptr, data, data->entry, data->argc, data->argv[0]);
 
-	printf("data->entry = %p\n", data->entry);
+	PX4_DEBUG("data->entry = %p\n", data->entry);
 	data->entry(data->argc, data->argv);
 	free(ptr);
-	printf("after entry\n");
-	printf("Before px4_task_exit\n");
+	PX4_DEBUG("after entry\n");
+	PX4_DEBUG("Before px4_task_exit\n");
 	px4_task_exit(0); 
-	printf("After px4_task_exit\n");
+	PX4_DEBUG("After px4_task_exit\n");
 } 
 
 void
 px4_systemreset(bool to_bootloader)
 {
-	printf("Called px4_system_reset\n");
+	PX4_DEBUG("Called px4_system_reset\n");
 }
 
 px4_task_t px4_task_spawn_cmd(const char *name, int scheduler, int priority, int stack_size, px4_main_t entry, char * const *argv)
@@ -107,7 +109,7 @@ px4_task_t px4_task_spawn_cmd(const char *name, int scheduler, int priority, int
 	unsigned long structsize;
 	char * p = (char *)argv;
 
-	printf("px4_task_spawn_cmd entry = %p\n", entry);
+	PX4_DEBUG("px4_task_spawn_cmd entry = %p %p %s\n", entry, argv, argv[0]);
 	// Calculate argc
 	while (p != (char *)0) {
 		p = argv[argc];
@@ -116,20 +118,24 @@ px4_task_t px4_task_spawn_cmd(const char *name, int scheduler, int priority, int
 		++argc;
 		len += strlen(p)+1;
 	}
-	printf("arg %d %p\n", argc, argv);
+	PX4_DEBUG("arg %d %p\n", argc, argv);
         structsize = sizeof(pthdata_t)+(argc+1)*sizeof(char *);
 	pthdata_t *taskdata;
     
+	PX4_DEBUG("arg %d %p\n", argc, argv);
 	// not safe to pass stack data to the thread creation
 	taskdata = (pthdata_t *)malloc(structsize+len);
+	PX4_DEBUG("arg %d %p\n", argc, argv);
 	offset = ((unsigned long)taskdata)+structsize;
+	PX4_DEBUG("arg %d %p\n", argc, argv);
 
     	taskdata->entry = entry;
 	taskdata->argc = argc;
 
+	PX4_DEBUG("arg %d %p\n", argc, argv);
 	for (i=0; i<argc; i++) {
-		printf("TEST\n");
-		printf("arg %d %s\n", i, argv[i]);
+		PX4_DEBUG("TEST\n");
+		PX4_DEBUG("arg %d %s\n", i, argv[i]);
 		taskdata->argv[i] = (char *)offset;
 		strcpy((char *)offset, argv[i]);
 		offset+=strlen(argv[i])+1;
@@ -142,11 +148,11 @@ px4_task_t px4_task_spawn_cmd(const char *name, int scheduler, int priority, int
 			taskmap[i].pid = i+1;
 			taskmap[i].name = name;
 			taskmap[i].isused = true;
-			taskmap[i].sp = malloc(stack_size);
+			taskmap[i].sp = malloc(2048);
 			break;
 		}
 	}
-	printf("TEST2\n");
+	PX4_DEBUG("taskdata %p entry %p %d %p\n", taskdata, taskdata->entry, taskdata->argc, taskdata->argv[0]);
 	thread_create(entry_adapter, taskmap[i].sp, i+1, (void *) taskdata);
 
         return i+1;
@@ -154,7 +160,7 @@ px4_task_t px4_task_spawn_cmd(const char *name, int scheduler, int priority, int
 
 int px4_task_delete(px4_task_t id)
 {
-	printf("Called px4_task_delete\n");
+	PX4_DEBUG("Called px4_task_delete\n");
 	return -EINVAL;
 }
 
@@ -167,7 +173,7 @@ void px4_task_exit(int ret)
 
 int px4_task_kill(px4_task_t id, int sig)
 {
-	printf("Called px4_task_kill\n");
+	PX4_DEBUG("Called px4_task_kill\n");
 	return -EINVAL;
 }
 
@@ -176,16 +182,16 @@ void px4_show_tasks()
 	int idx;
 	int count = 0;
 
-	printf("Active Tasks:\n");
+	PX4_DEBUG("Active Tasks:\n");
 	for (idx=0; idx < PX4_MAX_TASKS; idx++)
 	{
 		if (taskmap[idx].isused) {
-			printf("   %-10s %d\n", taskmap[idx].name.c_str(), taskmap[idx].pid);
+			PX4_DEBUG("   %-10s %d\n", taskmap[idx].name.c_str(), taskmap[idx].pid);
 			count++;
 		}
 	}
 	if (count == 0)
-		printf("   No running tasks\n");
+		PX4_DEBUG("   No running tasks\n");
 
 }
 

src/platforms/qurt/px4_layer/work_thread.c

@@ -139,7 +139,7 @@ static void work_process(FAR struct wqueue_s *wqueue, int lock_id)
 
           work_unlock(lock_id);
 	  if (!worker) {
-             printf("MESSED UP: worker = 0\n");
+             PX4_WARN("MESSED UP: worker = 0\n");
           }
           else
             worker(arg);

src/platforms/qurt/tests/hello/hello_example.cpp

@@ -1,4 +1,3 @@
-
 /****************************************************************************
  *
  *   Copyright (C) 2015 Mark Charlebois. All rights reserved.
@@ -40,6 +39,7 @@
  */
 
 #include "hello_example.h"
+#include <px4_log.h>
 #include <unistd.h>
 #include <stdio.h>
 
@@ -52,7 +52,7 @@ int HelloExample::main()
 	int i=0;
 	while (!appState.exitRequested() && i<5) {
 
-		printf("  Doing work...\n");
+		PX4_DEBUG("  Doing work...\n");
 		++i;
 	}
 

src/platforms/qurt/tests/hello/hello_main.cpp

@@ -38,6 +38,7 @@
  * @author Mark Charlebois <charlebm@gmail.com>
  */
 #include <px4_middleware.h>
+#include <px4_log.h>
 #include <px4_app.h>
 #include "hello_example.h"
 #include <stdio.h>
@@ -46,10 +47,10 @@ int PX4_MAIN(int argc, char **argv)
 {
 	px4::init(argc, argv, "hello");
 
-	printf("hello\n");
+	PX4_DEBUG("hello\n");
 	HelloExample hello;
 	hello.main();
 
-	printf("goodbye\n");
+	PX4_DEBUG("goodbye\n");
 	return 0;
 }

src/platforms/qurt/tests/hello/hello_start_qurt.cpp

@@ -38,6 +38,7 @@
  * @author Mark Charlebois <mcharleb@gmail.com>
  */
 #include "hello_example.h"
+#include <px4_log.h>
 #include <px4_app.h>
 #include <px4_tasks.h>
 #include <stdio.h>
@@ -52,11 +53,11 @@ extern "C" __EXPORT int hello_main(int argc, char *argv[]);
 
 static void usage()
 {
-	printf("usage: hello {start|stop|status}\n");
+	PX4_DEBUG("usage: hello {start|stop|status}\n");
 }
 int hello_main(int argc, char *argv[])
 {
-	printf("argc = %d %s %s %p\n", argc, argv[0], argv[1], argv[2]);
+	PX4_DEBUG("argc = %d %s %s %p\n", argc, argv[0], argv[1], argv[2]);
 	if (argc < 2) {
 		usage();
 		return 1;
@@ -64,8 +65,9 @@ int hello_main(int argc, char *argv[])
 
 	if (!strcmp(argv[1], "start")) {
 
+		PX4_DEBUG("Starting\n");
 		if (HelloExample::appState.isRunning()) {
-			printf("already running\n");
+			PX4_DEBUG("already running\n");
 			/* this is not an error */
 			return 0;
 		}
@@ -73,7 +75,7 @@ int hello_main(int argc, char *argv[])
 		daemon_task = px4_task_spawn_cmd("hello",
 				       SCHED_DEFAULT,
 				       SCHED_PRIORITY_MAX - 5,
-				       2000,
+				       16000,
 				       PX4_MAIN,
 				       (char* const*)argv);
 
@@ -87,10 +89,10 @@ int hello_main(int argc, char *argv[])
 
 	if (!strcmp(argv[1], "status")) {
 		if (HelloExample::appState.isRunning()) {
-			printf("is running\n");
+			PX4_DEBUG("is running\n");
 
 		} else {
-			printf("not started\n");
+			PX4_DEBUG("not started\n");
 		}
 
 		return 0;