Lines Matching +full:data +full:- +full:lanes
1 // SPDX-License-Identifier: GPL-2.0
3 * Driver for Renesas R-Car MIPI CSI-2 Receiver
20 #include <media/v4l2-ctrls.h>
21 #include <media/v4l2-device.h>
22 #include <media/v4l2-fwnode.h>
23 #include <media/v4l2-mc.h>
24 #include <media/v4l2-subdev.h>
54 * Channel Data Type Select
55 * VCDT[0-15]: Channel 0 VCDT[16-31]: Channel 1
56 * VCDT2[0-15]: Channel 2 VCDT2[16-31]: Channel 3
65 /* Frame Data Type Select */
80 /* Long Data Type Setting 0 */
83 /* Long Data Type Setting 1 */
103 /* Short Packet Data */
130 u16 data; member
304 /* PHY Data Lane Monitor */
378 unsigned short lanes; member
394 return ioread32(priv->base + reg); in rcsi2_read()
397 static void rcsi2_write(struct rcar_csi2 *priv, unsigned int reg, u32 data) in rcsi2_write() argument
399 iowrite32(data, priv->base + reg); in rcsi2_write()
406 reset_control_assert(priv->rstc); in rcsi2_enter_standby()
408 pm_runtime_put(priv->dev); in rcsi2_enter_standby()
415 ret = pm_runtime_resume_and_get(priv->dev); in rcsi2_exit_standby()
419 reset_control_deassert(priv->rstc); in rcsi2_exit_standby()
425 unsigned int lanes) in rcsi2_wait_phy_start() argument
429 /* Wait for the clock and data lanes to enter LP-11 state. */ in rcsi2_wait_phy_start()
431 const u32 lane_mask = (1 << lanes) - 1; in rcsi2_wait_phy_start()
440 dev_err(priv->dev, "Timeout waiting for LP-11 state\n"); in rcsi2_wait_phy_start()
442 return -ETIMEDOUT; in rcsi2_wait_phy_start()
449 for (hsfreq = priv->info->hsfreqrange; hsfreq->mbps != 0; hsfreq++) in rcsi2_set_phypll()
450 if (hsfreq->mbps >= mbps) in rcsi2_set_phypll()
453 if (!hsfreq->mbps) { in rcsi2_set_phypll()
454 dev_err(priv->dev, "Unsupported PHY speed (%u Mbps)", mbps); in rcsi2_set_phypll()
455 return -ERANGE; in rcsi2_set_phypll()
458 rcsi2_write(priv, PHYPLL_REG, PHYPLL_HSFREQRANGE(hsfreq->reg)); in rcsi2_set_phypll()
464 unsigned int lanes) in rcsi2_calc_mbps() argument
470 if (!priv->remote) in rcsi2_calc_mbps()
471 return -ENODEV; in rcsi2_calc_mbps()
473 source = priv->remote; in rcsi2_calc_mbps()
476 ctrl = v4l2_ctrl_find(source->ctrl_handler, V4L2_CID_PIXEL_RATE); in rcsi2_calc_mbps()
478 dev_err(priv->dev, "no pixel rate control in subdev %s\n", in rcsi2_calc_mbps()
479 source->name); in rcsi2_calc_mbps()
480 return -EINVAL; in rcsi2_calc_mbps()
489 do_div(mbps, lanes * 1000000); in rcsi2_calc_mbps()
495 unsigned int *lanes) in rcsi2_get_active_lanes() argument
501 *lanes = priv->lanes; in rcsi2_get_active_lanes()
503 ret = v4l2_subdev_call(priv->remote, pad, get_mbus_config, in rcsi2_get_active_lanes()
504 priv->remote_pad, &mbus_config); in rcsi2_get_active_lanes()
505 if (ret == -ENOIOCTLCMD) { in rcsi2_get_active_lanes()
506 dev_dbg(priv->dev, "No remote mbus configuration available\n"); in rcsi2_get_active_lanes()
511 dev_err(priv->dev, "Failed to get remote mbus configuration\n"); in rcsi2_get_active_lanes()
516 dev_err(priv->dev, "Unsupported media bus type %u\n", in rcsi2_get_active_lanes()
518 return -EINVAL; in rcsi2_get_active_lanes()
530 if (num_lanes > priv->lanes) { in rcsi2_get_active_lanes()
531 dev_err(priv->dev, in rcsi2_get_active_lanes()
532 "Unsupported mbus config: too many data lanes %u\n", in rcsi2_get_active_lanes()
534 return -EINVAL; in rcsi2_get_active_lanes()
537 *lanes = num_lanes; in rcsi2_get_active_lanes()
546 unsigned int lanes; in rcsi2_start_receiver() local
550 dev_dbg(priv->dev, "Input size (%ux%u%c)\n", in rcsi2_start_receiver()
551 priv->mf.width, priv->mf.height, in rcsi2_start_receiver()
552 priv->mf.field == V4L2_FIELD_NONE ? 'p' : 'i'); in rcsi2_start_receiver()
555 format = rcsi2_code_to_fmt(priv->mf.code); in rcsi2_start_receiver()
558 * Enable all supported CSI-2 channels with virtual channel and in rcsi2_start_receiver()
559 * data type matching. in rcsi2_start_receiver()
565 for (i = 0; i < priv->info->num_channels; i++) { in rcsi2_start_receiver()
569 VCDT_SEL_DT(format->datatype); in rcsi2_start_receiver()
578 if (priv->mf.field == V4L2_FIELD_ALTERNATE) { in rcsi2_start_receiver()
582 if (priv->mf.height == 240) in rcsi2_start_receiver()
589 * Get the number of active data lanes inspecting the remote mbus in rcsi2_start_receiver()
592 ret = rcsi2_get_active_lanes(priv, &lanes); in rcsi2_start_receiver()
597 phycnt |= (1 << lanes) - 1; in rcsi2_start_receiver()
599 mbps = rcsi2_calc_mbps(priv, format->bpp, lanes); in rcsi2_start_receiver()
615 /* Lanes are zero indexed. */ in rcsi2_start_receiver()
617 LSWAP_L0SEL(priv->lane_swap[0] - 1) | in rcsi2_start_receiver()
618 LSWAP_L1SEL(priv->lane_swap[1] - 1) | in rcsi2_start_receiver()
619 LSWAP_L2SEL(priv->lane_swap[2] - 1) | in rcsi2_start_receiver()
620 LSWAP_L3SEL(priv->lane_swap[3] - 1)); in rcsi2_start_receiver()
623 if (priv->info->init_phtw) { in rcsi2_start_receiver()
624 ret = priv->info->init_phtw(priv, mbps); in rcsi2_start_receiver()
629 if (priv->info->hsfreqrange) { in rcsi2_start_receiver()
635 if (priv->info->csi0clkfreqrange) in rcsi2_start_receiver()
637 CSI0CLKFREQRANGE(priv->info->csi0clkfreqrange)); in rcsi2_start_receiver()
646 ret = rcsi2_wait_phy_start(priv, lanes); in rcsi2_start_receiver()
651 if (priv->info->phy_post_init) { in rcsi2_start_receiver()
652 ret = priv->info->phy_post_init(priv); in rcsi2_start_receiver()
658 if (priv->info->clear_ulps) in rcsi2_start_receiver()
679 ret = v4l2_subdev_call(priv->remote, video, s_stream, 1); in rcsi2_start()
691 v4l2_subdev_call(priv->remote, video, s_stream, 0); in rcsi2_stop()
699 mutex_lock(&priv->lock); in rcsi2_s_stream()
701 if (!priv->remote) { in rcsi2_s_stream()
702 ret = -ENODEV; in rcsi2_s_stream()
706 if (enable && priv->stream_count == 0) { in rcsi2_s_stream()
710 } else if (!enable && priv->stream_count == 1) { in rcsi2_s_stream()
714 priv->stream_count += enable ? 1 : -1; in rcsi2_s_stream()
716 mutex_unlock(&priv->lock); in rcsi2_s_stream()
728 if (!rcsi2_code_to_fmt(format->format.code)) in rcsi2_set_pad_format()
729 format->format.code = rcar_csi2_formats[0].code; in rcsi2_set_pad_format()
731 if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE) { in rcsi2_set_pad_format()
732 priv->mf = format->format; in rcsi2_set_pad_format()
735 *framefmt = format->format; in rcsi2_set_pad_format()
747 if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE) in rcsi2_get_pad_format()
748 format->format = priv->mf; in rcsi2_get_pad_format()
750 format->format = *v4l2_subdev_get_try_format(sd, sd_state, 0); in rcsi2_get_pad_format()
769 static irqreturn_t rcsi2_irq(int irq, void *data) in rcsi2_irq() argument
771 struct rcar_csi2 *priv = data; in rcsi2_irq()
787 dev_info(priv->dev, "Transfer error, restarting CSI-2 receiver\n"); in rcsi2_irq()
792 static irqreturn_t rcsi2_irq_thread(int irq, void *data) in rcsi2_irq_thread() argument
794 struct rcar_csi2 *priv = data; in rcsi2_irq_thread()
796 mutex_lock(&priv->lock); in rcsi2_irq_thread()
800 dev_warn(priv->dev, "Failed to restart CSI-2 receiver\n"); in rcsi2_irq_thread()
801 mutex_unlock(&priv->lock); in rcsi2_irq_thread()
806 /* -----------------------------------------------------------------------------
817 pad = media_entity_get_fwnode_pad(&subdev->entity, asd->match.fwnode, in rcsi2_notify_bound()
820 dev_err(priv->dev, "Failed to find pad for %s\n", subdev->name); in rcsi2_notify_bound()
824 priv->remote = subdev; in rcsi2_notify_bound()
825 priv->remote_pad = pad; in rcsi2_notify_bound()
827 dev_dbg(priv->dev, "Bound %s pad: %d\n", subdev->name, pad); in rcsi2_notify_bound()
829 return media_create_pad_link(&subdev->entity, pad, in rcsi2_notify_bound()
830 &priv->subdev.entity, 0, in rcsi2_notify_bound()
841 priv->remote = NULL; in rcsi2_notify_unbind()
843 dev_dbg(priv->dev, "Unbind %s\n", subdev->name); in rcsi2_notify_unbind()
857 if (vep->base.port || vep->base.id) in rcsi2_parse_v4l2()
858 return -ENOTCONN; in rcsi2_parse_v4l2()
860 if (vep->bus_type != V4L2_MBUS_CSI2_DPHY) { in rcsi2_parse_v4l2()
861 dev_err(priv->dev, "Unsupported bus: %u\n", vep->bus_type); in rcsi2_parse_v4l2()
862 return -EINVAL; in rcsi2_parse_v4l2()
865 priv->lanes = vep->bus.mipi_csi2.num_data_lanes; in rcsi2_parse_v4l2()
866 if (priv->lanes != 1 && priv->lanes != 2 && priv->lanes != 4) { in rcsi2_parse_v4l2()
867 dev_err(priv->dev, "Unsupported number of data-lanes: %u\n", in rcsi2_parse_v4l2()
868 priv->lanes); in rcsi2_parse_v4l2()
869 return -EINVAL; in rcsi2_parse_v4l2()
872 for (i = 0; i < ARRAY_SIZE(priv->lane_swap); i++) { in rcsi2_parse_v4l2()
873 priv->lane_swap[i] = i < priv->lanes ? in rcsi2_parse_v4l2()
874 vep->bus.mipi_csi2.data_lanes[i] : i; in rcsi2_parse_v4l2()
877 if (priv->lane_swap[i] < 1 || priv->lane_swap[i] > 4) { in rcsi2_parse_v4l2()
878 dev_err(priv->dev, "data-lanes must be in 1-4 range\n"); in rcsi2_parse_v4l2()
879 return -EINVAL; in rcsi2_parse_v4l2()
896 ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(priv->dev), 0, 0, 0); in rcsi2_parse_dt()
898 dev_err(priv->dev, "Not connected to subdevice\n"); in rcsi2_parse_dt()
899 return -EINVAL; in rcsi2_parse_dt()
904 dev_err(priv->dev, "Could not parse v4l2 endpoint\n"); in rcsi2_parse_dt()
906 return -EINVAL; in rcsi2_parse_dt()
918 dev_dbg(priv->dev, "Found '%pOF'\n", to_of_node(fwnode)); in rcsi2_parse_dt()
920 v4l2_async_notifier_init(&priv->notifier); in rcsi2_parse_dt()
921 priv->notifier.ops = &rcar_csi2_notify_ops; in rcsi2_parse_dt()
923 asd = v4l2_async_notifier_add_fwnode_subdev(&priv->notifier, fwnode, in rcsi2_parse_dt()
929 ret = v4l2_async_subdev_notifier_register(&priv->subdev, in rcsi2_parse_dt()
930 &priv->notifier); in rcsi2_parse_dt()
932 v4l2_async_notifier_cleanup(&priv->notifier); in rcsi2_parse_dt()
937 /* -----------------------------------------------------------------------------
943 static int rcsi2_phtw_write(struct rcar_csi2 *priv, u16 data, u16 code) in rcsi2_phtw_write() argument
948 PHTW_DWEN | PHTW_TESTDIN_DATA(data) | in rcsi2_phtw_write()
959 dev_err(priv->dev, "Timeout waiting for PHTW_DWEN and/or PHTW_CWEN\n"); in rcsi2_phtw_write()
961 return -ETIMEDOUT; in rcsi2_phtw_write()
970 for (value = values; value->data || value->code; value++) { in rcsi2_phtw_write_array()
971 ret = rcsi2_phtw_write(priv, value->data, value->code); in rcsi2_phtw_write_array()
984 for (value = values; value->mbps; value++) in rcsi2_phtw_write_mbps()
985 if (value->mbps >= mbps) in rcsi2_phtw_write_mbps()
988 if (!value->mbps) { in rcsi2_phtw_write_mbps()
989 dev_err(priv->dev, "Unsupported PHY speed (%u Mbps)", mbps); in rcsi2_phtw_write_mbps()
990 return -ERANGE; in rcsi2_phtw_write_mbps()
993 return rcsi2_phtw_write(priv, value->reg, code); in rcsi2_phtw_write_mbps()
1000 { .data = 0xcc, .code = 0xe2 }, in __rcsi2_init_phtw_h3_v3h_m3n()
1001 { .data = 0x01, .code = 0xe3 }, in __rcsi2_init_phtw_h3_v3h_m3n()
1002 { .data = 0x11, .code = 0xe4 }, in __rcsi2_init_phtw_h3_v3h_m3n()
1003 { .data = 0x01, .code = 0xe5 }, in __rcsi2_init_phtw_h3_v3h_m3n()
1004 { .data = 0x10, .code = 0x04 }, in __rcsi2_init_phtw_h3_v3h_m3n()
1009 { .data = 0x38, .code = 0x08 }, in __rcsi2_init_phtw_h3_v3h_m3n()
1010 { .data = 0x01, .code = 0x00 }, in __rcsi2_init_phtw_h3_v3h_m3n()
1011 { .data = 0x4b, .code = 0xac }, in __rcsi2_init_phtw_h3_v3h_m3n()
1012 { .data = 0x03, .code = 0x00 }, in __rcsi2_init_phtw_h3_v3h_m3n()
1013 { .data = 0x80, .code = 0x07 }, in __rcsi2_init_phtw_h3_v3h_m3n()
1055 { .data = 0xee, .code = 0x34 }, in rcsi2_phy_post_init_v3m_e3()
1056 { .data = 0xee, .code = 0x44 }, in rcsi2_phy_post_init_v3m_e3()
1057 { .data = 0xee, .code = 0x54 }, in rcsi2_phy_post_init_v3m_e3()
1058 { .data = 0xee, .code = 0x84 }, in rcsi2_phy_post_init_v3m_e3()
1059 { .data = 0xee, .code = 0x94 }, in rcsi2_phy_post_init_v3m_e3()
1066 /* -----------------------------------------------------------------------------
1081 priv->base = devm_ioremap_resource(&pdev->dev, res); in rcsi2_probe_resources()
1082 if (IS_ERR(priv->base)) in rcsi2_probe_resources()
1083 return PTR_ERR(priv->base); in rcsi2_probe_resources()
1089 ret = devm_request_threaded_irq(&pdev->dev, irq, rcsi2_irq, in rcsi2_probe_resources()
1095 priv->rstc = devm_reset_control_get(&pdev->dev, NULL); in rcsi2_probe_resources()
1097 return PTR_ERR_OR_ZERO(priv->rstc); in rcsi2_probe_resources()
1160 .compatible = "renesas,r8a774a1-csi2",
1161 .data = &rcar_csi2_info_r8a7796,
1164 .compatible = "renesas,r8a774b1-csi2",
1165 .data = &rcar_csi2_info_r8a77965,
1168 .compatible = "renesas,r8a774c0-csi2",
1169 .data = &rcar_csi2_info_r8a77990,
1172 .compatible = "renesas,r8a774e1-csi2",
1173 .data = &rcar_csi2_info_r8a7795,
1176 .compatible = "renesas,r8a7795-csi2",
1177 .data = &rcar_csi2_info_r8a7795,
1180 .compatible = "renesas,r8a7796-csi2",
1181 .data = &rcar_csi2_info_r8a7796,
1184 .compatible = "renesas,r8a77961-csi2",
1185 .data = &rcar_csi2_info_r8a77961,
1188 .compatible = "renesas,r8a77965-csi2",
1189 .data = &rcar_csi2_info_r8a77965,
1192 .compatible = "renesas,r8a77970-csi2",
1193 .data = &rcar_csi2_info_r8a77970,
1196 .compatible = "renesas,r8a77980-csi2",
1197 .data = &rcar_csi2_info_r8a77980,
1200 .compatible = "renesas,r8a77990-csi2",
1201 .data = &rcar_csi2_info_r8a77990,
1210 .data = &rcar_csi2_info_r8a7795es1,
1214 .data = &rcar_csi2_info_r8a7795es2,
1226 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); in rcsi2_probe()
1228 return -ENOMEM; in rcsi2_probe()
1230 priv->info = of_device_get_match_data(&pdev->dev); in rcsi2_probe()
1238 priv->info = attr->data; in rcsi2_probe()
1240 priv->dev = &pdev->dev; in rcsi2_probe()
1242 mutex_init(&priv->lock); in rcsi2_probe()
1243 priv->stream_count = 0; in rcsi2_probe()
1247 dev_err(priv->dev, "Failed to get resources\n"); in rcsi2_probe()
1257 priv->subdev.owner = THIS_MODULE; in rcsi2_probe()
1258 priv->subdev.dev = &pdev->dev; in rcsi2_probe()
1259 v4l2_subdev_init(&priv->subdev, &rcar_csi2_subdev_ops); in rcsi2_probe()
1260 v4l2_set_subdevdata(&priv->subdev, &pdev->dev); in rcsi2_probe()
1261 snprintf(priv->subdev.name, V4L2_SUBDEV_NAME_SIZE, "%s %s", in rcsi2_probe()
1262 KBUILD_MODNAME, dev_name(&pdev->dev)); in rcsi2_probe()
1263 priv->subdev.flags = V4L2_SUBDEV_FL_HAS_DEVNODE; in rcsi2_probe()
1265 priv->subdev.entity.function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER; in rcsi2_probe()
1266 priv->subdev.entity.ops = &rcar_csi2_entity_ops; in rcsi2_probe()
1268 priv->pads[RCAR_CSI2_SINK].flags = MEDIA_PAD_FL_SINK; in rcsi2_probe()
1270 priv->pads[i].flags = MEDIA_PAD_FL_SOURCE; in rcsi2_probe()
1272 ret = media_entity_pads_init(&priv->subdev.entity, NR_OF_RCAR_CSI2_PAD, in rcsi2_probe()
1273 priv->pads); in rcsi2_probe()
1277 pm_runtime_enable(&pdev->dev); in rcsi2_probe()
1279 ret = v4l2_async_register_subdev(&priv->subdev); in rcsi2_probe()
1283 dev_info(priv->dev, "%d lanes found\n", priv->lanes); in rcsi2_probe()
1288 v4l2_async_notifier_unregister(&priv->notifier); in rcsi2_probe()
1289 v4l2_async_notifier_cleanup(&priv->notifier); in rcsi2_probe()
1298 v4l2_async_notifier_unregister(&priv->notifier); in rcsi2_remove()
1299 v4l2_async_notifier_cleanup(&priv->notifier); in rcsi2_remove()
1300 v4l2_async_unregister_subdev(&priv->subdev); in rcsi2_remove()
1302 pm_runtime_disable(&pdev->dev); in rcsi2_remove()
1311 .name = "rcar-csi2",
1319 MODULE_DESCRIPTION("Renesas R-Car MIPI CSI-2 receiver driver");