clean up the organization of + split out wpilib_interface

Change-Id: I5278e42d13c4bb46619e52e20a72e8e878863ed0
diff --git a/aos/linux_code/init.cc b/aos/linux_code/init.cc
index d7501af..a4e72db 100644
--- a/aos/linux_code/init.cc
+++ b/aos/linux_code/init.cc
@@ -109,4 +109,12 @@
   SetSoftRLimit(RLIMIT_CORE, RLIM_INFINITY, true);
 }
 
+void SetCurrentThreadRealtimePriority(int priority) {
+  struct sched_param param;
+  param.sched_priority = priority;
+  if (sched_setscheduler(0, SCHED_FIFO, &param) == -1) {
+    PLOG(FATAL, "sched_setscheduler(0, SCHED_FIFO, %d) failed", priority);
+  }
+}
+
 }  // namespace aos