[PATCH v4 1/2] [media] Add Rockchip RK1608 driver

From: Wen Nuan
Date: Thu Mar 08 2018 - 01:46:18 EST

From: Leo Wen <leo.wen@xxxxxxxxxxxxxx>

Rk1608 is used as a PreISP to link on Soc, which mainly has two functions.
One is to download the firmware of RK1608, and the other is to match the
extra sensor such as camera and enable sensor by calling sensor's s_power.

use below v4l2-ctl command to capture frames.

v4l2-ctl --verbose -d /dev/video1 --stream-mmap=2
--stream-to=/tmp/stream.out --stream-count=60 --stream-poll

use below command to playback the video on your PC.

mplayer ./stream.out -loop 0 -demuxer rawvideo -rawvideo
w=640:h=480:size=$((640*480*3/2)):format=NV12

Changes V4:
- Request the GPIO as input with the flag GPIOD_IN.
- Request the GPIO as output with the flag GPIOD_OUT_LOW.
- Delete these redundant functions(gpiod_direction_input..etc.).

Signed-off-by: Leo Wen <leo.wen@xxxxxxxxxxxxxx>
---
MAINTAINERS | 6 +
drivers/media/spi/Makefile | 1 +
drivers/media/spi/rk1608.c | 1374 ++++++++++++++++++++++++++++++++++++++++++++
drivers/media/spi/rk1608.h | 442 ++++++++++++++
4 files changed, 1823 insertions(+)
create mode 100644 drivers/media/spi/rk1608.c
create mode 100644 drivers/media/spi/rk1608.h

diff --git a/MAINTAINERS b/MAINTAINERS
index 93a12af..b2a98e3 100644
--- a/MAINTAINERS
+++ b/MAINTAINERS
@@ -136,6 +136,12 @@ Maintainers List (try to look for most precise areas first)

-----------------------------------

+ROCKCHIP RK1608 DRIVER
+M: Leo Wen <leo.wen@xxxxxxxxxxxxxx>
+S: Maintained
+F: drivers/media/spi/rk1608.c
+F: drivers/media/spi/rk1608.h
+
3C59X NETWORK DRIVER
M: Steffen Klassert <klassert@xxxxxxxxxxxxxxxxxxxxxxxxx>
L: netdev@xxxxxxxxxxxxxxx
diff --git a/drivers/media/spi/Makefile b/drivers/media/spi/Makefile
index ea64013..6d0e6ee 100644
--- a/drivers/media/spi/Makefile
+++ b/drivers/media/spi/Makefile
@@ -1 +1,2 @@
obj-$(CONFIG_VIDEO_GS1662) += gs1662.o
+obj-$(CONFIG_VIDEO_RK1608) += rk1608.o
diff --git a/drivers/media/spi/rk1608.c b/drivers/media/spi/rk1608.c
new file mode 100644
index 0000000..fedcd0b
--- /dev/null
+++ b/drivers/media/spi/rk1608.c
@@ -0,0 +1,1374 @@
+/**
+ * Rockchip rk1608 driver
+ *
+ * SPDX-License-Identifier: GPL-2.0
+ *
+ * Copyright (C) 2017 Rockchip Electronics Co., Ltd.
+ *
+ */
+#include <linux/clk.h>
+#include <linux/clkdev.h>
+#include <linux/delay.h>
+#include <linux/firmware.h>
+#include <linux/gpio/consumer.h>
+#include <linux/interrupt.h>
+#include <linux/module.h>
+#include <linux/of_graph.h>
+#include <media/v4l2-ctrls.h>
+#include <media/v4l2-fwnode.h>
+#include <media/v4l2-subdev.h>
+#include "rk1608.h"
+
+/**
+ * Rk1608 is used as the Pre-ISP to link on Soc, which mainly has two
+ * functions. One is to download the firmware of RK1608, and the other
+ * is to match the extra sensor such as camera and enable sensor by
+ * calling sensor's s_power.
+ * |-----------------------|
+ * | Sensor Camera |
+ * |-----------------------|
+ * |-----------||----------|
+ * |-----------||----------|
+ * |-----------\/----------|
+ * | Pre-ISP RK1608 |
+ * |-----------------------|
+ * |-----------||----------|
+ * |-----------||----------|
+ * |-----------\/----------|
+ * | Rockchip Soc |
+ * |-----------------------|
+ * Data Transfer As shown above. In RK1608, the data received from the
+ * extra sensor,and it is passed to the Soc through ISP.
+ */
+
+static inline struct rk1608_state *to_state(struct v4l2_subdev *sd)
+{
+ return container_of(sd, struct rk1608_state, sd);
+}
+
+/**
+ * rk1608_operation_query - RK1608 last operation state query
+ *
+ * @spi: device from which data will be read
+ * @state: last operation state [out]
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_operation_query(struct spi_device *spi, s32 *state)
+{
+ s32 query_cmd = RK1608_CMD_QUERY;
+ struct spi_transfer query_cmd_packet = {
+ .tx_buf = &query_cmd,
+ .len = sizeof(query_cmd),
+ };
+ struct spi_transfer state_packet = {
+ .rx_buf = state,
+ .len = sizeof(*state),
+ };
+ struct spi_message m;
+
+ spi_message_init(&m);
+ spi_message_add_tail(&query_cmd_packet, &m);
+ spi_message_add_tail(&state_packet, &m);
+ spi_sync(spi, &m);
+
+ return ((*state & RK1608_STATE_ID_MASK) == RK1608_STATE_ID) ? 0 : -1;
+}
+
+static int rk1608_write(struct spi_device *spi,
+ s32 addr, const s32 *data, size_t data_len)
+{
+ s32 write_cmd = RK1608_CMD_WRITE;
+ struct spi_transfer write_cmd_packet = {
+ .tx_buf = &write_cmd,
+ .len = sizeof(write_cmd),
+ };
+ struct spi_transfer addr_packet = {
+ .tx_buf = &addr,
+ .len = sizeof(addr),
+ };
+ struct spi_transfer data_packet = {
+ .tx_buf = data,
+ .len = data_len,
+ };
+ struct spi_message m;
+
+ spi_message_init(&m);
+ spi_message_add_tail(&write_cmd_packet, &m);
+ spi_message_add_tail(&addr_packet, &m);
+ spi_message_add_tail(&data_packet, &m);
+ return spi_sync(spi, &m);
+}
+
+/**
+ * rk1608_safe_write - RK1608 synchronous write with state check
+ *
+ * @spi: spi device
+ * @addr: resource address
+ * @data: data buffer
+ * @data_len: data buffer size, in bytes
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_safe_write(struct spi_device *spi,
+ s32 addr, const s32 *data, size_t data_len)
+{
+ s32 state, retry = 0;
+
+ while (data_len > 0) {
+ size_t slen = MIN(data_len, RK1608_MAX_OP_BYTES);
+
+ do {
+ rk1608_write(spi, addr, data, data_len);
+ if (rk1608_operation_query(spi, &state) != 0)
+ return -EPERM;
+ if ((state & RK1608_STATE_MASK) == 0)
+ break;
+ udelay(RK1608_OP_TRY_DELAY);
+ } while (retry++ != RK1608_OP_TRY_MAX);
+
+ data_len = data_len - slen;
+ data = (s32 *)((s8 *)data + slen);
+ addr += slen;
+ }
+ return 0;
+}
+
+static void rk1608_hw_init(struct spi_device *spi)
+{
+ s32 write_data = SPI0_PLL_SEL_APLL;
+
+ /* modify rk1608 spi slave clk to 300M */
+ rk1608_safe_write(spi, CRUPMU_CLKSEL14_CON, &write_data, 4);
+
+ /* modify rk1608 spi io driver strength to 8mA */
+ write_data = BIT7_6_SEL_8MA;
+ rk1608_safe_write(spi, PMUGRF_GPIO1A_E, &write_data, 4);
+ write_data = BIT1_0_SEL_8MA;
+ rk1608_safe_write(spi, PMUGRF_GPIO1B_E, &write_data, 4);
+}
+
+/**
+ * rk1608_read - RK1608 synchronous read
+ *
+ * @spi: spi device
+ * @addr: resource address
+ * @data: data buffer [out]
+ * @data_len: data buffer size, in bytes
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_read(struct spi_device *spi,
+ s32 addr, s32 *data, size_t data_len)
+{
+ s32 real_len = MIN(data_len, RK1608_MAX_OP_BYTES);
+ s32 read_cmd = RK1608_CMD_READ | (real_len << 14 &
+ RK1608_STATE_ID_MASK);
+ s32 read_begin_cmd = RK1608_CMD_READ_BEGIN;
+ s32 dummy = 0;
+ struct spi_transfer read_cmd_packet = {
+ .tx_buf = &read_cmd,
+ .len = sizeof(read_cmd),
+ };
+ struct spi_transfer addr_packet = {
+ .tx_buf = &addr,
+ .len = sizeof(addr),
+ };
+ struct spi_transfer read_dummy_packet = {
+ .tx_buf = &dummy,
+ .len = sizeof(dummy),
+ };
+ struct spi_transfer read_begin_cmd_packet = {
+ .tx_buf = &read_begin_cmd,
+ .len = sizeof(read_begin_cmd),
+ };
+ struct spi_transfer data_packet = {
+ .rx_buf = data,
+ .len = data_len,
+ };
+ struct spi_message m;
+
+ spi_message_init(&m);
+ spi_message_add_tail(&read_cmd_packet, &m);
+ spi_message_add_tail(&addr_packet, &m);
+ spi_message_add_tail(&read_dummy_packet, &m);
+ spi_message_add_tail(&read_begin_cmd_packet, &m);
+ spi_message_add_tail(&data_packet, &m);
+ return spi_sync(spi, &m);
+}
+
+/**
+ * rk1608_safe_read - RK1608 synchronous read with state check
+ *
+ * @spi: spi device
+ * @addr: resource address
+ * @data: data buffer [out]
+ * @data_len: data buffer size, in bytes
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_safe_read(struct spi_device *spi,
+ s32 addr, s32 *data, size_t data_len)
+{
+ s32 state = 0;
+ s32 retry = 0;
+
+ do {
+ rk1608_read(spi, addr, data, data_len);
+ if (rk1608_operation_query(spi, &state) != 0)
+ return -EPERM;
+ if ((state & RK1608_STATE_MASK) == 0)
+ break;
+ udelay(RK1608_OP_TRY_DELAY);
+ } while (retry++ != RK1608_OP_TRY_MAX);
+
+ return -(state & RK1608_STATE_MASK);
+}
+
+static int rk1608_read_wait(struct spi_device *spi,
+ const struct rk1608_section *sec)
+{
+ s32 value = 0;
+ int retry = 0;
+ int ret = 0;
+
+ do {
+ ret = rk1608_safe_read(spi, sec->wait_addr, &value, 4);
+ if (!ret && value == sec->wait_value)
+ break;
+
+ if (retry++ == sec->timeout) {
+ ret = -EPERM;
+ dev_err(&spi->dev, "Read 0x%x is %x != %x timeout\n",
+ sec->wait_addr, value, sec->wait_value);
+ break;
+ }
+ mdelay(sec->wait_time);
+ } while (1);
+
+ return ret;
+}
+
+static int rk1608_boot_request(struct spi_device *spi,
+ const struct rk1608_section *sec)
+{
+ struct rk1608_boot_req boot_req;
+ int retry = 0;
+ int ret = 0;
+
+ /*send boot request to rk1608 for ddr init*/
+ boot_req.flag = sec->flag;
+ boot_req.load_addr = sec->load_addr;
+ boot_req.boot_len = sec->size;
+ boot_req.status = 1;
+ boot_req.cmd = 2;
+
+ ret = rk1608_safe_write(spi, BOOT_REQUEST_ADDR,
+ (s32 *)&boot_req, sizeof(boot_req));
+ if (ret)
+ return ret;
+
+ if (sec->flag & BOOT_FLAG_READ_WAIT) {
+ /*waitting for rk1608 init ddr done*/
+ do {
+ ret = rk1608_safe_read(spi, BOOT_REQUEST_ADDR,
+ (s32 *)&boot_req,
+ sizeof(boot_req));
+
+ if (!ret && boot_req.status == 0)
+ break;
+
+ if (retry++ == sec->timeout) {
+ ret = -EPERM;
+ dev_err(&spi->dev, "Boot request timeout\n");
+ break;
+ }
+ mdelay(sec->wait_time);
+ } while (1);
+ }
+
+ return ret;
+}
+
+static int rk1608_download_section(struct spi_device *spi, const u8 *data,
+ const struct rk1608_section *sec)
+{
+ int ret = 0;
+
+ dev_info(&spi->dev, "offset:%x,size:%x,addr:%x,wait_time:%x",
+ sec->offset, sec->size, sec->load_addr, sec->wait_time);
+ dev_info(&spi->dev, "timeout:%x,crc:%x,flag:%x,type:%x",
+ sec->timeout, sec->crc_16, sec->flag, sec->type);
+
+ if (sec->size > 0) {
+ ret = rk1608_safe_write(spi, sec->load_addr,
+ (s32 *)(data + sec->offset),
+ sec->size);
+ if (ret) {
+ dev_err(&spi->dev, "RK1608 safe write err =%d\n", ret);
+ return ret;
+ }
+ }
+
+ if (sec->flag & BOOT_FLAG_BOOT_REQUEST)
+ ret = rk1608_boot_request(spi, sec);
+ else if (sec->flag & BOOT_FLAG_READ_WAIT)
+ ret = rk1608_read_wait(spi, sec);
+
+ return ret;
+}
+
+/**
+ * rk1608_download_fw: - rk1608 firmware download through spi
+ *
+ * @spi: spi device
+ * @fw_name: name of firmware file, NULL for default firmware name
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ **/
+static int rk1608_download_fw(struct spi_device *spi, const char *fw_name)
+{
+ const struct rk1608_header *head;
+ const struct firmware *fw;
+ int i = 0;
+ int ret = 0;
+
+ if (!fw_name)
+ fw_name = RK1608_FW_NAME;
+
+ dev_info(&spi->dev, "Before request firmware");
+ ret = request_firmware(&fw, fw_name, &spi->dev);
+ if (ret) {
+ dev_err(&spi->dev, "Request firmware %s failed!", fw_name);
+ return ret;
+ }
+
+ head = (const struct rk1608_header *)fw->data;
+
+ dev_info(&spi->dev, "Request firmware %s (version:%s) success!",
+ fw_name, head->version);
+
+ for (i = 0; i < head->section_count; i++) {
+ ret = rk1608_download_section(spi, fw->data,
+ &head->sections[i]);
+ if (ret)
+ break;
+ }
+
+ release_firmware(fw);
+ return ret;
+}
+
+static int rk1608_lsb_w32(struct spi_device *spi, s32 addr, s32 data)
+{
+ s32 write_cmd = RK1608_CMD_WRITE;
+ struct spi_transfer write_cmd_packet = {
+ .tx_buf = &write_cmd,
+ .len = sizeof(write_cmd),
+ };
+ struct spi_transfer addr_packet = {
+ .tx_buf = &addr,
+ .len = sizeof(addr),
+ };
+ struct spi_transfer data_packet = {
+ .tx_buf = &data,
+ .len = sizeof(data),
+ };
+ struct spi_message m;
+
+ write_cmd = MSB2LSB32(write_cmd);
+ addr = MSB2LSB32(addr);
+ data = MSB2LSB32(data);
+ spi_message_init(&m);
+ spi_message_add_tail(&write_cmd_packet, &m);
+ spi_message_add_tail(&addr_packet, &m);
+ spi_message_add_tail(&data_packet, &m);
+ return spi_sync(spi, &m);
+}
+
+static int rk1608_msg_init_sensor(struct rk1608_state *pdata,
+ struct msg_init *msg, int id)
+{
+ msg->msg_head.size = sizeof(struct msg_init);
+ msg->msg_head.type = id_msg_init_sensor_t;
+ msg->msg_head.id.camera_id = pdata->cd[id]->ci.cam_id;
+ msg->msg_head.mux.sync = 1;
+ msg->in_mipi_phy = pdata->cd[id]->ci.in_mipi;
+ msg->out_mipi_phy = pdata->cd[id]->ci.out_mipi;
+ msg->mipi_lane = pdata->cd[id]->ci.mipi_lane;
+ msg->bayer = 0;
+ memcpy(msg->sensor_name, pdata->cd[id]->sd.name,
+ sizeof(msg->sensor_name));
+ msg->i2c_slave_addr = (pdata->cd[id]->client->addr) << 1;
+ msg->i2c_bus = pdata->cd[id]->ci.i2c_bus;
+
+ return rk1608_send_msg_to_dsp(pdata, &msg->msg_head);
+}
+
+static int rk1608_msg_set_input_size(struct rk1608_state *pdata,
+ struct msg_in_size *msg, int id)
+{
+ msg->msg_head.size = sizeof(struct msg_in_size) / sizeof(int);
+ msg->msg_head.type = id_msg_set_input_size_t;
+ msg->msg_head.id.camera_id = pdata->cd[id]->ci.cam_id;
+ msg->msg_head.mux.sync = 1;
+ msg->data_type = pdata->cd[id]->ci.data_type;
+ msg->decode_format = pdata->cd[id]->ci.data_type;
+ msg->width = pdata->cd[id]->ci.width;
+ msg->height = pdata->cd[id]->ci.height;
+ msg->flag = 1;
+
+ return rk1608_send_msg_to_dsp(pdata, &msg->msg_head);
+}
+
+static int rk1608_msg_set_output_size(struct rk1608_state *pdata,
+ struct msg_out_size *msg, int id)
+{
+ msg->msg_head.size = sizeof(struct msg_out_size);
+ msg->msg_head.type = id_msg_set_output_size_t;
+ msg->msg_head.id.camera_id = pdata->cd[id]->ci.cam_id;
+ msg->msg_head.mux.sync = 1;
+ msg->width = pdata->cd[id]->ci.width;
+ msg->height = pdata->cd[id]->ci.height;
+ msg->mipi_clk = pdata->cd[id]->ci.mipi_clock;
+ msg->line_length_pclk = pdata->cd[id]->ci.htotal;
+ msg->frame_length_lines = pdata->cd[id]->ci.vtotal;
+
+ return rk1608_send_msg_to_dsp(pdata, &msg->msg_head);
+}
+
+static int rk1608_msg_set_stream_in_on(struct rk1608_state *pdata,
+ struct msg *msg, int id)
+{
+ msg->size = sizeof(struct msg);
+ msg->type = id_msg_set_stream_in_on_t;
+ msg->id.camera_id = pdata->cd[id]->ci.cam_id;
+ msg->mux.sync = 1;
+
+ return rk1608_send_msg_to_dsp(pdata, msg);
+}
+
+static int rk1608_msg_set_stream_in_off(struct rk1608_state *pdata,
+ struct msg *msg, int id)
+{
+ msg->size = sizeof(struct msg);
+ msg->type = id_msg_set_stream_in_off_t;
+ msg->id.camera_id = pdata->cd[id]->ci.cam_id;
+ msg->mux.sync = 1;
+
+ return rk1608_send_msg_to_dsp(pdata, msg);
+}
+
+static int rk1608_msg_set_stream_out_on(struct rk1608_state *pdata,
+ struct msg *msg, int id)
+{
+ msg->size = sizeof(struct msg);
+ msg->type = id_msg_set_stream_out_on_t;
+ msg->id.camera_id = pdata->cd[id]->ci.cam_id;
+ msg->mux.sync = 1;
+
+ return rk1608_send_msg_to_dsp(pdata, msg);
+}
+
+static int rk1608_msg_set_stream_out_off(struct rk1608_state *pdata,
+ struct msg *msg, int id)
+{
+ msg->size = sizeof(struct msg);
+ msg->type = id_msg_set_stream_out_off_t;
+ msg->id.camera_id = pdata->cd[id]->ci.cam_id;
+ msg->mux.sync = 1;
+
+ return rk1608_send_msg_to_dsp(pdata, msg);
+}
+
+static int rk1608_set_log_level(struct rk1608_state *pdata,
+ struct msg *msg, int level)
+{
+ msg->size = sizeof(struct msg);
+ msg->type = id_msg_set_log_level_t;
+ msg->mux.log_level = level;
+
+ return rk1608_send_msg_to_dsp(pdata, msg);
+}
+
+static int rk1608_init_sensor(struct rk1608_state *pdata, int id)
+{
+ struct msg *msg;
+ struct msg_init *msg_init;
+ struct msg_in_size *msg_in_size;
+ struct msg_out_size *msg_out_size;
+ int ret;
+
+ if (!pdata->cd[id]) {
+ dev_err(pdata->dev, "Did not find a sensor[%d]!\n", id);
+ return -EINVAL;
+ }
+
+ msg = kzalloc(sizeof(*msg), GFP_KERNEL);
+ if (!msg)
+ return -ENOMEM;
+ msg_init = kzalloc(sizeof(*msg_init), GFP_KERNEL);
+ if (!msg_init)
+ return -ENOMEM;
+ msg_in_size = kzalloc(sizeof(*msg_in_size), GFP_KERNEL);
+ if (!msg_in_size)
+ return -ENOMEM;
+ msg_out_size = kzalloc(sizeof(*msg_out_size), GFP_KERNEL);
+ if (!msg_out_size)
+ return -ENOMEM;
+
+ ret = rk1608_msg_init_sensor(pdata, msg_init, id);
+ ret |= rk1608_msg_set_input_size(pdata, msg_in_size, id);
+ ret |= rk1608_msg_set_output_size(pdata, msg_out_size, id);
+ ret |= rk1608_msg_set_stream_in_on(pdata, msg, id);
+ ret |= rk1608_msg_set_stream_out_on(pdata, msg, id);
+
+ kfree(msg_init);
+ kfree(msg_in_size);
+ kfree(msg_out_size);
+ kfree(msg);
+ return ret;
+}
+
+static int rk1608_deinit(struct rk1608_state *pdata, int id)
+{
+ struct msg *msg;
+ int ret;
+
+ msg = kzalloc(sizeof(*msg), GFP_KERNEL);
+ if (!msg)
+ return -ENOMEM;
+ ret = rk1608_msg_set_stream_out_off(pdata, msg, id);
+ ret |= rk1608_msg_set_stream_in_off(pdata, msg, id);
+ kfree(msg);
+
+ return ret;
+}
+
+void rk1608_cs_set_value(struct rk1608_state *pdata, int value)
+{
+ s8 null_cmd = 0;
+ struct spi_transfer null_cmd_packet = {
+ .tx_buf = &null_cmd,
+ .len = sizeof(null_cmd),
+ .cs_change = !value,
+ };
+ struct spi_message m;
+
+ spi_message_init(&m);
+ spi_message_add_tail(&null_cmd_packet, &m);
+ spi_sync(pdata->spi, &m);
+}
+
+static void rk1608_set_spi_speed(struct rk1608_state *pdata, u32 hz)
+{
+ pdata->spi->max_speed_hz = hz;
+}
+
+static int rk1608_clk_set(struct rk1608_state *pdata, int on)
+{
+ if (on) {
+ clk_prepare_enable(pdata->clks.pd_cif);
+ clk_prepare_enable(pdata->clks.aclk_cif);
+ clk_prepare_enable(pdata->clks.hclk_cif);
+ clk_prepare_enable(pdata->clks.cif_clk_in);
+ clk_prepare_enable(pdata->clks.cif_clk_out);
+ clk_prepare_enable(pdata->clks.clk_mipi_24m);
+ clk_prepare_enable(pdata->clks.hclk_mipiphy);
+ clk_set_rate(pdata->clks.cif_clk_out, RK1608_MCLK_RATE);
+ clk_prepare_enable(pdata->clks.mipi_clk);
+ clk_set_rate(pdata->clks.mipi_clk, RK1608_MCLK_RATE);
+ clk_prepare_enable(pdata->clks.mclk);
+ clk_set_rate(pdata->clks.mclk, RK1608_MCLK_RATE);
+ } else if (!on) {
+ clk_disable_unprepare(pdata->clks.pd_cif);
+ clk_disable_unprepare(pdata->clks.aclk_cif);
+ clk_disable_unprepare(pdata->clks.hclk_cif);
+ clk_disable_unprepare(pdata->clks.cif_clk_in);
+ clk_disable_unprepare(pdata->clks.cif_clk_out);
+ clk_disable_unprepare(pdata->clks.clk_mipi_24m);
+ clk_disable_unprepare(pdata->clks.hclk_mipiphy);
+ clk_disable_unprepare(pdata->clks.mipi_clk);
+ clk_disable_unprepare(pdata->clks.mclk);
+ }
+ return 0;
+}
+
+static int rk1608_sensor_power(struct v4l2_subdev *sd, int on)
+{
+ int ret = 0;
+ struct msg *msg = NULL;
+ struct rk1608_state *pdata = to_state(sd);
+ struct spi_device *spi = pdata->spi;
+
+ mutex_lock(&pdata->lock);
+ rk1608_clk_set(pdata, on);
+ /* Start Sensor power on/off */
+ if (pdata->cd[0])
+ v4l2_subdev_call(&pdata->cd[0]->sd, core, s_power, on);
+ if (pdata->cd[1])
+ v4l2_subdev_call(&pdata->cd[1]->sd, core, s_power, on);
+
+ if (on && !pdata->power_count) {
+ /* Request rk1608 enter slave mode */
+ rk1608_cs_set_value(pdata, 0);
+ gpiod_set_value(pdata->gpios.pdown, 1);
+ gpiod_set_value(pdata->gpios.wakeup, 1);
+ gpiod_set_value(pdata->gpios.reset, 1);
+ gpiod_set_value(pdata->gpios.reset, 0);
+ gpiod_set_value(pdata->gpios.reset, 1);
+ /* After Reset pull-up, CSn should keep low for 2ms+ */
+ mdelay(3);
+ rk1608_cs_set_value(pdata, 1);
+ rk1608_lsb_w32(spi, SPI_ENR, 0);
+ rk1608_lsb_w32(spi, SPI_CTRL0,
+ OPM_SLAVE_MODE | RSD_SEL_2CYC | DFS_SEL_16BIT);
+ rk1608_hw_init(pdata->spi);
+ rk1608_set_spi_speed(pdata, pdata->max_speed_hz);
+
+ /* Download system firmware */
+ ret = rk1608_download_fw(pdata->spi, NULL);
+
+ if (ret)
+ dev_err(pdata->dev, "Download firmware failed!");
+ else
+ dev_info(pdata->dev, "Download firmware success!");
+
+ enable_irq(pdata->irq);
+ if (pdata->sleepst_irq > 0)
+ enable_irq(pdata->sleepst_irq);
+ msg = kzalloc(sizeof(*msg), GFP_KERNEL);
+ if (!msg)
+ return -ENOMEM;
+ ret = rk1608_set_log_level(pdata, msg, 2);
+ } else if (!on && pdata->power_count == 1) {
+ kfree(msg);
+ disable_irq(pdata->irq);
+ disable_irq(pdata->sleepst_irq);
+ gpiod_set_value(pdata->gpios.pdown, 0);
+ gpiod_set_value(pdata->gpios.wakeup, 0);
+ gpiod_set_value(pdata->gpios.reset, 0);
+ rk1608_cs_set_value(pdata, 0);
+ }
+ /* Update the power count. */
+ pdata->power_count += on ? 1 : -1;
+ WARN_ON(pdata->power_count < 0);
+ mutex_unlock(&pdata->lock);
+ return ret;
+}
+
+static int rk1608_stream_on(struct rk1608_state *pdata)
+{
+ int id = 0, cnt = 0, ret = 0;
+
+ for (id = 0; id < pdata->sensor_nums; id++) {
+ ret = rk1608_init_sensor(pdata, id);
+ if (ret)
+ dev_err(pdata->dev, "Init sensor[%d] is failed!", id);
+ }
+ /* Waiting for the sensor to be ready */
+ while (pdata->sensor_cnt < pdata->sensor_nums) {
+ /* TIMEOUT 10s break*/
+ if (cnt++ > SENSOR_TIMEOUT) {
+ dev_err(pdata->dev, "Sensor%d is ready to timeout!",
+ pdata->sensor_cnt);
+ break;
+ }
+ mdelay(10);
+ }
+
+ if (pdata->sensor_nums) {
+ if (pdata->sensor_cnt == pdata->sensor_nums)
+ dev_info(pdata->dev, "Sensor(num %d) is ready!",
+ pdata->sensor_cnt);
+ } else {
+ dev_warn(pdata->dev, "No sensor is found!");
+ }
+
+ return 0;
+}
+
+static int rk1608_stream_off(struct rk1608_state *pdata)
+{
+ mutex_lock(&pdata->sensor_lock);
+ pdata->sensor_cnt = 0;
+ mutex_unlock(&pdata->sensor_lock);
+ if (pdata->cd[0])
+ rk1608_deinit(pdata, 0);
+ if (pdata->cd[1])
+ rk1608_deinit(pdata, 1);
+ return 0;
+}
+
+static int rk1608_s_stream(struct v4l2_subdev *sd, int enable)
+{
+ int ret;
+ struct rk1608_state *pdata = to_state(sd);
+
+ if (enable)
+ ret = rk1608_stream_on(pdata);
+ else
+ ret = rk1608_stream_off(pdata);
+
+ if (pdata->cd[0])
+ v4l2_subdev_call(&pdata->cd[0]->sd, video, s_stream, enable);
+ if (pdata->cd[1])
+ v4l2_subdev_call(&pdata->cd[1]->sd, video, s_stream, enable);
+ return ret;
+}
+
+static int rk1608_enum_mbus_code(struct v4l2_subdev *sd,
+ struct v4l2_subdev_pad_config *cfg,
+ struct v4l2_subdev_mbus_code_enum *code)
+{
+ struct rk1608_state *pdata = to_state(sd);
+ struct camera_dev *cd = pdata->cd[0];
+
+ if (code->index > 0)
+ return -EINVAL;
+
+ code->code = cd->ci.code;
+
+ return 0;
+}
+
+static int rk1608_get_fmt(struct v4l2_subdev *sd,
+ struct v4l2_subdev_pad_config *cfg,
+ struct v4l2_subdev_format *fmt)
+{
+ struct v4l2_mbus_framefmt *mf = &fmt->format;
+ struct rk1608_state *pdata = to_state(sd);
+ struct camera_dev *cd = pdata->cd[0];
+
+ if (cd) {
+ mf->code = cd->ci.code;
+ mf->width = cd->ci.width;
+ mf->height = cd->ci.height;
+ mf->field = cd->ci.field;
+ mf->colorspace = cd->ci.colorspace;
+ }
+
+ return 0;
+}
+
+static const struct v4l2_subdev_internal_ops rk1608_subdev_internal_ops = {
+ .open = NULL,
+};
+
+static const struct v4l2_subdev_video_ops rk1608_subdev_video_ops = {
+ .s_stream = rk1608_s_stream,
+};
+
+static const struct v4l2_subdev_pad_ops rk1608_subdev_pad_ops = {
+ .enum_mbus_code = rk1608_enum_mbus_code,
+ .get_fmt = rk1608_get_fmt,
+};
+
+static const struct v4l2_subdev_core_ops rk1608_core_ops = {
+ .s_power = rk1608_sensor_power,
+};
+
+static const struct v4l2_subdev_ops rk1608_subdev_ops = {
+ .core = &rk1608_core_ops,
+ .video = &rk1608_subdev_video_ops,
+ .pad = &rk1608_subdev_pad_ops,
+};
+
+/**
+ * rk1608_msq_read_head - read rk1608 msg queue head
+ *
+ * @spi: spi device
+ * @addr: msg queue head addr
+ * @m: msg queue pointer
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_msq_read_head(struct spi_device *spi,
+ u32 addr, struct rk1608_msg_queue *q)
+{
+ int err = 0;
+ s32 reg;
+
+ err = rk1608_safe_read(spi, RK1608_PMU_SYS_REG0, &reg, 4);
+
+ if (err || ((reg & RK1608_MSG_QUEUE_OK_MASK) !=
+ RK1608_MSG_QUEUE_OK_TAG))
+ return -EINVAL;
+
+ err = rk1608_safe_read(spi, addr, (s32 *)q, sizeof(*q));
+
+ return err;
+}
+
+/**
+ * rk1608_msq_recv_msg - receive a msg from RK1608 -> AP msg queue
+ *
+ * @q: msg queue
+ * @m: a msg pointer buf [out]
+ *
+ * need call rk1608_msq_recv_msg_free to free msg after msg use done
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_msq_recv_msg(struct spi_device *spi, struct msg **m)
+{
+ struct rk1608_msg_queue queue;
+ struct rk1608_msg_queue *q = &queue;
+ u32 size = 0, msg_size = 0;
+ u32 recv_addr = 0;
+ u32 next_recv_addr = 0;
+ int err = 0;
+
+ *m = NULL;
+ err = rk1608_msq_read_head(spi, RK1608_S_MSG_QUEUE_ADDR, q);
+ if (err)
+ return err;
+
+ if (q->cur_send == q->cur_recv)
+ return -EINVAL;
+ /* Skip to head when size is 0 */
+ err = rk1608_safe_read(spi, (s32)q->cur_recv, (s32 *)&size, 4);
+ if (err)
+ return err;
+ if (size == 0) {
+ err = rk1608_safe_read(spi, (s32)q->buf_head, (s32 *)&size, 4);
+ if (err)
+ return err;
+
+ msg_size = size * sizeof(u32);
+ recv_addr = q->buf_head;
+ next_recv_addr = q->buf_head + msg_size;
+ } else {
+ msg_size = size * sizeof(u32);
+ recv_addr = q->cur_recv;
+ next_recv_addr = q->cur_recv + msg_size;
+ if (next_recv_addr == q->buf_tail)
+ next_recv_addr = q->buf_head;
+ }
+
+ if (msg_size > (q->buf_tail - q->buf_head))
+ return -EPERM;
+
+ *m = kmalloc(msg_size, GFP_KERNEL);
+ err = rk1608_safe_read(spi, recv_addr, (s32 *)*m, msg_size);
+ if (err == 0) {
+ err = rk1608_safe_write(spi, RK1608_S_MSG_QUEUE_ADDR +
+ (u8 *)&q->cur_recv - (u8 *)q,
+ &next_recv_addr, 4);
+ }
+ if (err)
+ kfree(*m);
+
+ return err;
+}
+
+/**
+ * rk1608_msq_tail_free_size - get msg queue tail unused buf size
+ *
+ * @q: msg queue
+ *
+ * It returns size of msg queue tail unused buf size, unit byte
+ */
+u32 rk1608_msq_tail_free_size(const struct rk1608_msg_queue *q)
+{
+ if (q->cur_send >= q->cur_recv)
+ return (q->buf_tail - q->cur_send);
+
+ return q->cur_recv - q->cur_send;
+}
+
+/**
+ * rk1608_interrupt_request - RK1608 request a dsp interrupt
+ *
+ * @spi: spi device
+ * @interrupt_num: interrupt identification
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_interrupt_request(struct spi_device *spi,
+ s32 interrupt_num)
+{
+ s32 write_reg1_cmd = APB_CMD_WRITE_REG1;
+ struct spi_transfer write_reg1_cmd_packet = {
+ .tx_buf = &write_reg1_cmd,
+ .len = sizeof(write_reg1_cmd),
+ };
+ struct spi_transfer reg1_packet = {
+ .tx_buf = &interrupt_num,
+ .len = sizeof(interrupt_num),
+ };
+ struct spi_message m;
+
+ spi_message_init(&m);
+ spi_message_add_tail(&write_reg1_cmd_packet, &m);
+ spi_message_add_tail(&reg1_packet, &m);
+ return spi_sync(spi, &m);
+}
+
+/**
+ * dsp_msq_head_free_size - get msg queue head unused buf size
+ *
+ * @q: msg queue
+ *
+ * It returns size of msg queue head unused buf size, unit byte
+ */
+static u32 rk1608_msq_head_free_size(const struct rk1608_msg_queue *q)
+{
+ if (q->cur_send >= q->cur_recv)
+ return (q->cur_recv - q->buf_head);
+
+ return 0;
+}
+
+/**
+ * rk1608_msq_send_msg - send a msg to Soc -> DSP msg queue
+ *
+ * @spi: spi device
+ * @m: a msg to send
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_msq_send_msg(struct spi_device *spi, struct msg *m)
+{
+ int err = 0;
+ struct rk1608_msg_queue queue;
+ struct rk1608_msg_queue *q = &queue;
+ u32 msg_size = m->size * sizeof(u32);
+
+ err = rk1608_msq_read_head(spi, RK1608_R_MSG_QUEUE_ADDR, q);
+ if (err)
+ return err;
+
+ if (rk1608_msq_tail_free_size(q) > msg_size) {
+ u32 next_send;
+
+ err = rk1608_safe_write(spi, q->cur_send, (s32 *)m, msg_size);
+ next_send = q->cur_send + msg_size;
+ if (next_send == q->buf_tail)
+ next_send = q->buf_head;
+ q->cur_send = next_send;
+ } else if (rk1608_msq_head_free_size(q) > msg_size) {
+ /* Set size to 0 for skip to head mark */
+ err = rk1608_safe_write(spi, q->cur_send, (s32 *)NULL, 4);
+ if (err)
+ return err;
+ err = rk1608_safe_write(spi, q->buf_head, (s32 *)m, msg_size);
+ q->cur_send = q->buf_head + msg_size;
+ } else {
+ return -EPERM;
+ }
+
+ if (err)
+ return err;
+
+ err = rk1608_safe_write(spi, RK1608_R_MSG_QUEUE_ADDR +
+ (u8 *)&q->cur_send - (u8 *)q, &q->cur_send, 4);
+ rk1608_interrupt_request(spi, RK1608_IRQ_TYPE_MSG);
+ return err;
+}
+
+static int rk1608_send_msg_to_dsp(struct rk1608_state *pdata, struct msg *m)
+{
+ int ret = 0, msg_num = 0, timeout = 0, readval = 0;
+
+ /* For msg sync */
+ if (pdata->msg_num >= 8) {
+ dev_err(pdata->dev, "MSG sync queue full\n!");
+ ret = -EINVAL;
+ } else if (m->mux.sync == 1) {
+ mutex_lock(&pdata->send_msg_lock);
+ msg_num = pdata->msg_num;
+ atomic_set(&pdata->msg_done[pdata->msg_num++], 0);
+ mutex_unlock(&pdata->send_msg_lock);
+ }
+
+ mutex_lock(&pdata->send_msg_lock);
+ ret = rk1608_msq_send_msg(pdata->spi, m);
+ mutex_unlock(&pdata->send_msg_lock);
+
+ /* For msg sync */
+ if (m->mux.sync == 1) {
+ readval = atomic_read(&pdata->msg_done[msg_num]);
+ timeout = wait_event_timeout(pdata->msg_wait, readval,
+ MSG_SYNC_TIMEOUT);
+ if (unlikely(timeout <= 0)) {
+ dev_info(pdata->dev, "MSG wait timeout %d msg_num:%d\n",
+ timeout, pdata->msg_num);
+ mutex_lock(&pdata->send_msg_lock);
+ atomic_set(&pdata->msg_done[msg_num], 0);
+ mutex_unlock(&pdata->send_msg_lock);
+ }
+ }
+
+ return ret;
+}
+
+static void print_rk1608_log(struct rk1608_state *pdata,
+ struct msg *log)
+{
+ char *str = (char *)(log);
+
+ str[log->size * sizeof(s32) - 1] = 0;
+ str += sizeof(struct msg);
+ dev_info(pdata->dev, "RK1608(%d): %s", log->id.core_id, str);
+}
+
+static void dispatch_received_msg(struct rk1608_state *pdata,
+ struct msg *msg)
+{
+ if (msg->type == id_msg_set_stream_out_on_ret_t) {
+ mutex_lock(&pdata->sensor_lock);
+ pdata->sensor_cnt++;
+ mutex_unlock(&pdata->sensor_lock);
+ }
+
+ if (msg->type == id_msg_rk1608_log_t)
+ print_rk1608_log(pdata, msg);
+}
+
+static irqreturn_t rk1608_threaded_isr(int irq, void *dev_id)
+{
+ struct rk1608_state *pdata = dev_id;
+ struct msg *msg;
+
+ WARN_ON(irq != pdata->irq);
+ while (!rk1608_msq_recv_msg(pdata->spi, &msg) && NULL != msg) {
+ dispatch_received_msg(pdata, msg);
+ /* For kernel msg sync */
+ if (pdata->msg_num != 0 && msg->mux.sync) {
+ dev_info(pdata->dev, "RK1608 kernel sync\n");
+ mutex_lock(&pdata->send_msg_lock);
+ pdata->msg_num--;
+ atomic_set(&pdata->msg_done[pdata->msg_num], 1);
+ mutex_unlock(&pdata->send_msg_lock);
+ wake_up(&pdata->msg_wait);
+ }
+ kfree(msg);
+ }
+
+ return IRQ_HANDLED;
+}
+
+static irqreturn_t rk1608_sleep_isr(int irq, void *dev_id)
+{
+ struct rk1608_state *pdata = dev_id;
+
+ WARN_ON(irq != pdata->sleepst_irq);
+ gpiod_set_value(pdata->gpios.pdown, 0);
+
+ return IRQ_HANDLED;
+}
+
+static int rk1608_parse_dt_property(struct rk1608_state *pdata)
+{
+ int ret = 0;
+ int i;
+ struct device *dev = pdata->dev;
+ struct device_node *node = dev->of_node;
+
+ if (!node)
+ return -EPERM;
+
+ ret = of_property_read_u32(node, "spi-max-frequency",
+ &pdata->max_speed_hz);
+ if (ret) {
+ dev_warn(dev, "Can not get spi-max-frequency!");
+ pdata->max_speed_hz = RK1608_MCLK_RATE;
+ }
+ ret = of_property_read_u64(node, "link-freqs",
+ &pdata->link_freqs);
+ if (ret)
+ dev_warn(dev, "Can not get link_freqs!");
+
+ pdata->clks.mclk = devm_clk_get(dev, "mclk");
+ if (IS_ERR(pdata->clks.mclk)) {
+ dev_err(dev, "Can not get mclk, error %ld\n",
+ PTR_ERR(pdata->clks.mclk));
+ pdata->clks.mclk = NULL;
+ }
+ pdata->clks.mipi_clk = devm_clk_get(dev, "mipi_clk");
+ if (IS_ERR(pdata->clks.mipi_clk)) {
+ dev_err(dev, "Can not get mipi_clk, error %ld\n",
+ PTR_ERR(pdata->clks.mipi_clk));
+ pdata->clks.mipi_clk = NULL;
+ }
+
+ pdata->clks.pd_cif = devm_clk_get(dev, "pd_cif");
+ if (IS_ERR(pdata->clks.pd_cif)) {
+ dev_err(dev, "Can not get pd_cif, error %ld\n",
+ PTR_ERR(pdata->clks.pd_cif));
+ pdata->clks.pd_cif = NULL;
+ }
+ pdata->clks.aclk_cif = devm_clk_get(dev, "aclk_cif");
+ if (IS_ERR(pdata->clks.aclk_cif)) {
+ dev_err(dev, "Can not get aclk_cif, error %ld\n",
+ PTR_ERR(pdata->clks.aclk_cif));
+ pdata->clks.aclk_cif = NULL;
+ }
+ pdata->clks.hclk_cif = devm_clk_get(dev, "hclk_cif");
+ if (IS_ERR(pdata->clks.hclk_cif)) {
+ dev_warn(dev, "Can not get hclk_cif, error %ld\n",
+ PTR_ERR(pdata->clks.hclk_cif));
+ pdata->clks.hclk_cif = NULL;
+ }
+ pdata->clks.cif_clk_in = devm_clk_get(dev, "cif0_in");
+ if (IS_ERR(pdata->clks.cif_clk_in)) {
+ dev_err(dev, "Can not get cif_clk_in, error %ld\n",
+ PTR_ERR(pdata->clks.cif_clk_in));
+ pdata->clks.cif_clk_in = NULL;
+ }
+ pdata->clks.cif_clk_out = devm_clk_get(dev, "cif0_out");
+ if (IS_ERR(pdata->clks.cif_clk_out)) {
+ dev_err(dev, "Can not get cif_clk_out, error %ld\n",
+ PTR_ERR(pdata->clks.cif_clk_out));
+ pdata->clks.cif_clk_out = NULL;
+ }
+ pdata->clks.clk_mipi_24m = devm_clk_get(dev, "clk_mipi_24m");
+ if (IS_ERR(pdata->clks.clk_mipi_24m)) {
+ dev_err(dev, "Can not get clk_mipi_24m, error %ld\n",
+ PTR_ERR(pdata->clks.clk_mipi_24m));
+ pdata->clks.clk_mipi_24m = NULL;
+ }
+ pdata->clks.hclk_mipiphy = devm_clk_get(dev, "hclk_mipiphy");
+ if (IS_ERR(pdata->clks.hclk_mipiphy)) {
+ dev_err(dev, "Can not get hclk_mipiphy, error %ld\n",
+ PTR_ERR(pdata->clks.hclk_mipiphy));
+ pdata->clks.hclk_mipiphy = NULL;
+ }
+
+ pdata->gpios.reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_LOW);
+ if (IS_ERR(pdata->gpios.reset)) {
+ dev_err(dev, "Could not get reset gpio\n");
+ return PTR_ERR(pdata->gpios.reset);
+ }
+
+ pdata->gpios.pdown = devm_gpiod_get(dev, "powerdown", GPIOD_OUT_LOW);
+ if (IS_ERR(pdata->gpios.pdown)) {
+ dev_err(dev, "Could not get powerdown gpio\n");
+ return PTR_ERR(pdata->gpios.pdown);
+ }
+
+ pdata->gpios.wakeup = devm_gpiod_get(dev, "wakeup", GPIOD_OUT_LOW);
+ if (IS_ERR(pdata->gpios.wakeup)) {
+ dev_err(dev, "Could not get wakeup gpio\n");
+ return PTR_ERR(pdata->gpios.wakeup);
+ }
+
+ pdata->gpios.irq = devm_gpiod_get(dev, "irq", GPIOD_IN);
+ if (IS_ERR(pdata->gpios.irq)) {
+ dev_err(dev, "Could not get irq gpio\n");
+ return PTR_ERR(pdata->gpios.irq);
+ }
+ ret = gpiod_to_irq(pdata->gpios.irq);
+ if (ret < 0) {
+ dev_err(dev, "Get irq number for GPIO error %d\n", ret);
+ return ret;
+ }
+ pdata->irq = ret;
+ ret = request_threaded_irq(pdata->irq, NULL, rk1608_threaded_isr,
+ IRQF_TRIGGER_RISING | IRQF_ONESHOT,
+ "rk1608-irq", pdata);
+ if (ret) {
+ dev_err(dev, "Cannot request thread irq: %d\n", ret);
+ return ret;
+ }
+
+ disable_irq(pdata->irq);
+
+ pdata->gpios.sleepst = devm_gpiod_get(dev, "sleepst", GPIOD_IN);
+ if (IS_ERR(pdata->gpios.sleepst)) {
+ dev_err(dev, "Could not get powerdown gpio\n");
+ return PTR_ERR(pdata->gpios.sleepst);
+ }
+ ret = gpiod_to_irq(pdata->gpios.sleepst);
+ if (ret < 0) {
+ dev_err(dev, "Get irq number for GPIO error%d\n", ret);
+ return ret;
+ }
+ pdata->sleepst_irq = ret;
+ ret = request_any_context_irq(pdata->sleepst_irq,
+ rk1608_sleep_isr,
+ IRQF_TRIGGER_RISING,
+ "rk1608-sleepst", pdata);
+ disable_irq(pdata->sleepst_irq);
+
+ pdata->msg_num = 0;
+ init_waitqueue_head(&pdata->msg_wait);
+ for (i = 0; i < 8; i++)
+ atomic_set(&pdata->msg_done[i], 0);
+
+ return ret;
+}
+
+static int get_remote_node_dev(struct rk1608_state *pdev)
+{
+ struct i2c_client *sensor_pdev = NULL;
+ struct device *dev = pdev->dev;
+ struct device_node *parent = dev->of_node;
+ struct device_node *node, *pre_node = NULL;
+ struct device_node *remote = NULL;
+ int ret = 0, sensor_nums = 0;
+
+ node = of_graph_get_next_endpoint(parent, pre_node);
+ if (node) {
+ of_node_put(pre_node);
+ pre_node = node;
+ } else {
+ dev_err(dev, "Failed to get endpoint\n");
+ return -EINVAL;
+ }
+ while ((node = of_graph_get_next_endpoint(parent, pre_node)) != NULL) {
+ of_node_put(pre_node);
+ pre_node = node;
+ remote = of_graph_get_remote_port_parent(node);
+ if (!remote) {
+ dev_err(dev, "Invalid Sensor device\n");
+ of_node_put(remote);
+ ret = -EINVAL;
+ }
+
+ sensor_pdev = of_find_i2c_device_by_node(remote);
+ of_node_put(remote);
+
+ if (!sensor_pdev) {
+ dev_err(dev, "Failed to get Sensor device\n");
+ ret = -EINVAL;
+ } else {
+ pdev->cd[sensor_nums] = i2c_get_clientdata(sensor_pdev);
+ if (pdev->cd[sensor_nums])
+ sensor_nums++;
+ else
+ dev_err(dev, "Failed to get Sensor drvdata\n");
+ ret = 0;
+ }
+ }
+ pdev->sensor_nums = sensor_nums;
+ if (pdev->sensor_nums)
+ dev_info(dev, "Get Sensor (nums=%d) dev is OK!\n",
+ pdev->sensor_nums);
+
+ return ret;
+}
+
+static int rk1608_probe(struct spi_device *spi)
+{
+ struct rk1608_state *rk1608;
+ struct v4l2_subdev *sd;
+ struct v4l2_ctrl_handler *handler;
+ int ret = 0;
+
+ rk1608 = devm_kzalloc(&spi->dev, sizeof(*rk1608), GFP_KERNEL);
+ if (!rk1608)
+ return -ENOMEM;
+ rk1608->dev = &spi->dev;
+ rk1608->spi = spi;
+ spi_set_drvdata(spi, rk1608);
+ ret = rk1608_parse_dt_property(rk1608);
+ if (ret) {
+ dev_err(rk1608->dev, "RK1608 parse dt property err(%x)\n", ret);
+ goto parse_err;
+ }
+ ret = get_remote_node_dev(rk1608);
+ if (ret)
+ dev_warn(rk1608->dev, "Get remote node dev err(%x)\n", ret);
+ rk1608->sensor_cnt = 0;
+ mutex_init(&rk1608->sensor_lock);
+ mutex_init(&rk1608->send_msg_lock);
+ mutex_init(&rk1608->lock);
+ sd = &rk1608->sd;
+ v4l2_spi_subdev_init(sd, spi, &rk1608_subdev_ops);
+
+ handler = &rk1608->ctrl_handler;
+ ret = v4l2_ctrl_handler_init(handler, 1);
+ if (ret)
+ goto handler_init_err;
+
+ rk1608->link_freq = v4l2_ctrl_new_int_menu(handler, NULL,
+ V4L2_CID_LINK_FREQ,
+ 0, 0, &rk1608->link_freqs);
+ if (rk1608->link_freq)
+ rk1608->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY;
+
+ if (handler->error)
+ goto handler_err;
+
+ sd->ctrl_handler = handler;
+ sd->internal_ops = &rk1608_subdev_internal_ops;
+ sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
+
+ rk1608->pad.flags = MEDIA_PAD_FL_SOURCE;
+ sd->entity.function = MEDIA_ENT_F_CAM_SENSOR;
+
+ ret = media_entity_pads_init(&sd->entity, 1, &rk1608->pad);
+ if (ret < 0)
+ goto handler_err;
+
+ ret = v4l2_async_register_subdev(sd);
+ if (ret < 0)
+ goto register_err;
+ dev_info(rk1608->dev, "DSP RK1608 Driver probe is OK!\n");
+
+ return 0;
+register_err:
+ media_entity_cleanup(&sd->entity);
+handler_err:
+ v4l2_ctrl_handler_free(handler);
+handler_init_err:
+ mutex_destroy(&rk1608->lock);
+ mutex_destroy(&rk1608->send_msg_lock);
+ mutex_destroy(&rk1608->sensor_lock);
+parse_err:
+ kfree(rk1608);
+ return ret;
+}
+
+static int rk1608_remove(struct spi_device *spi)
+{
+ struct rk1608_state *rk1608 = spi_get_drvdata(spi);
+
+ v4l2_async_unregister_subdev(&rk1608->sd);
+ media_entity_cleanup(&rk1608->sd.entity);
+ v4l2_ctrl_handler_free(&rk1608->ctrl_handler);
+ mutex_destroy(&rk1608->lock);
+ mutex_destroy(&rk1608->send_msg_lock);
+ mutex_destroy(&rk1608->sensor_lock);
+ kfree(rk1608);
+
+ return 0;
+}
+
+static const struct spi_device_id rk1608_id[] = {
+ { "RK1608", 0 },
+ { }
+};
+MODULE_DEVICE_TABLE(spi, rk1608_id);
+
+#if IS_ENABLED(CONFIG_OF)
+static const struct of_device_id rk1608_of_match[] = {
+ { .compatible = "rockchip,rk1608" },
+ { /* sentinel */ },
+};
+MODULE_DEVICE_TABLE(of, rk1608_of_match);
+#endif
+
+static struct spi_driver rk1608_driver = {
+ .driver = {
+ .of_match_table = of_match_ptr(rk1608_of_match),
+ .name = "RK1608",
+ },
+ .probe = rk1608_probe,
+ .remove = rk1608_remove,
+ .id_table = rk1608_id,
+};
+
+module_spi_driver(rk1608_driver);
+
+MODULE_AUTHOR("Rockchip Camera/ISP team");
+MODULE_DESCRIPTION("A DSP driver for rk1608 chip");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/media/spi/rk1608.h b/drivers/media/spi/rk1608.h
new file mode 100644
index 0000000..5cb7d62
--- /dev/null
+++ b/drivers/media/spi/rk1608.h
@@ -0,0 +1,442 @@
+/**
+ * Rockchip rk1608 driver
+ *
+ * SPDX-License-Identifier: GPL-2.0
+ *
+ * Copyright (C) 2017 Rockchip Electronics Co., Ltd.
+ *
+ */
+
+#ifndef __RK1608_H__
+#define __RK1608_H__
+
+#include <linux/i2c.h>
+#include <linux/string.h>
+#include <linux/spi/spi.h>
+#include <linux/types.h>
+
+#define RK1608_OP_TRY_MAX 3
+#define RK1608_OP_TRY_DELAY 10
+#define RK1608_CMD_WRITE 0x00000011
+#define RK1608_CMD_WRITE_REG0 0X00010011
+#define RK1608_CMD_WRITE_REG1 0X00020011
+#define RK1608_CMD_READ 0x00000077
+#define RK1608_CMD_READ_BEGIN 0x000000aa
+#define RK1608_CMD_QUERY 0x000000ff
+#define RK1608_CMD_QUERY_REG2 0x000001ff
+#define RK1608_STATE_ID_MASK 0xffff0000
+#define RK1608_STATE_ID 0X16080000
+#define RK1608_STATE_MASK 0x0000ffff
+#define APB_CMD_WRITE_REG1 0X00020011
+#define RK1608_R_MSG_QUEUE_ADDR 0x60050000
+
+#define RK1608_IRQ_TYPE_MSG 0x12345678
+#define BOOT_REQUEST_ADDR 0x18000010
+#define RK1608_HEAD_ADDR 0x60000000
+#define RK1608_FW_NAME "rk1608.rkl"
+#define RK1608_S_MSG_QUEUE_ADDR 0x60050010
+#define RK1608_PMU_SYS_REG0 0x120000f0
+#define RK1608_MSG_QUEUE_OK_MASK 0xffff0001
+#define RK1608_MSG_QUEUE_OK_TAG 0x16080001
+#define RK1608_MAX_OP_BYTES 60000
+#define MSG_SYNC_TIMEOUT 50
+
+#define BOOT_FLAG_CRC (0x01 << 0)
+#define BOOT_FLAG_EXE (0x01 << 1)
+#define BOOT_FLAG_LOAD_PMEM (0x01 << 2)
+#define BOOT_FLAG_ACK (0x01 << 3)
+#define BOOT_FLAG_READ_WAIT (0x01 << 4)
+#define BOOT_FLAG_BOOT_REQUEST (0x01 << 5)
+
+#define DEBUG_DUMP_ALL_SEND_RECV_MSG 0
+#define RK1608_MCLK_RATE (24 * 1000 * 1000ul)
+#define SENSOR_TIMEOUT 1000
+
+#define OPM_SLAVE_MODE 0X100000
+#define RSD_SEL_2CYC 0X008000
+#define DFS_SEL_16BIT 0X000002
+#define SPI_CTRL0 0x11060000
+#define SPI_ENR 0x11060008
+#define CRUPMU_CLKSEL14_CON 0x12008098
+#define PMUGRF_GPIO1A_E 0x12030040
+#define PMUGRF_GPIO1B_E 0x12030044
+#define BIT7_6_SEL_8MA 0xf000a000
+#define BIT1_0_SEL_8MA 0x000f000a
+#define SPI0_PLL_SEL_APLL 0xff004000
+#define INVALID_ID -1
+#define RK1608_MAX_SEC_NUM 10
+
+#ifndef MIN
+#define MIN(a, b) ((a) < (b) ? (a) : (b))
+#endif
+
+#ifndef MSB2LSB32
+#define MSB2LSB32(x) ((((u32)x & 0x80808080) >> 7) | \
+ (((u32)x & 0x40404040) >> 5) | \
+ (((u32)x & 0x20202020) >> 3) | \
+ (((u32)x & 0x10101010) >> 1) | \
+ (((u32)x & 0x08080808) << 1) | \
+ (((u32)x & 0x04040404) << 3) | \
+ (((u32)x & 0x02020202) << 5) | \
+ (((u32)x & 0x01010101) << 7))
+#endif
+
+struct camera_info {
+ s8 cam_id;
+ s8 in_mipi;
+ s8 out_mipi;
+ s8 mipi_lane;
+ u8 i2c_bus;
+ u8 data_type;
+ u8 field;
+ u8 colorspace;
+ u16 code;
+ u16 width;
+ u16 height;
+ u16 htotal;
+ u16 vtotal;
+ u32 mipi_clock;
+};
+
+struct camera_dev {
+ struct v4l2_subdev sd;
+ struct i2c_client *client;
+ struct mutex lock; /*lock resource*/
+ struct camera_info ci;
+};
+
+struct rk1608_clks {
+ struct clk *mclk;
+ struct clk *mipi_clk;
+ struct clk *pd_cif;
+ struct clk *aclk_cif;
+ struct clk *hclk_cif;
+ struct clk *cif_clk_in;
+ struct clk *cif_clk_out;
+ struct clk *clk_mipi_24m;
+ struct clk *hclk_mipiphy;
+};
+
+struct rk1608_gpios {
+ struct gpio_desc *reset;
+ struct gpio_desc *irq;
+ struct gpio_desc *sleepst;
+ struct gpio_desc *wakeup;
+ struct gpio_desc *pdown;
+};
+
+struct rk1608_state {
+ struct v4l2_subdev sd;
+ struct media_pad pad;
+ struct mutex lock; /* protect resource */
+ struct mutex sensor_lock; /* protect sensor */
+ struct mutex send_msg_lock; /* protect msg */
+ struct rk1608_clks clks;
+ struct rk1608_gpios gpios;
+ struct camera_dev *cd[2];
+ struct device *dev;
+ struct spi_device *spi;
+ int power_count;
+ int irq;
+ int sleepst_irq;
+ int msg_num;
+ u32 sensor_cnt;
+ u32 sensor_nums;
+ u32 max_speed_hz;
+ atomic_t msg_done[8];
+ wait_queue_head_t msg_wait;
+ struct v4l2_ctrl *link_freq;
+ struct v4l2_ctrl_handler ctrl_handler;
+ s64 link_freqs;
+};
+
+struct rk1608_section {
+ union {
+ u32 offset;
+ u32 wait_value;
+ };
+ u32 size;
+ union {
+ u32 load_addr;
+ u32 wait_addr;
+ };
+ u16 wait_time;
+ u16 timeout;
+ u16 crc_16;
+ u8 flag;
+ u8 type;
+};
+
+struct rk1608_header {
+ char version[32];
+ u32 header_size;
+ u32 section_count;
+ struct rk1608_section sections[RK1608_MAX_SEC_NUM];
+};
+
+struct rk1608_boot_req {
+ u32 flag;
+ u32 load_addr;
+ u32 boot_len;
+ u8 status;
+ u8 dummy[2];
+ u8 cmd;
+};
+
+struct rk1608_msg_queue {
+ u32 buf_head; /* msg buffer head */
+ u32 buf_tail; /* msg buffer tail */
+ u32 cur_send; /* current msg send position */
+ u32 cur_recv; /* current msg receive position */
+};
+
+struct msg {
+ u32 size; /* unit 4 bytes */
+ u16 type;
+ union {
+ u8 camera_id;
+ u8 core_id;
+ } id;
+ union {
+ u8 sync;
+ u8 log_level;
+ s8 err;
+ } mux;
+};
+
+struct msg_init {
+ struct msg msg_head;
+ u32 i2c_bus;
+ u32 i2c_clk;
+ s8 in_mipi_phy;
+ s8 out_mipi_phy;
+ s8 mipi_lane;
+ s8 bayer;
+ u8 sensor_name[32];
+ u8 i2c_slave_addr;
+};
+
+struct msg_in_size {
+ struct msg msg_head;
+ s8 data_type;
+ s8 decode_format;
+ s8 flag;
+ s8 unused;
+ u16 width;
+ u16 height;
+};
+
+struct msg_out_size {
+ struct msg msg_head;
+ u16 width;
+ u16 height;
+ u32 mipi_clk;
+ u16 line_length_pclk;
+ u16 frame_length_lines;
+};
+
+enum {
+ /* AP -> RK1608
+ * msg of sensor
+ */
+ id_msg_init_sensor_t = 0x0001,
+ id_msg_set_input_size_t,
+ id_msg_set_output_size_t,
+ id_msg_set_stream_in_on_t,
+ id_msg_set_stream_in_off_t,
+ id_msg_set_stream_out_on_t,
+ id_msg_set_stream_out_off_t,
+
+ /* AP -> RK1608
+ * msg of take picture
+ */
+ id_msg_take_picture_t = 0x0021,
+ id_msg_take_picture_done_t,
+
+ /* AP -> RK1608
+ * msg of realtime parameter
+ */
+ id_msg_rt_args_t = 0x0031,
+
+ /* AP -> RK1608
+ * msg of power manager
+ */
+ id_msg_set_sys_mode_bypass_t = 0x0200,
+ id_msg_set_sys_mode_standby_t,
+ id_msg_set_sys_mode_idle_enable_t,
+ id_msg_set_sys_mode_idle_disable_t,
+ id_msg_set_sys_mode_slave_rk1608_on_t,
+ id_msg_set_sys_mode_slave_rk1608_off_t,
+
+ /* AP -> RK1608
+ * msg of debug config
+ */
+ id_msg_set_log_level_t = 0x0250,
+
+ /* RK1608 -> AP
+ * response of sensor msg
+ */
+ id_msg_init_sensor_ret_t = 0x0301,
+ id_msg_set_input_size_ret_t,
+ id_msg_set_output_size_ret_t,
+ id_msg_set_stream_in_on_ret_t,
+ id_msg_set_stream_in_off_ret_t,
+ id_msg_set_stream_out_on_ret_t,
+ id_msg_set_stream_out_off_ret_t,
+
+ /* RK1608 -> AP
+ * response of take picture msg
+ */
+ id_msg_take_picture_ret_t = 0x0320,
+ id_msg_take_picture_done_ret_t,
+
+ /* RK1608 -> AP
+ * response of realtime parameter msg
+ */
+ id_msg_rt_args_ret_t = 0x0330,
+
+ /* RK1608 -> AP */
+ id_msg_do_i2c_t = 0x0390,
+ /* AP -> rk1608 */
+ id_msg_do_i2c_ret_t,
+
+ /* RK1608 -> AP
+ * msg of print log
+ */
+ id_msg_rk1608_log_t = 0x0400,
+
+ /* dsi2csi dump */
+ id_msg_dsi2sci_rgb_dump_t = 0x6000,
+ id_msg_dsi2sci_nv12_dump_t = 0x6001,
+
+ /* RK1608 -> AP
+ * msg of xfile
+ */
+ id_msg_xfile_import_t = 0x8000 + 0x0600,
+ id_msg_xfile_export_t,
+ id_msg_xfile_mkdir_t
+};
+
+static int rk1608_send_msg_to_dsp(struct rk1608_state *pdata, struct msg *m);
+/**
+ * rk1608_write - RK1608 synchronous write
+ *
+ * @spi: spi device
+ * @addr: resource address
+ * @data: data buffer
+ * @data_len: data buffer size, in bytes
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_write(struct spi_device *spi, s32 addr,
+ const s32 *data, size_t data_len);
+
+/**
+ * rk1608_safe_write - RK1608 synchronous write with state check
+ *
+ * @spi: spi device
+ * @addr: resource address
+ * @data: data buffer
+ * @data_len: data buffer size, in bytes
+ * Context: can sleep
+ *
+ * It returns zero on success, else operation state code.
+ */
+static int rk1608_safe_write(struct spi_device *spi,
+ s32 addr, const s32 *data, size_t data_len);
+
+/**
+ * rk1608_read - RK1608 synchronous read
+ *
+ * @spi: spi device
+ * @addr: resource address
+ * @data: data buffer [out]
+ * @data_len: data buffer size, in bytes
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_read(struct spi_device *spi, s32 addr,
+ s32 *data, size_t data_len);
+
+/**
+ * rk1608_safe_read - RK1608 synchronous read with state check
+ *
+ * @spi: spi device
+ * @addr: resource address
+ * @data: data buffer [out]
+ * @data_len: data buffer size, in bytes
+ * Context: can sleep
+ *
+ * It returns zero on success, else operation state code.
+ */
+static int rk1608_safe_read(struct spi_device *spi,
+ s32 addr, s32 *data, size_t data_len);
+
+/**
+ * rk1608_operation_query - RK1608 last operation state query
+ *
+ * @spi: spi device
+ * @state: last operation state [out]
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_operation_query(struct spi_device *spi, s32 *state);
+
+/**
+ * rk1608_interrupt_request - RK1608 request a rk1608 interrupt
+ *
+ * @spi: spi device
+ * @interrupt_num: interrupt identification
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_interrupt_request(struct spi_device *spi,
+ s32 interrupt_num);
+
+static int rk1608_read_wait(struct spi_device *spi,
+ const struct rk1608_section *sec);
+
+static int rk1608_boot_request(struct spi_device *spi,
+ const struct rk1608_section *sec);
+
+static int rk1608_download_section(struct spi_device *spi, const u8 *data,
+ const struct rk1608_section *sec);
+/**
+ * rk1608_download_fw: - rk1608 firmware download through spi
+ *
+ * @spi: spi device
+ * @fw_name: name of firmware file, NULL for default firmware name
+ * Context: can sleep
+ *
+ * It returns zero on success, else a negative error code.
+ **/
+static int rk1608_download_fw(struct spi_device *spi, const char *fw_name);
+
+/**
+ * rk1608_msq_read_head - read rk1608 msg queue head
+ *
+ * @spi: spi device
+ * @addr: msg queue head addr
+ * @m: msg queue pointer
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_msq_read_head(struct spi_device *spi,
+ u32 addr, struct rk1608_msg_queue *q);
+
+/**
+ * rk1608_msq_recv_msg - receive a msg from RK1608 -> AP msg queue
+ *
+ * @q: msg queue
+ * @m: a msg pointer buf [out]
+ *
+ * need call rk1608_msq_free_received_msg to free msg after msg use done
+ *
+ * It returns zero on success, else a negative error code.
+ */
+static int rk1608_msq_recv_msg(struct spi_device *spi, struct msg **m);
+#endif
--
2.7.4