diff options
| -rw-r--r-- | src/drivers/intel/mipi_camera/camera.c | 85 |
1 files changed, 85 insertions, 0 deletions
diff --git a/src/drivers/intel/mipi_camera/camera.c b/src/drivers/intel/mipi_camera/camera.c index 5230a2ac3f..c4caccec5b 100644 --- a/src/drivers/intel/mipi_camera/camera.c +++ b/src/drivers/intel/mipi_camera/camera.c @@ -14,6 +14,88 @@ #define SENSOR_TYPE_UUID "26257549-9271-4ca4-bb43-c4899d5a4881" #define DEFAULT_ENDPOINT 0 +static uint32_t address_for_dev_type(const struct device *dev, uint8_t dev_type) +{ + struct drivers_intel_mipi_camera_config *config = dev->chip_info; + uint16_t i2c_bus = dev->bus ? dev->bus->secondary : 0xFFFF; + uint16_t i2c_addr; + + switch (dev_type) { + case DEV_TYPE_SENSOR: + i2c_addr = dev->path.i2c.device; + break; + case DEV_TYPE_VCM: + i2c_addr = config->vcm_address; + break; + case DEV_TYPE_ROM: + i2c_addr = config->rom_address; + break; + default: + return 0; + } + + return (((uint32_t)i2c_bus) << 24 | ((uint32_t)i2c_addr) << 8 | dev_type); +} + +static void camera_generate_dsm(const struct device *dev) +{ + struct drivers_intel_mipi_camera_config *config = dev->chip_info; + int local1_ret = 1 + (config->ssdb.vcm_type ? 1 : 0) + (config->ssdb.rom_type ? 1 : 0); + int next_local1 = 1; + /* Method (_DSM, 4, NotSerialized) */ + acpigen_write_method("_DSM", 4); + + /* ToBuffer (Arg0, Local0) */ + acpigen_write_to_buffer(ARG0_OP, LOCAL0_OP); + + /* If (LEqual (Local0, ToUUID(uuid))) */ + acpigen_write_if(); + acpigen_emit_byte(LEQUAL_OP); + acpigen_emit_byte(LOCAL0_OP); + acpigen_write_uuid(SENSOR_NAME_UUID); + acpigen_write_return_string(config->sensor_name ? config->sensor_name : "UNKNOWN"); + acpigen_pop_len(); /* If */ + + /* If (LEqual (Local0, ToUUID(uuid))) */ + acpigen_write_if(); + acpigen_emit_byte(LEQUAL_OP); + acpigen_emit_byte(LOCAL0_OP); + acpigen_write_uuid(SENSOR_TYPE_UUID); + /* ToInteger (Arg2, Local1) */ + acpigen_write_to_integer(ARG2_OP, LOCAL1_OP); + + /* If (LEqual (Local1, 1)) */ + acpigen_write_if_lequal_op_int(LOCAL1_OP, next_local1++); + acpigen_write_return_integer(local1_ret); + acpigen_pop_len(); /* If Arg2=1 */ + + /* If (LEqual (Local1, 2)) */ + acpigen_write_if_lequal_op_int(LOCAL1_OP, next_local1++); + acpigen_write_return_integer(address_for_dev_type(dev, DEV_TYPE_SENSOR)); + acpigen_pop_len(); /* If Arg2=2 */ + + if (config->ssdb.vcm_type) { + /* If (LEqual (Local1, 3)) */ + acpigen_write_if_lequal_op_int(LOCAL1_OP, next_local1++); + acpigen_write_return_integer(address_for_dev_type(dev, DEV_TYPE_VCM)); + acpigen_pop_len(); /* If Arg2=3 */ + } + + if (config->ssdb.rom_type) { + /* If (LEqual (Local1, 3 or 4)) */ + acpigen_write_if_lequal_op_int(LOCAL1_OP, next_local1); + acpigen_write_return_integer(address_for_dev_type(dev, DEV_TYPE_ROM)); + acpigen_pop_len(); /* If Arg2=3 or 4 */ + } + + acpigen_pop_len(); /* If uuid */ + + /* Return (Buffer (One) { 0x0 }) */ + acpigen_write_return_singleton_buffer(0x0); + + acpigen_pop_len(); /* Method _DSM */ +} + static void camera_fill_sensor_defaults(struct drivers_intel_mipi_camera_config *config) { if (config->disable_ssdb_defaults) @@ -66,6 +148,9 @@ static void camera_fill_sensor(const struct device *dev) camera_fill_sensor_defaults(config); + /* _DSM */ + camera_generate_dsm(dev); + ep00 = acpi_dp_new_table("EP00"); acpi_dp_add_integer(ep00, "endpoint", DEFAULT_ENDPOINT); acpi_dp_add_integer(ep00, "clock-lanes", 0); |