/* * MIPI DSI Bus * * Copyright (C) 2012-2013, Samsung Electronics, Co., Ltd. * Andrzej Hajda <a.hajda@samsung.com> * * Permission is hereby granted, free of charge, to any person obtaining a * copy of this software and associated documentation files (the * "Software"), to deal in the Software without restriction, including * without limitation the rights to use, copy, modify, merge, publish, * distribute, sub license, and/or sell copies of the Software, and to * permit persons to whom the Software is furnished to do so, subject to * the following conditions: * * The above copyright notice and this permission notice (including the * next paragraph) shall be included in all copies or substantial portions * of the Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE * USE OR OTHER DEALINGS IN THE SOFTWARE. */ #include <drm/drm_mipi_dsi.h> #include <linux/device.h> #include <linux/module.h> #include <linux/of_device.h> #include <linux/pm_runtime.h> #include <linux/slab.h> #include <video/mipi_display.h> static int mipi_dsi_device_match(struct device *dev, struct device_driver *drv) { return of_driver_match_device(dev, drv); } static const struct dev_pm_ops mipi_dsi_device_pm_ops = { .runtime_suspend = pm_generic_runtime_suspend, .runtime_resume = pm_generic_runtime_resume, .suspend = pm_generic_suspend, .resume = pm_generic_resume, .freeze = pm_generic_freeze, .thaw = pm_generic_thaw, .poweroff = pm_generic_poweroff, .restore = pm_generic_restore, }; static struct bus_type mipi_dsi_bus_type = { .name = "mipi-dsi", .match = mipi_dsi_device_match, .pm = &mipi_dsi_device_pm_ops, }; static void mipi_dsi_dev_release(struct device *dev) { struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev); of_node_put(dev->of_node); kfree(dsi); } static const struct device_type mipi_dsi_device_type = { .release = mipi_dsi_dev_release, }; static struct mipi_dsi_device *mipi_dsi_device_alloc(struct mipi_dsi_host *host) { struct mipi_dsi_device *dsi; dsi = kzalloc(sizeof(*dsi), GFP_KERNEL); if (!dsi) return ERR_PTR(-ENOMEM); dsi->host = host; dsi->dev.bus = &mipi_dsi_bus_type; dsi->dev.parent = host->dev; dsi->dev.type = &mipi_dsi_device_type; device_initialize(&dsi->dev); return dsi; } static int mipi_dsi_device_add(struct mipi_dsi_device *dsi) { struct mipi_dsi_host *host = dsi->host; dev_set_name(&dsi->dev, "%s.%d", dev_name(host->dev), dsi->channel); return device_add(&dsi->dev); } static struct mipi_dsi_device * of_mipi_dsi_device_add(struct mipi_dsi_host *host, struct device_node *node) { struct mipi_dsi_device *dsi; struct device *dev = host->dev; int ret; u32 reg; ret = of_property_read_u32(node, "reg", ®); if (ret) { dev_err(dev, "device node %s has no valid reg property: %d\n", node->full_name, ret); return ERR_PTR(-EINVAL); } if (reg > 3) { dev_err(dev, "device node %s has invalid reg property: %u\n", node->full_name, reg); return ERR_PTR(-EINVAL); } dsi = mipi_dsi_device_alloc(host); if (IS_ERR(dsi)) { dev_err(dev, "failed to allocate DSI device %s: %ld\n", node->full_name, PTR_ERR(dsi)); return dsi; } dsi->dev.of_node = of_node_get(node); dsi->channel = reg; ret = mipi_dsi_device_add(dsi); if (ret) { dev_err(dev, "failed to add DSI device %s: %d\n", node->full_name, ret); kfree(dsi); return ERR_PTR(ret); } return dsi; } int mipi_dsi_host_register(struct mipi_dsi_host *host) { struct device_node *node; for_each_available_child_of_node(host->dev->of_node, node) of_mipi_dsi_device_add(host, node); return 0; } EXPORT_SYMBOL(mipi_dsi_host_register); static int mipi_dsi_remove_device_fn(struct device *dev, void *priv) { struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev); device_unregister(&dsi->dev); return 0; } void mipi_dsi_host_unregister(struct mipi_dsi_host *host) { device_for_each_child(host->dev, NULL, mipi_dsi_remove_device_fn); } EXPORT_SYMBOL(mipi_dsi_host_unregister); /** * mipi_dsi_attach - attach a DSI device to its DSI host * @dsi: DSI peripheral */ int mipi_dsi_attach(struct mipi_dsi_device *dsi) { const struct mipi_dsi_host_ops *ops = dsi->host->ops; if (!ops || !ops->attach) return -ENOSYS; return ops->attach(dsi->host, dsi); } EXPORT_SYMBOL(mipi_dsi_attach); /** * mipi_dsi_detach - detach a DSI device from its DSI host * @dsi: DSI peripheral */ int mipi_dsi_detach(struct mipi_dsi_device *dsi) { const struct mipi_dsi_host_ops *ops = dsi->host->ops; if (!ops || !ops->detach) return -ENOSYS; return ops->detach(dsi->host, dsi); } EXPORT_SYMBOL(mipi_dsi_detach); /** * mipi_dsi_dcs_write - send DCS write command * @dsi: DSI device * @channel: virtual channel * @data: pointer to the command followed by parameters * @len: length of @data */ int mipi_dsi_dcs_write(struct mipi_dsi_device *dsi, unsigned int channel, const void *data, size_t len) { const struct mipi_dsi_host_ops *ops = dsi->host->ops; struct mipi_dsi_msg msg = { .channel = channel, .tx_buf = data, .tx_len = len }; if (!ops || !ops->transfer) return -ENOSYS; switch (len) { case 0: return -EINVAL; case 1: msg.type = MIPI_DSI_DCS_SHORT_WRITE; break; case 2: msg.type = MIPI_DSI_DCS_SHORT_WRITE_PARAM; break; default: msg.type = MIPI_DSI_DCS_LONG_WRITE; break; } return ops->transfer(dsi->host, &msg); } EXPORT_SYMBOL(mipi_dsi_dcs_write); /** * mipi_dsi_dcs_read - send DCS read request command * @dsi: DSI device * @channel: virtual channel * @cmd: DCS read command * @data: pointer to read buffer * @len: length of @data * * Function returns number of read bytes or error code. */ ssize_t mipi_dsi_dcs_read(struct mipi_dsi_device *dsi, unsigned int channel, u8 cmd, void *data, size_t len) { const struct mipi_dsi_host_ops *ops = dsi->host->ops; struct mipi_dsi_msg msg = { .channel = channel, .type = MIPI_DSI_DCS_READ, .tx_buf = &cmd, .tx_len = 1, .rx_buf = data, .rx_len = len }; if (!ops || !ops->transfer) return -ENOSYS; return ops->transfer(dsi->host, &msg); } EXPORT_SYMBOL(mipi_dsi_dcs_read); static int mipi_dsi_drv_probe(struct device *dev) { struct mipi_dsi_driver *drv = to_mipi_dsi_driver(dev->driver); struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev); return drv->probe(dsi); } static int mipi_dsi_drv_remove(struct device *dev) { struct mipi_dsi_driver *drv = to_mipi_dsi_driver(dev->driver); struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev); return drv->remove(dsi); } /** * mipi_dsi_driver_register - register a driver for DSI devices * @drv: DSI driver structure */ int mipi_dsi_driver_register(struct mipi_dsi_driver *drv) { drv->driver.bus = &mipi_dsi_bus_type; if (drv->probe) drv->driver.probe = mipi_dsi_drv_probe; if (drv->remove) drv->driver.remove = mipi_dsi_drv_remove; return driver_register(&drv->driver); } EXPORT_SYMBOL(mipi_dsi_driver_register); /** * mipi_dsi_driver_unregister - unregister a driver for DSI devices * @drv: DSI driver structure */ void mipi_dsi_driver_unregister(struct mipi_dsi_driver *drv) { driver_unregister(&drv->driver); } EXPORT_SYMBOL(mipi_dsi_driver_unregister); static int __init mipi_dsi_bus_init(void) { return bus_register(&mipi_dsi_bus_type); } postcore_initcall(mipi_dsi_bus_init); MODULE_AUTHOR("Andrzej Hajda <a.hajda@samsung.com>"); MODULE_DESCRIPTION("MIPI DSI Bus"); MODULE_LICENSE("GPL and additional rights");