Commit ce028702 authored by Sudeep Holla's avatar Sudeep Holla Committed by Jassi Brar

mailbox: pcc: Move bulk of PCCT parsing into pcc_mbox_probe

Move the PCCT subspace parsing and allocation into pcc_mbox_probe so
that we can get rid of global PCC channel and mailbox controller data.
It also helps to make use of devm_* APIs for all the allocations.
Signed-off-by: default avatarSudeep Holla <sudeep.holla@arm.com>
Signed-off-by: default avatarJassi Brar <jaswinder.singh@linaro.org>
parent c45ded7e
...@@ -63,8 +63,6 @@ ...@@ -63,8 +63,6 @@
#define MBOX_IRQ_NAME "pcc-mbox" #define MBOX_IRQ_NAME "pcc-mbox"
static struct mbox_chan *pcc_mbox_channels;
/** /**
* struct pcc_chan_reg - PCC register bundle * struct pcc_chan_reg - PCC register bundle
* *
...@@ -106,7 +104,7 @@ struct pcc_chan_info { ...@@ -106,7 +104,7 @@ struct pcc_chan_info {
#define to_pcc_chan_info(c) container_of(c, struct pcc_chan_info, chan) #define to_pcc_chan_info(c) container_of(c, struct pcc_chan_info, chan)
static struct pcc_chan_info *chan_info; static struct pcc_chan_info *chan_info;
static struct mbox_controller pcc_mbox_ctrl = {}; static int pcc_chan_count;
/* /*
* PCC can be used with perf critical drivers such as CPPC * PCC can be used with perf critical drivers such as CPPC
...@@ -281,11 +279,11 @@ struct pcc_mbox_chan * ...@@ -281,11 +279,11 @@ struct pcc_mbox_chan *
pcc_mbox_request_channel(struct mbox_client *cl, int subspace_id) pcc_mbox_request_channel(struct mbox_client *cl, int subspace_id)
{ {
struct pcc_chan_info *pchan; struct pcc_chan_info *pchan;
struct device *dev = pcc_mbox_ctrl.dev;
struct mbox_chan *chan; struct mbox_chan *chan;
struct device *dev;
unsigned long flags; unsigned long flags;
if (subspace_id < 0 || subspace_id >= pcc_mbox_ctrl.num_chans) if (subspace_id < 0 || subspace_id >= pcc_chan_count)
return ERR_PTR(-ENOENT); return ERR_PTR(-ENOENT);
pchan = chan_info + subspace_id; pchan = chan_info + subspace_id;
...@@ -294,6 +292,7 @@ pcc_mbox_request_channel(struct mbox_client *cl, int subspace_id) ...@@ -294,6 +292,7 @@ pcc_mbox_request_channel(struct mbox_client *cl, int subspace_id)
dev_err(dev, "Channel not found for idx: %d\n", subspace_id); dev_err(dev, "Channel not found for idx: %d\n", subspace_id);
return ERR_PTR(-EBUSY); return ERR_PTR(-EBUSY);
} }
dev = chan->mbox->dev;
spin_lock_irqsave(&chan->lock, flags); spin_lock_irqsave(&chan->lock, flags);
chan->msg_free = 0; chan->msg_free = 0;
...@@ -576,16 +575,12 @@ static void pcc_parse_subspace_shmem(struct pcc_chan_info *pchan, ...@@ -576,16 +575,12 @@ static void pcc_parse_subspace_shmem(struct pcc_chan_info *pchan,
*/ */
static int __init acpi_pcc_probe(void) static int __init acpi_pcc_probe(void)
{ {
int count, i, rc = 0;
acpi_status status;
struct acpi_table_header *pcct_tbl; struct acpi_table_header *pcct_tbl;
struct acpi_subtable_header *pcct_entry;
struct acpi_table_pcct *acpi_pcct_tbl;
struct acpi_subtable_proc proc[ACPI_PCCT_TYPE_RESERVED]; struct acpi_subtable_proc proc[ACPI_PCCT_TYPE_RESERVED];
int count, i, rc;
acpi_status status = AE_OK;
/* Search for PCCT */
status = acpi_get_table(ACPI_SIG_PCCT, 0, &pcct_tbl); status = acpi_get_table(ACPI_SIG_PCCT, 0, &pcct_tbl);
if (ACPI_FAILURE(status) || !pcct_tbl) if (ACPI_FAILURE(status) || !pcct_tbl)
return -ENODEV; return -ENODEV;
...@@ -607,21 +602,60 @@ static int __init acpi_pcc_probe(void) ...@@ -607,21 +602,60 @@ static int __init acpi_pcc_probe(void)
pr_warn("Invalid PCCT: %d PCC subspaces\n", count); pr_warn("Invalid PCCT: %d PCC subspaces\n", count);
rc = -EINVAL; rc = -EINVAL;
goto err_put_pcct; } else {
pcc_chan_count = count;
} }
pcc_mbox_channels = kcalloc(count, sizeof(struct mbox_chan), acpi_put_table(pcct_tbl);
GFP_KERNEL);
return rc;
}
/**
* pcc_mbox_probe - Called when we find a match for the
* PCCT platform device. This is purely used to represent
* the PCCT as a virtual device for registering with the
* generic Mailbox framework.
*
* @pdev: Pointer to platform device returned when a match
* is found.
*
* Return: 0 for Success, else errno.
*/
static int pcc_mbox_probe(struct platform_device *pdev)
{
struct device *dev = &pdev->dev;
struct mbox_controller *pcc_mbox_ctrl;
struct mbox_chan *pcc_mbox_channels;
struct acpi_table_header *pcct_tbl;
struct acpi_subtable_header *pcct_entry;
struct acpi_table_pcct *acpi_pcct_tbl;
acpi_status status = AE_OK;
int i, rc, count = pcc_chan_count;
/* Search for PCCT */
status = acpi_get_table(ACPI_SIG_PCCT, 0, &pcct_tbl);
if (ACPI_FAILURE(status) || !pcct_tbl)
return -ENODEV;
pcc_mbox_channels = devm_kcalloc(dev, count, sizeof(*pcc_mbox_channels),
GFP_KERNEL);
if (!pcc_mbox_channels) { if (!pcc_mbox_channels) {
pr_err("Could not allocate space for PCC mbox channels\n");
rc = -ENOMEM; rc = -ENOMEM;
goto err_put_pcct; goto err;
} }
chan_info = kcalloc(count, sizeof(*chan_info), GFP_KERNEL); chan_info = devm_kcalloc(dev, count, sizeof(*chan_info), GFP_KERNEL);
if (!chan_info) { if (!chan_info) {
rc = -ENOMEM; rc = -ENOMEM;
goto err_free_mbox; goto err;
}
pcc_mbox_ctrl = devm_kmalloc(dev, sizeof(*pcc_mbox_ctrl), GFP_KERNEL);
if (!pcc_mbox_ctrl) {
rc = -ENOMEM;
goto err;
} }
/* Point to the first PCC subspace entry */ /* Point to the first PCC subspace entry */
...@@ -630,7 +664,7 @@ static int __init acpi_pcc_probe(void) ...@@ -630,7 +664,7 @@ static int __init acpi_pcc_probe(void)
acpi_pcct_tbl = (struct acpi_table_pcct *) pcct_tbl; acpi_pcct_tbl = (struct acpi_table_pcct *) pcct_tbl;
if (acpi_pcct_tbl->flags & ACPI_PCCT_DOORBELL) if (acpi_pcct_tbl->flags & ACPI_PCCT_DOORBELL)
pcc_mbox_ctrl.txdone_irq = true; pcc_mbox_ctrl->txdone_irq = true;
for (i = 0; i < count; i++) { for (i = 0; i < count; i++) {
struct pcc_chan_info *pchan = chan_info + i; struct pcc_chan_info *pchan = chan_info + i;
...@@ -639,13 +673,13 @@ static int __init acpi_pcc_probe(void) ...@@ -639,13 +673,13 @@ static int __init acpi_pcc_probe(void)
pchan->chan.mchan = &pcc_mbox_channels[i]; pchan->chan.mchan = &pcc_mbox_channels[i];
if (pcct_entry->type == ACPI_PCCT_TYPE_EXT_PCC_SLAVE_SUBSPACE && if (pcct_entry->type == ACPI_PCCT_TYPE_EXT_PCC_SLAVE_SUBSPACE &&
!pcc_mbox_ctrl.txdone_irq) { !pcc_mbox_ctrl->txdone_irq) {
pr_err("Plaform Interrupt flag must be set to 1"); pr_err("Plaform Interrupt flag must be set to 1");
rc = -EINVAL; rc = -EINVAL;
goto err; goto err;
} }
if (pcc_mbox_ctrl.txdone_irq) { if (pcc_mbox_ctrl->txdone_irq) {
rc = pcc_parse_subspace_irq(pchan, pcct_entry); rc = pcc_parse_subspace_irq(pchan, pcct_entry);
if (rc < 0) if (rc < 0)
goto err; goto err;
...@@ -660,51 +694,25 @@ static int __init acpi_pcc_probe(void) ...@@ -660,51 +694,25 @@ static int __init acpi_pcc_probe(void)
((unsigned long) pcct_entry + pcct_entry->length); ((unsigned long) pcct_entry + pcct_entry->length);
} }
pcc_mbox_ctrl.num_chans = count; pcc_mbox_ctrl->num_chans = count;
pr_info("Detected %d PCC Subspaces\n", pcc_mbox_ctrl.num_chans); pr_info("Detected %d PCC Subspaces\n", pcc_mbox_ctrl->num_chans);
return 0; pcc_mbox_ctrl->chans = pcc_mbox_channels;
pcc_mbox_ctrl->ops = &pcc_chan_ops;
pcc_mbox_ctrl->dev = dev;
pr_info("Registering PCC driver as Mailbox controller\n");
rc = mbox_controller_register(pcc_mbox_ctrl);
if (rc)
pr_err("Err registering PCC as Mailbox controller: %d\n", rc);
else
return 0;
err: err:
kfree(chan_info);
err_free_mbox:
kfree(pcc_mbox_channels);
err_put_pcct:
acpi_put_table(pcct_tbl); acpi_put_table(pcct_tbl);
return rc; return rc;
} }
/**
* pcc_mbox_probe - Called when we find a match for the
* PCCT platform device. This is purely used to represent
* the PCCT as a virtual device for registering with the
* generic Mailbox framework.
*
* @pdev: Pointer to platform device returned when a match
* is found.
*
* Return: 0 for Success, else errno.
*/
static int pcc_mbox_probe(struct platform_device *pdev)
{
int ret = 0;
pcc_mbox_ctrl.chans = pcc_mbox_channels;
pcc_mbox_ctrl.ops = &pcc_chan_ops;
pcc_mbox_ctrl.dev = &pdev->dev;
pr_info("Registering PCC driver as Mailbox controller\n");
ret = mbox_controller_register(&pcc_mbox_ctrl);
if (ret) {
pr_err("Err registering PCC as Mailbox controller: %d\n", ret);
ret = -ENODEV;
}
return ret;
}
static struct platform_driver pcc_mbox_driver = { static struct platform_driver pcc_mbox_driver = {
.probe = pcc_mbox_probe, .probe = pcc_mbox_probe,
.driver = { .driver = {
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment