-
Notifications
You must be signed in to change notification settings - Fork 0
/
multilog.h
93 lines (74 loc) · 2.86 KB
/
multilog.h
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
/************************************************************************/
/* hardware access functions or macros */
/************************************************************************/
/* Index memory adress
* Two meory adresses are defined
* first the first address hast to be written with the adress of
* the CAN register to be addressed
* second on the second adress read or write the value
*
* multilog is using CAN_INDEXED_MEM_IO
*/
#ifdef CAN_INDEXED_MEM_IO
#if defined(MMC_SJA1000)
# define REGOFFSET 1
#elif defined(MULTILOG_SJA1000)
# define REGOFFSET 4
#endif
static inline unsigned Indexed_Inb(void __iomem *base, u32 adr) {
unsigned val;
writeb(adr, (void __iomem *)base);
val = readb(base + REGOFFSET);
# ifdef IODEBUG
printk("CANin: base: %x adr: %x, got: %x\n",
(u32)base, (u8)adr, (u8)val);
# endif
return val;
}
# ifdef IODEBUG
# define CANout(bd,adr,v) do {\
printk("CANout bd:%x base:%p reg:%x val:%x\n", \
bd, (void __iomem *)can_base[bd], \
(u32) ®base->adr, v); \
writeb((u32) ®base->adr, (void __iomem *)can_base[bd]); \
writeb(v, (void __iomem *)can_base[bd] + REGOFFSET); \
} while(0)
# define CANin(bd,adr) \
Indexed_Inb((void __iomem *)can_base[bd], (u32)®base->adr)
# define CANset(bd,adr,m) {\
unsigned val; \
val = Indexed_Inb((void __iomem *)can_base[bd], (u32) ®base->adr);\
writeb((u32) ®base->adr, (void __iomem *)can_base[bd]); \
writeb(val | m, (void __iomem *)can_base[bd] + REGOFFSET); \
}
# define CANreset(bd,adr,m) {\
unsigned val; \
val = Indexed_Inb((void __iomem *)can_base[bd], (u32) ®base->adr);\
writeb((u32) ®base->adr, (void __iomem *)can_base[bd]); \
writeb(val & ~m, (void __iomem *)can_base[bd] + REGOFFSET); \
}
/* not used, not filled, causes error at compile time */
# define CANtest(bd,adr,m) (x)
# else /* IODEBUG */
# define CANout(bd,adr,v) do {\
writeb((u32) ®base->adr, (void __iomem *)can_base[bd]); \
writeb(v, (void __iomem *)can_base[bd] + REGOFFSET); \
} while(0)
# define CANin(bd,adr) \
Indexed_Inb((void __iomem *)can_base[bd], (u32)®base->adr)
# define CANset(bd,adr,m) {\
unsigned val; \
val = Indexed_Inb((void __iomem *)can_base[bd], (u32) ®base->adr);\
writeb((u32) ®base->adr, (void __iomem *)can_base[bd]); \
writeb(val | m, (void __iomem *)can_base[bd] + REGOFFSET); \
}
# define CANreset(bd,adr,m) {\
unsigned val; \
val = Indexed_Inb((void __iomem *)can_base[bd], (u32) ®base->adr);\
writeb((u32) ®base->adr, (void __iomem *)can_base[bd]); \
writeb(val & ~m, (void __iomem *)can_base[bd] + REGOFFSET); \
}
/* not used, not filled, causes error at compile time */
# define CANtest(bd,adr,m) (x)
# endif /* IODEBUG */
#endif /* CAN_INDEXED_MEM_IO */