123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Copyright (c) 2016, NVIDIA CORPORATION. All rights reserved.
- */
- #include <linux/clk/tegra.h>
- #include <linux/genalloc.h>
- #include <linux/mailbox_client.h>
- #include <linux/module.h>
- #include <linux/of.h>
- #include <linux/of_address.h>
- #include <linux/of_device.h>
- #include <linux/platform_device.h>
- #include <linux/pm.h>
- #include <linux/semaphore.h>
- #include <linux/sched/clock.h>
- #include <soc/tegra/bpmp.h>
- #include <soc/tegra/bpmp-abi.h>
- #include <soc/tegra/ivc.h>
- #include "bpmp-private.h"
- #define MSG_ACK BIT(0)
- #define MSG_RING BIT(1)
- #define TAG_SZ 32
- static inline struct tegra_bpmp *
- mbox_client_to_bpmp(struct mbox_client *client)
- {
- return container_of(client, struct tegra_bpmp, mbox.client);
- }
- static inline const struct tegra_bpmp_ops *
- channel_to_ops(struct tegra_bpmp_channel *channel)
- {
- struct tegra_bpmp *bpmp = channel->bpmp;
- return bpmp->soc->ops;
- }
- struct tegra_bpmp *tegra_bpmp_get(struct device *dev)
- {
- struct platform_device *pdev;
- struct tegra_bpmp *bpmp;
- struct device_node *np;
- np = of_parse_phandle(dev->of_node, "nvidia,bpmp", 0);
- if (!np)
- return ERR_PTR(-ENOENT);
- pdev = of_find_device_by_node(np);
- if (!pdev) {
- bpmp = ERR_PTR(-ENODEV);
- goto put;
- }
- bpmp = platform_get_drvdata(pdev);
- if (!bpmp) {
- bpmp = ERR_PTR(-EPROBE_DEFER);
- put_device(&pdev->dev);
- goto put;
- }
- put:
- of_node_put(np);
- return bpmp;
- }
- EXPORT_SYMBOL_GPL(tegra_bpmp_get);
- void tegra_bpmp_put(struct tegra_bpmp *bpmp)
- {
- if (bpmp)
- put_device(bpmp->dev);
- }
- EXPORT_SYMBOL_GPL(tegra_bpmp_put);
- static int
- tegra_bpmp_channel_get_thread_index(struct tegra_bpmp_channel *channel)
- {
- struct tegra_bpmp *bpmp = channel->bpmp;
- unsigned int count;
- int index;
- count = bpmp->soc->channels.thread.count;
- index = channel - channel->bpmp->threaded_channels;
- if (index < 0 || index >= count)
- return -EINVAL;
- return index;
- }
- static bool tegra_bpmp_message_valid(const struct tegra_bpmp_message *msg)
- {
- return (msg->tx.size <= MSG_DATA_MIN_SZ) &&
- (msg->rx.size <= MSG_DATA_MIN_SZ) &&
- (msg->tx.size == 0 || msg->tx.data) &&
- (msg->rx.size == 0 || msg->rx.data);
- }
- static bool tegra_bpmp_is_response_ready(struct tegra_bpmp_channel *channel)
- {
- const struct tegra_bpmp_ops *ops = channel_to_ops(channel);
- return ops->is_response_ready(channel);
- }
- static bool tegra_bpmp_is_request_ready(struct tegra_bpmp_channel *channel)
- {
- const struct tegra_bpmp_ops *ops = channel_to_ops(channel);
- return ops->is_request_ready(channel);
- }
- static int tegra_bpmp_wait_response(struct tegra_bpmp_channel *channel)
- {
- unsigned long timeout = channel->bpmp->soc->channels.cpu_tx.timeout;
- ktime_t end;
- end = ktime_add_us(ktime_get(), timeout);
- do {
- if (tegra_bpmp_is_response_ready(channel))
- return 0;
- } while (ktime_before(ktime_get(), end));
- return -ETIMEDOUT;
- }
- static int tegra_bpmp_ack_response(struct tegra_bpmp_channel *channel)
- {
- const struct tegra_bpmp_ops *ops = channel_to_ops(channel);
- return ops->ack_response(channel);
- }
- static int tegra_bpmp_ack_request(struct tegra_bpmp_channel *channel)
- {
- const struct tegra_bpmp_ops *ops = channel_to_ops(channel);
- return ops->ack_request(channel);
- }
- static bool
- tegra_bpmp_is_request_channel_free(struct tegra_bpmp_channel *channel)
- {
- const struct tegra_bpmp_ops *ops = channel_to_ops(channel);
- return ops->is_request_channel_free(channel);
- }
- static bool
- tegra_bpmp_is_response_channel_free(struct tegra_bpmp_channel *channel)
- {
- const struct tegra_bpmp_ops *ops = channel_to_ops(channel);
- return ops->is_response_channel_free(channel);
- }
- static int
- tegra_bpmp_wait_request_channel_free(struct tegra_bpmp_channel *channel)
- {
- unsigned long timeout = channel->bpmp->soc->channels.cpu_tx.timeout;
- ktime_t start, now;
- start = ns_to_ktime(local_clock());
- do {
- if (tegra_bpmp_is_request_channel_free(channel))
- return 0;
- now = ns_to_ktime(local_clock());
- } while (ktime_us_delta(now, start) < timeout);
- return -ETIMEDOUT;
- }
- static int tegra_bpmp_post_request(struct tegra_bpmp_channel *channel)
- {
- const struct tegra_bpmp_ops *ops = channel_to_ops(channel);
- return ops->post_request(channel);
- }
- static int tegra_bpmp_post_response(struct tegra_bpmp_channel *channel)
- {
- const struct tegra_bpmp_ops *ops = channel_to_ops(channel);
- return ops->post_response(channel);
- }
- static int tegra_bpmp_ring_doorbell(struct tegra_bpmp *bpmp)
- {
- return bpmp->soc->ops->ring_doorbell(bpmp);
- }
- static ssize_t __tegra_bpmp_channel_read(struct tegra_bpmp_channel *channel,
- void *data, size_t size, int *ret)
- {
- int err;
- if (data && size > 0)
- memcpy_fromio(data, channel->ib->data, size);
- err = tegra_bpmp_ack_response(channel);
- if (err < 0)
- return err;
- *ret = channel->ib->code;
- return 0;
- }
- static ssize_t tegra_bpmp_channel_read(struct tegra_bpmp_channel *channel,
- void *data, size_t size, int *ret)
- {
- struct tegra_bpmp *bpmp = channel->bpmp;
- unsigned long flags;
- ssize_t err;
- int index;
- index = tegra_bpmp_channel_get_thread_index(channel);
- if (index < 0) {
- err = index;
- goto unlock;
- }
- spin_lock_irqsave(&bpmp->lock, flags);
- err = __tegra_bpmp_channel_read(channel, data, size, ret);
- clear_bit(index, bpmp->threaded.allocated);
- spin_unlock_irqrestore(&bpmp->lock, flags);
- unlock:
- up(&bpmp->threaded.lock);
- return err;
- }
- static ssize_t __tegra_bpmp_channel_write(struct tegra_bpmp_channel *channel,
- unsigned int mrq, unsigned long flags,
- const void *data, size_t size)
- {
- channel->ob->code = mrq;
- channel->ob->flags = flags;
- if (data && size > 0)
- memcpy_toio(channel->ob->data, data, size);
- return tegra_bpmp_post_request(channel);
- }
- static struct tegra_bpmp_channel *
- tegra_bpmp_write_threaded(struct tegra_bpmp *bpmp, unsigned int mrq,
- const void *data, size_t size)
- {
- unsigned long timeout = bpmp->soc->channels.thread.timeout;
- unsigned int count = bpmp->soc->channels.thread.count;
- struct tegra_bpmp_channel *channel;
- unsigned long flags;
- unsigned int index;
- int err;
- err = down_timeout(&bpmp->threaded.lock, usecs_to_jiffies(timeout));
- if (err < 0)
- return ERR_PTR(err);
- spin_lock_irqsave(&bpmp->lock, flags);
- index = find_first_zero_bit(bpmp->threaded.allocated, count);
- if (index == count) {
- err = -EBUSY;
- goto unlock;
- }
- channel = &bpmp->threaded_channels[index];
- if (!tegra_bpmp_is_request_channel_free(channel)) {
- err = -EBUSY;
- goto unlock;
- }
- set_bit(index, bpmp->threaded.allocated);
- err = __tegra_bpmp_channel_write(channel, mrq, MSG_ACK | MSG_RING,
- data, size);
- if (err < 0)
- goto clear_allocated;
- set_bit(index, bpmp->threaded.busy);
- spin_unlock_irqrestore(&bpmp->lock, flags);
- return channel;
- clear_allocated:
- clear_bit(index, bpmp->threaded.allocated);
- unlock:
- spin_unlock_irqrestore(&bpmp->lock, flags);
- up(&bpmp->threaded.lock);
- return ERR_PTR(err);
- }
- static ssize_t tegra_bpmp_channel_write(struct tegra_bpmp_channel *channel,
- unsigned int mrq, unsigned long flags,
- const void *data, size_t size)
- {
- int err;
- err = tegra_bpmp_wait_request_channel_free(channel);
- if (err < 0)
- return err;
- return __tegra_bpmp_channel_write(channel, mrq, flags, data, size);
- }
- int tegra_bpmp_transfer_atomic(struct tegra_bpmp *bpmp,
- struct tegra_bpmp_message *msg)
- {
- struct tegra_bpmp_channel *channel;
- int err;
- if (WARN_ON(!irqs_disabled()))
- return -EPERM;
- if (!tegra_bpmp_message_valid(msg))
- return -EINVAL;
- channel = bpmp->tx_channel;
- spin_lock(&bpmp->atomic_tx_lock);
- err = tegra_bpmp_channel_write(channel, msg->mrq, MSG_ACK,
- msg->tx.data, msg->tx.size);
- if (err < 0) {
- spin_unlock(&bpmp->atomic_tx_lock);
- return err;
- }
- spin_unlock(&bpmp->atomic_tx_lock);
- err = tegra_bpmp_ring_doorbell(bpmp);
- if (err < 0)
- return err;
- err = tegra_bpmp_wait_response(channel);
- if (err < 0)
- return err;
- return __tegra_bpmp_channel_read(channel, msg->rx.data, msg->rx.size,
- &msg->rx.ret);
- }
- EXPORT_SYMBOL_GPL(tegra_bpmp_transfer_atomic);
- int tegra_bpmp_transfer(struct tegra_bpmp *bpmp,
- struct tegra_bpmp_message *msg)
- {
- struct tegra_bpmp_channel *channel;
- unsigned long timeout;
- int err;
- if (WARN_ON(irqs_disabled()))
- return -EPERM;
- if (!tegra_bpmp_message_valid(msg))
- return -EINVAL;
- channel = tegra_bpmp_write_threaded(bpmp, msg->mrq, msg->tx.data,
- msg->tx.size);
- if (IS_ERR(channel))
- return PTR_ERR(channel);
- err = tegra_bpmp_ring_doorbell(bpmp);
- if (err < 0)
- return err;
- timeout = usecs_to_jiffies(bpmp->soc->channels.thread.timeout);
- err = wait_for_completion_timeout(&channel->completion, timeout);
- if (err == 0)
- return -ETIMEDOUT;
- return tegra_bpmp_channel_read(channel, msg->rx.data, msg->rx.size,
- &msg->rx.ret);
- }
- EXPORT_SYMBOL_GPL(tegra_bpmp_transfer);
- static struct tegra_bpmp_mrq *tegra_bpmp_find_mrq(struct tegra_bpmp *bpmp,
- unsigned int mrq)
- {
- struct tegra_bpmp_mrq *entry;
- list_for_each_entry(entry, &bpmp->mrqs, list)
- if (entry->mrq == mrq)
- return entry;
- return NULL;
- }
- void tegra_bpmp_mrq_return(struct tegra_bpmp_channel *channel, int code,
- const void *data, size_t size)
- {
- unsigned long flags = channel->ib->flags;
- struct tegra_bpmp *bpmp = channel->bpmp;
- int err;
- if (WARN_ON(size > MSG_DATA_MIN_SZ))
- return;
- err = tegra_bpmp_ack_request(channel);
- if (WARN_ON(err < 0))
- return;
- if ((flags & MSG_ACK) == 0)
- return;
- if (WARN_ON(!tegra_bpmp_is_response_channel_free(channel)))
- return;
- channel->ob->code = code;
- if (data && size > 0)
- memcpy_toio(channel->ob->data, data, size);
- err = tegra_bpmp_post_response(channel);
- if (WARN_ON(err < 0))
- return;
- if (flags & MSG_RING) {
- err = tegra_bpmp_ring_doorbell(bpmp);
- if (WARN_ON(err < 0))
- return;
- }
- }
- EXPORT_SYMBOL_GPL(tegra_bpmp_mrq_return);
- static void tegra_bpmp_handle_mrq(struct tegra_bpmp *bpmp,
- unsigned int mrq,
- struct tegra_bpmp_channel *channel)
- {
- struct tegra_bpmp_mrq *entry;
- u32 zero = 0;
- spin_lock(&bpmp->lock);
- entry = tegra_bpmp_find_mrq(bpmp, mrq);
- if (!entry) {
- spin_unlock(&bpmp->lock);
- tegra_bpmp_mrq_return(channel, -EINVAL, &zero, sizeof(zero));
- return;
- }
- entry->handler(mrq, channel, entry->data);
- spin_unlock(&bpmp->lock);
- }
- int tegra_bpmp_request_mrq(struct tegra_bpmp *bpmp, unsigned int mrq,
- tegra_bpmp_mrq_handler_t handler, void *data)
- {
- struct tegra_bpmp_mrq *entry;
- unsigned long flags;
- if (!handler)
- return -EINVAL;
- entry = devm_kzalloc(bpmp->dev, sizeof(*entry), GFP_KERNEL);
- if (!entry)
- return -ENOMEM;
- spin_lock_irqsave(&bpmp->lock, flags);
- entry->mrq = mrq;
- entry->handler = handler;
- entry->data = data;
- list_add(&entry->list, &bpmp->mrqs);
- spin_unlock_irqrestore(&bpmp->lock, flags);
- return 0;
- }
- EXPORT_SYMBOL_GPL(tegra_bpmp_request_mrq);
- void tegra_bpmp_free_mrq(struct tegra_bpmp *bpmp, unsigned int mrq, void *data)
- {
- struct tegra_bpmp_mrq *entry;
- unsigned long flags;
- spin_lock_irqsave(&bpmp->lock, flags);
- entry = tegra_bpmp_find_mrq(bpmp, mrq);
- if (!entry)
- goto unlock;
- list_del(&entry->list);
- devm_kfree(bpmp->dev, entry);
- unlock:
- spin_unlock_irqrestore(&bpmp->lock, flags);
- }
- EXPORT_SYMBOL_GPL(tegra_bpmp_free_mrq);
- bool tegra_bpmp_mrq_is_supported(struct tegra_bpmp *bpmp, unsigned int mrq)
- {
- struct mrq_query_abi_request req = { .mrq = cpu_to_le32(mrq) };
- struct mrq_query_abi_response resp;
- struct tegra_bpmp_message msg = {
- .mrq = MRQ_QUERY_ABI,
- .tx = {
- .data = &req,
- .size = sizeof(req),
- },
- .rx = {
- .data = &resp,
- .size = sizeof(resp),
- },
- };
- int err;
- err = tegra_bpmp_transfer(bpmp, &msg);
- if (err || msg.rx.ret)
- return false;
- return resp.status == 0;
- }
- EXPORT_SYMBOL_GPL(tegra_bpmp_mrq_is_supported);
- static void tegra_bpmp_mrq_handle_ping(unsigned int mrq,
- struct tegra_bpmp_channel *channel,
- void *data)
- {
- struct mrq_ping_request *request;
- struct mrq_ping_response response;
- request = (struct mrq_ping_request *)channel->ib->data;
- memset(&response, 0, sizeof(response));
- response.reply = request->challenge << 1;
- tegra_bpmp_mrq_return(channel, 0, &response, sizeof(response));
- }
- static int tegra_bpmp_ping(struct tegra_bpmp *bpmp)
- {
- struct mrq_ping_response response;
- struct mrq_ping_request request;
- struct tegra_bpmp_message msg;
- unsigned long flags;
- ktime_t start, end;
- int err;
- memset(&request, 0, sizeof(request));
- request.challenge = 1;
- memset(&response, 0, sizeof(response));
- memset(&msg, 0, sizeof(msg));
- msg.mrq = MRQ_PING;
- msg.tx.data = &request;
- msg.tx.size = sizeof(request);
- msg.rx.data = &response;
- msg.rx.size = sizeof(response);
- local_irq_save(flags);
- start = ktime_get();
- err = tegra_bpmp_transfer_atomic(bpmp, &msg);
- end = ktime_get();
- local_irq_restore(flags);
- if (!err)
- dev_dbg(bpmp->dev,
- "ping ok: challenge: %u, response: %u, time: %lld\n",
- request.challenge, response.reply,
- ktime_to_us(ktime_sub(end, start)));
- return err;
- }
- /* deprecated version of tag query */
- static int tegra_bpmp_get_firmware_tag_old(struct tegra_bpmp *bpmp, char *tag,
- size_t size)
- {
- struct mrq_query_tag_request request;
- struct tegra_bpmp_message msg;
- unsigned long flags;
- dma_addr_t phys;
- void *virt;
- int err;
- if (size != TAG_SZ)
- return -EINVAL;
- virt = dma_alloc_coherent(bpmp->dev, TAG_SZ, &phys,
- GFP_KERNEL | GFP_DMA32);
- if (!virt)
- return -ENOMEM;
- memset(&request, 0, sizeof(request));
- request.addr = phys;
- memset(&msg, 0, sizeof(msg));
- msg.mrq = MRQ_QUERY_TAG;
- msg.tx.data = &request;
- msg.tx.size = sizeof(request);
- local_irq_save(flags);
- err = tegra_bpmp_transfer_atomic(bpmp, &msg);
- local_irq_restore(flags);
- if (err == 0)
- memcpy(tag, virt, TAG_SZ);
- dma_free_coherent(bpmp->dev, TAG_SZ, virt, phys);
- return err;
- }
- static int tegra_bpmp_get_firmware_tag(struct tegra_bpmp *bpmp, char *tag,
- size_t size)
- {
- if (tegra_bpmp_mrq_is_supported(bpmp, MRQ_QUERY_FW_TAG)) {
- struct mrq_query_fw_tag_response resp;
- struct tegra_bpmp_message msg = {
- .mrq = MRQ_QUERY_FW_TAG,
- .rx = {
- .data = &resp,
- .size = sizeof(resp),
- },
- };
- int err;
- if (size != sizeof(resp.tag))
- return -EINVAL;
- err = tegra_bpmp_transfer(bpmp, &msg);
- if (err)
- return err;
- if (msg.rx.ret < 0)
- return -EINVAL;
- memcpy(tag, resp.tag, sizeof(resp.tag));
- return 0;
- }
- return tegra_bpmp_get_firmware_tag_old(bpmp, tag, size);
- }
- static void tegra_bpmp_channel_signal(struct tegra_bpmp_channel *channel)
- {
- unsigned long flags = channel->ob->flags;
- if ((flags & MSG_RING) == 0)
- return;
- complete(&channel->completion);
- }
- void tegra_bpmp_handle_rx(struct tegra_bpmp *bpmp)
- {
- struct tegra_bpmp_channel *channel;
- unsigned int i, count;
- unsigned long *busy;
- channel = bpmp->rx_channel;
- count = bpmp->soc->channels.thread.count;
- busy = bpmp->threaded.busy;
- if (tegra_bpmp_is_request_ready(channel))
- tegra_bpmp_handle_mrq(bpmp, channel->ib->code, channel);
- spin_lock(&bpmp->lock);
- for_each_set_bit(i, busy, count) {
- struct tegra_bpmp_channel *channel;
- channel = &bpmp->threaded_channels[i];
- if (tegra_bpmp_is_response_ready(channel)) {
- tegra_bpmp_channel_signal(channel);
- clear_bit(i, busy);
- }
- }
- spin_unlock(&bpmp->lock);
- }
- static int tegra_bpmp_probe(struct platform_device *pdev)
- {
- struct tegra_bpmp *bpmp;
- char tag[TAG_SZ];
- size_t size;
- int err;
- bpmp = devm_kzalloc(&pdev->dev, sizeof(*bpmp), GFP_KERNEL);
- if (!bpmp)
- return -ENOMEM;
- bpmp->soc = of_device_get_match_data(&pdev->dev);
- bpmp->dev = &pdev->dev;
- INIT_LIST_HEAD(&bpmp->mrqs);
- spin_lock_init(&bpmp->lock);
- bpmp->threaded.count = bpmp->soc->channels.thread.count;
- sema_init(&bpmp->threaded.lock, bpmp->threaded.count);
- size = BITS_TO_LONGS(bpmp->threaded.count) * sizeof(long);
- bpmp->threaded.allocated = devm_kzalloc(&pdev->dev, size, GFP_KERNEL);
- if (!bpmp->threaded.allocated)
- return -ENOMEM;
- bpmp->threaded.busy = devm_kzalloc(&pdev->dev, size, GFP_KERNEL);
- if (!bpmp->threaded.busy)
- return -ENOMEM;
- spin_lock_init(&bpmp->atomic_tx_lock);
- bpmp->tx_channel = devm_kzalloc(&pdev->dev, sizeof(*bpmp->tx_channel),
- GFP_KERNEL);
- if (!bpmp->tx_channel)
- return -ENOMEM;
- bpmp->rx_channel = devm_kzalloc(&pdev->dev, sizeof(*bpmp->rx_channel),
- GFP_KERNEL);
- if (!bpmp->rx_channel)
- return -ENOMEM;
- bpmp->threaded_channels = devm_kcalloc(&pdev->dev, bpmp->threaded.count,
- sizeof(*bpmp->threaded_channels),
- GFP_KERNEL);
- if (!bpmp->threaded_channels)
- return -ENOMEM;
- err = bpmp->soc->ops->init(bpmp);
- if (err < 0)
- return err;
- err = tegra_bpmp_request_mrq(bpmp, MRQ_PING,
- tegra_bpmp_mrq_handle_ping, bpmp);
- if (err < 0)
- goto deinit;
- err = tegra_bpmp_ping(bpmp);
- if (err < 0) {
- dev_err(&pdev->dev, "failed to ping BPMP: %d\n", err);
- goto free_mrq;
- }
- err = tegra_bpmp_get_firmware_tag(bpmp, tag, sizeof(tag));
- if (err < 0) {
- dev_err(&pdev->dev, "failed to get firmware tag: %d\n", err);
- goto free_mrq;
- }
- dev_info(&pdev->dev, "firmware: %.*s\n", (int)sizeof(tag), tag);
- platform_set_drvdata(pdev, bpmp);
- err = of_platform_default_populate(pdev->dev.of_node, NULL, &pdev->dev);
- if (err < 0)
- goto free_mrq;
- if (of_find_property(pdev->dev.of_node, "#clock-cells", NULL)) {
- err = tegra_bpmp_init_clocks(bpmp);
- if (err < 0)
- goto free_mrq;
- }
- if (of_find_property(pdev->dev.of_node, "#reset-cells", NULL)) {
- err = tegra_bpmp_init_resets(bpmp);
- if (err < 0)
- goto free_mrq;
- }
- if (of_find_property(pdev->dev.of_node, "#power-domain-cells", NULL)) {
- err = tegra_bpmp_init_powergates(bpmp);
- if (err < 0)
- goto free_mrq;
- }
- err = tegra_bpmp_init_debugfs(bpmp);
- if (err < 0)
- dev_err(&pdev->dev, "debugfs initialization failed: %d\n", err);
- return 0;
- free_mrq:
- tegra_bpmp_free_mrq(bpmp, MRQ_PING, bpmp);
- deinit:
- if (bpmp->soc->ops->deinit)
- bpmp->soc->ops->deinit(bpmp);
- return err;
- }
- static int __maybe_unused tegra_bpmp_resume(struct device *dev)
- {
- struct tegra_bpmp *bpmp = dev_get_drvdata(dev);
- if (bpmp->soc->ops->resume)
- return bpmp->soc->ops->resume(bpmp);
- else
- return 0;
- }
- static const struct dev_pm_ops tegra_bpmp_pm_ops = {
- .resume_noirq = tegra_bpmp_resume,
- };
- #if IS_ENABLED(CONFIG_ARCH_TEGRA_186_SOC) || \
- IS_ENABLED(CONFIG_ARCH_TEGRA_194_SOC) || \
- IS_ENABLED(CONFIG_ARCH_TEGRA_234_SOC)
- static const struct tegra_bpmp_soc tegra186_soc = {
- .channels = {
- .cpu_tx = {
- .offset = 3,
- .timeout = 60 * USEC_PER_SEC,
- },
- .thread = {
- .offset = 0,
- .count = 3,
- .timeout = 600 * USEC_PER_SEC,
- },
- .cpu_rx = {
- .offset = 13,
- .timeout = 0,
- },
- },
- .ops = &tegra186_bpmp_ops,
- .num_resets = 193,
- };
- #endif
- #if IS_ENABLED(CONFIG_ARCH_TEGRA_210_SOC)
- static const struct tegra_bpmp_soc tegra210_soc = {
- .channels = {
- .cpu_tx = {
- .offset = 0,
- .count = 1,
- .timeout = 60 * USEC_PER_SEC,
- },
- .thread = {
- .offset = 4,
- .count = 1,
- .timeout = 600 * USEC_PER_SEC,
- },
- .cpu_rx = {
- .offset = 8,
- .count = 1,
- .timeout = 0,
- },
- },
- .ops = &tegra210_bpmp_ops,
- };
- #endif
- static const struct of_device_id tegra_bpmp_match[] = {
- #if IS_ENABLED(CONFIG_ARCH_TEGRA_186_SOC) || \
- IS_ENABLED(CONFIG_ARCH_TEGRA_194_SOC) || \
- IS_ENABLED(CONFIG_ARCH_TEGRA_234_SOC)
- { .compatible = "nvidia,tegra186-bpmp", .data = &tegra186_soc },
- #endif
- #if IS_ENABLED(CONFIG_ARCH_TEGRA_210_SOC)
- { .compatible = "nvidia,tegra210-bpmp", .data = &tegra210_soc },
- #endif
- { }
- };
- static struct platform_driver tegra_bpmp_driver = {
- .driver = {
- .name = "tegra-bpmp",
- .of_match_table = tegra_bpmp_match,
- .pm = &tegra_bpmp_pm_ops,
- .suppress_bind_attrs = true,
- },
- .probe = tegra_bpmp_probe,
- };
- builtin_platform_driver(tegra_bpmp_driver);
|