adjust ioprio_get/set for kernels which don't define _syscall2/3 (i.e. 2.6.24 and...
[enigma2.git] / 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 }