1*4882a593Smuzhiyun /* SPDX-License-Identifier: GPL-2.0-or-later */
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * RDMA Transport Layer
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (c) 2014 - 2018 ProfitBricks GmbH. All rights reserved.
6*4882a593Smuzhiyun * Copyright (c) 2018 - 2019 1&1 IONOS Cloud GmbH. All rights reserved.
7*4882a593Smuzhiyun * Copyright (c) 2019 - 2020 1&1 IONOS SE. All rights reserved.
8*4882a593Smuzhiyun */
9*4882a593Smuzhiyun
10*4882a593Smuzhiyun #ifndef RTRS_PRI_H
11*4882a593Smuzhiyun #define RTRS_PRI_H
12*4882a593Smuzhiyun
13*4882a593Smuzhiyun #include <linux/uuid.h>
14*4882a593Smuzhiyun #include <rdma/rdma_cm.h>
15*4882a593Smuzhiyun #include <rdma/ib_verbs.h>
16*4882a593Smuzhiyun #include <rdma/ib.h>
17*4882a593Smuzhiyun
18*4882a593Smuzhiyun #include "rtrs.h"
19*4882a593Smuzhiyun
20*4882a593Smuzhiyun #define RTRS_PROTO_VER_MAJOR 2
21*4882a593Smuzhiyun #define RTRS_PROTO_VER_MINOR 0
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun #define RTRS_PROTO_VER_STRING __stringify(RTRS_PROTO_VER_MAJOR) "." \
24*4882a593Smuzhiyun __stringify(RTRS_PROTO_VER_MINOR)
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun /*
27*4882a593Smuzhiyun * Max IB immediate data size is 2^28 (MAX_IMM_PAYL_BITS)
28*4882a593Smuzhiyun * and the minimum chunk size is 4096 (2^12).
29*4882a593Smuzhiyun * So the maximum sess_queue_depth is 65536 (2^16) in theory.
30*4882a593Smuzhiyun * But mempool_create, create_qp and ib_post_send fail with
31*4882a593Smuzhiyun * "cannot allocate memory" error if sess_queue_depth is too big.
32*4882a593Smuzhiyun * Therefore the pratical max value of sess_queue_depth is
33*4882a593Smuzhiyun * somewhere between 1 and 65534 and it depends on the system.
34*4882a593Smuzhiyun */
35*4882a593Smuzhiyun #define MAX_SESS_QUEUE_DEPTH 65535
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun enum rtrs_imm_const {
38*4882a593Smuzhiyun MAX_IMM_TYPE_BITS = 4,
39*4882a593Smuzhiyun MAX_IMM_TYPE_MASK = ((1 << MAX_IMM_TYPE_BITS) - 1),
40*4882a593Smuzhiyun MAX_IMM_PAYL_BITS = 28,
41*4882a593Smuzhiyun MAX_IMM_PAYL_MASK = ((1 << MAX_IMM_PAYL_BITS) - 1),
42*4882a593Smuzhiyun };
43*4882a593Smuzhiyun
44*4882a593Smuzhiyun enum rtrs_imm_type {
45*4882a593Smuzhiyun RTRS_IO_REQ_IMM = 0, /* client to server */
46*4882a593Smuzhiyun RTRS_IO_RSP_IMM = 1, /* server to client */
47*4882a593Smuzhiyun RTRS_IO_RSP_W_INV_IMM = 2, /* server to client */
48*4882a593Smuzhiyun
49*4882a593Smuzhiyun RTRS_HB_MSG_IMM = 8, /* HB: HeartBeat */
50*4882a593Smuzhiyun RTRS_HB_ACK_IMM = 9,
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun RTRS_LAST_IMM,
53*4882a593Smuzhiyun };
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun enum {
56*4882a593Smuzhiyun SERVICE_CON_QUEUE_DEPTH = 512,
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun MAX_PATHS_NUM = 128,
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun MIN_CHUNK_SIZE = 8192,
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun RTRS_HB_INTERVAL_MS = 5000,
63*4882a593Smuzhiyun RTRS_HB_MISSED_MAX = 5,
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun RTRS_MAGIC = 0x1BBD,
66*4882a593Smuzhiyun RTRS_PROTO_VER = (RTRS_PROTO_VER_MAJOR << 8) | RTRS_PROTO_VER_MINOR,
67*4882a593Smuzhiyun };
68*4882a593Smuzhiyun
69*4882a593Smuzhiyun struct rtrs_ib_dev;
70*4882a593Smuzhiyun
71*4882a593Smuzhiyun struct rtrs_rdma_dev_pd_ops {
72*4882a593Smuzhiyun struct rtrs_ib_dev *(*alloc)(void);
73*4882a593Smuzhiyun void (*free)(struct rtrs_ib_dev *dev);
74*4882a593Smuzhiyun int (*init)(struct rtrs_ib_dev *dev);
75*4882a593Smuzhiyun void (*deinit)(struct rtrs_ib_dev *dev);
76*4882a593Smuzhiyun };
77*4882a593Smuzhiyun
78*4882a593Smuzhiyun struct rtrs_rdma_dev_pd {
79*4882a593Smuzhiyun struct mutex mutex;
80*4882a593Smuzhiyun struct list_head list;
81*4882a593Smuzhiyun enum ib_pd_flags pd_flags;
82*4882a593Smuzhiyun const struct rtrs_rdma_dev_pd_ops *ops;
83*4882a593Smuzhiyun };
84*4882a593Smuzhiyun
85*4882a593Smuzhiyun struct rtrs_ib_dev {
86*4882a593Smuzhiyun struct ib_device *ib_dev;
87*4882a593Smuzhiyun struct ib_pd *ib_pd;
88*4882a593Smuzhiyun struct kref ref;
89*4882a593Smuzhiyun struct list_head entry;
90*4882a593Smuzhiyun struct rtrs_rdma_dev_pd *pool;
91*4882a593Smuzhiyun };
92*4882a593Smuzhiyun
93*4882a593Smuzhiyun struct rtrs_con {
94*4882a593Smuzhiyun struct rtrs_sess *sess;
95*4882a593Smuzhiyun struct ib_qp *qp;
96*4882a593Smuzhiyun struct ib_cq *cq;
97*4882a593Smuzhiyun struct rdma_cm_id *cm_id;
98*4882a593Smuzhiyun unsigned int cid;
99*4882a593Smuzhiyun };
100*4882a593Smuzhiyun
101*4882a593Smuzhiyun struct rtrs_sess {
102*4882a593Smuzhiyun struct list_head entry;
103*4882a593Smuzhiyun struct sockaddr_storage dst_addr;
104*4882a593Smuzhiyun struct sockaddr_storage src_addr;
105*4882a593Smuzhiyun char sessname[NAME_MAX];
106*4882a593Smuzhiyun uuid_t uuid;
107*4882a593Smuzhiyun struct rtrs_con **con;
108*4882a593Smuzhiyun unsigned int con_num;
109*4882a593Smuzhiyun unsigned int recon_cnt;
110*4882a593Smuzhiyun struct rtrs_ib_dev *dev;
111*4882a593Smuzhiyun int dev_ref;
112*4882a593Smuzhiyun struct ib_cqe *hb_cqe;
113*4882a593Smuzhiyun void (*hb_err_handler)(struct rtrs_con *con);
114*4882a593Smuzhiyun struct workqueue_struct *hb_wq;
115*4882a593Smuzhiyun struct delayed_work hb_dwork;
116*4882a593Smuzhiyun unsigned int hb_interval_ms;
117*4882a593Smuzhiyun unsigned int hb_missed_cnt;
118*4882a593Smuzhiyun unsigned int hb_missed_max;
119*4882a593Smuzhiyun };
120*4882a593Smuzhiyun
121*4882a593Smuzhiyun /* rtrs information unit */
122*4882a593Smuzhiyun struct rtrs_iu {
123*4882a593Smuzhiyun struct ib_cqe cqe;
124*4882a593Smuzhiyun dma_addr_t dma_addr;
125*4882a593Smuzhiyun void *buf;
126*4882a593Smuzhiyun size_t size;
127*4882a593Smuzhiyun enum dma_data_direction direction;
128*4882a593Smuzhiyun };
129*4882a593Smuzhiyun
130*4882a593Smuzhiyun /**
131*4882a593Smuzhiyun * enum rtrs_msg_types - RTRS message types, see also rtrs/README
132*4882a593Smuzhiyun * @RTRS_MSG_INFO_REQ: Client additional info request to the server
133*4882a593Smuzhiyun * @RTRS_MSG_INFO_RSP: Server additional info response to the client
134*4882a593Smuzhiyun * @RTRS_MSG_WRITE: Client writes data per RDMA to server
135*4882a593Smuzhiyun * @RTRS_MSG_READ: Client requests data transfer from server
136*4882a593Smuzhiyun * @RTRS_MSG_RKEY_RSP: Server refreshed rkey for rbuf
137*4882a593Smuzhiyun */
138*4882a593Smuzhiyun enum rtrs_msg_types {
139*4882a593Smuzhiyun RTRS_MSG_INFO_REQ,
140*4882a593Smuzhiyun RTRS_MSG_INFO_RSP,
141*4882a593Smuzhiyun RTRS_MSG_WRITE,
142*4882a593Smuzhiyun RTRS_MSG_READ,
143*4882a593Smuzhiyun RTRS_MSG_RKEY_RSP,
144*4882a593Smuzhiyun };
145*4882a593Smuzhiyun
146*4882a593Smuzhiyun /**
147*4882a593Smuzhiyun * enum rtrs_msg_flags - RTRS message flags.
148*4882a593Smuzhiyun * @RTRS_NEED_INVAL: Send invalidation in response.
149*4882a593Smuzhiyun * @RTRS_MSG_NEW_RKEY_F: Send refreshed rkey in response.
150*4882a593Smuzhiyun */
151*4882a593Smuzhiyun enum rtrs_msg_flags {
152*4882a593Smuzhiyun RTRS_MSG_NEED_INVAL_F = 1 << 0,
153*4882a593Smuzhiyun RTRS_MSG_NEW_RKEY_F = 1 << 1,
154*4882a593Smuzhiyun };
155*4882a593Smuzhiyun
156*4882a593Smuzhiyun /**
157*4882a593Smuzhiyun * struct rtrs_sg_desc - RDMA-Buffer entry description
158*4882a593Smuzhiyun * @addr: Address of RDMA destination buffer
159*4882a593Smuzhiyun * @key: Authorization rkey to write to the buffer
160*4882a593Smuzhiyun * @len: Size of the buffer
161*4882a593Smuzhiyun */
162*4882a593Smuzhiyun struct rtrs_sg_desc {
163*4882a593Smuzhiyun __le64 addr;
164*4882a593Smuzhiyun __le32 key;
165*4882a593Smuzhiyun __le32 len;
166*4882a593Smuzhiyun };
167*4882a593Smuzhiyun
168*4882a593Smuzhiyun /**
169*4882a593Smuzhiyun * struct rtrs_msg_conn_req - Client connection request to the server
170*4882a593Smuzhiyun * @magic: RTRS magic
171*4882a593Smuzhiyun * @version: RTRS protocol version
172*4882a593Smuzhiyun * @cid: Current connection id
173*4882a593Smuzhiyun * @cid_num: Number of connections per session
174*4882a593Smuzhiyun * @recon_cnt: Reconnections counter
175*4882a593Smuzhiyun * @sess_uuid: UUID of a session (path)
176*4882a593Smuzhiyun * @paths_uuid: UUID of a group of sessions (paths)
177*4882a593Smuzhiyun *
178*4882a593Smuzhiyun * NOTE: max size 56 bytes, see man rdma_connect().
179*4882a593Smuzhiyun */
180*4882a593Smuzhiyun struct rtrs_msg_conn_req {
181*4882a593Smuzhiyun /* Is set to 0 by cma.c in case of AF_IB, do not touch that.
182*4882a593Smuzhiyun * see https://www.spinics.net/lists/linux-rdma/msg22397.html
183*4882a593Smuzhiyun */
184*4882a593Smuzhiyun u8 __cma_version;
185*4882a593Smuzhiyun /* On sender side that should be set to 0, or cma_save_ip_info()
186*4882a593Smuzhiyun * extract garbage and will fail.
187*4882a593Smuzhiyun */
188*4882a593Smuzhiyun u8 __ip_version;
189*4882a593Smuzhiyun __le16 magic;
190*4882a593Smuzhiyun __le16 version;
191*4882a593Smuzhiyun __le16 cid;
192*4882a593Smuzhiyun __le16 cid_num;
193*4882a593Smuzhiyun __le16 recon_cnt;
194*4882a593Smuzhiyun uuid_t sess_uuid;
195*4882a593Smuzhiyun uuid_t paths_uuid;
196*4882a593Smuzhiyun u8 first_conn : 1;
197*4882a593Smuzhiyun u8 reserved_bits : 7;
198*4882a593Smuzhiyun u8 reserved[11];
199*4882a593Smuzhiyun };
200*4882a593Smuzhiyun
201*4882a593Smuzhiyun /**
202*4882a593Smuzhiyun * struct rtrs_msg_conn_rsp - Server connection response to the client
203*4882a593Smuzhiyun * @magic: RTRS magic
204*4882a593Smuzhiyun * @version: RTRS protocol version
205*4882a593Smuzhiyun * @errno: If rdma_accept() then 0, if rdma_reject() indicates error
206*4882a593Smuzhiyun * @queue_depth: max inflight messages (queue-depth) in this session
207*4882a593Smuzhiyun * @max_io_size: max io size server supports
208*4882a593Smuzhiyun * @max_hdr_size: max msg header size server supports
209*4882a593Smuzhiyun *
210*4882a593Smuzhiyun * NOTE: size is 56 bytes, max possible is 136 bytes, see man rdma_accept().
211*4882a593Smuzhiyun */
212*4882a593Smuzhiyun struct rtrs_msg_conn_rsp {
213*4882a593Smuzhiyun __le16 magic;
214*4882a593Smuzhiyun __le16 version;
215*4882a593Smuzhiyun __le16 errno;
216*4882a593Smuzhiyun __le16 queue_depth;
217*4882a593Smuzhiyun __le32 max_io_size;
218*4882a593Smuzhiyun __le32 max_hdr_size;
219*4882a593Smuzhiyun __le32 flags;
220*4882a593Smuzhiyun u8 reserved[36];
221*4882a593Smuzhiyun };
222*4882a593Smuzhiyun
223*4882a593Smuzhiyun /**
224*4882a593Smuzhiyun * struct rtrs_msg_info_req
225*4882a593Smuzhiyun * @type: @RTRS_MSG_INFO_REQ
226*4882a593Smuzhiyun * @sessname: Session name chosen by client
227*4882a593Smuzhiyun */
228*4882a593Smuzhiyun struct rtrs_msg_info_req {
229*4882a593Smuzhiyun __le16 type;
230*4882a593Smuzhiyun u8 sessname[NAME_MAX];
231*4882a593Smuzhiyun u8 reserved[15];
232*4882a593Smuzhiyun };
233*4882a593Smuzhiyun
234*4882a593Smuzhiyun /**
235*4882a593Smuzhiyun * struct rtrs_msg_info_rsp
236*4882a593Smuzhiyun * @type: @RTRS_MSG_INFO_RSP
237*4882a593Smuzhiyun * @sg_cnt: Number of @desc entries
238*4882a593Smuzhiyun * @desc: RDMA buffers where the client can write to server
239*4882a593Smuzhiyun */
240*4882a593Smuzhiyun struct rtrs_msg_info_rsp {
241*4882a593Smuzhiyun __le16 type;
242*4882a593Smuzhiyun __le16 sg_cnt;
243*4882a593Smuzhiyun u8 reserved[4];
244*4882a593Smuzhiyun struct rtrs_sg_desc desc[];
245*4882a593Smuzhiyun };
246*4882a593Smuzhiyun
247*4882a593Smuzhiyun /**
248*4882a593Smuzhiyun * struct rtrs_msg_rkey_rsp
249*4882a593Smuzhiyun * @type: @RTRS_MSG_RKEY_RSP
250*4882a593Smuzhiyun * @buf_id: RDMA buf_id of the new rkey
251*4882a593Smuzhiyun * @rkey: new remote key for RDMA buffers id from server
252*4882a593Smuzhiyun */
253*4882a593Smuzhiyun struct rtrs_msg_rkey_rsp {
254*4882a593Smuzhiyun __le16 type;
255*4882a593Smuzhiyun __le16 buf_id;
256*4882a593Smuzhiyun __le32 rkey;
257*4882a593Smuzhiyun };
258*4882a593Smuzhiyun
259*4882a593Smuzhiyun /**
260*4882a593Smuzhiyun * struct rtrs_msg_rdma_read - RDMA data transfer request from client
261*4882a593Smuzhiyun * @type: always @RTRS_MSG_READ
262*4882a593Smuzhiyun * @usr_len: length of user payload
263*4882a593Smuzhiyun * @sg_cnt: number of @desc entries
264*4882a593Smuzhiyun * @desc: RDMA buffers where the server can write the result to
265*4882a593Smuzhiyun */
266*4882a593Smuzhiyun struct rtrs_msg_rdma_read {
267*4882a593Smuzhiyun __le16 type;
268*4882a593Smuzhiyun __le16 usr_len;
269*4882a593Smuzhiyun __le16 flags;
270*4882a593Smuzhiyun __le16 sg_cnt;
271*4882a593Smuzhiyun struct rtrs_sg_desc desc[];
272*4882a593Smuzhiyun };
273*4882a593Smuzhiyun
274*4882a593Smuzhiyun /**
275*4882a593Smuzhiyun * struct_msg_rdma_write - Message transferred to server with RDMA-Write
276*4882a593Smuzhiyun * @type: always @RTRS_MSG_WRITE
277*4882a593Smuzhiyun * @usr_len: length of user payload
278*4882a593Smuzhiyun */
279*4882a593Smuzhiyun struct rtrs_msg_rdma_write {
280*4882a593Smuzhiyun __le16 type;
281*4882a593Smuzhiyun __le16 usr_len;
282*4882a593Smuzhiyun };
283*4882a593Smuzhiyun
284*4882a593Smuzhiyun /**
285*4882a593Smuzhiyun * struct_msg_rdma_hdr - header for read or write request
286*4882a593Smuzhiyun * @type: @RTRS_MSG_WRITE | @RTRS_MSG_READ
287*4882a593Smuzhiyun */
288*4882a593Smuzhiyun struct rtrs_msg_rdma_hdr {
289*4882a593Smuzhiyun __le16 type;
290*4882a593Smuzhiyun };
291*4882a593Smuzhiyun
292*4882a593Smuzhiyun /* rtrs.c */
293*4882a593Smuzhiyun
294*4882a593Smuzhiyun struct rtrs_iu *rtrs_iu_alloc(u32 queue_size, size_t size, gfp_t t,
295*4882a593Smuzhiyun struct ib_device *dev, enum dma_data_direction,
296*4882a593Smuzhiyun void (*done)(struct ib_cq *cq, struct ib_wc *wc));
297*4882a593Smuzhiyun void rtrs_iu_free(struct rtrs_iu *iu, struct ib_device *dev, u32 queue_size);
298*4882a593Smuzhiyun int rtrs_iu_post_recv(struct rtrs_con *con, struct rtrs_iu *iu);
299*4882a593Smuzhiyun int rtrs_iu_post_send(struct rtrs_con *con, struct rtrs_iu *iu, size_t size,
300*4882a593Smuzhiyun struct ib_send_wr *head);
301*4882a593Smuzhiyun int rtrs_iu_post_rdma_write_imm(struct rtrs_con *con, struct rtrs_iu *iu,
302*4882a593Smuzhiyun struct ib_sge *sge, unsigned int num_sge,
303*4882a593Smuzhiyun u32 rkey, u64 rdma_addr, u32 imm_data,
304*4882a593Smuzhiyun enum ib_send_flags flags,
305*4882a593Smuzhiyun struct ib_send_wr *head);
306*4882a593Smuzhiyun
307*4882a593Smuzhiyun int rtrs_post_recv_empty(struct rtrs_con *con, struct ib_cqe *cqe);
308*4882a593Smuzhiyun int rtrs_post_rdma_write_imm_empty(struct rtrs_con *con, struct ib_cqe *cqe,
309*4882a593Smuzhiyun u32 imm_data, enum ib_send_flags flags,
310*4882a593Smuzhiyun struct ib_send_wr *head);
311*4882a593Smuzhiyun
312*4882a593Smuzhiyun int rtrs_cq_qp_create(struct rtrs_sess *rtrs_sess, struct rtrs_con *con,
313*4882a593Smuzhiyun u32 max_send_sge, int cq_vector, int cq_size,
314*4882a593Smuzhiyun u32 max_send_wr, u32 max_recv_wr,
315*4882a593Smuzhiyun enum ib_poll_context poll_ctx);
316*4882a593Smuzhiyun void rtrs_cq_qp_destroy(struct rtrs_con *con);
317*4882a593Smuzhiyun
318*4882a593Smuzhiyun void rtrs_init_hb(struct rtrs_sess *sess, struct ib_cqe *cqe,
319*4882a593Smuzhiyun unsigned int interval_ms, unsigned int missed_max,
320*4882a593Smuzhiyun void (*err_handler)(struct rtrs_con *con),
321*4882a593Smuzhiyun struct workqueue_struct *wq);
322*4882a593Smuzhiyun void rtrs_start_hb(struct rtrs_sess *sess);
323*4882a593Smuzhiyun void rtrs_stop_hb(struct rtrs_sess *sess);
324*4882a593Smuzhiyun void rtrs_send_hb_ack(struct rtrs_sess *sess);
325*4882a593Smuzhiyun
326*4882a593Smuzhiyun void rtrs_rdma_dev_pd_init(enum ib_pd_flags pd_flags,
327*4882a593Smuzhiyun struct rtrs_rdma_dev_pd *pool);
328*4882a593Smuzhiyun void rtrs_rdma_dev_pd_deinit(struct rtrs_rdma_dev_pd *pool);
329*4882a593Smuzhiyun
330*4882a593Smuzhiyun struct rtrs_ib_dev *rtrs_ib_dev_find_or_add(struct ib_device *ib_dev,
331*4882a593Smuzhiyun struct rtrs_rdma_dev_pd *pool);
332*4882a593Smuzhiyun int rtrs_ib_dev_put(struct rtrs_ib_dev *dev);
333*4882a593Smuzhiyun
rtrs_to_imm(u32 type,u32 payload)334*4882a593Smuzhiyun static inline u32 rtrs_to_imm(u32 type, u32 payload)
335*4882a593Smuzhiyun {
336*4882a593Smuzhiyun BUILD_BUG_ON(MAX_IMM_PAYL_BITS + MAX_IMM_TYPE_BITS != 32);
337*4882a593Smuzhiyun BUILD_BUG_ON(RTRS_LAST_IMM > (1<<MAX_IMM_TYPE_BITS));
338*4882a593Smuzhiyun return ((type & MAX_IMM_TYPE_MASK) << MAX_IMM_PAYL_BITS) |
339*4882a593Smuzhiyun (payload & MAX_IMM_PAYL_MASK);
340*4882a593Smuzhiyun }
341*4882a593Smuzhiyun
rtrs_from_imm(u32 imm,u32 * type,u32 * payload)342*4882a593Smuzhiyun static inline void rtrs_from_imm(u32 imm, u32 *type, u32 *payload)
343*4882a593Smuzhiyun {
344*4882a593Smuzhiyun *payload = imm & MAX_IMM_PAYL_MASK;
345*4882a593Smuzhiyun *type = imm >> MAX_IMM_PAYL_BITS;
346*4882a593Smuzhiyun }
347*4882a593Smuzhiyun
rtrs_to_io_req_imm(u32 addr)348*4882a593Smuzhiyun static inline u32 rtrs_to_io_req_imm(u32 addr)
349*4882a593Smuzhiyun {
350*4882a593Smuzhiyun return rtrs_to_imm(RTRS_IO_REQ_IMM, addr);
351*4882a593Smuzhiyun }
352*4882a593Smuzhiyun
rtrs_to_io_rsp_imm(u32 msg_id,int errno,bool w_inval)353*4882a593Smuzhiyun static inline u32 rtrs_to_io_rsp_imm(u32 msg_id, int errno, bool w_inval)
354*4882a593Smuzhiyun {
355*4882a593Smuzhiyun enum rtrs_imm_type type;
356*4882a593Smuzhiyun u32 payload;
357*4882a593Smuzhiyun
358*4882a593Smuzhiyun /* 9 bits for errno, 19 bits for msg_id */
359*4882a593Smuzhiyun payload = (abs(errno) & 0x1ff) << 19 | (msg_id & 0x7ffff);
360*4882a593Smuzhiyun type = w_inval ? RTRS_IO_RSP_W_INV_IMM : RTRS_IO_RSP_IMM;
361*4882a593Smuzhiyun
362*4882a593Smuzhiyun return rtrs_to_imm(type, payload);
363*4882a593Smuzhiyun }
364*4882a593Smuzhiyun
rtrs_from_io_rsp_imm(u32 payload,u32 * msg_id,int * errno)365*4882a593Smuzhiyun static inline void rtrs_from_io_rsp_imm(u32 payload, u32 *msg_id, int *errno)
366*4882a593Smuzhiyun {
367*4882a593Smuzhiyun /* 9 bits for errno, 19 bits for msg_id */
368*4882a593Smuzhiyun *msg_id = payload & 0x7ffff;
369*4882a593Smuzhiyun *errno = -(int)((payload >> 19) & 0x1ff);
370*4882a593Smuzhiyun }
371*4882a593Smuzhiyun
372*4882a593Smuzhiyun #define STAT_STORE_FUNC(type, set_value, reset) \
373*4882a593Smuzhiyun static ssize_t set_value##_store(struct kobject *kobj, \
374*4882a593Smuzhiyun struct kobj_attribute *attr, \
375*4882a593Smuzhiyun const char *buf, size_t count) \
376*4882a593Smuzhiyun { \
377*4882a593Smuzhiyun int ret = -EINVAL; \
378*4882a593Smuzhiyun type *stats = container_of(kobj, type, kobj_stats); \
379*4882a593Smuzhiyun \
380*4882a593Smuzhiyun if (sysfs_streq(buf, "1")) \
381*4882a593Smuzhiyun ret = reset(stats, true); \
382*4882a593Smuzhiyun else if (sysfs_streq(buf, "0")) \
383*4882a593Smuzhiyun ret = reset(stats, false); \
384*4882a593Smuzhiyun if (ret) \
385*4882a593Smuzhiyun return ret; \
386*4882a593Smuzhiyun \
387*4882a593Smuzhiyun return count; \
388*4882a593Smuzhiyun }
389*4882a593Smuzhiyun
390*4882a593Smuzhiyun #define STAT_SHOW_FUNC(type, get_value, print) \
391*4882a593Smuzhiyun static ssize_t get_value##_show(struct kobject *kobj, \
392*4882a593Smuzhiyun struct kobj_attribute *attr, \
393*4882a593Smuzhiyun char *page) \
394*4882a593Smuzhiyun { \
395*4882a593Smuzhiyun type *stats = container_of(kobj, type, kobj_stats); \
396*4882a593Smuzhiyun \
397*4882a593Smuzhiyun return print(stats, page, PAGE_SIZE); \
398*4882a593Smuzhiyun }
399*4882a593Smuzhiyun
400*4882a593Smuzhiyun #define STAT_ATTR(type, stat, print, reset) \
401*4882a593Smuzhiyun STAT_STORE_FUNC(type, stat, reset) \
402*4882a593Smuzhiyun STAT_SHOW_FUNC(type, stat, print) \
403*4882a593Smuzhiyun static struct kobj_attribute stat##_attr = __ATTR_RW(stat)
404*4882a593Smuzhiyun
405*4882a593Smuzhiyun #endif /* RTRS_PRI_H */
406