summaryrefslogtreecommitdiff
path: root/src/device/mipi/panel.c
blob: f2bf3408c2af01d7f1f90f73715ac49cfe94590f (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
/* SPDX-License-Identifier: GPL-2.0-only */

#include <console/console.h>
#include <delay.h>
#include <device/mipi_panel.h>

cb_err_t mipi_panel_parse_init_commands(const void *buf, mipi_cmd_func_t cmd_func)
{
	const struct panel_init_command *init = buf;

	/*
	 * The given commands should be in a buffer containing a packed array of
	 * panel_init_command and each element may be in variable size so we have
	 * to parse and scan.
	 */

	for (; init->cmd != PANEL_CMD_END; init = (const void *)buf) {
		/*
		 * For some commands like DELAY, the init->len should not be
		 * counted for buf.
		 */
		buf += sizeof(*init);

		u32 cmd = init->cmd, len = init->len;

		switch (cmd) {
		case PANEL_CMD_DELAY:
			mdelay(len);
			break;

		case PANEL_CMD_DCS:
		case PANEL_CMD_GENERIC:
			buf += len;

			cb_err_t ret = cmd_func(cmd, init->data, len);
			if (ret != CB_SUCCESS)
				return ret;
			break;

		default:
			printk(BIOS_ERR, "%s: Unknown command code: %d, "
			       "abort panel initialization.\n", __func__, cmd);
			return CB_ERR;
		}
	}

	return CB_SUCCESS;
}