/*
* Tegra sysfs mbox driver for IVC channels
*
* Copyright (c) 2016-2017 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.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see .
*/
#include
#include
#include
#include
#include
#include
#define NV(p) "nvidia," #p
#ifndef dev_err_once
#define dev_err_once(dev, fmt, ...) \
do { \
static bool __print_once __read_mostly; \
\
if (!__print_once) { \
__print_once = true; \
dev_err(dev, fmt, ##__VA_ARGS__); \
} \
} while (0)
#endif
static ssize_t sysfs_mbox_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct tegra_ivc_channel *chan = dev_get_drvdata(dev);
size_t length = chan->ivc.frame_size;
ssize_t count = 0;
dev_err_once(dev, "mbox is deprecated\n");
while ((count + length < PAGE_SIZE) &&
tegra_ivc_can_read(&chan->ivc)) {
const void *data = tegra_ivc_read_get_next_frame(&chan->ivc);
dev_dbg(&chan->dev, "rx msg\n");
print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET,
16, 1, data, length, true);
memcpy(buf, data, length);
tegra_ivc_read_advance(&chan->ivc);
buf += length;
count += length;
}
return count;
}
static ssize_t sysfs_mbox_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t count)
{
struct tegra_ivc_channel *chan = dev_get_drvdata(dev);
if (count > chan->ivc.frame_size) {
dev_err(dev, "data size %zu > mbox frame size %u\n",
count, chan->ivc.frame_size);
return -EMSGSIZE;
}
dev_err_once(dev, "mbox is deprecated\n");
dev_dbg(&chan->dev, "tx msg\n");
print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET,
16, 1, buf, count, true);
return tegra_ivc_write(&chan->ivc, buf, count);
}
static const DEVICE_ATTR(mbox, 0600, sysfs_mbox_show, sysfs_mbox_store);
/* This is a quick-and-dirty hack driver. Do not extend. */
static const struct of_device_id sysfs_mbox_of_match[] = {
{ .compatible = "nvidia,tegra186-camera-ivc-protocol-mods",
.data = "sce-mods" },
{ },
};
/* Tegra IVC channel device */
static int sysfs_mbox_probe(struct tegra_ivc_channel *chan)
{
struct device *legacy;
const struct of_device_id *id = of_match_device(sysfs_mbox_of_match,
&chan->dev);
int err;
if (id == NULL)
return -EINVAL;
BUG_ON(id->data == NULL);
legacy = root_device_register(id->data);
if (IS_ERR(legacy))
return PTR_ERR(legacy);
dev_set_drvdata(legacy, chan);
tegra_ivc_channel_set_drvdata(chan, legacy);
err = sysfs_create_link(&legacy->kobj, &chan->dev.kobj, "ivc-channel");
if (err)
goto err1;
err = sysfs_create_link(&chan->dev.kobj, &legacy->kobj, "legacy");
if (err)
goto err2;
err = device_create_file(legacy, &dev_attr_mbox);
if (err) {
sysfs_delete_link(&chan->dev.kobj, &legacy->kobj, "legacy");
err2:
sysfs_delete_link(&legacy->kobj, &chan->dev.kobj,
"ivc-channel");
err1:
root_device_unregister(legacy);
}
return err;
}
static void sysfs_mbox_remove(struct tegra_ivc_channel *chan)
{
struct device *legacy = tegra_ivc_channel_get_drvdata(chan);
device_remove_file(legacy, &dev_attr_mbox);
sysfs_delete_link(&chan->dev.kobj, &legacy->kobj, "legacy");
sysfs_delete_link(&legacy->kobj, &chan->dev.kobj, "ivc-channel");
root_device_unregister(legacy);
}
static const struct tegra_ivc_channel_ops tegra_ivc_channel_sysfs_ops = {
.probe = sysfs_mbox_probe,
.remove = sysfs_mbox_remove,
};
static struct tegra_ivc_driver sysfs_mbox_driver = {
.driver = {
.owner = THIS_MODULE,
.bus = &tegra_ivc_bus_type,
.name = "tegra-ivc-channel-sysfs",
.of_match_table = sysfs_mbox_of_match,
},
.dev_type = &tegra_ivc_channel_type,
.ops.channel = &tegra_ivc_channel_sysfs_ops,
};
tegra_ivc_subsys_driver_default(sysfs_mbox_driver);
MODULE_AUTHOR("Pekka Pessi ");
MODULE_DESCRIPTION("Legacy Tegra IVC sysfs driver");
MODULE_LICENSE("GPL");