master/mipi-i3c-hci/cmd_v1.c

148 static void fill_data_bytes(struct hci_xfer *xfer, u8 *data,
151 	xfer->cmd_desc[1] = 0;
154 		xfer->cmd_desc[1] |= CMD_I1_DATA_BYTE_4(data[3]);
157 		xfer->cmd_desc[1] |= CMD_I1_DATA_BYTE_3(data[2]);
160 		xfer->cmd_desc[1] |= CMD_I1_DATA_BYTE_2(data[1]);
163 		xfer->cmd_desc[1] |= CMD_I1_DATA_BYTE_1(data[0]);
169 	xfer->data = NULL;
173 			       struct hci_xfer *xfer,
178 	u8 *data = xfer->data;
179 	unsigned int data_len = xfer->data_len;
180 	bool rnw = xfer->rnw;
194 	xfer->cmd_tid = hci_get_tid();
198 		xfer->cmd_desc[0] =
200 			CMD_I0_TID(xfer->cmd_tid) |
205 		fill_data_bytes(xfer, data, data_len);
208 		xfer->cmd_desc[0] =
210 			CMD_R0_TID(xfer->cmd_tid) |
215 		xfer->cmd_desc[1] =
224 				     struct hci_xfer *xfer)
229 	u8 *data = xfer->data;
230 	unsigned int data_len = xfer->data_len;
231 	bool rnw = xfer->rnw;
233 	xfer->cmd_tid = hci_get_tid();
237 		xfer->cmd_desc[0] =
239 			CMD_I0_TID(xfer->cmd_tid) |
243 		fill_data_bytes(xfer, data, data_len);
246 		xfer->cmd_desc[0] =
248 			CMD_R0_TID(xfer->cmd_tid) |
252 		xfer->cmd_desc[1] =
259 				     struct hci_xfer *xfer)
264 	u8 *data = xfer->data;
265 	unsigned int data_len = xfer->data_len;
266 	bool rnw = xfer->rnw;
268 	xfer->cmd_tid = hci_get_tid();
272 		xfer->cmd_desc[0] =
274 			CMD_I0_TID(xfer->cmd_tid) |
278 		fill_data_bytes(xfer, data, data_len);
281 		xfer->cmd_desc[0] =
283 			CMD_R0_TID(xfer->cmd_tid) |
287 		xfer->cmd_desc[1] =
294 	struct hci_xfer *xfer;
301 	xfer = hci_alloc_xfer(1);
302 	if (!xfer)
326 		xfer->cmd_tid = hci_get_tid();
327 		xfer->cmd_desc[0] =
329 			CMD_A0_TID(xfer->cmd_tid) |
334 		xfer->cmd_desc[1] = 0;
335 		xfer->completion = &done;
336 		hci->io->queue_xfer(hci, xfer, 1);
338 		    hci->io->dequeue_xfer(hci, xfer, 1)) {
342 		if ((RESP_STATUS(xfer->response) == RESP_ERR_ADDR_HEADER ||
343 		     RESP_STATUS(xfer->response) == RESP_ERR_NACK) &&
344 		    RESP_DATA_LENGTH(xfer->response) == 1) {
348 		if (RESP_STATUS(xfer->response) != RESP_SUCCESS) {
371 	hci_free_xfer(xfer, 1);