887 lines
20 KiB
C
887 lines
20 KiB
C
/*
|
|
* Copyright (c) 2016, NVIDIA CORPORATION. All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2, as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*/
|
|
|
|
#include <linux/clk/tegra.h>
|
|
#include <linux/genalloc.h>
|
|
#include <linux/mailbox_client.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(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(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(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 ret;
|
|
|
|
ret = tegra_bpmp_transfer(bpmp, &msg);
|
|
if (ret || 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 SIMPLE_DEV_PM_OPS(tegra_bpmp_pm_ops, NULL, tegra_bpmp_resume);
|
|
|
|
#if IS_ENABLED(CONFIG_ARCH_TEGRA_186_SOC) || \
|
|
IS_ENABLED(CONFIG_ARCH_TEGRA_194_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)
|
|
{ .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,
|
|
},
|
|
.probe = tegra_bpmp_probe,
|
|
};
|
|
|
|
static int __init tegra_bpmp_init(void)
|
|
{
|
|
return platform_driver_register(&tegra_bpmp_driver);
|
|
}
|
|
core_initcall(tegra_bpmp_init);
|