Add test of roundrobin scheduler (still does not work)

git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@81 42af7a65-404d-4744-a932-0658087f49c3

4 files changed, 225 insertions, 1 deletions

diff --git a/nuttx/examples/ostest/Makefile b/nuttx/examples/ostest/Makefile
index 3e071e146..ed7859fc8 100644
--- a/nuttx/examples/ostest/Makefile
+++ b/nuttx/examples/ostest/Makefile
@@ -42,7 +42,7 @@ ASRCS	=
 AOBJS	= $(ASRCS:.S=$(OBJEXT))
 CSRCS	= main.c dev_null.c
 ifneq ($(CONFIG_DISABLE_PTHREAD),y)
-CSRCS	+= cancel.c cond.c mutex.c sem.c
+CSRCS	+= cancel.c cond.c mutex.c sem.c roundrobin.c
 endif
 ifneq ($(CONFIG_DISABLE_SIGNALS),y)
 CSRCS	+= sighand.c
diff --git a/nuttx/examples/ostest/main.c b/nuttx/examples/ostest/main.c
index 8272103a5..7afba05c9 100644
--- a/nuttx/examples/ostest/main.c
+++ b/nuttx/examples/ostest/main.c
@@ -164,6 +164,14 @@ static int user_main(int argc, char *argv[])
   sighand_test();
 #endif
 
+#if 0 /* Does not work yet */
+#if !defined(CONFIG_DISABLE_PTHREAD) && CONFIG_RR_INTERVAL > 0
+  /* Verify round robin scheduling */
+
+  rr_test();
+#endif
+#endif
+
   printf("user_main: Exitting\n");
   return 0;
 }
diff --git a/nuttx/examples/ostest/ostest.h b/nuttx/examples/ostest/ostest.h
index 8d567cb37..af5b490b4 100644
--- a/nuttx/examples/ostest/ostest.h
+++ b/nuttx/examples/ostest/ostest.h
@@ -92,4 +92,8 @@ extern void timedwait_test(void);
 
 extern void sighand_test(void);
 
+/* roundrobin.c *********************************************/
+
+extern void rr_test(void);
+
 #endif /* __OSTEST_H */
diff --git a/nuttx/examples/ostest/roundrobin.c b/nuttx/examples/ostest/roundrobin.c
new file mode 100644
index 000000000..d8217e451
--- /dev/null
+++ b/nuttx/examples/ostest/roundrobin.c
@@ -0,0 +1,212 @@
+/********************************************************************************
+ * dev_null.c
+ *
+ *   Copyright (C) 2007 Gregory Nutt. All rights reserved.
+ *   Author: Gregory Nutt <spudmonkey@racsa.co.cr>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in
+ *    the documentation and/or other materials provided with the
+ *    distribution.
+ * 3. Neither the name Gregory Nutt nor the names of its contributors may be
+ *    used to endorse or promote products derived from this software
+ *    without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+ * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+ * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
+ * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ *
+ ********************************************************************************/
+
+/********************************************************************************
+ * Included Files
+ ********************************************************************************/
+
+#include <nuttx/config.h>
+#include <stdio.h>
+#include "ostest.h"
+
+#if CONFIG_RR_INTERVAL > 0
+
+/********************************************************************************
+ * Definitions
+ ********************************************************************************/
+
+#define CONFIG_NINTEGERS 32768
+
+/********************************************************************************
+ * Private Data
+ ********************************************************************************/
+
+static int prime1[CONFIG_NINTEGERS];
+static int prime2[CONFIG_NINTEGERS];
+
+/********************************************************************************
+ * Private Functions
+ ********************************************************************************/
+
+/********************************************************************************
+ * Name: dosieve
+ *
+ * Description
+ *   This implements a "sieve of aristophanes" algorithm for finding prime number.
+ *   Credit for this belongs to someone, but I am not sure who anymore.  Anyway,
+ *   the only purpose here is that we need some algorithm that takes a long period 
+ *   of time to execute.
+ *
+ ********************************************************************************/
+
+static void dosieve(int *prime)
+{
+  int a,d;
+  int i;
+  int j;
+
+  a = 2;
+  d = a;
+
+  for (i = 0; i < CONFIG_NINTEGERS; i++)
+    {
+      prime[i] = i+2;
+    }
+
+  for (i = 1; i < 10; i++)
+    {
+      for (j = 0; j < CONFIG_NINTEGERS; j++)
+        {
+          d = a + d;
+          if (d < CONFIG_NINTEGERS)
+            {
+              prime[d]=0;
+            }
+        }
+      a++;
+      d = a;
+      i++;
+    }
+
+#if 0 /* We don't really care what the numbers are */
+  for (i = 0, j= 0; i < CONFIG_NINTEGERS; i++)
+    {
+      if (prime[i] != 0)
+       {
+         printf(" Prime %d: %d\n", j, prime[i]);
+         j++;
+       }
+    }
+#endif
+}
+
+/********************************************************************************
+ * Name: sieve1
+ ********************************************************************************/
+
+static void *sieve1(void *parameter)
+{
+  int i;
+
+  printf("sieve1 started\n");
+  for (i = 0; i < 1000; i++)
+    {
+      dosieve(prime1);
+    }
+  pthread_exit(NULL);
+}
+
+/********************************************************************************
+ * Name: sieve2
+ ********************************************************************************/
+
+static void *sieve2(void *parameter)
+{
+  int i;
+
+  printf("sieve2 started\n");
+  for (i = 0; i < 1000; i++)
+    {
+      dosieve(prime2);
+    }
+  pthread_exit(NULL);
+}
+
+/********************************************************************************
+ * Public Functions
+ ********************************************************************************/
+
+/********************************************************************************
+ * Name: rr_test
+ ********************************************************************************/
+
+void rr_test(void)
+{
+  pthread_t sieve1_thread;
+  pthread_t sieve2_thread;
+  struct sched_param sparam;
+  pthread_attr_t attr;
+  pthread_addr_t result;
+  int status;
+
+  printf("rr_test: Starting sieve1 thread \n");
+  status = pthread_attr_init(&attr);
+  if (status != OK)
+    {
+      printf("rr_test: pthread_attr_init failed, status=%d\n",  status);
+    }
+
+  sparam.sched_priority = sched_get_priority_min(SCHED_FIFO);
+  status = pthread_attr_setschedparam(&attr, &sparam);
+  if (status != OK)
+    {
+      printf("rr_test: pthread_attr_setschedparam failed, status=%d\n",  status);
+    }
+  else
+    {
+      printf("rr_test: Set thread priority to %d\n",  sparam.sched_priority);
+    }
+
+  status = pthread_attr_setschedpolicy(&attr, SCHED_RR);
+  if (status != OK)
+    {
+      printf("rr_test: pthread_attr_setschedpolicy failed, status=%d\n",  status);
+    }
+  else
+    {
+      printf("rr_test: Set thread policty to SCHED_RR\n");
+    }
+
+  status = pthread_create(&sieve1_thread, &attr, sieve1, NULL);
+  if (status != 0)
+    {
+      printf("rr_test: Error in thread 1 creation, status=%d\n",  status);
+    }
+
+  printf("rr_test: Starting sieve1 thread \n");
+
+  status = pthread_create(&sieve2_thread, &attr, sieve2, NULL);
+  if (status != 0)
+    {
+      printf("rr_test: Error in thread 2 creation, status=%d\n",  status);
+    }
+
+  printf("rr_test: Waiting for sieves to complete\n");
+  pthread_join(sieve2_thread, &result);
+  pthread_join(sieve1_thread, &result);
+  printf("rr_test: Done\n");
+}
+
+#endif /* CONFIG_RR_INTERVAL */