 99035e9931
			
		
	
	
	99035e9931
	
	
	
		
			
			Drivers now no longer need to set the .owner field. It will be automatically set at registration time. Signed-off-by: Thierry Reding <treding@nvidia.com>
		
			
				
	
	
		
			933 lines
		
	
	
	
		
			23 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			933 lines
		
	
	
	
		
			23 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * 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>
 | |
| 
 | |
| /**
 | |
|  * DOC: dsi helpers
 | |
|  *
 | |
|  * These functions contain some common logic and helpers to deal with MIPI DSI
 | |
|  * peripherals.
 | |
|  *
 | |
|  * Helpers are provided for a number of standard MIPI DSI command as well as a
 | |
|  * subset of the MIPI DCS command set.
 | |
|  */
 | |
| 
 | |
| 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 int of_device_match(struct device *dev, void *data)
 | |
| {
 | |
| 	return dev->of_node == data;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * of_find_mipi_dsi_device_by_node() - find the MIPI DSI device matching a
 | |
|  *    device tree node
 | |
|  * @np: device tree node
 | |
|  *
 | |
|  * Return: A pointer to the MIPI DSI device corresponding to @np or NULL if no
 | |
|  *    such device exists (or has not been registered yet).
 | |
|  */
 | |
| struct mipi_dsi_device *of_find_mipi_dsi_device_by_node(struct device_node *np)
 | |
| {
 | |
| 	struct device *dev;
 | |
| 
 | |
| 	dev = bus_find_device(&mipi_dsi_bus_type, NULL, np, of_device_match);
 | |
| 
 | |
| 	return dev ? to_mipi_dsi_device(dev) : NULL;
 | |
| }
 | |
| EXPORT_SYMBOL(of_find_mipi_dsi_device_by_node);
 | |
| 
 | |
| 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) {
 | |
| 		/* skip nodes without reg property */
 | |
| 		if (!of_find_property(node, "reg", NULL))
 | |
| 			continue;
 | |
| 		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);
 | |
| 
 | |
| static ssize_t mipi_dsi_device_transfer(struct mipi_dsi_device *dsi,
 | |
| 					struct mipi_dsi_msg *msg)
 | |
| {
 | |
| 	const struct mipi_dsi_host_ops *ops = dsi->host->ops;
 | |
| 
 | |
| 	if (!ops || !ops->transfer)
 | |
| 		return -ENOSYS;
 | |
| 
 | |
| 	if (dsi->mode_flags & MIPI_DSI_MODE_LPM)
 | |
| 		msg->flags |= MIPI_DSI_MSG_USE_LPM;
 | |
| 
 | |
| 	return ops->transfer(dsi->host, msg);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_packet_format_is_short - check if a packet is of the short format
 | |
|  * @type: MIPI DSI data type of the packet
 | |
|  *
 | |
|  * Return: true if the packet for the given data type is a short packet, false
 | |
|  * otherwise.
 | |
|  */
 | |
| bool mipi_dsi_packet_format_is_short(u8 type)
 | |
| {
 | |
| 	switch (type) {
 | |
| 	case MIPI_DSI_V_SYNC_START:
 | |
| 	case MIPI_DSI_V_SYNC_END:
 | |
| 	case MIPI_DSI_H_SYNC_START:
 | |
| 	case MIPI_DSI_H_SYNC_END:
 | |
| 	case MIPI_DSI_END_OF_TRANSMISSION:
 | |
| 	case MIPI_DSI_COLOR_MODE_OFF:
 | |
| 	case MIPI_DSI_COLOR_MODE_ON:
 | |
| 	case MIPI_DSI_SHUTDOWN_PERIPHERAL:
 | |
| 	case MIPI_DSI_TURN_ON_PERIPHERAL:
 | |
| 	case MIPI_DSI_GENERIC_SHORT_WRITE_0_PARAM:
 | |
| 	case MIPI_DSI_GENERIC_SHORT_WRITE_1_PARAM:
 | |
| 	case MIPI_DSI_GENERIC_SHORT_WRITE_2_PARAM:
 | |
| 	case MIPI_DSI_GENERIC_READ_REQUEST_0_PARAM:
 | |
| 	case MIPI_DSI_GENERIC_READ_REQUEST_1_PARAM:
 | |
| 	case MIPI_DSI_GENERIC_READ_REQUEST_2_PARAM:
 | |
| 	case MIPI_DSI_DCS_SHORT_WRITE:
 | |
| 	case MIPI_DSI_DCS_SHORT_WRITE_PARAM:
 | |
| 	case MIPI_DSI_DCS_READ:
 | |
| 	case MIPI_DSI_SET_MAXIMUM_RETURN_PACKET_SIZE:
 | |
| 		return true;
 | |
| 	}
 | |
| 
 | |
| 	return false;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_packet_format_is_short);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_packet_format_is_long - check if a packet is of the long format
 | |
|  * @type: MIPI DSI data type of the packet
 | |
|  *
 | |
|  * Return: true if the packet for the given data type is a long packet, false
 | |
|  * otherwise.
 | |
|  */
 | |
| bool mipi_dsi_packet_format_is_long(u8 type)
 | |
| {
 | |
| 	switch (type) {
 | |
| 	case MIPI_DSI_NULL_PACKET:
 | |
| 	case MIPI_DSI_BLANKING_PACKET:
 | |
| 	case MIPI_DSI_GENERIC_LONG_WRITE:
 | |
| 	case MIPI_DSI_DCS_LONG_WRITE:
 | |
| 	case MIPI_DSI_LOOSELY_PACKED_PIXEL_STREAM_YCBCR20:
 | |
| 	case MIPI_DSI_PACKED_PIXEL_STREAM_YCBCR24:
 | |
| 	case MIPI_DSI_PACKED_PIXEL_STREAM_YCBCR16:
 | |
| 	case MIPI_DSI_PACKED_PIXEL_STREAM_30:
 | |
| 	case MIPI_DSI_PACKED_PIXEL_STREAM_36:
 | |
| 	case MIPI_DSI_PACKED_PIXEL_STREAM_YCBCR12:
 | |
| 	case MIPI_DSI_PACKED_PIXEL_STREAM_16:
 | |
| 	case MIPI_DSI_PACKED_PIXEL_STREAM_18:
 | |
| 	case MIPI_DSI_PIXEL_STREAM_3BYTE_18:
 | |
| 	case MIPI_DSI_PACKED_PIXEL_STREAM_24:
 | |
| 		return true;
 | |
| 	}
 | |
| 
 | |
| 	return false;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_packet_format_is_long);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_create_packet - create a packet from a message according to the
 | |
|  *     DSI protocol
 | |
|  * @packet: pointer to a DSI packet structure
 | |
|  * @msg: message to translate into a packet
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_create_packet(struct mipi_dsi_packet *packet,
 | |
| 			   const struct mipi_dsi_msg *msg)
 | |
| {
 | |
| 	const u8 *tx = msg->tx_buf;
 | |
| 
 | |
| 	if (!packet || !msg)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	/* do some minimum sanity checking */
 | |
| 	if (!mipi_dsi_packet_format_is_short(msg->type) &&
 | |
| 	    !mipi_dsi_packet_format_is_long(msg->type))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (msg->channel > 3)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	memset(packet, 0, sizeof(*packet));
 | |
| 	packet->header[0] = ((msg->channel & 0x3) << 6) | (msg->type & 0x3f);
 | |
| 
 | |
| 	/* TODO: compute ECC if hardware support is not available */
 | |
| 
 | |
| 	/*
 | |
| 	 * Long write packets contain the word count in header bytes 1 and 2.
 | |
| 	 * The payload follows the header and is word count bytes long.
 | |
| 	 *
 | |
| 	 * Short write packets encode up to two parameters in header bytes 1
 | |
| 	 * and 2.
 | |
| 	 */
 | |
| 	if (mipi_dsi_packet_format_is_long(msg->type)) {
 | |
| 		packet->header[1] = (msg->tx_len >> 0) & 0xff;
 | |
| 		packet->header[2] = (msg->tx_len >> 8) & 0xff;
 | |
| 
 | |
| 		packet->payload_length = msg->tx_len;
 | |
| 		packet->payload = tx;
 | |
| 	} else {
 | |
| 		packet->header[1] = (msg->tx_len > 0) ? tx[0] : 0;
 | |
| 		packet->header[2] = (msg->tx_len > 1) ? tx[1] : 0;
 | |
| 	}
 | |
| 
 | |
| 	packet->size = sizeof(packet->header) + packet->payload_length;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_create_packet);
 | |
| 
 | |
| /*
 | |
|  * mipi_dsi_set_maximum_return_packet_size() - specify the maximum size of the
 | |
|  *    the payload in a long packet transmitted from the peripheral back to the
 | |
|  *    host processor
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @value: the maximum size of the payload
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_set_maximum_return_packet_size(struct mipi_dsi_device *dsi,
 | |
| 					    u16 value)
 | |
| {
 | |
| 	u8 tx[2] = { value & 0xff, value >> 8 };
 | |
| 	struct mipi_dsi_msg msg = {
 | |
| 		.channel = dsi->channel,
 | |
| 		.type = MIPI_DSI_SET_MAXIMUM_RETURN_PACKET_SIZE,
 | |
| 		.tx_len = sizeof(tx),
 | |
| 		.tx_buf = tx,
 | |
| 	};
 | |
| 
 | |
| 	return mipi_dsi_device_transfer(dsi, &msg);
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_set_maximum_return_packet_size);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_generic_write() - transmit data using a generic write packet
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @payload: buffer containing the payload
 | |
|  * @size: size of payload buffer
 | |
|  *
 | |
|  * This function will automatically choose the right data type depending on
 | |
|  * the payload length.
 | |
|  *
 | |
|  * Return: The number of bytes transmitted on success or a negative error code
 | |
|  * on failure.
 | |
|  */
 | |
| ssize_t mipi_dsi_generic_write(struct mipi_dsi_device *dsi, const void *payload,
 | |
| 			       size_t size)
 | |
| {
 | |
| 	struct mipi_dsi_msg msg = {
 | |
| 		.channel = dsi->channel,
 | |
| 		.tx_buf = payload,
 | |
| 		.tx_len = size
 | |
| 	};
 | |
| 
 | |
| 	switch (size) {
 | |
| 	case 0:
 | |
| 		msg.type = MIPI_DSI_GENERIC_SHORT_WRITE_0_PARAM;
 | |
| 		break;
 | |
| 
 | |
| 	case 1:
 | |
| 		msg.type = MIPI_DSI_GENERIC_SHORT_WRITE_1_PARAM;
 | |
| 		break;
 | |
| 
 | |
| 	case 2:
 | |
| 		msg.type = MIPI_DSI_GENERIC_SHORT_WRITE_2_PARAM;
 | |
| 		break;
 | |
| 
 | |
| 	default:
 | |
| 		msg.type = MIPI_DSI_GENERIC_LONG_WRITE;
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	return mipi_dsi_device_transfer(dsi, &msg);
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_generic_write);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_generic_read() - receive data using a generic read packet
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @params: buffer containing the request parameters
 | |
|  * @num_params: number of request parameters
 | |
|  * @data: buffer in which to return the received data
 | |
|  * @size: size of receive buffer
 | |
|  *
 | |
|  * This function will automatically choose the right data type depending on
 | |
|  * the number of parameters passed in.
 | |
|  *
 | |
|  * Return: The number of bytes successfully read or a negative error code on
 | |
|  * failure.
 | |
|  */
 | |
| ssize_t mipi_dsi_generic_read(struct mipi_dsi_device *dsi, const void *params,
 | |
| 			      size_t num_params, void *data, size_t size)
 | |
| {
 | |
| 	struct mipi_dsi_msg msg = {
 | |
| 		.channel = dsi->channel,
 | |
| 		.tx_len = num_params,
 | |
| 		.tx_buf = params,
 | |
| 		.rx_len = size,
 | |
| 		.rx_buf = data
 | |
| 	};
 | |
| 
 | |
| 	switch (num_params) {
 | |
| 	case 0:
 | |
| 		msg.type = MIPI_DSI_GENERIC_READ_REQUEST_0_PARAM;
 | |
| 		break;
 | |
| 
 | |
| 	case 1:
 | |
| 		msg.type = MIPI_DSI_GENERIC_READ_REQUEST_1_PARAM;
 | |
| 		break;
 | |
| 
 | |
| 	case 2:
 | |
| 		msg.type = MIPI_DSI_GENERIC_READ_REQUEST_2_PARAM;
 | |
| 		break;
 | |
| 
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	return mipi_dsi_device_transfer(dsi, &msg);
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_generic_read);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_write_buffer() - transmit a DCS command with payload
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @data: buffer containing data to be transmitted
 | |
|  * @len: size of transmission buffer
 | |
|  *
 | |
|  * This function will automatically choose the right data type depending on
 | |
|  * the command payload length.
 | |
|  *
 | |
|  * Return: The number of bytes successfully transmitted or a negative error
 | |
|  * code on failure.
 | |
|  */
 | |
| ssize_t mipi_dsi_dcs_write_buffer(struct mipi_dsi_device *dsi,
 | |
| 				  const void *data, size_t len)
 | |
| {
 | |
| 	struct mipi_dsi_msg msg = {
 | |
| 		.channel = dsi->channel,
 | |
| 		.tx_buf = data,
 | |
| 		.tx_len = len
 | |
| 	};
 | |
| 
 | |
| 	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 mipi_dsi_device_transfer(dsi, &msg);
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_write_buffer);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_write() - send DCS write command
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @cmd: DCS command
 | |
|  * @data: buffer containing the command payload
 | |
|  * @len: command payload length
 | |
|  *
 | |
|  * This function will automatically choose the right data type depending on
 | |
|  * the command payload length.
 | |
|  *
 | |
|  * Return: The number of bytes successfully transmitted or a negative error
 | |
|  * code on failure.
 | |
|  */
 | |
| ssize_t mipi_dsi_dcs_write(struct mipi_dsi_device *dsi, u8 cmd,
 | |
| 			   const void *data, size_t len)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 	size_t size;
 | |
| 	u8 *tx;
 | |
| 
 | |
| 	if (len > 0) {
 | |
| 		size = 1 + len;
 | |
| 
 | |
| 		tx = kmalloc(size, GFP_KERNEL);
 | |
| 		if (!tx)
 | |
| 			return -ENOMEM;
 | |
| 
 | |
| 		/* concatenate the DCS command byte and the payload */
 | |
| 		tx[0] = cmd;
 | |
| 		memcpy(&tx[1], data, len);
 | |
| 	} else {
 | |
| 		tx = &cmd;
 | |
| 		size = 1;
 | |
| 	}
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write_buffer(dsi, tx, size);
 | |
| 
 | |
| 	if (len > 0)
 | |
| 		kfree(tx);
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_write);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_read() - send DCS read request command
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @cmd: DCS command
 | |
|  * @data: buffer in which to receive data
 | |
|  * @len: size of receive buffer
 | |
|  *
 | |
|  * Return: The number of bytes read or a negative error code on failure.
 | |
|  */
 | |
| ssize_t mipi_dsi_dcs_read(struct mipi_dsi_device *dsi, u8 cmd, void *data,
 | |
| 			  size_t len)
 | |
| {
 | |
| 	struct mipi_dsi_msg msg = {
 | |
| 		.channel = dsi->channel,
 | |
| 		.type = MIPI_DSI_DCS_READ,
 | |
| 		.tx_buf = &cmd,
 | |
| 		.tx_len = 1,
 | |
| 		.rx_buf = data,
 | |
| 		.rx_len = len
 | |
| 	};
 | |
| 
 | |
| 	return mipi_dsi_device_transfer(dsi, &msg);
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_read);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_nop() - send DCS nop packet
 | |
|  * @dsi: DSI peripheral device
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_dcs_nop(struct mipi_dsi_device *dsi)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_NOP, NULL, 0);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_nop);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_soft_reset() - perform a software reset of the display module
 | |
|  * @dsi: DSI peripheral device
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_dcs_soft_reset(struct mipi_dsi_device *dsi)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SOFT_RESET, NULL, 0);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_soft_reset);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_get_power_mode() - query the display module's current power
 | |
|  *    mode
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @mode: return location for the current power mode
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_dcs_get_power_mode(struct mipi_dsi_device *dsi, u8 *mode)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_read(dsi, MIPI_DCS_GET_POWER_MODE, mode,
 | |
| 				sizeof(*mode));
 | |
| 	if (err <= 0) {
 | |
| 		if (err == 0)
 | |
| 			err = -ENODATA;
 | |
| 
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_get_power_mode);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_get_pixel_format() - gets the pixel format for the RGB image
 | |
|  *    data used by the interface
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @format: return location for the pixel format
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_dcs_get_pixel_format(struct mipi_dsi_device *dsi, u8 *format)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_read(dsi, MIPI_DCS_GET_PIXEL_FORMAT, format,
 | |
| 				sizeof(*format));
 | |
| 	if (err <= 0) {
 | |
| 		if (err == 0)
 | |
| 			err = -ENODATA;
 | |
| 
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_get_pixel_format);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_enter_sleep_mode() - disable all unnecessary blocks inside the
 | |
|  *    display module except interface communication
 | |
|  * @dsi: DSI peripheral device
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_dcs_enter_sleep_mode(struct mipi_dsi_device *dsi)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_ENTER_SLEEP_MODE, NULL, 0);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_enter_sleep_mode);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_exit_sleep_mode() - enable all blocks inside the display
 | |
|  *    module
 | |
|  * @dsi: DSI peripheral device
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_dcs_exit_sleep_mode(struct mipi_dsi_device *dsi)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_EXIT_SLEEP_MODE, NULL, 0);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_exit_sleep_mode);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_set_display_off() - stop displaying the image data on the
 | |
|  *    display device
 | |
|  * @dsi: DSI peripheral device
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_dcs_set_display_off(struct mipi_dsi_device *dsi)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_DISPLAY_OFF, NULL, 0);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_set_display_off);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_set_display_on() - start displaying the image data on the
 | |
|  *    display device
 | |
|  * @dsi: DSI peripheral device
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure
 | |
|  */
 | |
| int mipi_dsi_dcs_set_display_on(struct mipi_dsi_device *dsi)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_DISPLAY_ON, NULL, 0);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_set_display_on);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_set_column_address() - define the column extent of the frame
 | |
|  *    memory accessed by the host processor
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @start: first column of frame memory
 | |
|  * @end: last column of frame memory
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_dcs_set_column_address(struct mipi_dsi_device *dsi, u16 start,
 | |
| 				    u16 end)
 | |
| {
 | |
| 	u8 payload[4] = { start >> 8, start & 0xff, end >> 8, end & 0xff };
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_COLUMN_ADDRESS, payload,
 | |
| 				 sizeof(payload));
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_set_column_address);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_set_page_address() - define the page extent of the frame
 | |
|  *    memory accessed by the host processor
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @start: first page of frame memory
 | |
|  * @end: last page of frame memory
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_dcs_set_page_address(struct mipi_dsi_device *dsi, u16 start,
 | |
| 				  u16 end)
 | |
| {
 | |
| 	u8 payload[4] = { start >> 8, start & 0xff, end >> 8, end & 0xff };
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_PAGE_ADDRESS, payload,
 | |
| 				 sizeof(payload));
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_set_page_address);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_set_tear_off() - turn off the display module's Tearing Effect
 | |
|  *    output signal on the TE signal line
 | |
|  * @dsi: DSI peripheral device
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure
 | |
|  */
 | |
| int mipi_dsi_dcs_set_tear_off(struct mipi_dsi_device *dsi)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_TEAR_OFF, NULL, 0);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_set_tear_off);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_set_tear_on() - turn on the display module's Tearing Effect
 | |
|  *    output signal on the TE signal line.
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @mode: the Tearing Effect Output Line mode
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure
 | |
|  */
 | |
| int mipi_dsi_dcs_set_tear_on(struct mipi_dsi_device *dsi,
 | |
| 			     enum mipi_dsi_dcs_tear_mode mode)
 | |
| {
 | |
| 	u8 value = mode;
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_TEAR_ON, &value,
 | |
| 				 sizeof(value));
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_set_tear_on);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_dcs_set_pixel_format() - sets the pixel format for the RGB image
 | |
|  *    data used by the interface
 | |
|  * @dsi: DSI peripheral device
 | |
|  * @format: pixel format
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_dcs_set_pixel_format(struct mipi_dsi_device *dsi, u8 format)
 | |
| {
 | |
| 	ssize_t err;
 | |
| 
 | |
| 	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_PIXEL_FORMAT, &format,
 | |
| 				 sizeof(format));
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_dcs_set_pixel_format);
 | |
| 
 | |
| 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);
 | |
| }
 | |
| 
 | |
| static void mipi_dsi_drv_shutdown(struct device *dev)
 | |
| {
 | |
| 	struct mipi_dsi_driver *drv = to_mipi_dsi_driver(dev->driver);
 | |
| 	struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
 | |
| 
 | |
| 	drv->shutdown(dsi);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_driver_register_full() - register a driver for DSI devices
 | |
|  * @drv: DSI driver structure
 | |
|  * @owner: owner module
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| int mipi_dsi_driver_register_full(struct mipi_dsi_driver *drv,
 | |
| 				  struct module *owner)
 | |
| {
 | |
| 	drv->driver.bus = &mipi_dsi_bus_type;
 | |
| 	drv->driver.owner = owner;
 | |
| 
 | |
| 	if (drv->probe)
 | |
| 		drv->driver.probe = mipi_dsi_drv_probe;
 | |
| 	if (drv->remove)
 | |
| 		drv->driver.remove = mipi_dsi_drv_remove;
 | |
| 	if (drv->shutdown)
 | |
| 		drv->driver.shutdown = mipi_dsi_drv_shutdown;
 | |
| 
 | |
| 	return driver_register(&drv->driver);
 | |
| }
 | |
| EXPORT_SYMBOL(mipi_dsi_driver_register_full);
 | |
| 
 | |
| /**
 | |
|  * mipi_dsi_driver_unregister() - unregister a driver for DSI devices
 | |
|  * @drv: DSI driver structure
 | |
|  *
 | |
|  * Return: 0 on success or a negative error code on failure.
 | |
|  */
 | |
| 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");
 |