diff mbox series

[13/18] ipu3-cio2: Add functionality allowing software_node connections to sensors on platforms designed for Windows

Message ID 20201130133129.1024662-14-djrscally@gmail.com
State New
Headers show
Series Add functionality to ipu3-cio2 driver allowing software_node connections to sensors on platforms designed for Windows | expand

Commit Message

Daniel Scally Nov. 30, 2020, 1:31 p.m. UTC
Currently on platforms designed for Windows, connections between CIO2 and
sensors are not properly defined in DSDT. This patch extends the ipu3-cio2
driver to compensate by building software_node connections, parsing the
connection properties from the sensor's SSDB buffer.

Suggested-by: Jordan Hand <jorhand@linux.microsoft.com>
Signed-off-by: Daniel Scally <djrscally@gmail.com>
---
Changes since RFC v3:

	- Removed almost all global variables, dynamically allocated
	the cio2_bridge structure, plus a bunch of associated changes
	like 
	- Added a new function to ipu3-cio2-main.c to check for an 
	existing fwnode_graph before calling cio2_bridge_init()
	- Prefixed cio2_bridge_ to any variables and functions that
	lacked it
	- Assigned the new fwnode directly to the sensor's ACPI device
	fwnode as secondary. This removes the requirement to delay until
	the I2C devices are instantiated before ipu3-cio2 can probe, but
	it has a side effect, which is that those devices then grab a ref
	to the new software_node. This effectively prevents us from
	unloading the driver, because we can't free the memory that they
	live in whilst the device holds a reference to them. The work
	around at the moment is to _not_ unregister the software_nodes
	when ipu3-cio2 is unloaded; this becomes a one-time 'patch', that
	is simply skipped if the module is reloaded.
	- Moved the sensor's SSDB struct to be a member of cio2_sensor
	- Replaced ints with unsigned ints where appropriate
	- Iterated over all ACPI devices of a matching _HID rather than
	just the first to ensure we handle a device with multiple sensors
	of the same model.

 MAINTAINERS                                   |   1 +
 drivers/media/pci/intel/ipu3/Kconfig          |  18 ++
 drivers/media/pci/intel/ipu3/Makefile         |   1 +
 drivers/media/pci/intel/ipu3/cio2-bridge.c    | 260 ++++++++++++++++++
 drivers/media/pci/intel/ipu3/cio2-bridge.h    | 108 ++++++++
 drivers/media/pci/intel/ipu3/ipu3-cio2-main.c |  27 ++
 drivers/media/pci/intel/ipu3/ipu3-cio2.h      |   6 +
 7 files changed, 421 insertions(+)
 create mode 100644 drivers/media/pci/intel/ipu3/cio2-bridge.c
 create mode 100644 drivers/media/pci/intel/ipu3/cio2-bridge.h

Comments

Andy Shevchenko Nov. 30, 2020, 6:14 p.m. UTC | #1
On Mon, Nov 30, 2020 at 07:09:55PM +0200, Laurent Pinchart wrote:
> On Mon, Nov 30, 2020 at 01:31:24PM +0000, Daniel Scally wrote:

I agree with most of Laurent's comments. S

...

> > +	  Say Y here if your device is a detachable / hybrid laptop that comes
> > +	  with Windows installed by the OEM, for example:
> > +

> > +	  	- Microsoft Surface models (except Surface Pro 3)

In this line mixed TABs and spaces. Not sure if it's only in Laurent's reply.

> > +		- The Lenovo Miix line (for example the 510, 520, 710 and 720)
> > +		- Dell 7285

...

> > +	for (i = 0; i < ARRAY_SIZE(cio2_supported_devices); i++) {
> > +		const char *this_device = cio2_supported_devices[i];
> 
> s/this_device/name/ (or sensor_name, ...) ?

I would go with hid.

...

> > +		for_each_acpi_dev_match(adev, this_device, NULL, -1) {
> > +			if (!adev || !(adev->status.present && adev->status.enabled))
> 
> 			if (!adev || !adev->status.present || !adev->status.enabled))
> 
> may be a bit more readable. Does for_each_acpi_dev_match() return NULL
> devices though ? If no, you could drop the !adev check. You may also be
> able to drop the !present check, as I don't think ACPI allows !present
> && enabled.

I think this should be rather

        if (acpi_bus_get_status(adev) || !adev->status.present)
Sakari Ailus Nov. 30, 2020, 8:35 p.m. UTC | #2
Hi Daniel,

Thanks for the update! This is starting to look really nice!

Please still see my comments below.

On Mon, Nov 30, 2020 at 01:31:24PM +0000, Daniel Scally wrote:
> Currently on platforms designed for Windows, connections between CIO2 and
> sensors are not properly defined in DSDT. This patch extends the ipu3-cio2
> driver to compensate by building software_node connections, parsing the
> connection properties from the sensor's SSDB buffer.
> 
> Suggested-by: Jordan Hand <jorhand@linux.microsoft.com>
> Signed-off-by: Daniel Scally <djrscally@gmail.com>
> ---
> Changes since RFC v3:
> 
> 	- Removed almost all global variables, dynamically allocated
> 	the cio2_bridge structure, plus a bunch of associated changes
> 	like 
> 	- Added a new function to ipu3-cio2-main.c to check for an 
> 	existing fwnode_graph before calling cio2_bridge_init()
> 	- Prefixed cio2_bridge_ to any variables and functions that
> 	lacked it
> 	- Assigned the new fwnode directly to the sensor's ACPI device
> 	fwnode as secondary. This removes the requirement to delay until
> 	the I2C devices are instantiated before ipu3-cio2 can probe, but
> 	it has a side effect, which is that those devices then grab a ref
> 	to the new software_node. This effectively prevents us from
> 	unloading the driver, because we can't free the memory that they
> 	live in whilst the device holds a reference to them. The work
> 	around at the moment is to _not_ unregister the software_nodes
> 	when ipu3-cio2 is unloaded; this becomes a one-time 'patch', that
> 	is simply skipped if the module is reloaded.
> 	- Moved the sensor's SSDB struct to be a member of cio2_sensor
> 	- Replaced ints with unsigned ints where appropriate
> 	- Iterated over all ACPI devices of a matching _HID rather than
> 	just the first to ensure we handle a device with multiple sensors
> 	of the same model.
> 
>  MAINTAINERS                                   |   1 +
>  drivers/media/pci/intel/ipu3/Kconfig          |  18 ++
>  drivers/media/pci/intel/ipu3/Makefile         |   1 +
>  drivers/media/pci/intel/ipu3/cio2-bridge.c    | 260 ++++++++++++++++++
>  drivers/media/pci/intel/ipu3/cio2-bridge.h    | 108 ++++++++
>  drivers/media/pci/intel/ipu3/ipu3-cio2-main.c |  27 ++
>  drivers/media/pci/intel/ipu3/ipu3-cio2.h      |   6 +
>  7 files changed, 421 insertions(+)
>  create mode 100644 drivers/media/pci/intel/ipu3/cio2-bridge.c
>  create mode 100644 drivers/media/pci/intel/ipu3/cio2-bridge.h
> 
> diff --git a/MAINTAINERS b/MAINTAINERS
> index 9702b886d6a4..188559a0a610 100644
> --- a/MAINTAINERS
> +++ b/MAINTAINERS
> @@ -8927,6 +8927,7 @@ INTEL IPU3 CSI-2 CIO2 DRIVER
>  M:	Yong Zhi <yong.zhi@intel.com>
>  M:	Sakari Ailus <sakari.ailus@linux.intel.com>
>  M:	Bingbu Cao <bingbu.cao@intel.com>
> +M:	Dan Scally <djrscally@gmail.com>
>  R:	Tianshu Qiu <tian.shu.qiu@intel.com>
>  L:	linux-media@vger.kernel.org
>  S:	Maintained
> diff --git a/drivers/media/pci/intel/ipu3/Kconfig b/drivers/media/pci/intel/ipu3/Kconfig
> index 82d7f17e6a02..2b3350d042be 100644
> --- a/drivers/media/pci/intel/ipu3/Kconfig
> +++ b/drivers/media/pci/intel/ipu3/Kconfig
> @@ -16,3 +16,21 @@ config VIDEO_IPU3_CIO2
>  	  Say Y or M here if you have a Skylake/Kaby Lake SoC with MIPI CSI-2
>  	  connected camera.
>  	  The module will be called ipu3-cio2.
> +
> +config CIO2_BRIDGE
> +	bool "IPU3 CIO2 Sensors Bridge"
> +	depends on VIDEO_IPU3_CIO2
> +	help
> +	  This extension provides an API for the ipu3-cio2 driver to create
> +	  connections to cameras that are hidden in SSDB buffer in ACPI. It
> +	  can be used to enable support for cameras in detachable / hybrid
> +	  devices that ship with Windows.
> +
> +	  Say Y here if your device is a detachable / hybrid laptop that comes
> +	  with Windows installed by the OEM, for example:
> +
> +	  	- Microsoft Surface models (except Surface Pro 3)
> +		- The Lenovo Miix line (for example the 510, 520, 710 and 720)
> +		- Dell 7285
> +
> +	  If in doubt, say N here.
> diff --git a/drivers/media/pci/intel/ipu3/Makefile b/drivers/media/pci/intel/ipu3/Makefile
> index 429d516452e4..933777e6ea8a 100644
> --- a/drivers/media/pci/intel/ipu3/Makefile
> +++ b/drivers/media/pci/intel/ipu3/Makefile
> @@ -2,3 +2,4 @@
>  obj-$(CONFIG_VIDEO_IPU3_CIO2) += ipu3-cio2.o
>  
>  ipu3-cio2-y += ipu3-cio2-main.o
> +ipu3-cio2-$(CONFIG_CIO2_BRIDGE) += cio2-bridge.o
> diff --git a/drivers/media/pci/intel/ipu3/cio2-bridge.c b/drivers/media/pci/intel/ipu3/cio2-bridge.c
> new file mode 100644
> index 000000000000..fd3f8ba07274
> --- /dev/null
> +++ b/drivers/media/pci/intel/ipu3/cio2-bridge.c
> @@ -0,0 +1,260 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/* Author: Dan Scally <djrscally@gmail.com> */
> +#include <linux/acpi.h>
> +#include <linux/device.h>
> +#include <linux/i2c.h>
> +#include <linux/kernel.h>
> +#include <linux/module.h>
> +#include <linux/pci.h>
> +#include <linux/property.h>
> +#include <media/v4l2-subdev.h>
> +
> +#include "cio2-bridge.h"
> +
> +/*
> + * Extend this array with ACPI Hardware ID's of devices known to be working.
> + * Do not add a HID for a sensor that is not actually supported.
> + */
> +static const char * const cio2_supported_devices[] = {
> +	"INT33BE",
> +	"OVTI2680",

I guess we don't have the known-good frequencies for the CSI-2 bus in
firmware?

One option would be to put there what the drivers currently use. This
assumes the support for these devices is, well, somewhat opportunistic but
I guess there's no way around that right now at least.

As the systems are laptops, they're likely somewhat less prone to EMI
issues to begin with than mobile phones anyway.

> +};
> +
> +static int cio2_bridge_read_acpi_buffer(struct acpi_device *adev, char *id,
> +					void *data, u32 size)
> +{
> +	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
> +	union acpi_object *obj;
> +	acpi_status status;
> +	int ret;
> +
> +	status = acpi_evaluate_object(adev->handle, id, NULL, &buffer);
> +	if (ACPI_FAILURE(status))
> +		return -ENODEV;
> +
> +	obj = buffer.pointer;
> +	if (!obj) {
> +		dev_err(&adev->dev, "Couldn't locate ACPI buffer\n");
> +		return -ENODEV;
> +	}
> +
> +	if (obj->type != ACPI_TYPE_BUFFER) {
> +		dev_err(&adev->dev, "Not an ACPI buffer\n");
> +		ret = -ENODEV;
> +		goto out_free_buff;
> +	}
> +
> +	if (obj->buffer.length > size) {
> +		dev_err(&adev->dev, "Given buffer is too small\n");
> +		ret = -EINVAL;
> +		goto out_free_buff;
> +	}
> +
> +	memcpy(data, obj->buffer.pointer, obj->buffer.length);
> +	ret = obj->buffer.length;
> +
> +out_free_buff:
> +	kfree(buffer.pointer);
> +	return ret;
> +}
> +
> +static void cio2_bridge_init_property_names(struct cio2_sensor *sensor)
> +{
> +	strcpy(sensor->prop_names.clock_frequency, "clock-frequency");
> +	strcpy(sensor->prop_names.rotation, "rotation");
> +	strcpy(sensor->prop_names.bus_type, "bus-type");
> +	strcpy(sensor->prop_names.data_lanes, "data-lanes");
> +	strcpy(sensor->prop_names.remote_endpoint, "remote-endpoint");

Please use the actual field size instead with strncpy / strscpy.

> +}
> +
> +static void cio2_bridge_create_fwnode_properties(struct cio2_sensor *sensor)
> +{
> +	unsigned int i;
> +
> +	cio2_bridge_init_property_names(sensor);
> +
> +	for (i = 0; i < 4; i++)
> +		sensor->data_lanes[i] = i + 1;
> +
> +	/*
> +	 * Can't use PROPERTY_ENTRY_REF because it creates a new variable to
> +	 * point to, which doesn't survive the function.
> +	 */
> +	sensor->local_ref[0] = (struct software_node_ref_args){
> +		.node = &sensor->swnodes[SWNODE_CIO2_ENDPOINT]
> +		};

I guess this line should be unindented by one tab stop. Same for the
similar case below.

> +	sensor->remote_ref[0] = (struct software_node_ref_args){
> +		.node = &sensor->swnodes[SWNODE_SENSOR_ENDPOINT]
> +		};
> +
> +	sensor->dev_properties[0] = PROPERTY_ENTRY_U32(sensor->prop_names.clock_frequency,
> +						       sensor->ssdb.mclkspeed);
> +	sensor->dev_properties[1] = PROPERTY_ENTRY_U8(sensor->prop_names.rotation,
> +						      sensor->ssdb.degree);
> +
> +	sensor->ep_properties[0] = PROPERTY_ENTRY_U32(sensor->prop_names.bus_type, 5);
> +	sensor->ep_properties[1] = PROPERTY_ENTRY_U32_ARRAY_LEN(sensor->prop_names.data_lanes,
> +								sensor->data_lanes,
> +								sensor->ssdb.lanes);
> +	sensor->ep_properties[2] = PROPERTY_ENTRY_REF_ARRAY(sensor->prop_names.remote_endpoint,
> +							    sensor->local_ref);
> +
> +	sensor->cio2_properties[0] = PROPERTY_ENTRY_U32_ARRAY_LEN(sensor->prop_names.data_lanes,
> +								  sensor->data_lanes,
> +								  sensor->ssdb.lanes);
> +	sensor->cio2_properties[1] = PROPERTY_ENTRY_REF_ARRAY(sensor->prop_names.remote_endpoint,
> +							      sensor->remote_ref);
> +}
> +
> +static void cio2_bridge_init_swnode_names(struct cio2_sensor *sensor)
> +{
> +	snprintf(sensor->node_names.remote_port, 6, "port%u", sensor->ssdb.link);
> +	strcpy(sensor->node_names.port, "port0");
> +	strcpy(sensor->node_names.endpoint, "endpoint0");

Please use the actual size of the field, and strncpy / strscpy.

> +}
> +
> +static void cio2_bridge_create_connection_swnodes(struct cio2_bridge *bridge,
> +						  struct cio2_sensor *sensor)
> +{
> +	struct software_node *nodes = sensor->swnodes;
> +
> +	cio2_bridge_init_swnode_names(sensor);
> +
> +	nodes[SWNODE_SENSOR_HID] = NODE_SENSOR(sensor->name,
> +					       sensor->dev_properties);
> +	nodes[SWNODE_SENSOR_PORT] = NODE_PORT(sensor->node_names.port,
> +					      &nodes[SWNODE_SENSOR_HID]);
> +	nodes[SWNODE_SENSOR_ENDPOINT] = NODE_ENDPOINT(sensor->node_names.endpoint,
> +						      &nodes[SWNODE_SENSOR_PORT],
> +						      sensor->ep_properties);
> +	nodes[SWNODE_CIO2_PORT] = NODE_PORT(sensor->node_names.remote_port,
> +					    &bridge->cio2_hid_node);
> +	nodes[SWNODE_CIO2_ENDPOINT] = NODE_ENDPOINT(sensor->node_names.endpoint,
> +						    &nodes[SWNODE_CIO2_PORT],
> +						    sensor->cio2_properties);
> +}
> +
> +static void cio2_bridge_unregister_sensors(struct cio2_bridge *bridge)
> +{
> +	struct cio2_sensor *sensor;
> +	unsigned int i;
> +
> +	for (i = 0; i < bridge->n_sensors; i++) {
> +		sensor = &bridge->sensors[i];
> +		software_node_unregister_nodes(sensor->swnodes);
> +		acpi_dev_put(sensor->adev);
> +	}
> +}
> +
> +static int cio2_bridge_connect_sensors(struct cio2_bridge *bridge)
> +{
> +	struct fwnode_handle *fwnode;
> +	struct cio2_sensor *sensor;
> +	struct acpi_device *adev;
> +	unsigned int i;
> +	int ret = 0;
> +
> +	for (i = 0; i < ARRAY_SIZE(cio2_supported_devices); i++) {
> +		const char *this_device = cio2_supported_devices[i];
> +
> +		for_each_acpi_dev_match(adev, this_device, NULL, -1) {
> +			if (!adev || !(adev->status.present && adev->status.enabled))
> +				continue;
> +
> +			sensor = &bridge->sensors[bridge->n_sensors];
> +			sensor->adev = adev;
> +			strscpy(sensor->name, this_device, sizeof(sensor->name));
> +
> +			ret = cio2_bridge_read_acpi_buffer(adev, "SSDB",
> +							   &sensor->ssdb,
> +							   sizeof(sensor->ssdb));
> +			if (ret < 0)
> +				goto err_put_adev;
> +
> +			if (sensor->ssdb.lanes > 4) {
> +				dev_err(&adev->dev,
> +					"Number of lanes in SSDB is invalid\n");
> +				goto err_put_adev;
> +			}
> +
> +			cio2_bridge_create_fwnode_properties(sensor);
> +			cio2_bridge_create_connection_swnodes(bridge, sensor);
> +
> +			ret = software_node_register_nodes(sensor->swnodes);
> +			if (ret)
> +				goto err_put_adev;
> +
> +			fwnode = software_node_fwnode(&sensor->swnodes[SWNODE_SENSOR_HID]);
> +			if (!fwnode) {
> +				ret = -ENODEV;
> +				goto err_free_swnodes;
> +			}
> +
> +			adev->fwnode.secondary = fwnode;
> +
> +			dev_info(&bridge->cio2->dev,
> +				 "Found supported sensor %s\n",
> +				 acpi_dev_name(adev));
> +
> +			bridge->n_sensors++;
> +		}
> +	}
> +
> +	return ret;
> +
> +err_free_swnodes:
> +	software_node_unregister_nodes(sensor->swnodes);
> +err_put_adev:
> +	acpi_dev_put(sensor->adev);
> +
> +	return ret;
> +}
> +
> +int cio2_bridge_init(struct pci_dev *cio2)
> +{
> +	struct device *dev = &cio2->dev;
> +	struct fwnode_handle *fwnode;
> +	struct cio2_bridge *bridge;
> +	int ret;
> +
> +	bridge = kzalloc(sizeof(*bridge), GFP_KERNEL);
> +	if (!bridge)
> +		return -ENOMEM;
> +
> +	strscpy(bridge->cio2_node_name, CIO2_HID, sizeof(bridge->cio2_node_name));
> +	bridge->cio2_hid_node = (const struct software_node){ bridge->cio2_node_name };
> +	bridge->cio2 = pci_dev_get(cio2);
> +
> +	ret = software_node_register(&bridge->cio2_hid_node);
> +	if (ret < 0) {
> +		dev_err(dev, "Failed to register the CIO2 HID node\n");
> +		goto err_put_cio2;
> +	}
> +
> +	ret = cio2_bridge_connect_sensors(bridge);
> +	if (ret || bridge->n_sensors == 0)
> +		goto err_unregister_cio2;
> +
> +	dev_info(dev, "Connected %d cameras\n", bridge->n_sensors);
> +
> +	fwnode = software_node_fwnode(&bridge->cio2_hid_node);
> +	if (!fwnode) {
> +		dev_err(dev, "Error getting fwnode from cio2 software_node\n");
> +		ret = -ENODEV;
> +		goto err_unregister_sensors;
> +	}
> +
> +	set_secondary_fwnode(dev, fwnode);
> +
> +	return 0;
> +
> +err_unregister_sensors:
> +	cio2_bridge_unregister_sensors(bridge);
> +err_unregister_cio2:
> +	software_node_unregister(&bridge->cio2_hid_node);
> +err_put_cio2:
> +	pci_dev_put(bridge->cio2);
> +
> +	kfree(bridge);
> +	return ret;
> +}
> diff --git a/drivers/media/pci/intel/ipu3/cio2-bridge.h b/drivers/media/pci/intel/ipu3/cio2-bridge.h
> new file mode 100644
> index 000000000000..96f5c8a12be0
> --- /dev/null
> +++ b/drivers/media/pci/intel/ipu3/cio2-bridge.h
> @@ -0,0 +1,108 @@
> +/* SPDX-License-Identifier: GPL-2.0 */
> +/* Author: Dan Scally <djrscally@gmail.com> */
> +#ifndef __CIO2_BRIDGE_H
> +#define __CIO2_BRIDGE_H
> +
> +#include <linux/property.h>
> +
> +#define CIO2_HID				"INT343E"
> +#define CIO2_NUM_PORTS			  4
> +
> +#define NODE_SENSOR(_HID, _PROPS)		\
> +	((const struct software_node) {		\
> +		.name = _HID,			\
> +		.properties = _PROPS,		\
> +	})
> +
> +#define NODE_PORT(_PORT, _SENSOR_NODE)		\
> +	((const struct software_node) {		\
> +		_PORT,				\
> +		_SENSOR_NODE,			\
> +	})
> +
> +#define NODE_ENDPOINT(_EP, _PORT, _PROPS)	\
> +	((const struct software_node) {		\
> +		_EP,				\
> +		_PORT,				\
> +		_PROPS,				\
> +	})
> +
> +enum cio2_sensor_swnodes {
> +	SWNODE_SENSOR_HID,
> +	SWNODE_SENSOR_PORT,
> +	SWNODE_SENSOR_ENDPOINT,
> +	SWNODE_CIO2_PORT,
> +	SWNODE_CIO2_ENDPOINT,
> +	NR_OF_SENSOR_SWNODES
> +};
> +
> +/* Data representation as it is in ACPI SSDB buffer */
> +struct cio2_sensor_ssdb {
> +	u8 version;
> +	u8 sku;
> +	u8 guid_csi2[16];
> +	u8 devfunction;
> +	u8 bus;
> +	u32 dphylinkenfuses;
> +	u32 clockdiv;
> +	u8 link;
> +	u8 lanes;
> +	u32 csiparams[10];
> +	u32 maxlanespeed;
> +	u8 sensorcalibfileidx;
> +	u8 sensorcalibfileidxInMBZ[3];
> +	u8 romtype;
> +	u8 vcmtype;
> +	u8 platforminfo;
> +	u8 platformsubinfo;
> +	u8 flash;
> +	u8 privacyled;
> +	u8 degree;
> +	u8 mipilinkdefined;
> +	u32 mclkspeed;
> +	u8 controllogicid;
> +	u8 reserved1[3];
> +	u8 mclkport;
> +	u8 reserved2[13];
> +} __packed__;

This should be "__packed".

> +
> +struct cio2_property_names {
> +	char clock_frequency[16];
> +	char rotation[9];
> +	char bus_type[9];
> +	char data_lanes[11];
> +	char remote_endpoint[16];
> +};
> +
> +struct cio2_node_names {
> +	char port[6];
> +	char endpoint[10];
> +	char remote_port[6];
> +};
> +
> +struct cio2_sensor {
> +	char name[ACPI_ID_LEN];
> +	struct acpi_device *adev;
> +
> +	struct software_node swnodes[6];
> +	struct cio2_node_names node_names;
> +
> +	u32 data_lanes[4];
> +	struct cio2_sensor_ssdb ssdb;
> +	struct cio2_property_names prop_names;
> +	struct property_entry ep_properties[4];
> +	struct property_entry dev_properties[3];
> +	struct property_entry cio2_properties[3];
> +	struct software_node_ref_args local_ref[1];
> +	struct software_node_ref_args remote_ref[1];
> +};
> +
> +struct cio2_bridge {
> +	struct pci_dev *cio2;
> +	char cio2_node_name[ACPI_ID_LEN];
> +	struct software_node cio2_hid_node;
> +	unsigned int n_sensors;
> +	struct cio2_sensor sensors[CIO2_NUM_PORTS];
> +};
> +
> +#endif
> diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c b/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c
> index 36e354ecf71e..0d69b593e9f0 100644
> --- a/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c
> +++ b/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c
> @@ -1702,6 +1702,22 @@ static void cio2_queues_exit(struct cio2_device *cio2)
>  		cio2_queue_exit(cio2, &cio2->queue[i]);
>  }
>  
> +static bool cio2_check_fwnode_graph(struct fwnode_handle *fwnode)
> +{
> +	struct fwnode_handle *endpoint;
> +
> +	if (IS_ERR_OR_NULL(fwnode))
> +		return false;
> +
> +	endpoint = fwnode_graph_get_next_endpoint(fwnode, NULL);
> +	if (endpoint) {
> +		fwnode_handle_put(endpoint);
> +		return true;
> +	}
> +
> +	return cio2_check_fwnode_graph(fwnode->secondary);
> +}
> +
>  /**************** PCI interface ****************/
>  
>  static int cio2_pci_probe(struct pci_dev *pci_dev,
> @@ -1715,6 +1731,17 @@ static int cio2_pci_probe(struct pci_dev *pci_dev,
>  		return -ENOMEM;
>  	cio2->pci_dev = pci_dev;
>  
> +	/*
> +	 * On some platforms no connections to sensors are defined in firmware,
> +	 * if the device has no endpoints then we can try to build those as
> +	 * software_nodes parsed from SSDB.
> +	 */
> +	if (!cio2_check_fwnode_graph(dev_fwnode(&pci_dev->dev))) {
> +		r = cio2_bridge_init(pci_dev);
> +		if (r)
> +			return r;
> +	}
> +
>  	r = pcim_enable_device(pci_dev);
>  	if (r) {
>  		dev_err(&pci_dev->dev, "failed to enable device (%d)\n", r);
> diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2.h b/drivers/media/pci/intel/ipu3/ipu3-cio2.h
> index ccf0b85ae36f..520a27c9cdad 100644
> --- a/drivers/media/pci/intel/ipu3/ipu3-cio2.h
> +++ b/drivers/media/pci/intel/ipu3/ipu3-cio2.h
> @@ -437,4 +437,10 @@ static inline struct cio2_queue *vb2q_to_cio2_queue(struct vb2_queue *vq)
>  	return container_of(vq, struct cio2_queue, vbq);
>  }
>  
> +#if IS_ENABLED(CONFIG_CIO2_BRIDGE)
> +int cio2_bridge_init(struct pci_dev *cio2);
> +#else
> +int cio2_bridge_init(struct pci_dev *cio2) { return 0; }
> +#endif
> +
>  #endif
Daniel Scally Dec. 1, 2020, 10:11 p.m. UTC | #3
On 01/12/2020 22:08, Dan Scally wrote:
>>> +
>>> +		for_each_acpi_dev_match(adev, this_device, NULL, -1) {
>>> +			if (!adev || !(adev->status.present && adev->status.enabled))
>> 			if (!adev || !adev->status.present || !adev->status.enabled))
>>
>> may be a bit more readable. Does for_each_acpi_dev_match() return NULL
>> devices though ? If no, you could drop the !adev check. You may also be
>> able to drop the !present check, as I don't think ACPI allows !present
>> && enabled.
> You're right, the spec mandates enabled be 0 if present is 0. The
> iterator will return NULL when the previous return value was the last
> matching device, so that part needs to stay, but it can become:
>
> if (!adev || !adev->status.enabled)
>
Wait, that's silly, the loop won't start if the check is null so you're
right of course.
Laurent Pinchart Dec. 1, 2020, 10:30 p.m. UTC | #4
Hi Daniel,

On Tue, Dec 01, 2020 at 10:08:25PM +0000, Dan Scally wrote:
> On 30/11/2020 17:09, Laurent Pinchart wrote:

> > On Mon, Nov 30, 2020 at 01:31:24PM +0000, Daniel Scally wrote:

> >> Currently on platforms designed for Windows, connections between CIO2 and

> >> sensors are not properly defined in DSDT. This patch extends the ipu3-cio2

> >> driver to compensate by building software_node connections, parsing the

> >> connection properties from the sensor's SSDB buffer.

> >>

> >> Suggested-by: Jordan Hand <jorhand@linux.microsoft.com>

> >> Signed-off-by: Daniel Scally <djrscally@gmail.com>

> >> ---

> >> Changes since RFC v3:

> >>

> >> 	- Removed almost all global variables, dynamically allocated

> >> 	the cio2_bridge structure, plus a bunch of associated changes

> >> 	like 

> >> 	- Added a new function to ipu3-cio2-main.c to check for an 

> >> 	existing fwnode_graph before calling cio2_bridge_init()

> >> 	- Prefixed cio2_bridge_ to any variables and functions that

> >> 	lacked it

> >> 	- Assigned the new fwnode directly to the sensor's ACPI device

> >> 	fwnode as secondary. This removes the requirement to delay until

> >> 	the I2C devices are instantiated before ipu3-cio2 can probe, but

> >> 	it has a side effect, which is that those devices then grab a ref

> >> 	to the new software_node. This effectively prevents us from

> >> 	unloading the driver, because we can't free the memory that they

> >> 	live in whilst the device holds a reference to them. The work

> >> 	around at the moment is to _not_ unregister the software_nodes

> >> 	when ipu3-cio2 is unloaded; this becomes a one-time 'patch', that

> >> 	is simply skipped if the module is reloaded.

> >> 	- Moved the sensor's SSDB struct to be a member of cio2_sensor

> >> 	- Replaced ints with unsigned ints where appropriate

> >> 	- Iterated over all ACPI devices of a matching _HID rather than

> >> 	just the first to ensure we handle a device with multiple sensors

> >> 	of the same model.

> >>

> >>  MAINTAINERS                                   |   1 +

> >>  drivers/media/pci/intel/ipu3/Kconfig          |  18 ++

> >>  drivers/media/pci/intel/ipu3/Makefile         |   1 +

> >>  drivers/media/pci/intel/ipu3/cio2-bridge.c    | 260 ++++++++++++++++++

> >>  drivers/media/pci/intel/ipu3/cio2-bridge.h    | 108 ++++++++

> >>  drivers/media/pci/intel/ipu3/ipu3-cio2-main.c |  27 ++

> >>  drivers/media/pci/intel/ipu3/ipu3-cio2.h      |   6 +

> >>  7 files changed, 421 insertions(+)

> >>  create mode 100644 drivers/media/pci/intel/ipu3/cio2-bridge.c

> >>  create mode 100644 drivers/media/pci/intel/ipu3/cio2-bridge.h

> >>

> >> diff --git a/MAINTAINERS b/MAINTAINERS

> >> index 9702b886d6a4..188559a0a610 100644

> >> --- a/MAINTAINERS

> >> +++ b/MAINTAINERS

> >> @@ -8927,6 +8927,7 @@ INTEL IPU3 CSI-2 CIO2 DRIVER

> >>  M:	Yong Zhi <yong.zhi@intel.com>

> >>  M:	Sakari Ailus <sakari.ailus@linux.intel.com>

> >>  M:	Bingbu Cao <bingbu.cao@intel.com>

> >> +M:	Dan Scally <djrscally@gmail.com>

> >>  R:	Tianshu Qiu <tian.shu.qiu@intel.com>

> >>  L:	linux-media@vger.kernel.org

> >>  S:	Maintained

> >> diff --git a/drivers/media/pci/intel/ipu3/Kconfig b/drivers/media/pci/intel/ipu3/Kconfig

> >> index 82d7f17e6a02..2b3350d042be 100644

> >> --- a/drivers/media/pci/intel/ipu3/Kconfig

> >> +++ b/drivers/media/pci/intel/ipu3/Kconfig

> >> @@ -16,3 +16,21 @@ config VIDEO_IPU3_CIO2

> >>  	  Say Y or M here if you have a Skylake/Kaby Lake SoC with MIPI CSI-2

> >>  	  connected camera.

> >>  	  The module will be called ipu3-cio2.

> >> +

> >> +config CIO2_BRIDGE

> >> +	bool "IPU3 CIO2 Sensors Bridge"

> >> +	depends on VIDEO_IPU3_CIO2

> >> +	help

> >> +	  This extension provides an API for the ipu3-cio2 driver to create

> >> +	  connections to cameras that are hidden in SSDB buffer in ACPI. It

> >> +	  can be used to enable support for cameras in detachable / hybrid

> >> +	  devices that ship with Windows.

> >> +

> >> +	  Say Y here if your device is a detachable / hybrid laptop that comes

> >> +	  with Windows installed by the OEM, for example:

> >> +

> >> +	  	- Microsoft Surface models (except Surface Pro 3)

> >> +		- The Lenovo Miix line (for example the 510, 520, 710 and 720)

> >> +		- Dell 7285

> >> +

> >> +	  If in doubt, say N here.

> >> diff --git a/drivers/media/pci/intel/ipu3/Makefile b/drivers/media/pci/intel/ipu3/Makefile

> >> index 429d516452e4..933777e6ea8a 100644

> >> --- a/drivers/media/pci/intel/ipu3/Makefile

> >> +++ b/drivers/media/pci/intel/ipu3/Makefile

> >> @@ -2,3 +2,4 @@

> >>  obj-$(CONFIG_VIDEO_IPU3_CIO2) += ipu3-cio2.o

> >>  

> >>  ipu3-cio2-y += ipu3-cio2-main.o

> >> +ipu3-cio2-$(CONFIG_CIO2_BRIDGE) += cio2-bridge.o

> >> diff --git a/drivers/media/pci/intel/ipu3/cio2-bridge.c b/drivers/media/pci/intel/ipu3/cio2-bridge.c

> >> new file mode 100644

> >> index 000000000000..fd3f8ba07274

> >> --- /dev/null

> >> +++ b/drivers/media/pci/intel/ipu3/cio2-bridge.c

> >> @@ -0,0 +1,260 @@

> >> +// SPDX-License-Identifier: GPL-2.0

> >> +/* Author: Dan Scally <djrscally@gmail.com> */

> > 

> > Could you please add a blank line here ?

> 

> Yes

>

> >> +#include <linux/acpi.h>

> >> +#include <linux/device.h>

> >> +#include <linux/i2c.h>

> > 

> > Is this header needed ?

> > 

> >> +#include <linux/kernel.h>

> >> +#include <linux/module.h>

> > 

> > And this one ?

> > 

> >> +#include <linux/pci.h>

> >> +#include <linux/property.h>

> >> +#include <media/v4l2-subdev.h>

> > 

> > And this one ?

> 

> Ah yes - bit sloppy, they're orphaned from earlier versions, sorry about

> that.

> 

> >> +

> >> +#include "cio2-bridge.h"

> >> +

> >> +/*

> >> + * Extend this array with ACPI Hardware ID's of devices known to be working.

> >> + * Do not add a HID for a sensor that is not actually supported.

> >> + */

> >> +static const char * const cio2_supported_devices[] = {

> > 

> > Maybe cio2_supported_sensors ?

> 

> Sure

> 

> >> +	"INT33BE",

> >> +	"OVTI2680",

> >> +};

> >> +

> >> +static int cio2_bridge_read_acpi_buffer(struct acpi_device *adev, char *id,

> >> +					void *data, u32 size)

> >> +{

> >> +	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };

> >> +	union acpi_object *obj;

> >> +	acpi_status status;

> >> +	int ret;

> >> +

> >> +	status = acpi_evaluate_object(adev->handle, id, NULL, &buffer);

> >> +	if (ACPI_FAILURE(status))

> >> +		return -ENODEV;

> >> +

> >> +	obj = buffer.pointer;

> >> +	if (!obj) {

> >> +		dev_err(&adev->dev, "Couldn't locate ACPI buffer\n");

> >> +		return -ENODEV;

> >> +	}

> >> +

> >> +	if (obj->type != ACPI_TYPE_BUFFER) {

> >> +		dev_err(&adev->dev, "Not an ACPI buffer\n");

> >> +		ret = -ENODEV;

> >> +		goto out_free_buff;

> >> +	}

> >> +

> >> +	if (obj->buffer.length > size) {

> >> +		dev_err(&adev->dev, "Given buffer is too small\n");

> >> +		ret = -EINVAL;

> >> +		goto out_free_buff;

> >> +	}

> >> +

> >> +	memcpy(data, obj->buffer.pointer, obj->buffer.length);

> >> +	ret = obj->buffer.length;

> >> +

> >> +out_free_buff:

> >> +	kfree(buffer.pointer);

> >> +	return ret;

> >> +}

> >> +

> >> +static void cio2_bridge_init_property_names(struct cio2_sensor *sensor)

> >> +{

> >> +	strcpy(sensor->prop_names.clock_frequency, "clock-frequency");

> >> +	strcpy(sensor->prop_names.rotation, "rotation");

> >> +	strcpy(sensor->prop_names.bus_type, "bus-type");

> >> +	strcpy(sensor->prop_names.data_lanes, "data-lanes");

> >> +	strcpy(sensor->prop_names.remote_endpoint, "remote-endpoint");

> > 

> > This is a bit fragile, as there's no len check. How about the following

> > ?

> > static const struct cio2_property_names prop_names = {

> > 	.clock_frequency = "clock-frequency",

> > 	.rotation = "rotation",

> > 	.bus_type = "bus-type",

> > 	.data_lanes = "data-lanes",

> > 	.remote_endpoint = "remote-endpoint",

> > };

> > 

> > static void cio2_bridge_init_property_names(struct cio2_sensor *sensor)

> > {

> > 	sensor->prop_names = prop_names;

> > }

> > 

> > This shoudl generate a compilation warning if the string is too long.

> > 

> > You could even inline that line in

> > cio2_bridge_create_fwnode_properties().

> 

> Yes, I like that, thanks - I'll make the change.

> 

> >> +}

> >> +

> >> +static void cio2_bridge_create_fwnode_properties(struct cio2_sensor *sensor)

> >> +{

> >> +	unsigned int i;

> >> +

> >> +	cio2_bridge_init_property_names(sensor);

> >> +

> >> +	for (i = 0; i < 4; i++)

> >> +		sensor->data_lanes[i] = i + 1;

> > 

> > Is there no provision in the SSDB for data lane remapping ?

> 

> Sorry; don't follow what you mean by data lane remapping here.


Some CSI-2 receivers can remap data lanes. The routing inside the SoC
from the data lane input pins to the PHYs is configurable. This makes
board design easier as you can route the data lanes to any of the
inputs. That's why the data lanes DT property is a list of lane numbers
instead of a number of lanes. I'm actually not sure if the CIO2 supports
this.
 
> >> +

> >> +	/*

> >> +	 * Can't use PROPERTY_ENTRY_REF because it creates a new variable to

> >> +	 * point to, which doesn't survive the function.

> >> +	 */

> >> +	sensor->local_ref[0] = (struct software_node_ref_args){

> >> +		.node = &sensor->swnodes[SWNODE_CIO2_ENDPOINT]

> >> +		};

> > 

> > I'd remove one tab here. Or just write

> > 

> > 	sensor->local_ref[0].node = &sensor->swnodes[SWNODE_CIO2_ENDPOINT];

> 

> Yep, changed.

> 

> >> +	sensor->remote_ref[0] = (struct software_node_ref_args){

> >> +		.node = &sensor->swnodes[SWNODE_SENSOR_ENDPOINT]

> >> +		};

> >> +

> >> +	sensor->dev_properties[0] = PROPERTY_ENTRY_U32(sensor->prop_names.clock_frequency,

> >> +						       sensor->ssdb.mclkspeed);

> >> +	sensor->dev_properties[1] = PROPERTY_ENTRY_U8(sensor->prop_names.rotation,

> >> +						      sensor->ssdb.degree);

> >> +

> >> +	sensor->ep_properties[0] = PROPERTY_ENTRY_U32(sensor->prop_names.bus_type, 5);

> >> +	sensor->ep_properties[1] = PROPERTY_ENTRY_U32_ARRAY_LEN(sensor->prop_names.data_lanes,

> >> +								sensor->data_lanes,

> >> +								sensor->ssdb.lanes);

> >> +	sensor->ep_properties[2] = PROPERTY_ENTRY_REF_ARRAY(sensor->prop_names.remote_endpoint,

> >> +							    sensor->local_ref);

> >> +

> >> +	sensor->cio2_properties[0] = PROPERTY_ENTRY_U32_ARRAY_LEN(sensor->prop_names.data_lanes,

> >> +								  sensor->data_lanes,

> >> +								  sensor->ssdb.lanes);

> >> +	sensor->cio2_properties[1] = PROPERTY_ENTRY_REF_ARRAY(sensor->prop_names.remote_endpoint,

> >> +							      sensor->remote_ref);

> >> +}

> >> +

> >> +static void cio2_bridge_init_swnode_names(struct cio2_sensor *sensor)

> >> +{

> >> +	snprintf(sensor->node_names.remote_port, 6, "port%u", sensor->ssdb.link);

> >> +	strcpy(sensor->node_names.port, "port0");

> >> +	strcpy(sensor->node_names.endpoint, "endpoint0");

> >> +}

> >> +

> >> +static void cio2_bridge_create_connection_swnodes(struct cio2_bridge *bridge,

> >> +						  struct cio2_sensor *sensor)

> >> +{

> >> +	struct software_node *nodes = sensor->swnodes;

> >> +

> >> +	cio2_bridge_init_swnode_names(sensor);

> >> +

> >> +	nodes[SWNODE_SENSOR_HID] = NODE_SENSOR(sensor->name,

> >> +					       sensor->dev_properties);

> >> +	nodes[SWNODE_SENSOR_PORT] = NODE_PORT(sensor->node_names.port,

> >> +					      &nodes[SWNODE_SENSOR_HID]);

> >> +	nodes[SWNODE_SENSOR_ENDPOINT] = NODE_ENDPOINT(sensor->node_names.endpoint,

> >> +						      &nodes[SWNODE_SENSOR_PORT],

> >> +						      sensor->ep_properties);

> >> +	nodes[SWNODE_CIO2_PORT] = NODE_PORT(sensor->node_names.remote_port,

> >> +					    &bridge->cio2_hid_node);

> >> +	nodes[SWNODE_CIO2_ENDPOINT] = NODE_ENDPOINT(sensor->node_names.endpoint,

> >> +						    &nodes[SWNODE_CIO2_PORT],

> >> +						    sensor->cio2_properties);

> >> +}

> >> +

> >> +static void cio2_bridge_unregister_sensors(struct cio2_bridge *bridge)

> >> +{

> >> +	struct cio2_sensor *sensor;

> >> +	unsigned int i;

> >> +

> >> +	for (i = 0; i < bridge->n_sensors; i++) {

> >> +		sensor = &bridge->sensors[i];

> >> +		software_node_unregister_nodes(sensor->swnodes);

> >> +		acpi_dev_put(sensor->adev);

> >> +	}

> >> +}

> >> +

> >> +static int cio2_bridge_connect_sensors(struct cio2_bridge *bridge)

> >> +{

> >> +	struct fwnode_handle *fwnode;

> >> +	struct cio2_sensor *sensor;

> >> +	struct acpi_device *adev;

> >> +	unsigned int i;

> >> +	int ret = 0;

> >> +

> >> +	for (i = 0; i < ARRAY_SIZE(cio2_supported_devices); i++) {

> >> +		const char *this_device = cio2_supported_devices[i];

> > 

> > s/this_device/name/ (or sensor_name, ...) ?

> 

> I went for hid as Andy suggested.

>

> > 

> >> +

> >> +		for_each_acpi_dev_match(adev, this_device, NULL, -1) {

> >> +			if (!adev || !(adev->status.present && adev->status.enabled))

> > 

> > 			if (!adev || !adev->status.present || !adev->status.enabled))

> > 

> > may be a bit more readable. Does for_each_acpi_dev_match() return NULL

> > devices though ? If no, you could drop the !adev check. You may also be

> > able to drop the !present check, as I don't think ACPI allows !present

> > && enabled.

> 

> You're right, the spec mandates enabled be 0 if present is 0. The

> iterator will return NULL when the previous return value was the last

> matching device, so that part needs to stay, but it can become:

> 

> if (!adev || !adev->status.enabled)


As you've commented out in a reply, the loop will stop when adev is NULL
:-)

> >> +				continue;

> >> +

> >> +			sensor = &bridge->sensors[bridge->n_sensors];

> >> +			sensor->adev = adev;

> >> +			strscpy(sensor->name, this_device, sizeof(sensor->name));

> >> +

> >> +			ret = cio2_bridge_read_acpi_buffer(adev, "SSDB",

> >> +							   &sensor->ssdb,

> >> +							   sizeof(sensor->ssdb));

> >> +			if (ret < 0)

> >> +				goto err_put_adev;

> >> +

> >> +			if (sensor->ssdb.lanes > 4) {

> >> +				dev_err(&adev->dev,

> >> +					"Number of lanes in SSDB is invalid\n");

> >> +				goto err_put_adev;

> >> +			}

> >> +

> >> +			cio2_bridge_create_fwnode_properties(sensor);

> >> +			cio2_bridge_create_connection_swnodes(bridge, sensor);

> >> +

> >> +			ret = software_node_register_nodes(sensor->swnodes);

> >> +			if (ret)

> >> +				goto err_put_adev;

> >> +

> >> +			fwnode = software_node_fwnode(&sensor->swnodes[SWNODE_SENSOR_HID]);

> >> +			if (!fwnode) {

> >> +				ret = -ENODEV;

> >> +				goto err_free_swnodes;

> >> +			}

> >> +

> >> +			adev->fwnode.secondary = fwnode;

> >> +

> >> +			dev_info(&bridge->cio2->dev,

> >> +				 "Found supported sensor %s\n",

> >> +				 acpi_dev_name(adev));

> >> +

> >> +			bridge->n_sensors++;

> > 

> > We probably want a check here to avoid overflowing bridge->sensors. The

> > other option is to make bridge->sensors a struct list_head and allocate

> > sensors dynamically.

> 

> Err - agree on a check. There's only 4 ports in a CIO2 device, so that's

> the maximum. Seems easier to just do a check, unless the wasted memory

> is enough that it's worth allocating dynamically. I don't mind either

> approach.


In theory we could route multiple sensors to the same receiver, as long
as only one of them drives the lanes at any given time. It's one way to
support multiple sensors in cheap designs. I doubt we'll ever encounter
that with the IPU3, so we could just limit the count to 4.

> >> +		}

> >> +	}

> >> +

> >> +	return ret;

> >> +

> >> +err_free_swnodes:

> >> +	software_node_unregister_nodes(sensor->swnodes);

> >> +err_put_adev:

> >> +	acpi_dev_put(sensor->adev);

> >> +

> >> +	return ret;

> >> +}

> >> +

> >> +int cio2_bridge_init(struct pci_dev *cio2)

> >> +{

> >> +	struct device *dev = &cio2->dev;

> >> +	struct fwnode_handle *fwnode;

> >> +	struct cio2_bridge *bridge;

> >> +	int ret;

> >> +

> >> +	bridge = kzalloc(sizeof(*bridge), GFP_KERNEL);

> >> +	if (!bridge)

> >> +		return -ENOMEM;

> >> +

> >> +	strscpy(bridge->cio2_node_name, CIO2_HID, sizeof(bridge->cio2_node_name));

> >> +	bridge->cio2_hid_node = (const struct software_node){ bridge->cio2_node_name };

> > 

> > Maybe just

> > 

> > 	bridge->cio2_hid_node.name = bridge->cio2_node_name;

> > 

> > as the rest is already zeroed by the kzalloc() call ?

> > 

> >> +	bridge->cio2 = pci_dev_get(cio2);

> > 

> > As the cio2 pointer is only used to print a message in

> > cio2_bridge_connect_sensors(), do we need to store it in the bridge

> > structure, and take a reference to the device ?

> > 

> >> +

> >> +	ret = software_node_register(&bridge->cio2_hid_node);

> >> +	if (ret < 0) {

> >> +		dev_err(dev, "Failed to register the CIO2 HID node\n");

> >> +		goto err_put_cio2;

> >> +	}

> >> +

> >> +	ret = cio2_bridge_connect_sensors(bridge);

> >> +	if (ret || bridge->n_sensors == 0)

> >> +		goto err_unregister_cio2;

> >> +

> >> +	dev_info(dev, "Connected %d cameras\n", bridge->n_sensors);

> >> +

> >> +	fwnode = software_node_fwnode(&bridge->cio2_hid_node);

> >> +	if (!fwnode) {

> >> +		dev_err(dev, "Error getting fwnode from cio2 software_node\n");

> >> +		ret = -ENODEV;

> >> +		goto err_unregister_sensors;

> > 

> > Can this happen ?

> 

> It _shouldn't_ happen, as long as nothing else is touching the swnodes

> I've registered or anything. I've never seen it happen. That didn't feel

> like quite enough to say it can't ever happen - but I'm happy to skip

> the check if you think thats ok.


It seems a bit overkill to me, but I'm not a swnode specialist :-)

> >> +	}

> >> +

> >> +	set_secondary_fwnode(dev, fwnode);

> >> +

> >> +	return 0;

> >> +

> >> +err_unregister_sensors:

> >> +	cio2_bridge_unregister_sensors(bridge);

> >> +err_unregister_cio2:

> >> +	software_node_unregister(&bridge->cio2_hid_node);

> >> +err_put_cio2:

> >> +	pci_dev_put(bridge->cio2);

> >> +

> >> +	kfree(bridge);

> >> +	return ret;

> >> +}

> >> diff --git a/drivers/media/pci/intel/ipu3/cio2-bridge.h b/drivers/media/pci/intel/ipu3/cio2-bridge.h

> >> new file mode 100644

> >> index 000000000000..96f5c8a12be0

> >> --- /dev/null

> >> +++ b/drivers/media/pci/intel/ipu3/cio2-bridge.h

> > 

> > This file is only included by cio2-bridge.c, so you could inline it

> > there. Up to you.

> 

> I think I like them separate

> 

> >> @@ -0,0 +1,108 @@

> >> +/* SPDX-License-Identifier: GPL-2.0 */

> >> +/* Author: Dan Scally <djrscally@gmail.com> */

> >> +#ifndef __CIO2_BRIDGE_H

> >> +#define __CIO2_BRIDGE_H

> >> +

> >> +#include <linux/property.h>

> >> +

> >> +#define CIO2_HID				"INT343E"

> >> +#define CIO2_NUM_PORTS			  4

> > 

> > There are a few rogue spaces before '4'.

> 

> Argh, thanks, this is the curse of using VS code on multiple machines...


I recommend vim ;-)

> >> +

> >> +#define NODE_SENSOR(_HID, _PROPS)		\

> >> +	((const struct software_node) {		\

> >> +		.name = _HID,			\

> >> +		.properties = _PROPS,		\

> >> +	})

> >> +

> >> +#define NODE_PORT(_PORT, _SENSOR_NODE)		\

> >> +	((const struct software_node) {		\

> >> +		_PORT,				\

> >> +		_SENSOR_NODE,			\

> >> +	})

> >> +

> >> +#define NODE_ENDPOINT(_EP, _PORT, _PROPS)	\

> >> +	((const struct software_node) {		\

> >> +		_EP,				\

> >> +		_PORT,				\

> >> +		_PROPS,				\

> >> +	})

> >> +

> >> +enum cio2_sensor_swnodes {

> >> +	SWNODE_SENSOR_HID,

> >> +	SWNODE_SENSOR_PORT,

> >> +	SWNODE_SENSOR_ENDPOINT,

> >> +	SWNODE_CIO2_PORT,

> >> +	SWNODE_CIO2_ENDPOINT,

> >> +	NR_OF_SENSOR_SWNODES

> >> +};

> >> +

> >> +/* Data representation as it is in ACPI SSDB buffer */

> >> +struct cio2_sensor_ssdb {

> >> +	u8 version;

> >> +	u8 sku;

> >> +	u8 guid_csi2[16];

> >> +	u8 devfunction;

> >> +	u8 bus;

> >> +	u32 dphylinkenfuses;

> >> +	u32 clockdiv;

> >> +	u8 link;

> >> +	u8 lanes;

> >> +	u32 csiparams[10];

> >> +	u32 maxlanespeed;

> >> +	u8 sensorcalibfileidx;

> >> +	u8 sensorcalibfileidxInMBZ[3];

> >> +	u8 romtype;

> >> +	u8 vcmtype;

> >> +	u8 platforminfo;

> >> +	u8 platformsubinfo;

> >> +	u8 flash;

> >> +	u8 privacyled;

> >> +	u8 degree;

> >> +	u8 mipilinkdefined;

> >> +	u32 mclkspeed;

> >> +	u8 controllogicid;

> >> +	u8 reserved1[3];

> >> +	u8 mclkport;

> >> +	u8 reserved2[13];

> >> +} __packed__;

> >> +

> >> +struct cio2_property_names {

> >> +	char clock_frequency[16];

> >> +	char rotation[9];

> >> +	char bus_type[9];

> >> +	char data_lanes[11];

> >> +	char remote_endpoint[16];

> >> +};

> >> +

> >> +struct cio2_node_names {

> >> +	char port[6];

> >> +	char endpoint[10];

> >> +	char remote_port[6];

> >> +};

> >> +

> >> +struct cio2_sensor {

> >> +	char name[ACPI_ID_LEN];

> >> +	struct acpi_device *adev;

> >> +

> >> +	struct software_node swnodes[6];

> >> +	struct cio2_node_names node_names;

> >> +

> >> +	u32 data_lanes[4];

> >> +	struct cio2_sensor_ssdb ssdb;

> >> +	struct cio2_property_names prop_names;

> >> +	struct property_entry ep_properties[4];

> >> +	struct property_entry dev_properties[3];

> >> +	struct property_entry cio2_properties[3];

> >> +	struct software_node_ref_args local_ref[1];

> >> +	struct software_node_ref_args remote_ref[1];

> >> +};

> >> +

> >> +struct cio2_bridge {

> >> +	struct pci_dev *cio2;

> >> +	char cio2_node_name[ACPI_ID_LEN];

> >> +	struct software_node cio2_hid_node;

> >> +	unsigned int n_sensors;

> >> +	struct cio2_sensor sensors[CIO2_NUM_PORTS];

> >> +};

> >> +

> >> +#endif

> >> diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c b/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c

> >> index 36e354ecf71e..0d69b593e9f0 100644

> >> --- a/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c

> >> +++ b/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c

> >> @@ -1702,6 +1702,22 @@ static void cio2_queues_exit(struct cio2_device *cio2)

> >>  		cio2_queue_exit(cio2, &cio2->queue[i]);

> >>  }

> >>  

> >> +static bool cio2_check_fwnode_graph(struct fwnode_handle *fwnode)

> >> +{

> >> +	struct fwnode_handle *endpoint;

> >> +

> >> +	if (IS_ERR_OR_NULL(fwnode))

> >> +		return false;

> >> +

> >> +	endpoint = fwnode_graph_get_next_endpoint(fwnode, NULL);

> >> +	if (endpoint) {

> >> +		fwnode_handle_put(endpoint);

> >> +		return true;

> >> +	}

> >> +

> >> +	return cio2_check_fwnode_graph(fwnode->secondary);

> > 

> > If we have a fwnode->secondary and this check fails there's something

> > seriously wrong, I wonder if we should print an error message.

> 

> Yes, probably a good thought, since nothing will work in that case. I'll

> add something appropriate.

> 

> > Overall this is nice. I think the next version will get my ack :-)

> 

> Excellent :)

> 

> >> +}

> >> +

> >>  /**************** PCI interface ****************/

> >>  

> >>  static int cio2_pci_probe(struct pci_dev *pci_dev,

> >> @@ -1715,6 +1731,17 @@ static int cio2_pci_probe(struct pci_dev *pci_dev,

> >>  		return -ENOMEM;

> >>  	cio2->pci_dev = pci_dev;

> >>  

> >> +	/*

> >> +	 * On some platforms no connections to sensors are defined in firmware,

> >> +	 * if the device has no endpoints then we can try to build those as

> >> +	 * software_nodes parsed from SSDB.

> >> +	 */

> >> +	if (!cio2_check_fwnode_graph(dev_fwnode(&pci_dev->dev))) {

> >> +		r = cio2_bridge_init(pci_dev);

> >> +		if (r)

> >> +			return r;

> >> +	}

> >> +

> >>  	r = pcim_enable_device(pci_dev);

> >>  	if (r) {

> >>  		dev_err(&pci_dev->dev, "failed to enable device (%d)\n", r);

> >> diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2.h b/drivers/media/pci/intel/ipu3/ipu3-cio2.h

> >> index ccf0b85ae36f..520a27c9cdad 100644

> >> --- a/drivers/media/pci/intel/ipu3/ipu3-cio2.h

> >> +++ b/drivers/media/pci/intel/ipu3/ipu3-cio2.h

> >> @@ -437,4 +437,10 @@ static inline struct cio2_queue *vb2q_to_cio2_queue(struct vb2_queue *vq)

> >>  	return container_of(vq, struct cio2_queue, vbq);

> >>  }

> >>  

> >> +#if IS_ENABLED(CONFIG_CIO2_BRIDGE)

> >> +int cio2_bridge_init(struct pci_dev *cio2);

> >> +#else

> >> +int cio2_bridge_init(struct pci_dev *cio2) { return 0; }

> >> +#endif

> >> +

> >>  #endif


-- 
Regards,

Laurent Pinchart
Daniel Scally Dec. 1, 2020, 11:15 p.m. UTC | #5
Hi Laurent
On 01/12/2020 22:30, Laurent Pinchart wrote:
>>>> +}
>>>> +
>>>> +static void cio2_bridge_create_fwnode_properties(struct cio2_sensor *sensor)
>>>> +{
>>>> +	unsigned int i;
>>>> +
>>>> +	cio2_bridge_init_property_names(sensor);
>>>> +
>>>> +	for (i = 0; i < 4; i++)
>>>> +		sensor->data_lanes[i] = i + 1;
>>> Is there no provision in the SSDB for data lane remapping ?
>> Sorry; don't follow what you mean by data lane remapping here.
> Some CSI-2 receivers can remap data lanes. The routing inside the SoC
> from the data lane input pins to the PHYs is configurable. This makes
> board design easier as you can route the data lanes to any of the
> inputs. That's why the data lanes DT property is a list of lane numbers
> instead of a number of lanes. I'm actually not sure if the CIO2 supports
> this.

I don't see anything in the SSDB that might refer to that, though of
course we're lacking documentation for it so it could be a part that we
don't understand yet.


>>>> +			dev_info(&bridge->cio2->dev,
>>>> +				 "Found supported sensor %s\n",
>>>> +				 acpi_dev_name(adev));
>>>> +
>>>> +			bridge->n_sensors++;
>>> We probably want a check here to avoid overflowing bridge->sensors. The
>>> other option is to make bridge->sensors a struct list_head and allocate
>>> sensors dynamically.
>> Err - agree on a check. There's only 4 ports in a CIO2 device, so that's
>> the maximum. Seems easier to just do a check, unless the wasted memory
>> is enough that it's worth allocating dynamically. I don't mind either
>> approach.
> In theory we could route multiple sensors to the same receiver, as long
> as only one of them drives the lanes at any given time. It's one way to
> support multiple sensors in cheap designs. I doubt we'll ever encounter
> that with the IPU3, so we could just limit the count to 4.
Ah, that's neat though. But I'll leave it at a check at the top of the
loop for now.
>>>> +
>>>> +	fwnode = software_node_fwnode(&bridge->cio2_hid_node);
>>>> +	if (!fwnode) {
>>>> +		dev_err(dev, "Error getting fwnode from cio2 software_node\n");
>>>> +		ret = -ENODEV;
>>>> +		goto err_unregister_sensors;
>>> Can this happen ?
>> It _shouldn't_ happen, as long as nothing else is touching the swnodes
>> I've registered or anything. I've never seen it happen. That didn't feel
>> like quite enough to say it can't ever happen - but I'm happy to skip
>> the check if you think thats ok.
> It seems a bit overkill to me, but I'm not a swnode specialist :-)
I'm going to keep it, if you have no strong feelings, partly through
caution but also because the other place swnodes are most heavily used
(drivers/platform/x86/intel_cht_int33fe_typec.c) _does_ perform the
check, so consistency too.
>>>> @@ -0,0 +1,108 @@
>>>> +/* SPDX-License-Identifier: GPL-2.0 */
>>>> +/* Author: Dan Scally <djrscally@gmail.com> */
>>>> +#ifndef __CIO2_BRIDGE_H
>>>> +#define __CIO2_BRIDGE_H
>>>> +
>>>> +#include <linux/property.h>
>>>> +
>>>> +#define CIO2_HID				"INT343E"
>>>> +#define CIO2_NUM_PORTS			  4
>>> There are a few rogue spaces before '4'.
>> Argh, thanks, this is the curse of using VS code on multiple machines...
> I recommend vim ;-)
You're not the only one - maybe I need to spend the time and it'll save
time in the future
Sakari Ailus Dec. 2, 2020, 10:38 a.m. UTC | #6
Hi Laurent,

On Wed, Dec 02, 2020 at 12:30:53AM +0200, Laurent Pinchart wrote:
> Hi Daniel,

> 

> On Tue, Dec 01, 2020 at 10:08:25PM +0000, Dan Scally wrote:

> > On 30/11/2020 17:09, Laurent Pinchart wrote:

> > > On Mon, Nov 30, 2020 at 01:31:24PM +0000, Daniel Scally wrote:

> > >> Currently on platforms designed for Windows, connections between CIO2 and

> > >> sensors are not properly defined in DSDT. This patch extends the ipu3-cio2

> > >> driver to compensate by building software_node connections, parsing the

> > >> connection properties from the sensor's SSDB buffer.

> > >>

> > >> Suggested-by: Jordan Hand <jorhand@linux.microsoft.com>

> > >> Signed-off-by: Daniel Scally <djrscally@gmail.com>

> > >> ---

> > >> Changes since RFC v3:

> > >>

> > >> 	- Removed almost all global variables, dynamically allocated

> > >> 	the cio2_bridge structure, plus a bunch of associated changes

> > >> 	like 

> > >> 	- Added a new function to ipu3-cio2-main.c to check for an 

> > >> 	existing fwnode_graph before calling cio2_bridge_init()

> > >> 	- Prefixed cio2_bridge_ to any variables and functions that

> > >> 	lacked it

> > >> 	- Assigned the new fwnode directly to the sensor's ACPI device

> > >> 	fwnode as secondary. This removes the requirement to delay until

> > >> 	the I2C devices are instantiated before ipu3-cio2 can probe, but

> > >> 	it has a side effect, which is that those devices then grab a ref

> > >> 	to the new software_node. This effectively prevents us from

> > >> 	unloading the driver, because we can't free the memory that they

> > >> 	live in whilst the device holds a reference to them. The work

> > >> 	around at the moment is to _not_ unregister the software_nodes

> > >> 	when ipu3-cio2 is unloaded; this becomes a one-time 'patch', that

> > >> 	is simply skipped if the module is reloaded.

> > >> 	- Moved the sensor's SSDB struct to be a member of cio2_sensor

> > >> 	- Replaced ints with unsigned ints where appropriate

> > >> 	- Iterated over all ACPI devices of a matching _HID rather than

> > >> 	just the first to ensure we handle a device with multiple sensors

> > >> 	of the same model.

> > >>

> > >>  MAINTAINERS                                   |   1 +

> > >>  drivers/media/pci/intel/ipu3/Kconfig          |  18 ++

> > >>  drivers/media/pci/intel/ipu3/Makefile         |   1 +

> > >>  drivers/media/pci/intel/ipu3/cio2-bridge.c    | 260 ++++++++++++++++++

> > >>  drivers/media/pci/intel/ipu3/cio2-bridge.h    | 108 ++++++++

> > >>  drivers/media/pci/intel/ipu3/ipu3-cio2-main.c |  27 ++

> > >>  drivers/media/pci/intel/ipu3/ipu3-cio2.h      |   6 +

> > >>  7 files changed, 421 insertions(+)

> > >>  create mode 100644 drivers/media/pci/intel/ipu3/cio2-bridge.c

> > >>  create mode 100644 drivers/media/pci/intel/ipu3/cio2-bridge.h

> > >>

> > >> diff --git a/MAINTAINERS b/MAINTAINERS

> > >> index 9702b886d6a4..188559a0a610 100644

> > >> --- a/MAINTAINERS

> > >> +++ b/MAINTAINERS

> > >> @@ -8927,6 +8927,7 @@ INTEL IPU3 CSI-2 CIO2 DRIVER

> > >>  M:	Yong Zhi <yong.zhi@intel.com>

> > >>  M:	Sakari Ailus <sakari.ailus@linux.intel.com>

> > >>  M:	Bingbu Cao <bingbu.cao@intel.com>

> > >> +M:	Dan Scally <djrscally@gmail.com>

> > >>  R:	Tianshu Qiu <tian.shu.qiu@intel.com>

> > >>  L:	linux-media@vger.kernel.org

> > >>  S:	Maintained

> > >> diff --git a/drivers/media/pci/intel/ipu3/Kconfig b/drivers/media/pci/intel/ipu3/Kconfig

> > >> index 82d7f17e6a02..2b3350d042be 100644

> > >> --- a/drivers/media/pci/intel/ipu3/Kconfig

> > >> +++ b/drivers/media/pci/intel/ipu3/Kconfig

> > >> @@ -16,3 +16,21 @@ config VIDEO_IPU3_CIO2

> > >>  	  Say Y or M here if you have a Skylake/Kaby Lake SoC with MIPI CSI-2

> > >>  	  connected camera.

> > >>  	  The module will be called ipu3-cio2.

> > >> +

> > >> +config CIO2_BRIDGE

> > >> +	bool "IPU3 CIO2 Sensors Bridge"

> > >> +	depends on VIDEO_IPU3_CIO2

> > >> +	help

> > >> +	  This extension provides an API for the ipu3-cio2 driver to create

> > >> +	  connections to cameras that are hidden in SSDB buffer in ACPI. It

> > >> +	  can be used to enable support for cameras in detachable / hybrid

> > >> +	  devices that ship with Windows.

> > >> +

> > >> +	  Say Y here if your device is a detachable / hybrid laptop that comes

> > >> +	  with Windows installed by the OEM, for example:

> > >> +

> > >> +	  	- Microsoft Surface models (except Surface Pro 3)

> > >> +		- The Lenovo Miix line (for example the 510, 520, 710 and 720)

> > >> +		- Dell 7285

> > >> +

> > >> +	  If in doubt, say N here.

> > >> diff --git a/drivers/media/pci/intel/ipu3/Makefile b/drivers/media/pci/intel/ipu3/Makefile

> > >> index 429d516452e4..933777e6ea8a 100644

> > >> --- a/drivers/media/pci/intel/ipu3/Makefile

> > >> +++ b/drivers/media/pci/intel/ipu3/Makefile

> > >> @@ -2,3 +2,4 @@

> > >>  obj-$(CONFIG_VIDEO_IPU3_CIO2) += ipu3-cio2.o

> > >>  

> > >>  ipu3-cio2-y += ipu3-cio2-main.o

> > >> +ipu3-cio2-$(CONFIG_CIO2_BRIDGE) += cio2-bridge.o

> > >> diff --git a/drivers/media/pci/intel/ipu3/cio2-bridge.c b/drivers/media/pci/intel/ipu3/cio2-bridge.c

> > >> new file mode 100644

> > >> index 000000000000..fd3f8ba07274

> > >> --- /dev/null

> > >> +++ b/drivers/media/pci/intel/ipu3/cio2-bridge.c

> > >> @@ -0,0 +1,260 @@

> > >> +// SPDX-License-Identifier: GPL-2.0

> > >> +/* Author: Dan Scally <djrscally@gmail.com> */

> > > 

> > > Could you please add a blank line here ?

> > 

> > Yes

> >

> > >> +#include <linux/acpi.h>

> > >> +#include <linux/device.h>

> > >> +#include <linux/i2c.h>

> > > 

> > > Is this header needed ?

> > > 

> > >> +#include <linux/kernel.h>

> > >> +#include <linux/module.h>

> > > 

> > > And this one ?

> > > 

> > >> +#include <linux/pci.h>

> > >> +#include <linux/property.h>

> > >> +#include <media/v4l2-subdev.h>

> > > 

> > > And this one ?

> > 

> > Ah yes - bit sloppy, they're orphaned from earlier versions, sorry about

> > that.

> > 

> > >> +

> > >> +#include "cio2-bridge.h"

> > >> +

> > >> +/*

> > >> + * Extend this array with ACPI Hardware ID's of devices known to be working.

> > >> + * Do not add a HID for a sensor that is not actually supported.

> > >> + */

> > >> +static const char * const cio2_supported_devices[] = {

> > > 

> > > Maybe cio2_supported_sensors ?

> > 

> > Sure

> > 

> > >> +	"INT33BE",

> > >> +	"OVTI2680",

> > >> +};

> > >> +

> > >> +static int cio2_bridge_read_acpi_buffer(struct acpi_device *adev, char *id,

> > >> +					void *data, u32 size)

> > >> +{

> > >> +	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };

> > >> +	union acpi_object *obj;

> > >> +	acpi_status status;

> > >> +	int ret;

> > >> +

> > >> +	status = acpi_evaluate_object(adev->handle, id, NULL, &buffer);

> > >> +	if (ACPI_FAILURE(status))

> > >> +		return -ENODEV;

> > >> +

> > >> +	obj = buffer.pointer;

> > >> +	if (!obj) {

> > >> +		dev_err(&adev->dev, "Couldn't locate ACPI buffer\n");

> > >> +		return -ENODEV;

> > >> +	}

> > >> +

> > >> +	if (obj->type != ACPI_TYPE_BUFFER) {

> > >> +		dev_err(&adev->dev, "Not an ACPI buffer\n");

> > >> +		ret = -ENODEV;

> > >> +		goto out_free_buff;

> > >> +	}

> > >> +

> > >> +	if (obj->buffer.length > size) {

> > >> +		dev_err(&adev->dev, "Given buffer is too small\n");

> > >> +		ret = -EINVAL;

> > >> +		goto out_free_buff;

> > >> +	}

> > >> +

> > >> +	memcpy(data, obj->buffer.pointer, obj->buffer.length);

> > >> +	ret = obj->buffer.length;

> > >> +

> > >> +out_free_buff:

> > >> +	kfree(buffer.pointer);

> > >> +	return ret;

> > >> +}

> > >> +

> > >> +static void cio2_bridge_init_property_names(struct cio2_sensor *sensor)

> > >> +{

> > >> +	strcpy(sensor->prop_names.clock_frequency, "clock-frequency");

> > >> +	strcpy(sensor->prop_names.rotation, "rotation");

> > >> +	strcpy(sensor->prop_names.bus_type, "bus-type");

> > >> +	strcpy(sensor->prop_names.data_lanes, "data-lanes");

> > >> +	strcpy(sensor->prop_names.remote_endpoint, "remote-endpoint");

> > > 

> > > This is a bit fragile, as there's no len check. How about the following

> > > ?

> > > static const struct cio2_property_names prop_names = {

> > > 	.clock_frequency = "clock-frequency",

> > > 	.rotation = "rotation",

> > > 	.bus_type = "bus-type",

> > > 	.data_lanes = "data-lanes",

> > > 	.remote_endpoint = "remote-endpoint",

> > > };

> > > 

> > > static void cio2_bridge_init_property_names(struct cio2_sensor *sensor)

> > > {

> > > 	sensor->prop_names = prop_names;

> > > }

> > > 

> > > This shoudl generate a compilation warning if the string is too long.

> > > 

> > > You could even inline that line in

> > > cio2_bridge_create_fwnode_properties().

> > 

> > Yes, I like that, thanks - I'll make the change.

> > 

> > >> +}

> > >> +

> > >> +static void cio2_bridge_create_fwnode_properties(struct cio2_sensor *sensor)

> > >> +{

> > >> +	unsigned int i;

> > >> +

> > >> +	cio2_bridge_init_property_names(sensor);

> > >> +

> > >> +	for (i = 0; i < 4; i++)

> > >> +		sensor->data_lanes[i] = i + 1;

> > > 

> > > Is there no provision in the SSDB for data lane remapping ?

> > 

> > Sorry; don't follow what you mean by data lane remapping here.

> 

> Some CSI-2 receivers can remap data lanes. The routing inside the SoC

> from the data lane input pins to the PHYs is configurable. This makes

> board design easier as you can route the data lanes to any of the

> inputs. That's why the data lanes DT property is a list of lane numbers

> instead of a number of lanes. I'm actually not sure if the CIO2 supports

> this.


To my knowledge it does not. Only the number of lanes allocated to
different ports matters.

...

> > >> @@ -0,0 +1,108 @@

> > >> +/* SPDX-License-Identifier: GPL-2.0 */

> > >> +/* Author: Dan Scally <djrscally@gmail.com> */

> > >> +#ifndef __CIO2_BRIDGE_H

> > >> +#define __CIO2_BRIDGE_H

> > >> +

> > >> +#include <linux/property.h>

> > >> +

> > >> +#define CIO2_HID				"INT343E"

> > >> +#define CIO2_NUM_PORTS			  4

> > > 

> > > There are a few rogue spaces before '4'.

> > 

> > Argh, thanks, this is the curse of using VS code on multiple machines...

> 

> I recommend vim ;-)


What is VS code? Very Serious Code?

I can recommend Emacs; that could help, too.

-- 
Kind regards,

Sakari Ailus
Daniel Scally Dec. 2, 2020, 10:53 a.m. UTC | #7
On 02/12/2020 10:38, Sakari Ailus wrote:
> Hi Laurent,
>
> On Wed, Dec 02, 2020 at 12:30:53AM +0200, Laurent Pinchart wrote:
>> Hi Daniel,
>>
>> On Tue, Dec 01, 2020 at 10:08:25PM +0000, Dan Scally wrote:
>>> On 30/11/2020 17:09, Laurent Pinchart wrote:
>>>> On Mon, Nov 30, 2020 at 01:31:24PM +0000, Daniel Scally wrote:
>>>>> Currently on platforms designed for Windows, connections between CIO2 and
>>>>> sensors are not properly defined in DSDT. This patch extends the ipu3-cio2
>>>>> driver to compensate by building software_node connections, parsing the
>>>>> connection properties from the sensor's SSDB buffer.
>>>>>
>>>>> Suggested-by: Jordan Hand <jorhand@linux.microsoft.com>
>>>>> Signed-off-by: Daniel Scally <djrscally@gmail.com>
>>>>> ---
>>>>> Changes since RFC v3:
>>>>>
>>>>> 	- Removed almost all global variables, dynamically allocated
>>>>> 	the cio2_bridge structure, plus a bunch of associated changes
>>>>> 	like 
>>>>> 	- Added a new function to ipu3-cio2-main.c to check for an 
>>>>> 	existing fwnode_graph before calling cio2_bridge_init()
>>>>> 	- Prefixed cio2_bridge_ to any variables and functions that
>>>>> 	lacked it
>>>>> 	- Assigned the new fwnode directly to the sensor's ACPI device
>>>>> 	fwnode as secondary. This removes the requirement to delay until
>>>>> 	the I2C devices are instantiated before ipu3-cio2 can probe, but
>>>>> 	it has a side effect, which is that those devices then grab a ref
>>>>> 	to the new software_node. This effectively prevents us from
>>>>> 	unloading the driver, because we can't free the memory that they
>>>>> 	live in whilst the device holds a reference to them. The work
>>>>> 	around at the moment is to _not_ unregister the software_nodes
>>>>> 	when ipu3-cio2 is unloaded; this becomes a one-time 'patch', that
>>>>> 	is simply skipped if the module is reloaded.
>>>>> 	- Moved the sensor's SSDB struct to be a member of cio2_sensor
>>>>> 	- Replaced ints with unsigned ints where appropriate
>>>>> 	- Iterated over all ACPI devices of a matching _HID rather than
>>>>> 	just the first to ensure we handle a device with multiple sensors
>>>>> 	of the same model.
>>>>>
>>>>>  MAINTAINERS                                   |   1 +
>>>>>  drivers/media/pci/intel/ipu3/Kconfig          |  18 ++
>>>>>  drivers/media/pci/intel/ipu3/Makefile         |   1 +
>>>>>  drivers/media/pci/intel/ipu3/cio2-bridge.c    | 260 ++++++++++++++++++
>>>>>  drivers/media/pci/intel/ipu3/cio2-bridge.h    | 108 ++++++++
>>>>>  drivers/media/pci/intel/ipu3/ipu3-cio2-main.c |  27 ++
>>>>>  drivers/media/pci/intel/ipu3/ipu3-cio2.h      |   6 +
>>>>>  7 files changed, 421 insertions(+)
>>>>>  create mode 100644 drivers/media/pci/intel/ipu3/cio2-bridge.c
>>>>>  create mode 100644 drivers/media/pci/intel/ipu3/cio2-bridge.h
>>>>>
>>>>> diff --git a/MAINTAINERS b/MAINTAINERS
>>>>> index 9702b886d6a4..188559a0a610 100644
>>>>> --- a/MAINTAINERS
>>>>> +++ b/MAINTAINERS
>>>>> @@ -8927,6 +8927,7 @@ INTEL IPU3 CSI-2 CIO2 DRIVER
>>>>>  M:	Yong Zhi <yong.zhi@intel.com>
>>>>>  M:	Sakari Ailus <sakari.ailus@linux.intel.com>
>>>>>  M:	Bingbu Cao <bingbu.cao@intel.com>
>>>>> +M:	Dan Scally <djrscally@gmail.com>
>>>>>  R:	Tianshu Qiu <tian.shu.qiu@intel.com>
>>>>>  L:	linux-media@vger.kernel.org
>>>>>  S:	Maintained
>>>>> diff --git a/drivers/media/pci/intel/ipu3/Kconfig b/drivers/media/pci/intel/ipu3/Kconfig
>>>>> index 82d7f17e6a02..2b3350d042be 100644
>>>>> --- a/drivers/media/pci/intel/ipu3/Kconfig
>>>>> +++ b/drivers/media/pci/intel/ipu3/Kconfig
>>>>> @@ -16,3 +16,21 @@ config VIDEO_IPU3_CIO2
>>>>>  	  Say Y or M here if you have a Skylake/Kaby Lake SoC with MIPI CSI-2
>>>>>  	  connected camera.
>>>>>  	  The module will be called ipu3-cio2.
>>>>> +
>>>>> +config CIO2_BRIDGE
>>>>> +	bool "IPU3 CIO2 Sensors Bridge"
>>>>> +	depends on VIDEO_IPU3_CIO2
>>>>> +	help
>>>>> +	  This extension provides an API for the ipu3-cio2 driver to create
>>>>> +	  connections to cameras that are hidden in SSDB buffer in ACPI. It
>>>>> +	  can be used to enable support for cameras in detachable / hybrid
>>>>> +	  devices that ship with Windows.
>>>>> +
>>>>> +	  Say Y here if your device is a detachable / hybrid laptop that comes
>>>>> +	  with Windows installed by the OEM, for example:
>>>>> +
>>>>> +	  	- Microsoft Surface models (except Surface Pro 3)
>>>>> +		- The Lenovo Miix line (for example the 510, 520, 710 and 720)
>>>>> +		- Dell 7285
>>>>> +
>>>>> +	  If in doubt, say N here.
>>>>> diff --git a/drivers/media/pci/intel/ipu3/Makefile b/drivers/media/pci/intel/ipu3/Makefile
>>>>> index 429d516452e4..933777e6ea8a 100644
>>>>> --- a/drivers/media/pci/intel/ipu3/Makefile
>>>>> +++ b/drivers/media/pci/intel/ipu3/Makefile
>>>>> @@ -2,3 +2,4 @@
>>>>>  obj-$(CONFIG_VIDEO_IPU3_CIO2) += ipu3-cio2.o
>>>>>  
>>>>>  ipu3-cio2-y += ipu3-cio2-main.o
>>>>> +ipu3-cio2-$(CONFIG_CIO2_BRIDGE) += cio2-bridge.o
>>>>> diff --git a/drivers/media/pci/intel/ipu3/cio2-bridge.c b/drivers/media/pci/intel/ipu3/cio2-bridge.c
>>>>> new file mode 100644
>>>>> index 000000000000..fd3f8ba07274
>>>>> --- /dev/null
>>>>> +++ b/drivers/media/pci/intel/ipu3/cio2-bridge.c
>>>>> @@ -0,0 +1,260 @@
>>>>> +// SPDX-License-Identifier: GPL-2.0
>>>>> +/* Author: Dan Scally <djrscally@gmail.com> */
>>>> Could you please add a blank line here ?
>>> Yes
>>>
>>>>> +#include <linux/acpi.h>
>>>>> +#include <linux/device.h>
>>>>> +#include <linux/i2c.h>
>>>> Is this header needed ?
>>>>
>>>>> +#include <linux/kernel.h>
>>>>> +#include <linux/module.h>
>>>> And this one ?
>>>>
>>>>> +#include <linux/pci.h>
>>>>> +#include <linux/property.h>
>>>>> +#include <media/v4l2-subdev.h>
>>>> And this one ?
>>> Ah yes - bit sloppy, they're orphaned from earlier versions, sorry about
>>> that.
>>>
>>>>> +
>>>>> +#include "cio2-bridge.h"
>>>>> +
>>>>> +/*
>>>>> + * Extend this array with ACPI Hardware ID's of devices known to be working.
>>>>> + * Do not add a HID for a sensor that is not actually supported.
>>>>> + */
>>>>> +static const char * const cio2_supported_devices[] = {
>>>> Maybe cio2_supported_sensors ?
>>> Sure
>>>
>>>>> +	"INT33BE",
>>>>> +	"OVTI2680",
>>>>> +};
>>>>> +
>>>>> +static int cio2_bridge_read_acpi_buffer(struct acpi_device *adev, char *id,
>>>>> +					void *data, u32 size)
>>>>> +{
>>>>> +	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
>>>>> +	union acpi_object *obj;
>>>>> +	acpi_status status;
>>>>> +	int ret;
>>>>> +
>>>>> +	status = acpi_evaluate_object(adev->handle, id, NULL, &buffer);
>>>>> +	if (ACPI_FAILURE(status))
>>>>> +		return -ENODEV;
>>>>> +
>>>>> +	obj = buffer.pointer;
>>>>> +	if (!obj) {
>>>>> +		dev_err(&adev->dev, "Couldn't locate ACPI buffer\n");
>>>>> +		return -ENODEV;
>>>>> +	}
>>>>> +
>>>>> +	if (obj->type != ACPI_TYPE_BUFFER) {
>>>>> +		dev_err(&adev->dev, "Not an ACPI buffer\n");
>>>>> +		ret = -ENODEV;
>>>>> +		goto out_free_buff;
>>>>> +	}
>>>>> +
>>>>> +	if (obj->buffer.length > size) {
>>>>> +		dev_err(&adev->dev, "Given buffer is too small\n");
>>>>> +		ret = -EINVAL;
>>>>> +		goto out_free_buff;
>>>>> +	}
>>>>> +
>>>>> +	memcpy(data, obj->buffer.pointer, obj->buffer.length);
>>>>> +	ret = obj->buffer.length;
>>>>> +
>>>>> +out_free_buff:
>>>>> +	kfree(buffer.pointer);
>>>>> +	return ret;
>>>>> +}
>>>>> +
>>>>> +static void cio2_bridge_init_property_names(struct cio2_sensor *sensor)
>>>>> +{
>>>>> +	strcpy(sensor->prop_names.clock_frequency, "clock-frequency");
>>>>> +	strcpy(sensor->prop_names.rotation, "rotation");
>>>>> +	strcpy(sensor->prop_names.bus_type, "bus-type");
>>>>> +	strcpy(sensor->prop_names.data_lanes, "data-lanes");
>>>>> +	strcpy(sensor->prop_names.remote_endpoint, "remote-endpoint");
>>>> This is a bit fragile, as there's no len check. How about the following
>>>> ?
>>>> static const struct cio2_property_names prop_names = {
>>>> 	.clock_frequency = "clock-frequency",
>>>> 	.rotation = "rotation",
>>>> 	.bus_type = "bus-type",
>>>> 	.data_lanes = "data-lanes",
>>>> 	.remote_endpoint = "remote-endpoint",
>>>> };
>>>>
>>>> static void cio2_bridge_init_property_names(struct cio2_sensor *sensor)
>>>> {
>>>> 	sensor->prop_names = prop_names;
>>>> }
>>>>
>>>> This shoudl generate a compilation warning if the string is too long.
>>>>
>>>> You could even inline that line in
>>>> cio2_bridge_create_fwnode_properties().
>>> Yes, I like that, thanks - I'll make the change.
>>>
>>>>> +}
>>>>> +
>>>>> +static void cio2_bridge_create_fwnode_properties(struct cio2_sensor *sensor)
>>>>> +{
>>>>> +	unsigned int i;
>>>>> +
>>>>> +	cio2_bridge_init_property_names(sensor);
>>>>> +
>>>>> +	for (i = 0; i < 4; i++)
>>>>> +		sensor->data_lanes[i] = i + 1;
>>>> Is there no provision in the SSDB for data lane remapping ?
>>> Sorry; don't follow what you mean by data lane remapping here.
>> Some CSI-2 receivers can remap data lanes. The routing inside the SoC
>> from the data lane input pins to the PHYs is configurable. This makes
>> board design easier as you can route the data lanes to any of the
>> inputs. That's why the data lanes DT property is a list of lane numbers
>> instead of a number of lanes. I'm actually not sure if the CIO2 supports
>> this.
> To my knowledge it does not. Only the number of lanes allocated to
> different ports matters.
>
So nothing to change here then I think?
>>>>> @@ -0,0 +1,108 @@
>>>>> +/* SPDX-License-Identifier: GPL-2.0 */
>>>>> +/* Author: Dan Scally <djrscally@gmail.com> */
>>>>> +#ifndef __CIO2_BRIDGE_H
>>>>> +#define __CIO2_BRIDGE_H
>>>>> +
>>>>> +#include <linux/property.h>
>>>>> +
>>>>> +#define CIO2_HID				"INT343E"
>>>>> +#define CIO2_NUM_PORTS			  4
>>>> There are a few rogue spaces before '4'.
>>> Argh, thanks, this is the curse of using VS code on multiple machines...
>> I recommend vim ;-)
> What is VS code? Very Serious Code?

Visual Studio Code - it has some nice features, but the
facepalm-to-productivity ratio is a bit high.

> I can recommend Emacs; that could help, too.
Andy Shevchenko Dec. 2, 2020, 12:01 p.m. UTC | #8
On Wed, Dec 02, 2020 at 12:38:51PM +0200, Sakari Ailus wrote:
> On Wed, Dec 02, 2020 at 12:30:53AM +0200, Laurent Pinchart wrote:
> > On Tue, Dec 01, 2020 at 10:08:25PM +0000, Dan Scally wrote:
> > > On 30/11/2020 17:09, Laurent Pinchart wrote:
> > > > On Mon, Nov 30, 2020 at 01:31:24PM +0000, Daniel Scally wrote:

...

> > > >> +#define CIO2_NUM_PORTS			  4
> > > > 
> > > > There are a few rogue spaces before '4'.
> > > 
> > > Argh, thanks, this is the curse of using VS code on multiple machines...
> > 
> > I recommend vim ;-)
> 
> What is VS code? Very Serious Code?

Visual Studio Code. Something good from MS (no sarcasm, btw).

> I can recommend Emacs; that could help, too.
Andy Shevchenko Dec. 2, 2020, 12:02 p.m. UTC | #9
On Wed, Dec 02, 2020 at 10:53:05AM +0000, Dan Scally wrote:
> On 02/12/2020 10:38, Sakari Ailus wrote:

...

> >>> Argh, thanks, this is the curse of using VS code on multiple machines...
> >> I recommend vim ;-)
> > What is VS code? Very Serious Code?
> 
> Visual Studio Code - it has some nice features, but the
> facepalm-to-productivity ratio is a bit high.

Perhaps you can submit an issue report on GitHub. I found VS Code pretty nice
to be with Linux kernel development.
Daniel Scally Dec. 2, 2020, 10:44 p.m. UTC | #10
On 02/12/2020 12:02, Andy Shevchenko wrote:
> On Wed, Dec 02, 2020 at 10:53:05AM +0000, Dan Scally wrote:
>> On 02/12/2020 10:38, Sakari Ailus wrote:
> 
> ...
> 
>>>>> Argh, thanks, this is the curse of using VS code on multiple machines...
>>>> I recommend vim ;-)
>>> What is VS code? Very Serious Code?
>>
>> Visual Studio Code - it has some nice features, but the
>> facepalm-to-productivity ratio is a bit high.
> 
> Perhaps you can submit an issue report on GitHub. I found VS Code pretty nice
> to be with Linux kernel development.

Yeah I like it too; it's the one I've stuck with despite the annoyances
I find. It has some super handy features for someone who doesn't know
most of the kernel APIs very well yet. Writing up the issues is on my
to-do list but I hate to do it without at least putting some effort into
figuring out what the problem is and I so far didn't get round to that yet
Daniel Scally Dec. 15, 2020, 10:28 a.m. UTC | #11
Morning Sakari

On 30/11/2020 20:35, Sakari Ailus wrote:
>> +/*
>> + * Extend this array with ACPI Hardware ID's of devices known to be working.
>> + * Do not add a HID for a sensor that is not actually supported.
>> + */
>> +static const char * const cio2_supported_devices[] = {
>> +	"INT33BE",
>> +	"OVTI2680",
> 
> I guess we don't have the known-good frequencies for the CSI-2 bus in
> firmware?
> 
> One option would be to put there what the drivers currently use. This
> assumes the support for these devices is, well, somewhat opportunistic but
> I guess there's no way around that right now at least.
> 
> As the systems are laptops, they're likely somewhat less prone to EMI
> issues to begin with than mobile phones anyway.

Just looking at this; we're currently using this with the ov2680 driver
that's in mainline currently (with very minor tweaks) plus a
hacked-into-roughly-working version of the atomisp-ov5693 driver (ACPI
ID INT33BE = ov5693 physical device). Neither of those drivers lists any
link frequencies, nor provides a link frequency control for v4l2 to work
with.

On the other hand, the ov5648 [1] and ov8865 [2] drivers which Paul has
submitted recently, which we also want to be able to support, _do_
include that. I can register the frequencies Paul's defined there as a
link-frequencies property but this gives rise to two questions:


1. Is this _mandatory_? Do I need to be finding the link-frequencies for
the OV2680 and OV5693 drivers too? Or can I skip that property where the
driver doesn't handle it anyway. Seems to be working fine without
controlling it in driver.
2. Can I trust all the values in the drivers to be available on each
platform? For example for the ov5648 Paul lists these as available:

 938static const s64 ov5648_link_freq_menu[] = {


 939        210000000,


 940        168000000,


 941};

But can I safely register a link-frequencies property for both of those
and trust that that'll work on all IPU3 platforms with an ov5648 in them?

Thanks
Dan
Daniel Scally Dec. 15, 2020, 10:32 a.m. UTC | #12
On 15/12/2020 10:28, Daniel Scally wrote:
> Morning Sakari

>

> On 30/11/2020 20:35, Sakari Ailus wrote:

>>> +/*

>>> + * Extend this array with ACPI Hardware ID's of devices known to be working.

>>> + * Do not add a HID for a sensor that is not actually supported.

>>> + */

>>> +static const char * const cio2_supported_devices[] = {

>>> +	"INT33BE",

>>> +	"OVTI2680",

>> I guess we don't have the known-good frequencies for the CSI-2 bus in

>> firmware?

>>

>> One option would be to put there what the drivers currently use. This

>> assumes the support for these devices is, well, somewhat opportunistic but

>> I guess there's no way around that right now at least.

>>

>> As the systems are laptops, they're likely somewhat less prone to EMI

>> issues to begin with than mobile phones anyway.

> Just looking at this; we're currently using this with the ov2680 driver

> that's in mainline currently (with very minor tweaks) plus a

> hacked-into-roughly-working version of the atomisp-ov5693 driver (ACPI

> ID INT33BE = ov5693 physical device). Neither of those drivers lists any

> link frequencies, nor provides a link frequency control for v4l2 to work

> with.

>

> On the other hand, the ov5648 [1] and ov8865 [2] drivers which Paul has

> submitted recently



Forgot to actually link these:


[1]
https://lore.kernel.org/linux-media/20201211154027.153535-1-paul.kocialkowski@bootlin.com/T/#m5eb18611b7df1538ed4924422583b62cc61dbfae

[2]
https://lore.kernel.org/linux-media/20201211154428.153762-1-paul.kocialkowski@bootlin.com/T/#m6d4fd5e590b1c4583d4a74f5ae938ea011408640
Sakari Ailus Dec. 15, 2020, 10:02 p.m. UTC | #13
Hi Daniel,

On Tue, Dec 15, 2020 at 10:28:59AM +0000, Daniel Scally wrote:
> Morning Sakari
> 
> On 30/11/2020 20:35, Sakari Ailus wrote:
> >> +/*
> >> + * Extend this array with ACPI Hardware ID's of devices known to be working.
> >> + * Do not add a HID for a sensor that is not actually supported.
> >> + */
> >> +static const char * const cio2_supported_devices[] = {
> >> +	"INT33BE",
> >> +	"OVTI2680",
> > 
> > I guess we don't have the known-good frequencies for the CSI-2 bus in
> > firmware?
> > 
> > One option would be to put there what the drivers currently use. This
> > assumes the support for these devices is, well, somewhat opportunistic but
> > I guess there's no way around that right now at least.
> > 
> > As the systems are laptops, they're likely somewhat less prone to EMI
> > issues to begin with than mobile phones anyway.
> 
> Just looking at this; we're currently using this with the ov2680 driver
> that's in mainline currently (with very minor tweaks) plus a
> hacked-into-roughly-working version of the atomisp-ov5693 driver (ACPI
> ID INT33BE = ov5693 physical device). Neither of those drivers lists any
> link frequencies, nor provides a link frequency control for v4l2 to work
> with.
> 
> On the other hand, the ov5648 [1] and ov8865 [2] drivers which Paul has
> submitted recently, which we also want to be able to support, _do_
> include that. I can register the frequencies Paul's defined there as a
> link-frequencies property but this gives rise to two questions:
> 
> 
> 1. Is this _mandatory_? Do I need to be finding the link-frequencies for
> the OV2680 and OV5693 drivers too? Or can I skip that property where the
> driver doesn't handle it anyway. Seems to be working fine without
> controlling it in driver.

Receiver drivers generally need the information to program the receiver
timing. It may work for you without using the correct frequency, but the
risk of failure on another unit increases.

> 2. Can I trust all the values in the drivers to be available on each
> platform? For example for the ov5648 Paul lists these as available:
> 
>  938static const s64 ov5648_link_freq_menu[] = {
> 
> 
>  939        210000000,
> 
> 
>  940        168000000,
> 
> 
>  941};
> 
> But can I safely register a link-frequencies property for both of those
> and trust that that'll work on all IPU3 platforms with an ov5648 in them?

Ideally we'd know which frequency Windows uses, and use the same.

Using another frequency may have adverse effects elsewhere in the system.
AFAIU mostly this concerns radios of all sorts.

Now that this is in the kernel in any case, it can be fixed later on so I'm
not too worried about it. Having still a comment there that the
configuration is opportunistic would be nice.
diff mbox series

Patch

diff --git a/MAINTAINERS b/MAINTAINERS
index 9702b886d6a4..188559a0a610 100644
--- a/MAINTAINERS
+++ b/MAINTAINERS
@@ -8927,6 +8927,7 @@  INTEL IPU3 CSI-2 CIO2 DRIVER
 M:	Yong Zhi <yong.zhi@intel.com>
 M:	Sakari Ailus <sakari.ailus@linux.intel.com>
 M:	Bingbu Cao <bingbu.cao@intel.com>
+M:	Dan Scally <djrscally@gmail.com>
 R:	Tianshu Qiu <tian.shu.qiu@intel.com>
 L:	linux-media@vger.kernel.org
 S:	Maintained
diff --git a/drivers/media/pci/intel/ipu3/Kconfig b/drivers/media/pci/intel/ipu3/Kconfig
index 82d7f17e6a02..2b3350d042be 100644
--- a/drivers/media/pci/intel/ipu3/Kconfig
+++ b/drivers/media/pci/intel/ipu3/Kconfig
@@ -16,3 +16,21 @@  config VIDEO_IPU3_CIO2
 	  Say Y or M here if you have a Skylake/Kaby Lake SoC with MIPI CSI-2
 	  connected camera.
 	  The module will be called ipu3-cio2.
+
+config CIO2_BRIDGE
+	bool "IPU3 CIO2 Sensors Bridge"
+	depends on VIDEO_IPU3_CIO2
+	help
+	  This extension provides an API for the ipu3-cio2 driver to create
+	  connections to cameras that are hidden in SSDB buffer in ACPI. It
+	  can be used to enable support for cameras in detachable / hybrid
+	  devices that ship with Windows.
+
+	  Say Y here if your device is a detachable / hybrid laptop that comes
+	  with Windows installed by the OEM, for example:
+
+	  	- Microsoft Surface models (except Surface Pro 3)
+		- The Lenovo Miix line (for example the 510, 520, 710 and 720)
+		- Dell 7285
+
+	  If in doubt, say N here.
diff --git a/drivers/media/pci/intel/ipu3/Makefile b/drivers/media/pci/intel/ipu3/Makefile
index 429d516452e4..933777e6ea8a 100644
--- a/drivers/media/pci/intel/ipu3/Makefile
+++ b/drivers/media/pci/intel/ipu3/Makefile
@@ -2,3 +2,4 @@ 
 obj-$(CONFIG_VIDEO_IPU3_CIO2) += ipu3-cio2.o
 
 ipu3-cio2-y += ipu3-cio2-main.o
+ipu3-cio2-$(CONFIG_CIO2_BRIDGE) += cio2-bridge.o
diff --git a/drivers/media/pci/intel/ipu3/cio2-bridge.c b/drivers/media/pci/intel/ipu3/cio2-bridge.c
new file mode 100644
index 000000000000..fd3f8ba07274
--- /dev/null
+++ b/drivers/media/pci/intel/ipu3/cio2-bridge.c
@@ -0,0 +1,260 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/* Author: Dan Scally <djrscally@gmail.com> */
+#include <linux/acpi.h>
+#include <linux/device.h>
+#include <linux/i2c.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/pci.h>
+#include <linux/property.h>
+#include <media/v4l2-subdev.h>
+
+#include "cio2-bridge.h"
+
+/*
+ * Extend this array with ACPI Hardware ID's of devices known to be working.
+ * Do not add a HID for a sensor that is not actually supported.
+ */
+static const char * const cio2_supported_devices[] = {
+	"INT33BE",
+	"OVTI2680",
+};
+
+static int cio2_bridge_read_acpi_buffer(struct acpi_device *adev, char *id,
+					void *data, u32 size)
+{
+	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
+	union acpi_object *obj;
+	acpi_status status;
+	int ret;
+
+	status = acpi_evaluate_object(adev->handle, id, NULL, &buffer);
+	if (ACPI_FAILURE(status))
+		return -ENODEV;
+
+	obj = buffer.pointer;
+	if (!obj) {
+		dev_err(&adev->dev, "Couldn't locate ACPI buffer\n");
+		return -ENODEV;
+	}
+
+	if (obj->type != ACPI_TYPE_BUFFER) {
+		dev_err(&adev->dev, "Not an ACPI buffer\n");
+		ret = -ENODEV;
+		goto out_free_buff;
+	}
+
+	if (obj->buffer.length > size) {
+		dev_err(&adev->dev, "Given buffer is too small\n");
+		ret = -EINVAL;
+		goto out_free_buff;
+	}
+
+	memcpy(data, obj->buffer.pointer, obj->buffer.length);
+	ret = obj->buffer.length;
+
+out_free_buff:
+	kfree(buffer.pointer);
+	return ret;
+}
+
+static void cio2_bridge_init_property_names(struct cio2_sensor *sensor)
+{
+	strcpy(sensor->prop_names.clock_frequency, "clock-frequency");
+	strcpy(sensor->prop_names.rotation, "rotation");
+	strcpy(sensor->prop_names.bus_type, "bus-type");
+	strcpy(sensor->prop_names.data_lanes, "data-lanes");
+	strcpy(sensor->prop_names.remote_endpoint, "remote-endpoint");
+}
+
+static void cio2_bridge_create_fwnode_properties(struct cio2_sensor *sensor)
+{
+	unsigned int i;
+
+	cio2_bridge_init_property_names(sensor);
+
+	for (i = 0; i < 4; i++)
+		sensor->data_lanes[i] = i + 1;
+
+	/*
+	 * Can't use PROPERTY_ENTRY_REF because it creates a new variable to
+	 * point to, which doesn't survive the function.
+	 */
+	sensor->local_ref[0] = (struct software_node_ref_args){
+		.node = &sensor->swnodes[SWNODE_CIO2_ENDPOINT]
+		};
+	sensor->remote_ref[0] = (struct software_node_ref_args){
+		.node = &sensor->swnodes[SWNODE_SENSOR_ENDPOINT]
+		};
+
+	sensor->dev_properties[0] = PROPERTY_ENTRY_U32(sensor->prop_names.clock_frequency,
+						       sensor->ssdb.mclkspeed);
+	sensor->dev_properties[1] = PROPERTY_ENTRY_U8(sensor->prop_names.rotation,
+						      sensor->ssdb.degree);
+
+	sensor->ep_properties[0] = PROPERTY_ENTRY_U32(sensor->prop_names.bus_type, 5);
+	sensor->ep_properties[1] = PROPERTY_ENTRY_U32_ARRAY_LEN(sensor->prop_names.data_lanes,
+								sensor->data_lanes,
+								sensor->ssdb.lanes);
+	sensor->ep_properties[2] = PROPERTY_ENTRY_REF_ARRAY(sensor->prop_names.remote_endpoint,
+							    sensor->local_ref);
+
+	sensor->cio2_properties[0] = PROPERTY_ENTRY_U32_ARRAY_LEN(sensor->prop_names.data_lanes,
+								  sensor->data_lanes,
+								  sensor->ssdb.lanes);
+	sensor->cio2_properties[1] = PROPERTY_ENTRY_REF_ARRAY(sensor->prop_names.remote_endpoint,
+							      sensor->remote_ref);
+}
+
+static void cio2_bridge_init_swnode_names(struct cio2_sensor *sensor)
+{
+	snprintf(sensor->node_names.remote_port, 6, "port%u", sensor->ssdb.link);
+	strcpy(sensor->node_names.port, "port0");
+	strcpy(sensor->node_names.endpoint, "endpoint0");
+}
+
+static void cio2_bridge_create_connection_swnodes(struct cio2_bridge *bridge,
+						  struct cio2_sensor *sensor)
+{
+	struct software_node *nodes = sensor->swnodes;
+
+	cio2_bridge_init_swnode_names(sensor);
+
+	nodes[SWNODE_SENSOR_HID] = NODE_SENSOR(sensor->name,
+					       sensor->dev_properties);
+	nodes[SWNODE_SENSOR_PORT] = NODE_PORT(sensor->node_names.port,
+					      &nodes[SWNODE_SENSOR_HID]);
+	nodes[SWNODE_SENSOR_ENDPOINT] = NODE_ENDPOINT(sensor->node_names.endpoint,
+						      &nodes[SWNODE_SENSOR_PORT],
+						      sensor->ep_properties);
+	nodes[SWNODE_CIO2_PORT] = NODE_PORT(sensor->node_names.remote_port,
+					    &bridge->cio2_hid_node);
+	nodes[SWNODE_CIO2_ENDPOINT] = NODE_ENDPOINT(sensor->node_names.endpoint,
+						    &nodes[SWNODE_CIO2_PORT],
+						    sensor->cio2_properties);
+}
+
+static void cio2_bridge_unregister_sensors(struct cio2_bridge *bridge)
+{
+	struct cio2_sensor *sensor;
+	unsigned int i;
+
+	for (i = 0; i < bridge->n_sensors; i++) {
+		sensor = &bridge->sensors[i];
+		software_node_unregister_nodes(sensor->swnodes);
+		acpi_dev_put(sensor->adev);
+	}
+}
+
+static int cio2_bridge_connect_sensors(struct cio2_bridge *bridge)
+{
+	struct fwnode_handle *fwnode;
+	struct cio2_sensor *sensor;
+	struct acpi_device *adev;
+	unsigned int i;
+	int ret = 0;
+
+	for (i = 0; i < ARRAY_SIZE(cio2_supported_devices); i++) {
+		const char *this_device = cio2_supported_devices[i];
+
+		for_each_acpi_dev_match(adev, this_device, NULL, -1) {
+			if (!adev || !(adev->status.present && adev->status.enabled))
+				continue;
+
+			sensor = &bridge->sensors[bridge->n_sensors];
+			sensor->adev = adev;
+			strscpy(sensor->name, this_device, sizeof(sensor->name));
+
+			ret = cio2_bridge_read_acpi_buffer(adev, "SSDB",
+							   &sensor->ssdb,
+							   sizeof(sensor->ssdb));
+			if (ret < 0)
+				goto err_put_adev;
+
+			if (sensor->ssdb.lanes > 4) {
+				dev_err(&adev->dev,
+					"Number of lanes in SSDB is invalid\n");
+				goto err_put_adev;
+			}
+
+			cio2_bridge_create_fwnode_properties(sensor);
+			cio2_bridge_create_connection_swnodes(bridge, sensor);
+
+			ret = software_node_register_nodes(sensor->swnodes);
+			if (ret)
+				goto err_put_adev;
+
+			fwnode = software_node_fwnode(&sensor->swnodes[SWNODE_SENSOR_HID]);
+			if (!fwnode) {
+				ret = -ENODEV;
+				goto err_free_swnodes;
+			}
+
+			adev->fwnode.secondary = fwnode;
+
+			dev_info(&bridge->cio2->dev,
+				 "Found supported sensor %s\n",
+				 acpi_dev_name(adev));
+
+			bridge->n_sensors++;
+		}
+	}
+
+	return ret;
+
+err_free_swnodes:
+	software_node_unregister_nodes(sensor->swnodes);
+err_put_adev:
+	acpi_dev_put(sensor->adev);
+
+	return ret;
+}
+
+int cio2_bridge_init(struct pci_dev *cio2)
+{
+	struct device *dev = &cio2->dev;
+	struct fwnode_handle *fwnode;
+	struct cio2_bridge *bridge;
+	int ret;
+
+	bridge = kzalloc(sizeof(*bridge), GFP_KERNEL);
+	if (!bridge)
+		return -ENOMEM;
+
+	strscpy(bridge->cio2_node_name, CIO2_HID, sizeof(bridge->cio2_node_name));
+	bridge->cio2_hid_node = (const struct software_node){ bridge->cio2_node_name };
+	bridge->cio2 = pci_dev_get(cio2);
+
+	ret = software_node_register(&bridge->cio2_hid_node);
+	if (ret < 0) {
+		dev_err(dev, "Failed to register the CIO2 HID node\n");
+		goto err_put_cio2;
+	}
+
+	ret = cio2_bridge_connect_sensors(bridge);
+	if (ret || bridge->n_sensors == 0)
+		goto err_unregister_cio2;
+
+	dev_info(dev, "Connected %d cameras\n", bridge->n_sensors);
+
+	fwnode = software_node_fwnode(&bridge->cio2_hid_node);
+	if (!fwnode) {
+		dev_err(dev, "Error getting fwnode from cio2 software_node\n");
+		ret = -ENODEV;
+		goto err_unregister_sensors;
+	}
+
+	set_secondary_fwnode(dev, fwnode);
+
+	return 0;
+
+err_unregister_sensors:
+	cio2_bridge_unregister_sensors(bridge);
+err_unregister_cio2:
+	software_node_unregister(&bridge->cio2_hid_node);
+err_put_cio2:
+	pci_dev_put(bridge->cio2);
+
+	kfree(bridge);
+	return ret;
+}
diff --git a/drivers/media/pci/intel/ipu3/cio2-bridge.h b/drivers/media/pci/intel/ipu3/cio2-bridge.h
new file mode 100644
index 000000000000..96f5c8a12be0
--- /dev/null
+++ b/drivers/media/pci/intel/ipu3/cio2-bridge.h
@@ -0,0 +1,108 @@ 
+/* SPDX-License-Identifier: GPL-2.0 */
+/* Author: Dan Scally <djrscally@gmail.com> */
+#ifndef __CIO2_BRIDGE_H
+#define __CIO2_BRIDGE_H
+
+#include <linux/property.h>
+
+#define CIO2_HID				"INT343E"
+#define CIO2_NUM_PORTS			  4
+
+#define NODE_SENSOR(_HID, _PROPS)		\
+	((const struct software_node) {		\
+		.name = _HID,			\
+		.properties = _PROPS,		\
+	})
+
+#define NODE_PORT(_PORT, _SENSOR_NODE)		\
+	((const struct software_node) {		\
+		_PORT,				\
+		_SENSOR_NODE,			\
+	})
+
+#define NODE_ENDPOINT(_EP, _PORT, _PROPS)	\
+	((const struct software_node) {		\
+		_EP,				\
+		_PORT,				\
+		_PROPS,				\
+	})
+
+enum cio2_sensor_swnodes {
+	SWNODE_SENSOR_HID,
+	SWNODE_SENSOR_PORT,
+	SWNODE_SENSOR_ENDPOINT,
+	SWNODE_CIO2_PORT,
+	SWNODE_CIO2_ENDPOINT,
+	NR_OF_SENSOR_SWNODES
+};
+
+/* Data representation as it is in ACPI SSDB buffer */
+struct cio2_sensor_ssdb {
+	u8 version;
+	u8 sku;
+	u8 guid_csi2[16];
+	u8 devfunction;
+	u8 bus;
+	u32 dphylinkenfuses;
+	u32 clockdiv;
+	u8 link;
+	u8 lanes;
+	u32 csiparams[10];
+	u32 maxlanespeed;
+	u8 sensorcalibfileidx;
+	u8 sensorcalibfileidxInMBZ[3];
+	u8 romtype;
+	u8 vcmtype;
+	u8 platforminfo;
+	u8 platformsubinfo;
+	u8 flash;
+	u8 privacyled;
+	u8 degree;
+	u8 mipilinkdefined;
+	u32 mclkspeed;
+	u8 controllogicid;
+	u8 reserved1[3];
+	u8 mclkport;
+	u8 reserved2[13];
+} __packed__;
+
+struct cio2_property_names {
+	char clock_frequency[16];
+	char rotation[9];
+	char bus_type[9];
+	char data_lanes[11];
+	char remote_endpoint[16];
+};
+
+struct cio2_node_names {
+	char port[6];
+	char endpoint[10];
+	char remote_port[6];
+};
+
+struct cio2_sensor {
+	char name[ACPI_ID_LEN];
+	struct acpi_device *adev;
+
+	struct software_node swnodes[6];
+	struct cio2_node_names node_names;
+
+	u32 data_lanes[4];
+	struct cio2_sensor_ssdb ssdb;
+	struct cio2_property_names prop_names;
+	struct property_entry ep_properties[4];
+	struct property_entry dev_properties[3];
+	struct property_entry cio2_properties[3];
+	struct software_node_ref_args local_ref[1];
+	struct software_node_ref_args remote_ref[1];
+};
+
+struct cio2_bridge {
+	struct pci_dev *cio2;
+	char cio2_node_name[ACPI_ID_LEN];
+	struct software_node cio2_hid_node;
+	unsigned int n_sensors;
+	struct cio2_sensor sensors[CIO2_NUM_PORTS];
+};
+
+#endif
diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c b/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c
index 36e354ecf71e..0d69b593e9f0 100644
--- a/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c
+++ b/drivers/media/pci/intel/ipu3/ipu3-cio2-main.c
@@ -1702,6 +1702,22 @@  static void cio2_queues_exit(struct cio2_device *cio2)
 		cio2_queue_exit(cio2, &cio2->queue[i]);
 }
 
+static bool cio2_check_fwnode_graph(struct fwnode_handle *fwnode)
+{
+	struct fwnode_handle *endpoint;
+
+	if (IS_ERR_OR_NULL(fwnode))
+		return false;
+
+	endpoint = fwnode_graph_get_next_endpoint(fwnode, NULL);
+	if (endpoint) {
+		fwnode_handle_put(endpoint);
+		return true;
+	}
+
+	return cio2_check_fwnode_graph(fwnode->secondary);
+}
+
 /**************** PCI interface ****************/
 
 static int cio2_pci_probe(struct pci_dev *pci_dev,
@@ -1715,6 +1731,17 @@  static int cio2_pci_probe(struct pci_dev *pci_dev,
 		return -ENOMEM;
 	cio2->pci_dev = pci_dev;
 
+	/*
+	 * On some platforms no connections to sensors are defined in firmware,
+	 * if the device has no endpoints then we can try to build those as
+	 * software_nodes parsed from SSDB.
+	 */
+	if (!cio2_check_fwnode_graph(dev_fwnode(&pci_dev->dev))) {
+		r = cio2_bridge_init(pci_dev);
+		if (r)
+			return r;
+	}
+
 	r = pcim_enable_device(pci_dev);
 	if (r) {
 		dev_err(&pci_dev->dev, "failed to enable device (%d)\n", r);
diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2.h b/drivers/media/pci/intel/ipu3/ipu3-cio2.h
index ccf0b85ae36f..520a27c9cdad 100644
--- a/drivers/media/pci/intel/ipu3/ipu3-cio2.h
+++ b/drivers/media/pci/intel/ipu3/ipu3-cio2.h
@@ -437,4 +437,10 @@  static inline struct cio2_queue *vb2q_to_cio2_queue(struct vb2_queue *vq)
 	return container_of(vq, struct cio2_queue, vbq);
 }
 
+#if IS_ENABLED(CONFIG_CIO2_BRIDGE)
+int cio2_bridge_init(struct pci_dev *cio2);
+#else
+int cio2_bridge_init(struct pci_dev *cio2) { return 0; }
+#endif
+
 #endif