iwlwifi/mei/main.c

307 					u32 q_sz)
314 	if (rd > q_sz || wr > q_sz) {
320 	room_in_buf = wr >= rd ? q_sz - wr + rd : rd - wr;
329 	if (wr + tx_sz <= q_sz) {
332 		memcpy(q_head + wr, hdr, q_sz - wr);
333 		memcpy(q_head, (const u8 *)hdr + q_sz - wr, tx_sz - (q_sz - wr));
336 	WRITE_ONCE(notif_q->wr_ptr, cpu_to_le32((wr + tx_sz) % q_sz));
408 	u32 q_sz;
431 	q_sz = mei->shared_mem.q_size[SAP_DIRECTION_HOST_TO_ME][SAP_QUEUE_IDX_NOTIF];
432 	ret = iwl_mei_write_cyclic_buf(q_head, notif_q, q_head, hdr, q_sz);
450 	u32 q_sz;
482 	q_sz = mei->shared_mem.q_size[SAP_DIRECTION_HOST_TO_ME][SAP_QUEUE_IDX_DATA];
490 	if (rd > q_sz || wr > q_sz) {
496 	room_in_buf = wr >= rd ? q_sz - wr + rd : rd - wr;
530 	if (wr + tx_sz <= q_sz) {
533 		skb_copy_bits(skb, 0, q_head + wr, q_sz - wr);
534 		skb_copy_bits(skb, q_sz - wr, q_head, tx_sz - (q_sz - wr));
537 	WRITE_ONCE(notif_q->wr_ptr, cpu_to_le32((wr + tx_sz) % q_sz));
1007 static void iwl_mei_read_from_q(const u8 *q_head, u32 q_sz,
1014 	if (rd + len <= q_sz) {
1018 		memcpy(buf, q_head + rd, q_sz - rd);
1019 		memcpy(buf + q_sz - rd, q_head, len - (q_sz - rd));
1020 		rd = len - (q_sz - rd);
1031 				    const u8 *q_head, u32 q_sz,
1049 		iwl_mei_read_from_q(q_head, q_sz, &rd, wr, &hdr, sizeof(hdr));
1082 		iwl_mei_read_from_q(q_head, q_sz, &rd, wr,
1091 		iwl_mei_read_from_q(q_head, q_sz, &rd, wr, data, len);
1105 				      const u8 *q_head, u32 q_sz,
1119 		iwl_mei_read_from_q(q_head, q_sz, &rd, wr, hdr, sizeof(*hdr));
1126 		iwl_mei_read_from_q(q_head, q_sz, &rd, wr, hdr + 1, len);
1145 				  u32 q_sz)
1151 	if (rd > q_sz || wr > q_sz) {
1160 	valid_rx_sz = wr > rd ? wr - rd : q_sz - rd + wr;
1163 		iwl_mei_handle_sap_data(cldev, q_head, q_sz, rd, wr,
1166 		iwl_mei_handle_sap_rx_cmd(cldev, q_head, q_sz, rd, wr,
1180 	u32 q_sz;
1188 	q_sz = mei->shared_mem.q_size[SAP_DIRECTION_ME_TO_HOST][SAP_QUEUE_IDX_NOTIF];
1195 	iwl_mei_handle_sap_rx(cldev, notif_q, q_head, NULL, q_sz);
1201 	q_sz = mei->shared_mem.q_size[SAP_DIRECTION_ME_TO_HOST][SAP_QUEUE_IDX_DATA];
1205 	iwl_mei_handle_sap_rx(cldev, notif_q, q_head, &tx_skbs, q_sz);