Repository navigation
Expand file tree
/
Copy pathpadconf.c
More file actions
100 lines (82 loc) · 1.92 KB
/
Copy pathpadconf.c
File metadata and controls
100 lines (82 loc) · 1.92 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
/* kernel headers */
#include <minix/syslib.h>
#include <minix/drvlib.h>
#include <minix/log.h>
#include <minix/padconf.h>
#include <minix/mmio.h>
/* system headers */
#include <sys/mman.h>
#include <sys/types.h>
/* usr headers */
#include <stdio.h>
#include <stdlib.h>
#include <stdarg.h>
#include <string.h>
#include <errno.h>
#include <assert.h>
/* local headers */
/* used for logging */
static struct log log = {
.name = "omap_padconf",
.log_level = LEVEL_INFO,
.log_func = default_log
};
static u32_t base = 0;
static u32_t use_count = 0;
int
padconf_init()
{
struct minix_mem_range mr;
use_count++;
if (base != 0) {
/* when used in a library we can't guaranty we only call this
* method once */
log_trace(&log, "Called %d times\n", use_count);
return OK;
}
mr.mr_base = PADCONF_REGISTERS_BASE;
mr.mr_limit = PADCONF_REGISTERS_BASE + 0x1000;
if (sys_privctl(SELF, SYS_PRIV_ADD_MEM, &mr) != 0) {
log_warn(&log, "Unable to request permission to map memory\n");
return EPERM;
}
base =
(uint32_t) vm_map_phys(SELF, (void *) PADCONF_REGISTERS_BASE,
0x1000);
if (base == (uint32_t) MAP_FAILED) {
log_warn(&log, "Unable to map GPIO memory\n");
return EPERM;
}
mr.mr_base = PADCONF_REGISTERS_BASE;
mr.mr_limit = PADCONF_REGISTERS_BASE + 0x1000;
if (sys_privctl(SELF, SYS_PRIV_ADD_MEM, &mr) != 0) {
log_warn(&log, "Unable to request permission to map memory\n");
return EPERM;
}
base =
(uint32_t) vm_map_phys(SELF, (void *) PADCONF_REGISTERS_BASE,
0x1000);
if (base == (uint32_t) MAP_FAILED) {
log_warn(&log, "Unable to map GPIO memory\n");
return EPERM;
}
return OK;
}
int
padconf_set(u32_t padconf, u32_t mask, u32_t value)
{
assert(padconf <= CONTROL_PADCONF_ETK_D14);
set32(base + padconf, mask, value);
return OK;
}
int
padconf_release()
{
assert(use_count > 0);
use_count--;
if (use_count == 0) {
vm_unmap_phys(SELF, (void *) base, 0x1000);
}
base = 0;
return OK;
}