nvkm/falcon/msgq.c

26 nvkm_falcon_msgq_open(struct nvkm_falcon_msgq *msgq)
28 	spin_lock(&msgq->lock);
29 	msgq->position = nvkm_falcon_rd32(msgq->qmgr->falcon, msgq->tail_reg);
33 nvkm_falcon_msgq_close(struct nvkm_falcon_msgq *msgq, bool commit)
35 	struct nvkm_falcon *falcon = msgq->qmgr->falcon;
38 		nvkm_falcon_wr32(falcon, msgq->tail_reg, msgq->position);
40 	spin_unlock(&msgq->lock);
44 nvkm_falcon_msgq_empty(struct nvkm_falcon_msgq *msgq)
46 	u32 head = nvkm_falcon_rd32(msgq->qmgr->falcon, msgq->head_reg);
47 	u32 tail = nvkm_falcon_rd32(msgq->qmgr->falcon, msgq->tail_reg);
52 nvkm_falcon_msgq_pop(struct nvkm_falcon_msgq *msgq, void *data, u32 size)
54 	struct nvkm_falcon *falcon = msgq->qmgr->falcon;
57 	head = nvkm_falcon_rd32(falcon, msgq->head_reg);
59 	if (head < msgq->position)
60 		msgq->position = msgq->offset;
62 	tail = msgq->position;
66 		FLCNQ_ERR(msgq, "requested %d bytes, but only %d available",
72 	msgq->position += ALIGN(size, QUEUE_ALIGNMENT);
77 nvkm_falcon_msgq_read(struct nvkm_falcon_msgq *msgq, struct nvfw_falcon_msg *hdr)
81 	nvkm_falcon_msgq_open(msgq);
83 	if (nvkm_falcon_msgq_empty(msgq))
86 	ret = nvkm_falcon_msgq_pop(msgq, hdr, HDR_SIZE);
88 		FLCNQ_ERR(msgq, "failed to read message header");
93 		FLCNQ_ERR(msgq, "message too big, %d bytes", hdr->size);
101 		ret = nvkm_falcon_msgq_pop(msgq, (hdr + 1), read_size);
103 			FLCNQ_ERR(msgq, "failed to read message data");
110 	nvkm_falcon_msgq_close(msgq, (ret >= 0));
115 nvkm_falcon_msgq_exec(struct nvkm_falcon_msgq *msgq, struct nvfw_falcon_msg *hdr)
119 	seq = &msgq->qmgr->seq.id[hdr->seq_id];
121 		FLCNQ_ERR(msgq, "message for unknown sequence %08x", seq->id);
131 		nvkm_falcon_qmgr_seq_release(msgq->qmgr, seq);
140 nvkm_falcon_msgq_recv(struct nvkm_falcon_msgq *msgq)
149 	while (nvkm_falcon_msgq_read(msgq, hdr) > 0)
150 		nvkm_falcon_msgq_exec(msgq, hdr);
154 nvkm_falcon_msgq_recv_initmsg(struct nvkm_falcon_msgq *msgq,
157 	struct nvkm_falcon *falcon = msgq->qmgr->falcon;
161 	msgq->head_reg = falcon->func->msgq.head;
162 	msgq->tail_reg = falcon->func->msgq.tail;
163 	msgq->offset = nvkm_falcon_rd32(falcon, falcon->func->msgq.tail);
165 	nvkm_falcon_msgq_open(msgq);
166 	ret = nvkm_falcon_msgq_pop(msgq, data, size);
172 	nvkm_falcon_msgq_close(msgq, ret == 0);
177 nvkm_falcon_msgq_init(struct nvkm_falcon_msgq *msgq,
180 	const struct nvkm_falcon_func *func = msgq->qmgr->falcon->func;
182 	msgq->head_reg = func->msgq.head + index * func->msgq.stride;
183 	msgq->tail_reg = func->msgq.tail + index * func->msgq.stride;
184 	msgq->offset = offset;
186 	FLCNQ_DBG(msgq, "initialised @ index %d offset 0x%08x size 0x%08x",
187 		  index, msgq->offset, size);
193 	struct nvkm_falcon_msgq *msgq = *pmsgq;
194 	if (msgq) {
204 	struct nvkm_falcon_msgq *msgq = *pmsgq;
206 	if (!(msgq = *pmsgq = kzalloc(sizeof(*msgq), GFP_KERNEL)))
209 	msgq->qmgr = qmgr;
210 	msgq->name = name;
211 	spin_lock_init(&msgq->lock);