Loading...
1/*
2 * MIPI DSI Bus
3 *
4 * Copyright (C) 2012-2013, Samsung Electronics, Co., Ltd.
5 * Andrzej Hajda <a.hajda@samsung.com>
6 *
7 * Permission is hereby granted, free of charge, to any person obtaining a
8 * copy of this software and associated documentation files (the
9 * "Software"), to deal in the Software without restriction, including
10 * without limitation the rights to use, copy, modify, merge, publish,
11 * distribute, sub license, and/or sell copies of the Software, and to
12 * permit persons to whom the Software is furnished to do so, subject to
13 * the following conditions:
14 *
15 * The above copyright notice and this permission notice (including the
16 * next paragraph) shall be included in all copies or substantial portions
17 * of the Software.
18 *
19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
21 * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
22 * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
23 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
24 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
25 * USE OR OTHER DEALINGS IN THE SOFTWARE.
26 */
27
28#include <drm/drm_mipi_dsi.h>
29
30#include <linux/device.h>
31#include <linux/module.h>
32#include <linux/of_device.h>
33#include <linux/pm_runtime.h>
34#include <linux/slab.h>
35
36#include <video/mipi_display.h>
37
38/**
39 * DOC: dsi helpers
40 *
41 * These functions contain some common logic and helpers to deal with MIPI DSI
42 * peripherals.
43 *
44 * Helpers are provided for a number of standard MIPI DSI command as well as a
45 * subset of the MIPI DCS command set.
46 */
47
48static int mipi_dsi_device_match(struct device *dev, struct device_driver *drv)
49{
50 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
51
52 /* attempt OF style match */
53 if (of_driver_match_device(dev, drv))
54 return 1;
55
56 /* compare DSI device and driver names */
57 if (!strcmp(dsi->name, drv->name))
58 return 1;
59
60 return 0;
61}
62
63static const struct dev_pm_ops mipi_dsi_device_pm_ops = {
64 .runtime_suspend = pm_generic_runtime_suspend,
65 .runtime_resume = pm_generic_runtime_resume,
66 .suspend = pm_generic_suspend,
67 .resume = pm_generic_resume,
68 .freeze = pm_generic_freeze,
69 .thaw = pm_generic_thaw,
70 .poweroff = pm_generic_poweroff,
71 .restore = pm_generic_restore,
72};
73
74static struct bus_type mipi_dsi_bus_type = {
75 .name = "mipi-dsi",
76 .match = mipi_dsi_device_match,
77 .pm = &mipi_dsi_device_pm_ops,
78};
79
80static int of_device_match(struct device *dev, void *data)
81{
82 return dev->of_node == data;
83}
84
85/**
86 * of_find_mipi_dsi_device_by_node() - find the MIPI DSI device matching a
87 * device tree node
88 * @np: device tree node
89 *
90 * Return: A pointer to the MIPI DSI device corresponding to @np or NULL if no
91 * such device exists (or has not been registered yet).
92 */
93struct mipi_dsi_device *of_find_mipi_dsi_device_by_node(struct device_node *np)
94{
95 struct device *dev;
96
97 dev = bus_find_device(&mipi_dsi_bus_type, NULL, np, of_device_match);
98
99 return dev ? to_mipi_dsi_device(dev) : NULL;
100}
101EXPORT_SYMBOL(of_find_mipi_dsi_device_by_node);
102
103static void mipi_dsi_dev_release(struct device *dev)
104{
105 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
106
107 of_node_put(dev->of_node);
108 kfree(dsi);
109}
110
111static const struct device_type mipi_dsi_device_type = {
112 .release = mipi_dsi_dev_release,
113};
114
115static struct mipi_dsi_device *mipi_dsi_device_alloc(struct mipi_dsi_host *host)
116{
117 struct mipi_dsi_device *dsi;
118
119 dsi = kzalloc(sizeof(*dsi), GFP_KERNEL);
120 if (!dsi)
121 return ERR_PTR(-ENOMEM);
122
123 dsi->host = host;
124 dsi->dev.bus = &mipi_dsi_bus_type;
125 dsi->dev.parent = host->dev;
126 dsi->dev.type = &mipi_dsi_device_type;
127
128 device_initialize(&dsi->dev);
129
130 return dsi;
131}
132
133static int mipi_dsi_device_add(struct mipi_dsi_device *dsi)
134{
135 struct mipi_dsi_host *host = dsi->host;
136
137 dev_set_name(&dsi->dev, "%s.%d", dev_name(host->dev), dsi->channel);
138
139 return device_add(&dsi->dev);
140}
141
142#if IS_ENABLED(CONFIG_OF)
143static struct mipi_dsi_device *
144of_mipi_dsi_device_add(struct mipi_dsi_host *host, struct device_node *node)
145{
146 struct device *dev = host->dev;
147 struct mipi_dsi_device_info info = { };
148 int ret;
149 u32 reg;
150
151 if (of_modalias_node(node, info.type, sizeof(info.type)) < 0) {
152 dev_err(dev, "modalias failure on %s\n", node->full_name);
153 return ERR_PTR(-EINVAL);
154 }
155
156 ret = of_property_read_u32(node, "reg", ®);
157 if (ret) {
158 dev_err(dev, "device node %s has no valid reg property: %d\n",
159 node->full_name, ret);
160 return ERR_PTR(-EINVAL);
161 }
162
163 info.channel = reg;
164 info.node = of_node_get(node);
165
166 return mipi_dsi_device_register_full(host, &info);
167}
168#else
169static struct mipi_dsi_device *
170of_mipi_dsi_device_add(struct mipi_dsi_host *host, struct device_node *node)
171{
172 return ERR_PTR(-ENODEV);
173}
174#endif
175
176/**
177 * mipi_dsi_device_register_full - create a MIPI DSI device
178 * @host: DSI host to which this device is connected
179 * @info: pointer to template containing DSI device information
180 *
181 * Create a MIPI DSI device by using the device information provided by
182 * mipi_dsi_device_info template
183 *
184 * Returns:
185 * A pointer to the newly created MIPI DSI device, or, a pointer encoded
186 * with an error
187 */
188struct mipi_dsi_device *
189mipi_dsi_device_register_full(struct mipi_dsi_host *host,
190 const struct mipi_dsi_device_info *info)
191{
192 struct mipi_dsi_device *dsi;
193 struct device *dev = host->dev;
194 int ret;
195
196 if (!info) {
197 dev_err(dev, "invalid mipi_dsi_device_info pointer\n");
198 return ERR_PTR(-EINVAL);
199 }
200
201 if (info->channel > 3) {
202 dev_err(dev, "invalid virtual channel: %u\n", info->channel);
203 return ERR_PTR(-EINVAL);
204 }
205
206 dsi = mipi_dsi_device_alloc(host);
207 if (IS_ERR(dsi)) {
208 dev_err(dev, "failed to allocate DSI device %ld\n",
209 PTR_ERR(dsi));
210 return dsi;
211 }
212
213 dsi->dev.of_node = info->node;
214 dsi->channel = info->channel;
215 strlcpy(dsi->name, info->type, sizeof(dsi->name));
216
217 ret = mipi_dsi_device_add(dsi);
218 if (ret) {
219 dev_err(dev, "failed to add DSI device %d\n", ret);
220 kfree(dsi);
221 return ERR_PTR(ret);
222 }
223
224 return dsi;
225}
226EXPORT_SYMBOL(mipi_dsi_device_register_full);
227
228/**
229 * mipi_dsi_device_unregister - unregister MIPI DSI device
230 * @dsi: DSI peripheral device
231 */
232void mipi_dsi_device_unregister(struct mipi_dsi_device *dsi)
233{
234 device_unregister(&dsi->dev);
235}
236EXPORT_SYMBOL(mipi_dsi_device_unregister);
237
238static DEFINE_MUTEX(host_lock);
239static LIST_HEAD(host_list);
240
241/**
242 * of_find_mipi_dsi_host_by_node() - find the MIPI DSI host matching a
243 * device tree node
244 * @node: device tree node
245 *
246 * Returns:
247 * A pointer to the MIPI DSI host corresponding to @node or NULL if no
248 * such device exists (or has not been registered yet).
249 */
250struct mipi_dsi_host *of_find_mipi_dsi_host_by_node(struct device_node *node)
251{
252 struct mipi_dsi_host *host;
253
254 mutex_lock(&host_lock);
255
256 list_for_each_entry(host, &host_list, list) {
257 if (host->dev->of_node == node) {
258 mutex_unlock(&host_lock);
259 return host;
260 }
261 }
262
263 mutex_unlock(&host_lock);
264
265 return NULL;
266}
267EXPORT_SYMBOL(of_find_mipi_dsi_host_by_node);
268
269int mipi_dsi_host_register(struct mipi_dsi_host *host)
270{
271 struct device_node *node;
272
273 for_each_available_child_of_node(host->dev->of_node, node) {
274 /* skip nodes without reg property */
275 if (!of_find_property(node, "reg", NULL))
276 continue;
277 of_mipi_dsi_device_add(host, node);
278 }
279
280 mutex_lock(&host_lock);
281 list_add_tail(&host->list, &host_list);
282 mutex_unlock(&host_lock);
283
284 return 0;
285}
286EXPORT_SYMBOL(mipi_dsi_host_register);
287
288static int mipi_dsi_remove_device_fn(struct device *dev, void *priv)
289{
290 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
291
292 mipi_dsi_device_unregister(dsi);
293
294 return 0;
295}
296
297void mipi_dsi_host_unregister(struct mipi_dsi_host *host)
298{
299 device_for_each_child(host->dev, NULL, mipi_dsi_remove_device_fn);
300
301 mutex_lock(&host_lock);
302 list_del_init(&host->list);
303 mutex_unlock(&host_lock);
304}
305EXPORT_SYMBOL(mipi_dsi_host_unregister);
306
307/**
308 * mipi_dsi_attach - attach a DSI device to its DSI host
309 * @dsi: DSI peripheral
310 */
311int mipi_dsi_attach(struct mipi_dsi_device *dsi)
312{
313 const struct mipi_dsi_host_ops *ops = dsi->host->ops;
314
315 if (!ops || !ops->attach)
316 return -ENOSYS;
317
318 return ops->attach(dsi->host, dsi);
319}
320EXPORT_SYMBOL(mipi_dsi_attach);
321
322/**
323 * mipi_dsi_detach - detach a DSI device from its DSI host
324 * @dsi: DSI peripheral
325 */
326int mipi_dsi_detach(struct mipi_dsi_device *dsi)
327{
328 const struct mipi_dsi_host_ops *ops = dsi->host->ops;
329
330 if (!ops || !ops->detach)
331 return -ENOSYS;
332
333 return ops->detach(dsi->host, dsi);
334}
335EXPORT_SYMBOL(mipi_dsi_detach);
336
337static ssize_t mipi_dsi_device_transfer(struct mipi_dsi_device *dsi,
338 struct mipi_dsi_msg *msg)
339{
340 const struct mipi_dsi_host_ops *ops = dsi->host->ops;
341
342 if (!ops || !ops->transfer)
343 return -ENOSYS;
344
345 if (dsi->mode_flags & MIPI_DSI_MODE_LPM)
346 msg->flags |= MIPI_DSI_MSG_USE_LPM;
347
348 return ops->transfer(dsi->host, msg);
349}
350
351/**
352 * mipi_dsi_packet_format_is_short - check if a packet is of the short format
353 * @type: MIPI DSI data type of the packet
354 *
355 * Return: true if the packet for the given data type is a short packet, false
356 * otherwise.
357 */
358bool mipi_dsi_packet_format_is_short(u8 type)
359{
360 switch (type) {
361 case MIPI_DSI_V_SYNC_START:
362 case MIPI_DSI_V_SYNC_END:
363 case MIPI_DSI_H_SYNC_START:
364 case MIPI_DSI_H_SYNC_END:
365 case MIPI_DSI_END_OF_TRANSMISSION:
366 case MIPI_DSI_COLOR_MODE_OFF:
367 case MIPI_DSI_COLOR_MODE_ON:
368 case MIPI_DSI_SHUTDOWN_PERIPHERAL:
369 case MIPI_DSI_TURN_ON_PERIPHERAL:
370 case MIPI_DSI_GENERIC_SHORT_WRITE_0_PARAM:
371 case MIPI_DSI_GENERIC_SHORT_WRITE_1_PARAM:
372 case MIPI_DSI_GENERIC_SHORT_WRITE_2_PARAM:
373 case MIPI_DSI_GENERIC_READ_REQUEST_0_PARAM:
374 case MIPI_DSI_GENERIC_READ_REQUEST_1_PARAM:
375 case MIPI_DSI_GENERIC_READ_REQUEST_2_PARAM:
376 case MIPI_DSI_DCS_SHORT_WRITE:
377 case MIPI_DSI_DCS_SHORT_WRITE_PARAM:
378 case MIPI_DSI_DCS_READ:
379 case MIPI_DSI_SET_MAXIMUM_RETURN_PACKET_SIZE:
380 return true;
381 }
382
383 return false;
384}
385EXPORT_SYMBOL(mipi_dsi_packet_format_is_short);
386
387/**
388 * mipi_dsi_packet_format_is_long - check if a packet is of the long format
389 * @type: MIPI DSI data type of the packet
390 *
391 * Return: true if the packet for the given data type is a long packet, false
392 * otherwise.
393 */
394bool mipi_dsi_packet_format_is_long(u8 type)
395{
396 switch (type) {
397 case MIPI_DSI_NULL_PACKET:
398 case MIPI_DSI_BLANKING_PACKET:
399 case MIPI_DSI_GENERIC_LONG_WRITE:
400 case MIPI_DSI_DCS_LONG_WRITE:
401 case MIPI_DSI_LOOSELY_PACKED_PIXEL_STREAM_YCBCR20:
402 case MIPI_DSI_PACKED_PIXEL_STREAM_YCBCR24:
403 case MIPI_DSI_PACKED_PIXEL_STREAM_YCBCR16:
404 case MIPI_DSI_PACKED_PIXEL_STREAM_30:
405 case MIPI_DSI_PACKED_PIXEL_STREAM_36:
406 case MIPI_DSI_PACKED_PIXEL_STREAM_YCBCR12:
407 case MIPI_DSI_PACKED_PIXEL_STREAM_16:
408 case MIPI_DSI_PACKED_PIXEL_STREAM_18:
409 case MIPI_DSI_PIXEL_STREAM_3BYTE_18:
410 case MIPI_DSI_PACKED_PIXEL_STREAM_24:
411 return true;
412 }
413
414 return false;
415}
416EXPORT_SYMBOL(mipi_dsi_packet_format_is_long);
417
418/**
419 * mipi_dsi_create_packet - create a packet from a message according to the
420 * DSI protocol
421 * @packet: pointer to a DSI packet structure
422 * @msg: message to translate into a packet
423 *
424 * Return: 0 on success or a negative error code on failure.
425 */
426int mipi_dsi_create_packet(struct mipi_dsi_packet *packet,
427 const struct mipi_dsi_msg *msg)
428{
429 if (!packet || !msg)
430 return -EINVAL;
431
432 /* do some minimum sanity checking */
433 if (!mipi_dsi_packet_format_is_short(msg->type) &&
434 !mipi_dsi_packet_format_is_long(msg->type))
435 return -EINVAL;
436
437 if (msg->channel > 3)
438 return -EINVAL;
439
440 memset(packet, 0, sizeof(*packet));
441 packet->header[0] = ((msg->channel & 0x3) << 6) | (msg->type & 0x3f);
442
443 /* TODO: compute ECC if hardware support is not available */
444
445 /*
446 * Long write packets contain the word count in header bytes 1 and 2.
447 * The payload follows the header and is word count bytes long.
448 *
449 * Short write packets encode up to two parameters in header bytes 1
450 * and 2.
451 */
452 if (mipi_dsi_packet_format_is_long(msg->type)) {
453 packet->header[1] = (msg->tx_len >> 0) & 0xff;
454 packet->header[2] = (msg->tx_len >> 8) & 0xff;
455
456 packet->payload_length = msg->tx_len;
457 packet->payload = msg->tx_buf;
458 } else {
459 const u8 *tx = msg->tx_buf;
460
461 packet->header[1] = (msg->tx_len > 0) ? tx[0] : 0;
462 packet->header[2] = (msg->tx_len > 1) ? tx[1] : 0;
463 }
464
465 packet->size = sizeof(packet->header) + packet->payload_length;
466
467 return 0;
468}
469EXPORT_SYMBOL(mipi_dsi_create_packet);
470
471/**
472 * mipi_dsi_shutdown_peripheral() - sends a Shutdown Peripheral command
473 * @dsi: DSI peripheral device
474 *
475 * Return: 0 on success or a negative error code on failure.
476 */
477int mipi_dsi_shutdown_peripheral(struct mipi_dsi_device *dsi)
478{
479 struct mipi_dsi_msg msg = {
480 .channel = dsi->channel,
481 .type = MIPI_DSI_SHUTDOWN_PERIPHERAL,
482 .tx_buf = (u8 [2]) { 0, 0 },
483 .tx_len = 2,
484 };
485
486 return mipi_dsi_device_transfer(dsi, &msg);
487}
488EXPORT_SYMBOL(mipi_dsi_shutdown_peripheral);
489
490/**
491 * mipi_dsi_turn_on_peripheral() - sends a Turn On Peripheral command
492 * @dsi: DSI peripheral device
493 *
494 * Return: 0 on success or a negative error code on failure.
495 */
496int mipi_dsi_turn_on_peripheral(struct mipi_dsi_device *dsi)
497{
498 struct mipi_dsi_msg msg = {
499 .channel = dsi->channel,
500 .type = MIPI_DSI_TURN_ON_PERIPHERAL,
501 .tx_buf = (u8 [2]) { 0, 0 },
502 .tx_len = 2,
503 };
504
505 return mipi_dsi_device_transfer(dsi, &msg);
506}
507EXPORT_SYMBOL(mipi_dsi_turn_on_peripheral);
508
509/*
510 * mipi_dsi_set_maximum_return_packet_size() - specify the maximum size of the
511 * the payload in a long packet transmitted from the peripheral back to the
512 * host processor
513 * @dsi: DSI peripheral device
514 * @value: the maximum size of the payload
515 *
516 * Return: 0 on success or a negative error code on failure.
517 */
518int mipi_dsi_set_maximum_return_packet_size(struct mipi_dsi_device *dsi,
519 u16 value)
520{
521 u8 tx[2] = { value & 0xff, value >> 8 };
522 struct mipi_dsi_msg msg = {
523 .channel = dsi->channel,
524 .type = MIPI_DSI_SET_MAXIMUM_RETURN_PACKET_SIZE,
525 .tx_len = sizeof(tx),
526 .tx_buf = tx,
527 };
528
529 return mipi_dsi_device_transfer(dsi, &msg);
530}
531EXPORT_SYMBOL(mipi_dsi_set_maximum_return_packet_size);
532
533/**
534 * mipi_dsi_generic_write() - transmit data using a generic write packet
535 * @dsi: DSI peripheral device
536 * @payload: buffer containing the payload
537 * @size: size of payload buffer
538 *
539 * This function will automatically choose the right data type depending on
540 * the payload length.
541 *
542 * Return: The number of bytes transmitted on success or a negative error code
543 * on failure.
544 */
545ssize_t mipi_dsi_generic_write(struct mipi_dsi_device *dsi, const void *payload,
546 size_t size)
547{
548 struct mipi_dsi_msg msg = {
549 .channel = dsi->channel,
550 .tx_buf = payload,
551 .tx_len = size
552 };
553
554 switch (size) {
555 case 0:
556 msg.type = MIPI_DSI_GENERIC_SHORT_WRITE_0_PARAM;
557 break;
558
559 case 1:
560 msg.type = MIPI_DSI_GENERIC_SHORT_WRITE_1_PARAM;
561 break;
562
563 case 2:
564 msg.type = MIPI_DSI_GENERIC_SHORT_WRITE_2_PARAM;
565 break;
566
567 default:
568 msg.type = MIPI_DSI_GENERIC_LONG_WRITE;
569 break;
570 }
571
572 return mipi_dsi_device_transfer(dsi, &msg);
573}
574EXPORT_SYMBOL(mipi_dsi_generic_write);
575
576/**
577 * mipi_dsi_generic_read() - receive data using a generic read packet
578 * @dsi: DSI peripheral device
579 * @params: buffer containing the request parameters
580 * @num_params: number of request parameters
581 * @data: buffer in which to return the received data
582 * @size: size of receive buffer
583 *
584 * This function will automatically choose the right data type depending on
585 * the number of parameters passed in.
586 *
587 * Return: The number of bytes successfully read or a negative error code on
588 * failure.
589 */
590ssize_t mipi_dsi_generic_read(struct mipi_dsi_device *dsi, const void *params,
591 size_t num_params, void *data, size_t size)
592{
593 struct mipi_dsi_msg msg = {
594 .channel = dsi->channel,
595 .tx_len = num_params,
596 .tx_buf = params,
597 .rx_len = size,
598 .rx_buf = data
599 };
600
601 switch (num_params) {
602 case 0:
603 msg.type = MIPI_DSI_GENERIC_READ_REQUEST_0_PARAM;
604 break;
605
606 case 1:
607 msg.type = MIPI_DSI_GENERIC_READ_REQUEST_1_PARAM;
608 break;
609
610 case 2:
611 msg.type = MIPI_DSI_GENERIC_READ_REQUEST_2_PARAM;
612 break;
613
614 default:
615 return -EINVAL;
616 }
617
618 return mipi_dsi_device_transfer(dsi, &msg);
619}
620EXPORT_SYMBOL(mipi_dsi_generic_read);
621
622/**
623 * mipi_dsi_dcs_write_buffer() - transmit a DCS command with payload
624 * @dsi: DSI peripheral device
625 * @data: buffer containing data to be transmitted
626 * @len: size of transmission buffer
627 *
628 * This function will automatically choose the right data type depending on
629 * the command payload length.
630 *
631 * Return: The number of bytes successfully transmitted or a negative error
632 * code on failure.
633 */
634ssize_t mipi_dsi_dcs_write_buffer(struct mipi_dsi_device *dsi,
635 const void *data, size_t len)
636{
637 struct mipi_dsi_msg msg = {
638 .channel = dsi->channel,
639 .tx_buf = data,
640 .tx_len = len
641 };
642
643 switch (len) {
644 case 0:
645 return -EINVAL;
646
647 case 1:
648 msg.type = MIPI_DSI_DCS_SHORT_WRITE;
649 break;
650
651 case 2:
652 msg.type = MIPI_DSI_DCS_SHORT_WRITE_PARAM;
653 break;
654
655 default:
656 msg.type = MIPI_DSI_DCS_LONG_WRITE;
657 break;
658 }
659
660 return mipi_dsi_device_transfer(dsi, &msg);
661}
662EXPORT_SYMBOL(mipi_dsi_dcs_write_buffer);
663
664/**
665 * mipi_dsi_dcs_write() - send DCS write command
666 * @dsi: DSI peripheral device
667 * @cmd: DCS command
668 * @data: buffer containing the command payload
669 * @len: command payload length
670 *
671 * This function will automatically choose the right data type depending on
672 * the command payload length.
673 *
674 * Return: The number of bytes successfully transmitted or a negative error
675 * code on failure.
676 */
677ssize_t mipi_dsi_dcs_write(struct mipi_dsi_device *dsi, u8 cmd,
678 const void *data, size_t len)
679{
680 ssize_t err;
681 size_t size;
682 u8 *tx;
683
684 if (len > 0) {
685 size = 1 + len;
686
687 tx = kmalloc(size, GFP_KERNEL);
688 if (!tx)
689 return -ENOMEM;
690
691 /* concatenate the DCS command byte and the payload */
692 tx[0] = cmd;
693 memcpy(&tx[1], data, len);
694 } else {
695 tx = &cmd;
696 size = 1;
697 }
698
699 err = mipi_dsi_dcs_write_buffer(dsi, tx, size);
700
701 if (len > 0)
702 kfree(tx);
703
704 return err;
705}
706EXPORT_SYMBOL(mipi_dsi_dcs_write);
707
708/**
709 * mipi_dsi_dcs_read() - send DCS read request command
710 * @dsi: DSI peripheral device
711 * @cmd: DCS command
712 * @data: buffer in which to receive data
713 * @len: size of receive buffer
714 *
715 * Return: The number of bytes read or a negative error code on failure.
716 */
717ssize_t mipi_dsi_dcs_read(struct mipi_dsi_device *dsi, u8 cmd, void *data,
718 size_t len)
719{
720 struct mipi_dsi_msg msg = {
721 .channel = dsi->channel,
722 .type = MIPI_DSI_DCS_READ,
723 .tx_buf = &cmd,
724 .tx_len = 1,
725 .rx_buf = data,
726 .rx_len = len
727 };
728
729 return mipi_dsi_device_transfer(dsi, &msg);
730}
731EXPORT_SYMBOL(mipi_dsi_dcs_read);
732
733/**
734 * mipi_dsi_dcs_nop() - send DCS nop packet
735 * @dsi: DSI peripheral device
736 *
737 * Return: 0 on success or a negative error code on failure.
738 */
739int mipi_dsi_dcs_nop(struct mipi_dsi_device *dsi)
740{
741 ssize_t err;
742
743 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_NOP, NULL, 0);
744 if (err < 0)
745 return err;
746
747 return 0;
748}
749EXPORT_SYMBOL(mipi_dsi_dcs_nop);
750
751/**
752 * mipi_dsi_dcs_soft_reset() - perform a software reset of the display module
753 * @dsi: DSI peripheral device
754 *
755 * Return: 0 on success or a negative error code on failure.
756 */
757int mipi_dsi_dcs_soft_reset(struct mipi_dsi_device *dsi)
758{
759 ssize_t err;
760
761 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SOFT_RESET, NULL, 0);
762 if (err < 0)
763 return err;
764
765 return 0;
766}
767EXPORT_SYMBOL(mipi_dsi_dcs_soft_reset);
768
769/**
770 * mipi_dsi_dcs_get_power_mode() - query the display module's current power
771 * mode
772 * @dsi: DSI peripheral device
773 * @mode: return location for the current power mode
774 *
775 * Return: 0 on success or a negative error code on failure.
776 */
777int mipi_dsi_dcs_get_power_mode(struct mipi_dsi_device *dsi, u8 *mode)
778{
779 ssize_t err;
780
781 err = mipi_dsi_dcs_read(dsi, MIPI_DCS_GET_POWER_MODE, mode,
782 sizeof(*mode));
783 if (err <= 0) {
784 if (err == 0)
785 err = -ENODATA;
786
787 return err;
788 }
789
790 return 0;
791}
792EXPORT_SYMBOL(mipi_dsi_dcs_get_power_mode);
793
794/**
795 * mipi_dsi_dcs_get_pixel_format() - gets the pixel format for the RGB image
796 * data used by the interface
797 * @dsi: DSI peripheral device
798 * @format: return location for the pixel format
799 *
800 * Return: 0 on success or a negative error code on failure.
801 */
802int mipi_dsi_dcs_get_pixel_format(struct mipi_dsi_device *dsi, u8 *format)
803{
804 ssize_t err;
805
806 err = mipi_dsi_dcs_read(dsi, MIPI_DCS_GET_PIXEL_FORMAT, format,
807 sizeof(*format));
808 if (err <= 0) {
809 if (err == 0)
810 err = -ENODATA;
811
812 return err;
813 }
814
815 return 0;
816}
817EXPORT_SYMBOL(mipi_dsi_dcs_get_pixel_format);
818
819/**
820 * mipi_dsi_dcs_enter_sleep_mode() - disable all unnecessary blocks inside the
821 * display module except interface communication
822 * @dsi: DSI peripheral device
823 *
824 * Return: 0 on success or a negative error code on failure.
825 */
826int mipi_dsi_dcs_enter_sleep_mode(struct mipi_dsi_device *dsi)
827{
828 ssize_t err;
829
830 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_ENTER_SLEEP_MODE, NULL, 0);
831 if (err < 0)
832 return err;
833
834 return 0;
835}
836EXPORT_SYMBOL(mipi_dsi_dcs_enter_sleep_mode);
837
838/**
839 * mipi_dsi_dcs_exit_sleep_mode() - enable all blocks inside the display
840 * module
841 * @dsi: DSI peripheral device
842 *
843 * Return: 0 on success or a negative error code on failure.
844 */
845int mipi_dsi_dcs_exit_sleep_mode(struct mipi_dsi_device *dsi)
846{
847 ssize_t err;
848
849 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_EXIT_SLEEP_MODE, NULL, 0);
850 if (err < 0)
851 return err;
852
853 return 0;
854}
855EXPORT_SYMBOL(mipi_dsi_dcs_exit_sleep_mode);
856
857/**
858 * mipi_dsi_dcs_set_display_off() - stop displaying the image data on the
859 * display device
860 * @dsi: DSI peripheral device
861 *
862 * Return: 0 on success or a negative error code on failure.
863 */
864int mipi_dsi_dcs_set_display_off(struct mipi_dsi_device *dsi)
865{
866 ssize_t err;
867
868 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_DISPLAY_OFF, NULL, 0);
869 if (err < 0)
870 return err;
871
872 return 0;
873}
874EXPORT_SYMBOL(mipi_dsi_dcs_set_display_off);
875
876/**
877 * mipi_dsi_dcs_set_display_on() - start displaying the image data on the
878 * display device
879 * @dsi: DSI peripheral device
880 *
881 * Return: 0 on success or a negative error code on failure
882 */
883int mipi_dsi_dcs_set_display_on(struct mipi_dsi_device *dsi)
884{
885 ssize_t err;
886
887 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_DISPLAY_ON, NULL, 0);
888 if (err < 0)
889 return err;
890
891 return 0;
892}
893EXPORT_SYMBOL(mipi_dsi_dcs_set_display_on);
894
895/**
896 * mipi_dsi_dcs_set_column_address() - define the column extent of the frame
897 * memory accessed by the host processor
898 * @dsi: DSI peripheral device
899 * @start: first column of frame memory
900 * @end: last column of frame memory
901 *
902 * Return: 0 on success or a negative error code on failure.
903 */
904int mipi_dsi_dcs_set_column_address(struct mipi_dsi_device *dsi, u16 start,
905 u16 end)
906{
907 u8 payload[4] = { start >> 8, start & 0xff, end >> 8, end & 0xff };
908 ssize_t err;
909
910 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_COLUMN_ADDRESS, payload,
911 sizeof(payload));
912 if (err < 0)
913 return err;
914
915 return 0;
916}
917EXPORT_SYMBOL(mipi_dsi_dcs_set_column_address);
918
919/**
920 * mipi_dsi_dcs_set_page_address() - define the page extent of the frame
921 * memory accessed by the host processor
922 * @dsi: DSI peripheral device
923 * @start: first page of frame memory
924 * @end: last page of frame memory
925 *
926 * Return: 0 on success or a negative error code on failure.
927 */
928int mipi_dsi_dcs_set_page_address(struct mipi_dsi_device *dsi, u16 start,
929 u16 end)
930{
931 u8 payload[4] = { start >> 8, start & 0xff, end >> 8, end & 0xff };
932 ssize_t err;
933
934 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_PAGE_ADDRESS, payload,
935 sizeof(payload));
936 if (err < 0)
937 return err;
938
939 return 0;
940}
941EXPORT_SYMBOL(mipi_dsi_dcs_set_page_address);
942
943/**
944 * mipi_dsi_dcs_set_tear_off() - turn off the display module's Tearing Effect
945 * output signal on the TE signal line
946 * @dsi: DSI peripheral device
947 *
948 * Return: 0 on success or a negative error code on failure
949 */
950int mipi_dsi_dcs_set_tear_off(struct mipi_dsi_device *dsi)
951{
952 ssize_t err;
953
954 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_TEAR_OFF, NULL, 0);
955 if (err < 0)
956 return err;
957
958 return 0;
959}
960EXPORT_SYMBOL(mipi_dsi_dcs_set_tear_off);
961
962/**
963 * mipi_dsi_dcs_set_tear_on() - turn on the display module's Tearing Effect
964 * output signal on the TE signal line.
965 * @dsi: DSI peripheral device
966 * @mode: the Tearing Effect Output Line mode
967 *
968 * Return: 0 on success or a negative error code on failure
969 */
970int mipi_dsi_dcs_set_tear_on(struct mipi_dsi_device *dsi,
971 enum mipi_dsi_dcs_tear_mode mode)
972{
973 u8 value = mode;
974 ssize_t err;
975
976 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_TEAR_ON, &value,
977 sizeof(value));
978 if (err < 0)
979 return err;
980
981 return 0;
982}
983EXPORT_SYMBOL(mipi_dsi_dcs_set_tear_on);
984
985/**
986 * mipi_dsi_dcs_set_pixel_format() - sets the pixel format for the RGB image
987 * data used by the interface
988 * @dsi: DSI peripheral device
989 * @format: pixel format
990 *
991 * Return: 0 on success or a negative error code on failure.
992 */
993int mipi_dsi_dcs_set_pixel_format(struct mipi_dsi_device *dsi, u8 format)
994{
995 ssize_t err;
996
997 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_PIXEL_FORMAT, &format,
998 sizeof(format));
999 if (err < 0)
1000 return err;
1001
1002 return 0;
1003}
1004EXPORT_SYMBOL(mipi_dsi_dcs_set_pixel_format);
1005
1006static int mipi_dsi_drv_probe(struct device *dev)
1007{
1008 struct mipi_dsi_driver *drv = to_mipi_dsi_driver(dev->driver);
1009 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
1010
1011 return drv->probe(dsi);
1012}
1013
1014static int mipi_dsi_drv_remove(struct device *dev)
1015{
1016 struct mipi_dsi_driver *drv = to_mipi_dsi_driver(dev->driver);
1017 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
1018
1019 return drv->remove(dsi);
1020}
1021
1022static void mipi_dsi_drv_shutdown(struct device *dev)
1023{
1024 struct mipi_dsi_driver *drv = to_mipi_dsi_driver(dev->driver);
1025 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
1026
1027 drv->shutdown(dsi);
1028}
1029
1030/**
1031 * mipi_dsi_driver_register_full() - register a driver for DSI devices
1032 * @drv: DSI driver structure
1033 * @owner: owner module
1034 *
1035 * Return: 0 on success or a negative error code on failure.
1036 */
1037int mipi_dsi_driver_register_full(struct mipi_dsi_driver *drv,
1038 struct module *owner)
1039{
1040 drv->driver.bus = &mipi_dsi_bus_type;
1041 drv->driver.owner = owner;
1042
1043 if (drv->probe)
1044 drv->driver.probe = mipi_dsi_drv_probe;
1045 if (drv->remove)
1046 drv->driver.remove = mipi_dsi_drv_remove;
1047 if (drv->shutdown)
1048 drv->driver.shutdown = mipi_dsi_drv_shutdown;
1049
1050 return driver_register(&drv->driver);
1051}
1052EXPORT_SYMBOL(mipi_dsi_driver_register_full);
1053
1054/**
1055 * mipi_dsi_driver_unregister() - unregister a driver for DSI devices
1056 * @drv: DSI driver structure
1057 *
1058 * Return: 0 on success or a negative error code on failure.
1059 */
1060void mipi_dsi_driver_unregister(struct mipi_dsi_driver *drv)
1061{
1062 driver_unregister(&drv->driver);
1063}
1064EXPORT_SYMBOL(mipi_dsi_driver_unregister);
1065
1066static int __init mipi_dsi_bus_init(void)
1067{
1068 return bus_register(&mipi_dsi_bus_type);
1069}
1070postcore_initcall(mipi_dsi_bus_init);
1071
1072MODULE_AUTHOR("Andrzej Hajda <a.hajda@samsung.com>");
1073MODULE_DESCRIPTION("MIPI DSI Bus");
1074MODULE_LICENSE("GPL and additional rights");
1/*
2 * MIPI DSI Bus
3 *
4 * Copyright (C) 2012-2013, Samsung Electronics, Co., Ltd.
5 * Andrzej Hajda <a.hajda@samsung.com>
6 *
7 * Permission is hereby granted, free of charge, to any person obtaining a
8 * copy of this software and associated documentation files (the
9 * "Software"), to deal in the Software without restriction, including
10 * without limitation the rights to use, copy, modify, merge, publish,
11 * distribute, sub license, and/or sell copies of the Software, and to
12 * permit persons to whom the Software is furnished to do so, subject to
13 * the following conditions:
14 *
15 * The above copyright notice and this permission notice (including the
16 * next paragraph) shall be included in all copies or substantial portions
17 * of the Software.
18 *
19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
21 * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
22 * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
23 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
24 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
25 * USE OR OTHER DEALINGS IN THE SOFTWARE.
26 */
27
28#include <drm/drm_mipi_dsi.h>
29
30#include <linux/device.h>
31#include <linux/module.h>
32#include <linux/of_device.h>
33#include <linux/pm_runtime.h>
34#include <linux/slab.h>
35
36#include <video/mipi_display.h>
37
38/**
39 * DOC: dsi helpers
40 *
41 * These functions contain some common logic and helpers to deal with MIPI DSI
42 * peripherals.
43 *
44 * Helpers are provided for a number of standard MIPI DSI command as well as a
45 * subset of the MIPI DCS command set.
46 */
47
48static int mipi_dsi_device_match(struct device *dev, struct device_driver *drv)
49{
50 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
51
52 /* attempt OF style match */
53 if (of_driver_match_device(dev, drv))
54 return 1;
55
56 /* compare DSI device and driver names */
57 if (!strcmp(dsi->name, drv->name))
58 return 1;
59
60 return 0;
61}
62
63static int mipi_dsi_uevent(struct device *dev, struct kobj_uevent_env *env)
64{
65 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
66 int err;
67
68 err = of_device_uevent_modalias(dev, env);
69 if (err != -ENODEV)
70 return err;
71
72 add_uevent_var(env, "MODALIAS=%s%s", MIPI_DSI_MODULE_PREFIX,
73 dsi->name);
74
75 return 0;
76}
77
78static const struct dev_pm_ops mipi_dsi_device_pm_ops = {
79 .runtime_suspend = pm_generic_runtime_suspend,
80 .runtime_resume = pm_generic_runtime_resume,
81 .suspend = pm_generic_suspend,
82 .resume = pm_generic_resume,
83 .freeze = pm_generic_freeze,
84 .thaw = pm_generic_thaw,
85 .poweroff = pm_generic_poweroff,
86 .restore = pm_generic_restore,
87};
88
89static struct bus_type mipi_dsi_bus_type = {
90 .name = "mipi-dsi",
91 .match = mipi_dsi_device_match,
92 .uevent = mipi_dsi_uevent,
93 .pm = &mipi_dsi_device_pm_ops,
94};
95
96/**
97 * of_find_mipi_dsi_device_by_node() - find the MIPI DSI device matching a
98 * device tree node
99 * @np: device tree node
100 *
101 * Return: A pointer to the MIPI DSI device corresponding to @np or NULL if no
102 * such device exists (or has not been registered yet).
103 */
104struct mipi_dsi_device *of_find_mipi_dsi_device_by_node(struct device_node *np)
105{
106 struct device *dev;
107
108 dev = bus_find_device_by_of_node(&mipi_dsi_bus_type, np);
109
110 return dev ? to_mipi_dsi_device(dev) : NULL;
111}
112EXPORT_SYMBOL(of_find_mipi_dsi_device_by_node);
113
114static void mipi_dsi_dev_release(struct device *dev)
115{
116 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
117
118 of_node_put(dev->of_node);
119 kfree(dsi);
120}
121
122static const struct device_type mipi_dsi_device_type = {
123 .release = mipi_dsi_dev_release,
124};
125
126static struct mipi_dsi_device *mipi_dsi_device_alloc(struct mipi_dsi_host *host)
127{
128 struct mipi_dsi_device *dsi;
129
130 dsi = kzalloc(sizeof(*dsi), GFP_KERNEL);
131 if (!dsi)
132 return ERR_PTR(-ENOMEM);
133
134 dsi->host = host;
135 dsi->dev.bus = &mipi_dsi_bus_type;
136 dsi->dev.parent = host->dev;
137 dsi->dev.type = &mipi_dsi_device_type;
138
139 device_initialize(&dsi->dev);
140
141 return dsi;
142}
143
144static int mipi_dsi_device_add(struct mipi_dsi_device *dsi)
145{
146 struct mipi_dsi_host *host = dsi->host;
147
148 dev_set_name(&dsi->dev, "%s.%d", dev_name(host->dev), dsi->channel);
149
150 return device_add(&dsi->dev);
151}
152
153#if IS_ENABLED(CONFIG_OF)
154static struct mipi_dsi_device *
155of_mipi_dsi_device_add(struct mipi_dsi_host *host, struct device_node *node)
156{
157 struct device *dev = host->dev;
158 struct mipi_dsi_device_info info = { };
159 int ret;
160 u32 reg;
161
162 if (of_modalias_node(node, info.type, sizeof(info.type)) < 0) {
163 dev_err(dev, "modalias failure on %pOF\n", node);
164 return ERR_PTR(-EINVAL);
165 }
166
167 ret = of_property_read_u32(node, "reg", ®);
168 if (ret) {
169 dev_err(dev, "device node %pOF has no valid reg property: %d\n",
170 node, ret);
171 return ERR_PTR(-EINVAL);
172 }
173
174 info.channel = reg;
175 info.node = of_node_get(node);
176
177 return mipi_dsi_device_register_full(host, &info);
178}
179#else
180static struct mipi_dsi_device *
181of_mipi_dsi_device_add(struct mipi_dsi_host *host, struct device_node *node)
182{
183 return ERR_PTR(-ENODEV);
184}
185#endif
186
187/**
188 * mipi_dsi_device_register_full - create a MIPI DSI device
189 * @host: DSI host to which this device is connected
190 * @info: pointer to template containing DSI device information
191 *
192 * Create a MIPI DSI device by using the device information provided by
193 * mipi_dsi_device_info template
194 *
195 * Returns:
196 * A pointer to the newly created MIPI DSI device, or, a pointer encoded
197 * with an error
198 */
199struct mipi_dsi_device *
200mipi_dsi_device_register_full(struct mipi_dsi_host *host,
201 const struct mipi_dsi_device_info *info)
202{
203 struct mipi_dsi_device *dsi;
204 struct device *dev = host->dev;
205 int ret;
206
207 if (!info) {
208 dev_err(dev, "invalid mipi_dsi_device_info pointer\n");
209 return ERR_PTR(-EINVAL);
210 }
211
212 if (info->channel > 3) {
213 dev_err(dev, "invalid virtual channel: %u\n", info->channel);
214 return ERR_PTR(-EINVAL);
215 }
216
217 dsi = mipi_dsi_device_alloc(host);
218 if (IS_ERR(dsi)) {
219 dev_err(dev, "failed to allocate DSI device %ld\n",
220 PTR_ERR(dsi));
221 return dsi;
222 }
223
224 dsi->dev.of_node = info->node;
225 dsi->channel = info->channel;
226 strlcpy(dsi->name, info->type, sizeof(dsi->name));
227
228 ret = mipi_dsi_device_add(dsi);
229 if (ret) {
230 dev_err(dev, "failed to add DSI device %d\n", ret);
231 kfree(dsi);
232 return ERR_PTR(ret);
233 }
234
235 return dsi;
236}
237EXPORT_SYMBOL(mipi_dsi_device_register_full);
238
239/**
240 * mipi_dsi_device_unregister - unregister MIPI DSI device
241 * @dsi: DSI peripheral device
242 */
243void mipi_dsi_device_unregister(struct mipi_dsi_device *dsi)
244{
245 device_unregister(&dsi->dev);
246}
247EXPORT_SYMBOL(mipi_dsi_device_unregister);
248
249static DEFINE_MUTEX(host_lock);
250static LIST_HEAD(host_list);
251
252/**
253 * of_find_mipi_dsi_host_by_node() - find the MIPI DSI host matching a
254 * device tree node
255 * @node: device tree node
256 *
257 * Returns:
258 * A pointer to the MIPI DSI host corresponding to @node or NULL if no
259 * such device exists (or has not been registered yet).
260 */
261struct mipi_dsi_host *of_find_mipi_dsi_host_by_node(struct device_node *node)
262{
263 struct mipi_dsi_host *host;
264
265 mutex_lock(&host_lock);
266
267 list_for_each_entry(host, &host_list, list) {
268 if (host->dev->of_node == node) {
269 mutex_unlock(&host_lock);
270 return host;
271 }
272 }
273
274 mutex_unlock(&host_lock);
275
276 return NULL;
277}
278EXPORT_SYMBOL(of_find_mipi_dsi_host_by_node);
279
280int mipi_dsi_host_register(struct mipi_dsi_host *host)
281{
282 struct device_node *node;
283
284 for_each_available_child_of_node(host->dev->of_node, node) {
285 /* skip nodes without reg property */
286 if (!of_find_property(node, "reg", NULL))
287 continue;
288 of_mipi_dsi_device_add(host, node);
289 }
290
291 mutex_lock(&host_lock);
292 list_add_tail(&host->list, &host_list);
293 mutex_unlock(&host_lock);
294
295 return 0;
296}
297EXPORT_SYMBOL(mipi_dsi_host_register);
298
299static int mipi_dsi_remove_device_fn(struct device *dev, void *priv)
300{
301 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
302
303 mipi_dsi_device_unregister(dsi);
304
305 return 0;
306}
307
308void mipi_dsi_host_unregister(struct mipi_dsi_host *host)
309{
310 device_for_each_child(host->dev, NULL, mipi_dsi_remove_device_fn);
311
312 mutex_lock(&host_lock);
313 list_del_init(&host->list);
314 mutex_unlock(&host_lock);
315}
316EXPORT_SYMBOL(mipi_dsi_host_unregister);
317
318/**
319 * mipi_dsi_attach - attach a DSI device to its DSI host
320 * @dsi: DSI peripheral
321 */
322int mipi_dsi_attach(struct mipi_dsi_device *dsi)
323{
324 const struct mipi_dsi_host_ops *ops = dsi->host->ops;
325
326 if (!ops || !ops->attach)
327 return -ENOSYS;
328
329 return ops->attach(dsi->host, dsi);
330}
331EXPORT_SYMBOL(mipi_dsi_attach);
332
333/**
334 * mipi_dsi_detach - detach a DSI device from its DSI host
335 * @dsi: DSI peripheral
336 */
337int mipi_dsi_detach(struct mipi_dsi_device *dsi)
338{
339 const struct mipi_dsi_host_ops *ops = dsi->host->ops;
340
341 if (!ops || !ops->detach)
342 return -ENOSYS;
343
344 return ops->detach(dsi->host, dsi);
345}
346EXPORT_SYMBOL(mipi_dsi_detach);
347
348static ssize_t mipi_dsi_device_transfer(struct mipi_dsi_device *dsi,
349 struct mipi_dsi_msg *msg)
350{
351 const struct mipi_dsi_host_ops *ops = dsi->host->ops;
352
353 if (!ops || !ops->transfer)
354 return -ENOSYS;
355
356 if (dsi->mode_flags & MIPI_DSI_MODE_LPM)
357 msg->flags |= MIPI_DSI_MSG_USE_LPM;
358
359 return ops->transfer(dsi->host, msg);
360}
361
362/**
363 * mipi_dsi_packet_format_is_short - check if a packet is of the short format
364 * @type: MIPI DSI data type of the packet
365 *
366 * Return: true if the packet for the given data type is a short packet, false
367 * otherwise.
368 */
369bool mipi_dsi_packet_format_is_short(u8 type)
370{
371 switch (type) {
372 case MIPI_DSI_V_SYNC_START:
373 case MIPI_DSI_V_SYNC_END:
374 case MIPI_DSI_H_SYNC_START:
375 case MIPI_DSI_H_SYNC_END:
376 case MIPI_DSI_END_OF_TRANSMISSION:
377 case MIPI_DSI_COLOR_MODE_OFF:
378 case MIPI_DSI_COLOR_MODE_ON:
379 case MIPI_DSI_SHUTDOWN_PERIPHERAL:
380 case MIPI_DSI_TURN_ON_PERIPHERAL:
381 case MIPI_DSI_GENERIC_SHORT_WRITE_0_PARAM:
382 case MIPI_DSI_GENERIC_SHORT_WRITE_1_PARAM:
383 case MIPI_DSI_GENERIC_SHORT_WRITE_2_PARAM:
384 case MIPI_DSI_GENERIC_READ_REQUEST_0_PARAM:
385 case MIPI_DSI_GENERIC_READ_REQUEST_1_PARAM:
386 case MIPI_DSI_GENERIC_READ_REQUEST_2_PARAM:
387 case MIPI_DSI_DCS_SHORT_WRITE:
388 case MIPI_DSI_DCS_SHORT_WRITE_PARAM:
389 case MIPI_DSI_DCS_READ:
390 case MIPI_DSI_DCS_COMPRESSION_MODE:
391 case MIPI_DSI_SET_MAXIMUM_RETURN_PACKET_SIZE:
392 return true;
393 }
394
395 return false;
396}
397EXPORT_SYMBOL(mipi_dsi_packet_format_is_short);
398
399/**
400 * mipi_dsi_packet_format_is_long - check if a packet is of the long format
401 * @type: MIPI DSI data type of the packet
402 *
403 * Return: true if the packet for the given data type is a long packet, false
404 * otherwise.
405 */
406bool mipi_dsi_packet_format_is_long(u8 type)
407{
408 switch (type) {
409 case MIPI_DSI_PPS_LONG_WRITE:
410 case MIPI_DSI_NULL_PACKET:
411 case MIPI_DSI_BLANKING_PACKET:
412 case MIPI_DSI_GENERIC_LONG_WRITE:
413 case MIPI_DSI_DCS_LONG_WRITE:
414 case MIPI_DSI_LOOSELY_PACKED_PIXEL_STREAM_YCBCR20:
415 case MIPI_DSI_PACKED_PIXEL_STREAM_YCBCR24:
416 case MIPI_DSI_PACKED_PIXEL_STREAM_YCBCR16:
417 case MIPI_DSI_PACKED_PIXEL_STREAM_30:
418 case MIPI_DSI_PACKED_PIXEL_STREAM_36:
419 case MIPI_DSI_PACKED_PIXEL_STREAM_YCBCR12:
420 case MIPI_DSI_PACKED_PIXEL_STREAM_16:
421 case MIPI_DSI_PACKED_PIXEL_STREAM_18:
422 case MIPI_DSI_PIXEL_STREAM_3BYTE_18:
423 case MIPI_DSI_PACKED_PIXEL_STREAM_24:
424 return true;
425 }
426
427 return false;
428}
429EXPORT_SYMBOL(mipi_dsi_packet_format_is_long);
430
431/**
432 * mipi_dsi_create_packet - create a packet from a message according to the
433 * DSI protocol
434 * @packet: pointer to a DSI packet structure
435 * @msg: message to translate into a packet
436 *
437 * Return: 0 on success or a negative error code on failure.
438 */
439int mipi_dsi_create_packet(struct mipi_dsi_packet *packet,
440 const struct mipi_dsi_msg *msg)
441{
442 if (!packet || !msg)
443 return -EINVAL;
444
445 /* do some minimum sanity checking */
446 if (!mipi_dsi_packet_format_is_short(msg->type) &&
447 !mipi_dsi_packet_format_is_long(msg->type))
448 return -EINVAL;
449
450 if (msg->channel > 3)
451 return -EINVAL;
452
453 memset(packet, 0, sizeof(*packet));
454 packet->header[0] = ((msg->channel & 0x3) << 6) | (msg->type & 0x3f);
455
456 /* TODO: compute ECC if hardware support is not available */
457
458 /*
459 * Long write packets contain the word count in header bytes 1 and 2.
460 * The payload follows the header and is word count bytes long.
461 *
462 * Short write packets encode up to two parameters in header bytes 1
463 * and 2.
464 */
465 if (mipi_dsi_packet_format_is_long(msg->type)) {
466 packet->header[1] = (msg->tx_len >> 0) & 0xff;
467 packet->header[2] = (msg->tx_len >> 8) & 0xff;
468
469 packet->payload_length = msg->tx_len;
470 packet->payload = msg->tx_buf;
471 } else {
472 const u8 *tx = msg->tx_buf;
473
474 packet->header[1] = (msg->tx_len > 0) ? tx[0] : 0;
475 packet->header[2] = (msg->tx_len > 1) ? tx[1] : 0;
476 }
477
478 packet->size = sizeof(packet->header) + packet->payload_length;
479
480 return 0;
481}
482EXPORT_SYMBOL(mipi_dsi_create_packet);
483
484/**
485 * mipi_dsi_shutdown_peripheral() - sends a Shutdown Peripheral command
486 * @dsi: DSI peripheral device
487 *
488 * Return: 0 on success or a negative error code on failure.
489 */
490int mipi_dsi_shutdown_peripheral(struct mipi_dsi_device *dsi)
491{
492 struct mipi_dsi_msg msg = {
493 .channel = dsi->channel,
494 .type = MIPI_DSI_SHUTDOWN_PERIPHERAL,
495 .tx_buf = (u8 [2]) { 0, 0 },
496 .tx_len = 2,
497 };
498 int ret = mipi_dsi_device_transfer(dsi, &msg);
499
500 return (ret < 0) ? ret : 0;
501}
502EXPORT_SYMBOL(mipi_dsi_shutdown_peripheral);
503
504/**
505 * mipi_dsi_turn_on_peripheral() - sends a Turn On Peripheral command
506 * @dsi: DSI peripheral device
507 *
508 * Return: 0 on success or a negative error code on failure.
509 */
510int mipi_dsi_turn_on_peripheral(struct mipi_dsi_device *dsi)
511{
512 struct mipi_dsi_msg msg = {
513 .channel = dsi->channel,
514 .type = MIPI_DSI_TURN_ON_PERIPHERAL,
515 .tx_buf = (u8 [2]) { 0, 0 },
516 .tx_len = 2,
517 };
518 int ret = mipi_dsi_device_transfer(dsi, &msg);
519
520 return (ret < 0) ? ret : 0;
521}
522EXPORT_SYMBOL(mipi_dsi_turn_on_peripheral);
523
524/*
525 * mipi_dsi_set_maximum_return_packet_size() - specify the maximum size of the
526 * the payload in a long packet transmitted from the peripheral back to the
527 * host processor
528 * @dsi: DSI peripheral device
529 * @value: the maximum size of the payload
530 *
531 * Return: 0 on success or a negative error code on failure.
532 */
533int mipi_dsi_set_maximum_return_packet_size(struct mipi_dsi_device *dsi,
534 u16 value)
535{
536 u8 tx[2] = { value & 0xff, value >> 8 };
537 struct mipi_dsi_msg msg = {
538 .channel = dsi->channel,
539 .type = MIPI_DSI_SET_MAXIMUM_RETURN_PACKET_SIZE,
540 .tx_len = sizeof(tx),
541 .tx_buf = tx,
542 };
543 int ret = mipi_dsi_device_transfer(dsi, &msg);
544
545 return (ret < 0) ? ret : 0;
546}
547EXPORT_SYMBOL(mipi_dsi_set_maximum_return_packet_size);
548
549/**
550 * mipi_dsi_generic_write() - transmit data using a generic write packet
551 * @dsi: DSI peripheral device
552 * @payload: buffer containing the payload
553 * @size: size of payload buffer
554 *
555 * This function will automatically choose the right data type depending on
556 * the payload length.
557 *
558 * Return: The number of bytes transmitted on success or a negative error code
559 * on failure.
560 */
561ssize_t mipi_dsi_generic_write(struct mipi_dsi_device *dsi, const void *payload,
562 size_t size)
563{
564 struct mipi_dsi_msg msg = {
565 .channel = dsi->channel,
566 .tx_buf = payload,
567 .tx_len = size
568 };
569
570 switch (size) {
571 case 0:
572 msg.type = MIPI_DSI_GENERIC_SHORT_WRITE_0_PARAM;
573 break;
574
575 case 1:
576 msg.type = MIPI_DSI_GENERIC_SHORT_WRITE_1_PARAM;
577 break;
578
579 case 2:
580 msg.type = MIPI_DSI_GENERIC_SHORT_WRITE_2_PARAM;
581 break;
582
583 default:
584 msg.type = MIPI_DSI_GENERIC_LONG_WRITE;
585 break;
586 }
587
588 return mipi_dsi_device_transfer(dsi, &msg);
589}
590EXPORT_SYMBOL(mipi_dsi_generic_write);
591
592/**
593 * mipi_dsi_generic_read() - receive data using a generic read packet
594 * @dsi: DSI peripheral device
595 * @params: buffer containing the request parameters
596 * @num_params: number of request parameters
597 * @data: buffer in which to return the received data
598 * @size: size of receive buffer
599 *
600 * This function will automatically choose the right data type depending on
601 * the number of parameters passed in.
602 *
603 * Return: The number of bytes successfully read or a negative error code on
604 * failure.
605 */
606ssize_t mipi_dsi_generic_read(struct mipi_dsi_device *dsi, const void *params,
607 size_t num_params, void *data, size_t size)
608{
609 struct mipi_dsi_msg msg = {
610 .channel = dsi->channel,
611 .tx_len = num_params,
612 .tx_buf = params,
613 .rx_len = size,
614 .rx_buf = data
615 };
616
617 switch (num_params) {
618 case 0:
619 msg.type = MIPI_DSI_GENERIC_READ_REQUEST_0_PARAM;
620 break;
621
622 case 1:
623 msg.type = MIPI_DSI_GENERIC_READ_REQUEST_1_PARAM;
624 break;
625
626 case 2:
627 msg.type = MIPI_DSI_GENERIC_READ_REQUEST_2_PARAM;
628 break;
629
630 default:
631 return -EINVAL;
632 }
633
634 return mipi_dsi_device_transfer(dsi, &msg);
635}
636EXPORT_SYMBOL(mipi_dsi_generic_read);
637
638/**
639 * mipi_dsi_dcs_write_buffer() - transmit a DCS command with payload
640 * @dsi: DSI peripheral device
641 * @data: buffer containing data to be transmitted
642 * @len: size of transmission buffer
643 *
644 * This function will automatically choose the right data type depending on
645 * the command payload length.
646 *
647 * Return: The number of bytes successfully transmitted or a negative error
648 * code on failure.
649 */
650ssize_t mipi_dsi_dcs_write_buffer(struct mipi_dsi_device *dsi,
651 const void *data, size_t len)
652{
653 struct mipi_dsi_msg msg = {
654 .channel = dsi->channel,
655 .tx_buf = data,
656 .tx_len = len
657 };
658
659 switch (len) {
660 case 0:
661 return -EINVAL;
662
663 case 1:
664 msg.type = MIPI_DSI_DCS_SHORT_WRITE;
665 break;
666
667 case 2:
668 msg.type = MIPI_DSI_DCS_SHORT_WRITE_PARAM;
669 break;
670
671 default:
672 msg.type = MIPI_DSI_DCS_LONG_WRITE;
673 break;
674 }
675
676 return mipi_dsi_device_transfer(dsi, &msg);
677}
678EXPORT_SYMBOL(mipi_dsi_dcs_write_buffer);
679
680/**
681 * mipi_dsi_dcs_write() - send DCS write command
682 * @dsi: DSI peripheral device
683 * @cmd: DCS command
684 * @data: buffer containing the command payload
685 * @len: command payload length
686 *
687 * This function will automatically choose the right data type depending on
688 * the command payload length.
689 *
690 * Return: The number of bytes successfully transmitted or a negative error
691 * code on failure.
692 */
693ssize_t mipi_dsi_dcs_write(struct mipi_dsi_device *dsi, u8 cmd,
694 const void *data, size_t len)
695{
696 ssize_t err;
697 size_t size;
698 u8 *tx;
699
700 if (len > 0) {
701 size = 1 + len;
702
703 tx = kmalloc(size, GFP_KERNEL);
704 if (!tx)
705 return -ENOMEM;
706
707 /* concatenate the DCS command byte and the payload */
708 tx[0] = cmd;
709 memcpy(&tx[1], data, len);
710 } else {
711 tx = &cmd;
712 size = 1;
713 }
714
715 err = mipi_dsi_dcs_write_buffer(dsi, tx, size);
716
717 if (len > 0)
718 kfree(tx);
719
720 return err;
721}
722EXPORT_SYMBOL(mipi_dsi_dcs_write);
723
724/**
725 * mipi_dsi_dcs_read() - send DCS read request command
726 * @dsi: DSI peripheral device
727 * @cmd: DCS command
728 * @data: buffer in which to receive data
729 * @len: size of receive buffer
730 *
731 * Return: The number of bytes read or a negative error code on failure.
732 */
733ssize_t mipi_dsi_dcs_read(struct mipi_dsi_device *dsi, u8 cmd, void *data,
734 size_t len)
735{
736 struct mipi_dsi_msg msg = {
737 .channel = dsi->channel,
738 .type = MIPI_DSI_DCS_READ,
739 .tx_buf = &cmd,
740 .tx_len = 1,
741 .rx_buf = data,
742 .rx_len = len
743 };
744
745 return mipi_dsi_device_transfer(dsi, &msg);
746}
747EXPORT_SYMBOL(mipi_dsi_dcs_read);
748
749/**
750 * mipi_dsi_dcs_nop() - send DCS nop packet
751 * @dsi: DSI peripheral device
752 *
753 * Return: 0 on success or a negative error code on failure.
754 */
755int mipi_dsi_dcs_nop(struct mipi_dsi_device *dsi)
756{
757 ssize_t err;
758
759 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_NOP, NULL, 0);
760 if (err < 0)
761 return err;
762
763 return 0;
764}
765EXPORT_SYMBOL(mipi_dsi_dcs_nop);
766
767/**
768 * mipi_dsi_dcs_soft_reset() - perform a software reset of the display module
769 * @dsi: DSI peripheral device
770 *
771 * Return: 0 on success or a negative error code on failure.
772 */
773int mipi_dsi_dcs_soft_reset(struct mipi_dsi_device *dsi)
774{
775 ssize_t err;
776
777 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SOFT_RESET, NULL, 0);
778 if (err < 0)
779 return err;
780
781 return 0;
782}
783EXPORT_SYMBOL(mipi_dsi_dcs_soft_reset);
784
785/**
786 * mipi_dsi_dcs_get_power_mode() - query the display module's current power
787 * mode
788 * @dsi: DSI peripheral device
789 * @mode: return location for the current power mode
790 *
791 * Return: 0 on success or a negative error code on failure.
792 */
793int mipi_dsi_dcs_get_power_mode(struct mipi_dsi_device *dsi, u8 *mode)
794{
795 ssize_t err;
796
797 err = mipi_dsi_dcs_read(dsi, MIPI_DCS_GET_POWER_MODE, mode,
798 sizeof(*mode));
799 if (err <= 0) {
800 if (err == 0)
801 err = -ENODATA;
802
803 return err;
804 }
805
806 return 0;
807}
808EXPORT_SYMBOL(mipi_dsi_dcs_get_power_mode);
809
810/**
811 * mipi_dsi_dcs_get_pixel_format() - gets the pixel format for the RGB image
812 * data used by the interface
813 * @dsi: DSI peripheral device
814 * @format: return location for the pixel format
815 *
816 * Return: 0 on success or a negative error code on failure.
817 */
818int mipi_dsi_dcs_get_pixel_format(struct mipi_dsi_device *dsi, u8 *format)
819{
820 ssize_t err;
821
822 err = mipi_dsi_dcs_read(dsi, MIPI_DCS_GET_PIXEL_FORMAT, format,
823 sizeof(*format));
824 if (err <= 0) {
825 if (err == 0)
826 err = -ENODATA;
827
828 return err;
829 }
830
831 return 0;
832}
833EXPORT_SYMBOL(mipi_dsi_dcs_get_pixel_format);
834
835/**
836 * mipi_dsi_dcs_enter_sleep_mode() - disable all unnecessary blocks inside the
837 * display module except interface communication
838 * @dsi: DSI peripheral device
839 *
840 * Return: 0 on success or a negative error code on failure.
841 */
842int mipi_dsi_dcs_enter_sleep_mode(struct mipi_dsi_device *dsi)
843{
844 ssize_t err;
845
846 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_ENTER_SLEEP_MODE, NULL, 0);
847 if (err < 0)
848 return err;
849
850 return 0;
851}
852EXPORT_SYMBOL(mipi_dsi_dcs_enter_sleep_mode);
853
854/**
855 * mipi_dsi_dcs_exit_sleep_mode() - enable all blocks inside the display
856 * module
857 * @dsi: DSI peripheral device
858 *
859 * Return: 0 on success or a negative error code on failure.
860 */
861int mipi_dsi_dcs_exit_sleep_mode(struct mipi_dsi_device *dsi)
862{
863 ssize_t err;
864
865 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_EXIT_SLEEP_MODE, NULL, 0);
866 if (err < 0)
867 return err;
868
869 return 0;
870}
871EXPORT_SYMBOL(mipi_dsi_dcs_exit_sleep_mode);
872
873/**
874 * mipi_dsi_dcs_set_display_off() - stop displaying the image data on the
875 * display device
876 * @dsi: DSI peripheral device
877 *
878 * Return: 0 on success or a negative error code on failure.
879 */
880int mipi_dsi_dcs_set_display_off(struct mipi_dsi_device *dsi)
881{
882 ssize_t err;
883
884 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_DISPLAY_OFF, NULL, 0);
885 if (err < 0)
886 return err;
887
888 return 0;
889}
890EXPORT_SYMBOL(mipi_dsi_dcs_set_display_off);
891
892/**
893 * mipi_dsi_dcs_set_display_on() - start displaying the image data on the
894 * display device
895 * @dsi: DSI peripheral device
896 *
897 * Return: 0 on success or a negative error code on failure
898 */
899int mipi_dsi_dcs_set_display_on(struct mipi_dsi_device *dsi)
900{
901 ssize_t err;
902
903 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_DISPLAY_ON, NULL, 0);
904 if (err < 0)
905 return err;
906
907 return 0;
908}
909EXPORT_SYMBOL(mipi_dsi_dcs_set_display_on);
910
911/**
912 * mipi_dsi_dcs_set_column_address() - define the column extent of the frame
913 * memory accessed by the host processor
914 * @dsi: DSI peripheral device
915 * @start: first column of frame memory
916 * @end: last column of frame memory
917 *
918 * Return: 0 on success or a negative error code on failure.
919 */
920int mipi_dsi_dcs_set_column_address(struct mipi_dsi_device *dsi, u16 start,
921 u16 end)
922{
923 u8 payload[4] = { start >> 8, start & 0xff, end >> 8, end & 0xff };
924 ssize_t err;
925
926 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_COLUMN_ADDRESS, payload,
927 sizeof(payload));
928 if (err < 0)
929 return err;
930
931 return 0;
932}
933EXPORT_SYMBOL(mipi_dsi_dcs_set_column_address);
934
935/**
936 * mipi_dsi_dcs_set_page_address() - define the page extent of the frame
937 * memory accessed by the host processor
938 * @dsi: DSI peripheral device
939 * @start: first page of frame memory
940 * @end: last page of frame memory
941 *
942 * Return: 0 on success or a negative error code on failure.
943 */
944int mipi_dsi_dcs_set_page_address(struct mipi_dsi_device *dsi, u16 start,
945 u16 end)
946{
947 u8 payload[4] = { start >> 8, start & 0xff, end >> 8, end & 0xff };
948 ssize_t err;
949
950 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_PAGE_ADDRESS, payload,
951 sizeof(payload));
952 if (err < 0)
953 return err;
954
955 return 0;
956}
957EXPORT_SYMBOL(mipi_dsi_dcs_set_page_address);
958
959/**
960 * mipi_dsi_dcs_set_tear_off() - turn off the display module's Tearing Effect
961 * output signal on the TE signal line
962 * @dsi: DSI peripheral device
963 *
964 * Return: 0 on success or a negative error code on failure
965 */
966int mipi_dsi_dcs_set_tear_off(struct mipi_dsi_device *dsi)
967{
968 ssize_t err;
969
970 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_TEAR_OFF, NULL, 0);
971 if (err < 0)
972 return err;
973
974 return 0;
975}
976EXPORT_SYMBOL(mipi_dsi_dcs_set_tear_off);
977
978/**
979 * mipi_dsi_dcs_set_tear_on() - turn on the display module's Tearing Effect
980 * output signal on the TE signal line.
981 * @dsi: DSI peripheral device
982 * @mode: the Tearing Effect Output Line mode
983 *
984 * Return: 0 on success or a negative error code on failure
985 */
986int mipi_dsi_dcs_set_tear_on(struct mipi_dsi_device *dsi,
987 enum mipi_dsi_dcs_tear_mode mode)
988{
989 u8 value = mode;
990 ssize_t err;
991
992 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_TEAR_ON, &value,
993 sizeof(value));
994 if (err < 0)
995 return err;
996
997 return 0;
998}
999EXPORT_SYMBOL(mipi_dsi_dcs_set_tear_on);
1000
1001/**
1002 * mipi_dsi_dcs_set_pixel_format() - sets the pixel format for the RGB image
1003 * data used by the interface
1004 * @dsi: DSI peripheral device
1005 * @format: pixel format
1006 *
1007 * Return: 0 on success or a negative error code on failure.
1008 */
1009int mipi_dsi_dcs_set_pixel_format(struct mipi_dsi_device *dsi, u8 format)
1010{
1011 ssize_t err;
1012
1013 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_PIXEL_FORMAT, &format,
1014 sizeof(format));
1015 if (err < 0)
1016 return err;
1017
1018 return 0;
1019}
1020EXPORT_SYMBOL(mipi_dsi_dcs_set_pixel_format);
1021
1022/**
1023 * mipi_dsi_dcs_set_tear_scanline() - set the scanline to use as trigger for
1024 * the Tearing Effect output signal of the display module
1025 * @dsi: DSI peripheral device
1026 * @scanline: scanline to use as trigger
1027 *
1028 * Return: 0 on success or a negative error code on failure
1029 */
1030int mipi_dsi_dcs_set_tear_scanline(struct mipi_dsi_device *dsi, u16 scanline)
1031{
1032 u8 payload[3] = { MIPI_DCS_SET_TEAR_SCANLINE, scanline >> 8,
1033 scanline & 0xff };
1034 ssize_t err;
1035
1036 err = mipi_dsi_generic_write(dsi, payload, sizeof(payload));
1037 if (err < 0)
1038 return err;
1039
1040 return 0;
1041}
1042EXPORT_SYMBOL(mipi_dsi_dcs_set_tear_scanline);
1043
1044/**
1045 * mipi_dsi_dcs_set_display_brightness() - sets the brightness value of the
1046 * display
1047 * @dsi: DSI peripheral device
1048 * @brightness: brightness value
1049 *
1050 * Return: 0 on success or a negative error code on failure.
1051 */
1052int mipi_dsi_dcs_set_display_brightness(struct mipi_dsi_device *dsi,
1053 u16 brightness)
1054{
1055 u8 payload[2] = { brightness & 0xff, brightness >> 8 };
1056 ssize_t err;
1057
1058 err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_DISPLAY_BRIGHTNESS,
1059 payload, sizeof(payload));
1060 if (err < 0)
1061 return err;
1062
1063 return 0;
1064}
1065EXPORT_SYMBOL(mipi_dsi_dcs_set_display_brightness);
1066
1067/**
1068 * mipi_dsi_dcs_get_display_brightness() - gets the current brightness value
1069 * of the display
1070 * @dsi: DSI peripheral device
1071 * @brightness: brightness value
1072 *
1073 * Return: 0 on success or a negative error code on failure.
1074 */
1075int mipi_dsi_dcs_get_display_brightness(struct mipi_dsi_device *dsi,
1076 u16 *brightness)
1077{
1078 ssize_t err;
1079
1080 err = mipi_dsi_dcs_read(dsi, MIPI_DCS_GET_DISPLAY_BRIGHTNESS,
1081 brightness, sizeof(*brightness));
1082 if (err <= 0) {
1083 if (err == 0)
1084 err = -ENODATA;
1085
1086 return err;
1087 }
1088
1089 return 0;
1090}
1091EXPORT_SYMBOL(mipi_dsi_dcs_get_display_brightness);
1092
1093static int mipi_dsi_drv_probe(struct device *dev)
1094{
1095 struct mipi_dsi_driver *drv = to_mipi_dsi_driver(dev->driver);
1096 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
1097
1098 return drv->probe(dsi);
1099}
1100
1101static int mipi_dsi_drv_remove(struct device *dev)
1102{
1103 struct mipi_dsi_driver *drv = to_mipi_dsi_driver(dev->driver);
1104 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
1105
1106 return drv->remove(dsi);
1107}
1108
1109static void mipi_dsi_drv_shutdown(struct device *dev)
1110{
1111 struct mipi_dsi_driver *drv = to_mipi_dsi_driver(dev->driver);
1112 struct mipi_dsi_device *dsi = to_mipi_dsi_device(dev);
1113
1114 drv->shutdown(dsi);
1115}
1116
1117/**
1118 * mipi_dsi_driver_register_full() - register a driver for DSI devices
1119 * @drv: DSI driver structure
1120 * @owner: owner module
1121 *
1122 * Return: 0 on success or a negative error code on failure.
1123 */
1124int mipi_dsi_driver_register_full(struct mipi_dsi_driver *drv,
1125 struct module *owner)
1126{
1127 drv->driver.bus = &mipi_dsi_bus_type;
1128 drv->driver.owner = owner;
1129
1130 if (drv->probe)
1131 drv->driver.probe = mipi_dsi_drv_probe;
1132 if (drv->remove)
1133 drv->driver.remove = mipi_dsi_drv_remove;
1134 if (drv->shutdown)
1135 drv->driver.shutdown = mipi_dsi_drv_shutdown;
1136
1137 return driver_register(&drv->driver);
1138}
1139EXPORT_SYMBOL(mipi_dsi_driver_register_full);
1140
1141/**
1142 * mipi_dsi_driver_unregister() - unregister a driver for DSI devices
1143 * @drv: DSI driver structure
1144 *
1145 * Return: 0 on success or a negative error code on failure.
1146 */
1147void mipi_dsi_driver_unregister(struct mipi_dsi_driver *drv)
1148{
1149 driver_unregister(&drv->driver);
1150}
1151EXPORT_SYMBOL(mipi_dsi_driver_unregister);
1152
1153static int __init mipi_dsi_bus_init(void)
1154{
1155 return bus_register(&mipi_dsi_bus_type);
1156}
1157postcore_initcall(mipi_dsi_bus_init);
1158
1159MODULE_AUTHOR("Andrzej Hajda <a.hajda@samsung.com>");
1160MODULE_DESCRIPTION("MIPI DSI Bus");
1161MODULE_LICENSE("GPL and additional rights");