remoteproc: calculate max_notifyid by counting vrings
Simplify handling of max_notifyid by simply counting the number of vrings. Signed-off-by: Sjur Brændeland <sjur.brandeland@stericsson.com> Acked-by: Ido Yariv <ido@wizery.com> [small terminology changes] Signed-off-by: Ohad Ben-Cohen <ohad@wizery.com>
This commit is contained in:
parent
232fcdbb45
commit
ba7290e016
|
@ -224,9 +224,6 @@ int rproc_alloc_vring(struct rproc_vdev *rvdev, int i)
|
|||
}
|
||||
notifyid = ret;
|
||||
|
||||
/* Store largest notifyid */
|
||||
rproc->max_notifyid = max(rproc->max_notifyid, notifyid);
|
||||
|
||||
dev_dbg(dev, "vring%d: va %p dma %llx size %x idr %d\n", i, va,
|
||||
(unsigned long long)dma, size, notifyid);
|
||||
|
||||
|
@ -268,25 +265,13 @@ rproc_parse_vring(struct rproc_vdev *rvdev, struct fw_rsc_vdev *rsc, int i)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static int rproc_max_notifyid(int id, void *p, void *data)
|
||||
{
|
||||
int *maxid = data;
|
||||
*maxid = max(*maxid, id);
|
||||
return 0;
|
||||
}
|
||||
|
||||
void rproc_free_vring(struct rproc_vring *rvring)
|
||||
{
|
||||
int size = PAGE_ALIGN(vring_size(rvring->len, rvring->align));
|
||||
struct rproc *rproc = rvring->rvdev->rproc;
|
||||
int maxid = 0;
|
||||
|
||||
dma_free_coherent(rproc->dev.parent, size, rvring->va, rvring->dma);
|
||||
idr_remove(&rproc->notifyids, rvring->notifyid);
|
||||
|
||||
/* Find the largest remaining notifyid */
|
||||
idr_for_each(&rproc->notifyids, rproc_max_notifyid, &maxid);
|
||||
rproc->max_notifyid = maxid;
|
||||
}
|
||||
|
||||
/**
|
||||
|
@ -669,6 +654,15 @@ free_carv:
|
|||
return ret;
|
||||
}
|
||||
|
||||
static int rproc_count_vrings(struct rproc *rproc, struct fw_rsc_vdev *rsc,
|
||||
int avail)
|
||||
{
|
||||
/* Summarize the number of notification IDs */
|
||||
rproc->max_notifyid += rsc->num_of_vrings;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* A lookup table for resource handlers. The indices are defined in
|
||||
* enum fw_resource_type.
|
||||
|
@ -684,6 +678,10 @@ static rproc_handle_resource_t rproc_vdev_handler[RSC_LAST] = {
|
|||
[RSC_VDEV] = (rproc_handle_resource_t)rproc_handle_vdev,
|
||||
};
|
||||
|
||||
static rproc_handle_resource_t rproc_count_vrings_handler[RSC_LAST] = {
|
||||
[RSC_VDEV] = (rproc_handle_resource_t)rproc_count_vrings,
|
||||
};
|
||||
|
||||
/* handle firmware resource entries before booting the remote processor */
|
||||
static int rproc_handle_resources(struct rproc *rproc,
|
||||
struct resource_table *table, int len,
|
||||
|
@ -858,6 +856,11 @@ static void rproc_fw_config_virtio(const struct firmware *fw, void *context)
|
|||
if (!table)
|
||||
goto out;
|
||||
|
||||
/* count the number of notify-ids */
|
||||
rproc->max_notifyid = -1;
|
||||
ret = rproc_handle_resources(rproc, table, tablesz,
|
||||
rproc_count_vrings_handler);
|
||||
|
||||
/* look for virtio devices and register them */
|
||||
ret = rproc_handle_resources(rproc, table, tablesz, rproc_vdev_handler);
|
||||
if (ret)
|
||||
|
|
|
@ -213,7 +213,7 @@ static int sproc_start(struct rproc *rproc)
|
|||
}
|
||||
|
||||
/* Subscribe to notifications */
|
||||
for (i = 0; i < rproc->max_notifyid; i++) {
|
||||
for (i = 0; i <= rproc->max_notifyid; i++) {
|
||||
err = sproc->mdev->ops.kick_subscribe(sproc->mdev, i);
|
||||
if (err) {
|
||||
sproc_err(sproc,
|
||||
|
|
Loading…
Reference in New Issue