| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * 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>
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 10:41:13 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 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, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-06 08:53:39 +02:00
										 |  |  | 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 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; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-28 12:52:37 +01:00
										 |  |  | 	for_each_available_child_of_node(host->dev->of_node, node) { | 
					
						
							|  |  |  | 		/* skip nodes without reg property */ | 
					
						
							|  |  |  | 		if (!of_find_property(node, "reg", NULL)) | 
					
						
							|  |  |  | 			continue; | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 		of_mipi_dsi_device_add(host, node); | 
					
						
							| 
									
										
										
										
											2014-03-28 12:52:37 +01:00
										 |  |  | 	} | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-10-14 11:12:32 +02:00
										 |  |  | 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); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-11-04 14:59:14 +01:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-10-16 13:44:02 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	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; | 
					
						
							| 
									
										
										
										
											2014-12-05 11:46:56 +01:00
										 |  |  | 		packet->payload = msg->tx_buf; | 
					
						
							| 
									
										
										
										
											2014-10-16 13:44:02 +02:00
										 |  |  | 	} else { | 
					
						
							| 
									
										
										
										
											2014-12-05 11:46:56 +01:00
										 |  |  | 		const u8 *tx = msg->tx_buf; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-10-16 13:44:02 +02:00
										 |  |  | 		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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 09:27:15 +02:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 10:36:21 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | /**
 | 
					
						
							| 
									
										
										
										
											2014-07-21 15:47:10 +02:00
										 |  |  |  * 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. | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  |  */ | 
					
						
							| 
									
										
										
										
											2014-07-21 15:47:10 +02:00
										 |  |  | ssize_t mipi_dsi_dcs_write_buffer(struct mipi_dsi_device *dsi, | 
					
						
							|  |  |  | 				  const void *data, size_t len) | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct mipi_dsi_msg msg = { | 
					
						
							| 
									
										
										
										
											2014-07-21 12:28:25 +02:00
										 |  |  | 		.channel = dsi->channel, | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 		.tx_buf = data, | 
					
						
							|  |  |  | 		.tx_len = len | 
					
						
							|  |  |  | 	}; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	switch (len) { | 
					
						
							|  |  |  | 	case 0: | 
					
						
							|  |  |  | 		return -EINVAL; | 
					
						
							| 
									
										
										
										
											2014-07-21 15:47:10 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 	case 1: | 
					
						
							|  |  |  | 		msg.type = MIPI_DSI_DCS_SHORT_WRITE; | 
					
						
							|  |  |  | 		break; | 
					
						
							| 
									
										
										
										
											2014-07-21 15:47:10 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 	case 2: | 
					
						
							|  |  |  | 		msg.type = MIPI_DSI_DCS_SHORT_WRITE_PARAM; | 
					
						
							|  |  |  | 		break; | 
					
						
							| 
									
										
										
										
											2014-07-21 15:47:10 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 	default: | 
					
						
							|  |  |  | 		msg.type = MIPI_DSI_DCS_LONG_WRITE; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-10-14 11:12:32 +02:00
										 |  |  | 	return mipi_dsi_device_transfer(dsi, &msg); | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | } | 
					
						
							| 
									
										
										
										
											2014-07-21 15:47:10 +02:00
										 |  |  | 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; | 
					
						
							|  |  |  | } | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | EXPORT_SYMBOL(mipi_dsi_dcs_write); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							| 
									
										
										
										
											2014-07-21 15:47:10 +02:00
										 |  |  |  * 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 | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  |  * | 
					
						
							| 
									
										
										
										
											2014-07-21 15:47:10 +02:00
										 |  |  |  * Return: The number of bytes read or a negative error code on failure. | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  |  */ | 
					
						
							| 
									
										
										
										
											2014-07-21 12:28:25 +02:00
										 |  |  | ssize_t mipi_dsi_dcs_read(struct mipi_dsi_device *dsi, u8 cmd, void *data, | 
					
						
							|  |  |  | 			  size_t len) | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct mipi_dsi_msg msg = { | 
					
						
							| 
									
										
										
										
											2014-07-21 12:28:25 +02:00
										 |  |  | 		.channel = dsi->channel, | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 		.type = MIPI_DSI_DCS_READ, | 
					
						
							|  |  |  | 		.tx_buf = &cmd, | 
					
						
							|  |  |  | 		.tx_len = 1, | 
					
						
							|  |  |  | 		.rx_buf = data, | 
					
						
							|  |  |  | 		.rx_len = len | 
					
						
							|  |  |  | 	}; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-10-14 11:12:32 +02:00
										 |  |  | 	return mipi_dsi_device_transfer(dsi, &msg); | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | } | 
					
						
							|  |  |  | EXPORT_SYMBOL(mipi_dsi_dcs_read); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 11:14:02 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 11:15:15 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 11:17:06 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 11:18:46 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 10:38:31 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 11:20:25 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 10:38:31 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-08-05 11:18:46 +02:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * 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); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 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); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-04-29 17:19:57 +02:00
										 |  |  | 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); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | /**
 | 
					
						
							| 
									
										
										
										
											2014-11-04 16:09:56 +01:00
										 |  |  |  * mipi_dsi_driver_register_full() - register a driver for DSI devices | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  |  * @drv: DSI driver structure | 
					
						
							| 
									
										
										
										
											2014-11-04 16:09:56 +01:00
										 |  |  |  * @owner: owner module | 
					
						
							| 
									
										
										
										
											2014-08-05 10:41:13 +02:00
										 |  |  |  * | 
					
						
							|  |  |  |  * Return: 0 on success or a negative error code on failure. | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  |  */ | 
					
						
							| 
									
										
										
										
											2014-11-04 16:09:56 +01:00
										 |  |  | int mipi_dsi_driver_register_full(struct mipi_dsi_driver *drv, | 
					
						
							|  |  |  | 				  struct module *owner) | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	drv->driver.bus = &mipi_dsi_bus_type; | 
					
						
							| 
									
										
										
										
											2014-11-04 16:09:56 +01:00
										 |  |  | 	drv->driver.owner = owner; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 	if (drv->probe) | 
					
						
							|  |  |  | 		drv->driver.probe = mipi_dsi_drv_probe; | 
					
						
							|  |  |  | 	if (drv->remove) | 
					
						
							|  |  |  | 		drv->driver.remove = mipi_dsi_drv_remove; | 
					
						
							| 
									
										
										
										
											2014-04-29 17:19:57 +02:00
										 |  |  | 	if (drv->shutdown) | 
					
						
							|  |  |  | 		drv->driver.shutdown = mipi_dsi_drv_shutdown; | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	return driver_register(&drv->driver); | 
					
						
							|  |  |  | } | 
					
						
							| 
									
										
										
										
											2014-11-04 16:09:56 +01:00
										 |  |  | EXPORT_SYMBOL(mipi_dsi_driver_register_full); | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							| 
									
										
										
										
											2014-08-05 10:41:13 +02:00
										 |  |  |  * mipi_dsi_driver_unregister() - unregister a driver for DSI devices | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  |  * @drv: DSI driver structure | 
					
						
							| 
									
										
										
										
											2014-08-05 10:41:13 +02:00
										 |  |  |  * | 
					
						
							|  |  |  |  * Return: 0 on success or a negative error code on failure. | 
					
						
							| 
									
										
										
										
											2013-12-04 16:35:12 +01:00
										 |  |  |  */ | 
					
						
							|  |  |  | 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"); |