lib/base/ioprio.cpp

   1 #include <lib/base/ioprio.h>
   2 #include <stdio.h>
   3 #include <stdlib.h>
   4 #include <errno.h>
   5 #include <getopt.h>
   6 #include <unistd.h>
   7 #include <sys/ptrace.h>
   8 #include <asm/unistd.h>
   9
  10 #include <lib/base/eerror.h>
  11
  12 extern "C" int sys_ioprio_set(int, int, int);
  13 extern "C" int sys_ioprio_get(int, int);
  14
  15 #if defined(__i386__)
  16 #define __NR_ioprio_set         289
  17 #define __NR_ioprio_get         290
  18 #elif defined(__ppc__) || defined(__powerpc__)
  19 #define __NR_ioprio_set         273
  20 #define __NR_ioprio_get         274
  21 #elif defined(__x86_64__)
  22 #define __NR_ioprio_set         251
  23 #define __NR_ioprio_get         252
  24 #elif defined(__ia64__)
  25 #define __NR_ioprio_set         1274
  26 #define __NR_ioprio_get         1275
  27 #elif defined(__mips__)
  28 #define __NR_ioprio_set         4284
  29 #define __NR_ioprio_get         4285
  30 #else
  31 #error "Unsupported arch"
  32 #endif
  33
  34 #if defined(_syscall3) && defined(_syscall2)
  35
  36 _syscall3(int, ioprio_set, int, which, int, who, int, ioprio);
  37 _syscall2(int, ioprio_get, int, which, int, who);
  38
  39 #else
  40
  41 static inline int ioprio_set(int which, int who, int ioprio)
  42 {
  43         return syscall(__NR_ioprio_set, which, who, ioprio);
  44 }
  45
  46 static inline int ioprio_get(int which, int who)
  47 {
  48         return syscall(__NR_ioprio_get, which, who);
  49 }
  50
  51 #endif
  52
  53 #define IOPRIO_CLASS_SHIFT      13
  54
  55 enum {
  56         IOPRIO_WHO_PROCESS = 1,
  57         IOPRIO_WHO_PGRP,
  58         IOPRIO_WHO_USER,
  59 };
  60
  61 const char *to_prio[] = { "none", "realtime", "best-effort", "idle", };
  62
  63 void setIoPrio(int prio_class, int prio)
  64 {
  65         if (prio_class < 0 || prio_class > 3)
  66         {
  67                 eDebug("prio class(%d) out of valid range (0..3)", prio_class);
  68                 return;
  69         }
  70         if (prio < 0 || prio > 7)
  71         {
  72                 eDebug("prio level(%d) out of range (0..7)", prio);
  73                 return;
  74         }
  75         if (ioprio_set(IOPRIO_WHO_PROCESS, 0 /*pid 0 .. current process*/, prio | prio_class << IOPRIO_CLASS_SHIFT) == -1)
  76                 eDebug("setIoPrio failed (%m) !");
  77         else
  78                 eDebug("setIoPrio %s level %d ok", to_prio[prio_class], prio);
  79 }
  80
  81 void printIoPrio()
  82 {
  83         int pid = 0, ioprio = ioprio_get(IOPRIO_WHO_PROCESS, pid);
  84
  85         eDebug("pid=%d, %d", pid, ioprio);
  86
  87         if (ioprio == -1)
  88                 eDebug("ioprio_get(%m)");
  89         else {
  90                 int ioprio_class = ioprio >> IOPRIO_CLASS_SHIFT;
  91                 ioprio = ioprio & 0xff;
  92                 eDebug("%s: prio %d", to_prio[ioprio_class], ioprio);
  93         }
  94 }