mediatek: mt76-6e-usb: Copied entire code from v5.18.y
[platform/kernel/linux-rpi.git] / drivers / rapidio / rio-access.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * RapidIO configuration space access support
4  *
5  * Copyright 2005 MontaVista Software, Inc.
6  * Matt Porter <mporter@kernel.crashing.org>
7  */
8
9 #include <linux/rio.h>
10 #include <linux/module.h>
11
12 #include <linux/rio_drv.h>
13
14 /*
15  *  Wrappers for all RIO configuration access functions.  They just check
16  *  alignment and call the low-level functions pointed to by rio_mport->ops.
17  */
18
19 #define RIO_8_BAD 0
20 #define RIO_16_BAD (offset & 1)
21 #define RIO_32_BAD (offset & 3)
22
23 /**
24  * RIO_LOP_READ - Generate rio_local_read_config_* functions
25  * @size: Size of configuration space read (8, 16, 32 bits)
26  * @type: C type of value argument
27  * @len: Length of configuration space read (1, 2, 4 bytes)
28  *
29  * Generates rio_local_read_config_* functions used to access
30  * configuration space registers on the local device.
31  */
32 #define RIO_LOP_READ(size,type,len) \
33 int __rio_local_read_config_##size \
34         (struct rio_mport *mport, u32 offset, type *value)              \
35 {                                                                       \
36         int res;                                                        \
37         u32 data = 0;                                                   \
38         if (RIO_##size##_BAD) return RIO_BAD_SIZE;                      \
39         res = mport->ops->lcread(mport, mport->id, offset, len, &data); \
40         *value = (type)data;                                            \
41         return res;                                                     \
42 }
43
44 /**
45  * RIO_LOP_WRITE - Generate rio_local_write_config_* functions
46  * @size: Size of configuration space write (8, 16, 32 bits)
47  * @type: C type of value argument
48  * @len: Length of configuration space write (1, 2, 4 bytes)
49  *
50  * Generates rio_local_write_config_* functions used to access
51  * configuration space registers on the local device.
52  */
53 #define RIO_LOP_WRITE(size,type,len) \
54 int __rio_local_write_config_##size \
55         (struct rio_mport *mport, u32 offset, type value)               \
56 {                                                                       \
57         if (RIO_##size##_BAD) return RIO_BAD_SIZE;                      \
58         return mport->ops->lcwrite(mport, mport->id, offset, len, value);\
59 }
60
61 RIO_LOP_READ(8, u8, 1)
62 RIO_LOP_READ(16, u16, 2)
63 RIO_LOP_READ(32, u32, 4)
64 RIO_LOP_WRITE(8, u8, 1)
65 RIO_LOP_WRITE(16, u16, 2)
66 RIO_LOP_WRITE(32, u32, 4)
67
68 EXPORT_SYMBOL_GPL(__rio_local_read_config_8);
69 EXPORT_SYMBOL_GPL(__rio_local_read_config_16);
70 EXPORT_SYMBOL_GPL(__rio_local_read_config_32);
71 EXPORT_SYMBOL_GPL(__rio_local_write_config_8);
72 EXPORT_SYMBOL_GPL(__rio_local_write_config_16);
73 EXPORT_SYMBOL_GPL(__rio_local_write_config_32);
74
75 /**
76  * RIO_OP_READ - Generate rio_mport_read_config_* functions
77  * @size: Size of configuration space read (8, 16, 32 bits)
78  * @type: C type of value argument
79  * @len: Length of configuration space read (1, 2, 4 bytes)
80  *
81  * Generates rio_mport_read_config_* functions used to access
82  * configuration space registers on the local device.
83  */
84 #define RIO_OP_READ(size,type,len) \
85 int rio_mport_read_config_##size \
86         (struct rio_mport *mport, u16 destid, u8 hopcount, u32 offset, type *value)     \
87 {                                                                       \
88         int res;                                                        \
89         u32 data = 0;                                                   \
90         if (RIO_##size##_BAD) return RIO_BAD_SIZE;                      \
91         res = mport->ops->cread(mport, mport->id, destid, hopcount, offset, len, &data); \
92         *value = (type)data;                                            \
93         return res;                                                     \
94 }
95
96 /**
97  * RIO_OP_WRITE - Generate rio_mport_write_config_* functions
98  * @size: Size of configuration space write (8, 16, 32 bits)
99  * @type: C type of value argument
100  * @len: Length of configuration space write (1, 2, 4 bytes)
101  *
102  * Generates rio_mport_write_config_* functions used to access
103  * configuration space registers on the local device.
104  */
105 #define RIO_OP_WRITE(size,type,len) \
106 int rio_mport_write_config_##size \
107         (struct rio_mport *mport, u16 destid, u8 hopcount, u32 offset, type value)      \
108 {                                                                       \
109         if (RIO_##size##_BAD) return RIO_BAD_SIZE;                      \
110         return mport->ops->cwrite(mport, mport->id, destid, hopcount,   \
111                         offset, len, value);                            \
112 }
113
114 RIO_OP_READ(8, u8, 1)
115 RIO_OP_READ(16, u16, 2)
116 RIO_OP_READ(32, u32, 4)
117 RIO_OP_WRITE(8, u8, 1)
118 RIO_OP_WRITE(16, u16, 2)
119 RIO_OP_WRITE(32, u32, 4)
120
121 EXPORT_SYMBOL_GPL(rio_mport_read_config_8);
122 EXPORT_SYMBOL_GPL(rio_mport_read_config_16);
123 EXPORT_SYMBOL_GPL(rio_mport_read_config_32);
124 EXPORT_SYMBOL_GPL(rio_mport_write_config_8);
125 EXPORT_SYMBOL_GPL(rio_mport_write_config_16);
126 EXPORT_SYMBOL_GPL(rio_mport_write_config_32);
127
128 /**
129  * rio_mport_send_doorbell - Send a doorbell message
130  *
131  * @mport: RIO master port
132  * @destid: RIO device destination ID
133  * @data: Doorbell message data
134  *
135  * Send a doorbell message to a RIO device. The doorbell message
136  * has a 16-bit info field provided by the data argument.
137  */
138 int rio_mport_send_doorbell(struct rio_mport *mport, u16 destid, u16 data)
139 {
140         return mport->ops->dsend(mport, mport->id, destid, data);
141 }
142
143 EXPORT_SYMBOL_GPL(rio_mport_send_doorbell);