Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 | // SPDX-License-Identifier: GPL-2.0-or-later /* * v4l2-i2c - I2C helpers for Video4Linux2 */ #include <linux/i2c.h> #include <linux/module.h> #include <media/v4l2-common.h> #include <media/v4l2-device.h> void v4l2_i2c_subdev_unregister(struct v4l2_subdev *sd) { struct i2c_client *client = v4l2_get_subdevdata(sd); /* * We need to unregister the i2c client * explicitly. We cannot rely on * i2c_del_adapter to always unregister * clients for us, since if the i2c bus is a * platform bus, then it is never deleted. * * Device tree or ACPI based devices must not * be unregistered as they have not been * registered by us, and would not be * re-created by just probing the V4L2 driver. */ if (client && !client->dev.of_node && !client->dev.fwnode) i2c_unregister_device(client); } void v4l2_i2c_subdev_set_name(struct v4l2_subdev *sd, struct i2c_client *client, const char *devname, const char *postfix) { if (!devname) devname = client->dev.driver->name; if (!postfix) postfix = ""; snprintf(sd->name, sizeof(sd->name), "%s%s %d-%04x", devname, postfix, i2c_adapter_id(client->adapter), client->addr); } EXPORT_SYMBOL_GPL(v4l2_i2c_subdev_set_name); void v4l2_i2c_subdev_init(struct v4l2_subdev *sd, struct i2c_client *client, const struct v4l2_subdev_ops *ops) { v4l2_subdev_init(sd, ops); sd->flags |= V4L2_SUBDEV_FL_IS_I2C; /* the owner is the same as the i2c_client's driver owner */ sd->owner = client->dev.driver->owner; sd->dev = &client->dev; /* i2c_client and v4l2_subdev point to one another */ v4l2_set_subdevdata(sd, client); i2c_set_clientdata(client, sd); v4l2_i2c_subdev_set_name(sd, client, NULL, NULL); } EXPORT_SYMBOL_GPL(v4l2_i2c_subdev_init); /* Load an i2c sub-device. */ struct v4l2_subdev *v4l2_i2c_new_subdev_board(struct v4l2_device *v4l2_dev, struct i2c_adapter *adapter, struct i2c_board_info *info, const unsigned short *probe_addrs) { struct v4l2_subdev *sd = NULL; struct i2c_client *client; if (!v4l2_dev) return NULL; request_module(I2C_MODULE_PREFIX "%s", info->type); /* Create the i2c client */ if (info->addr == 0 && probe_addrs) client = i2c_new_scanned_device(adapter, info, probe_addrs, NULL); else client = i2c_new_client_device(adapter, info); /* * Note: by loading the module first we are certain that c->driver * will be set if the driver was found. If the module was not loaded * first, then the i2c core tries to delay-load the module for us, * and then c->driver is still NULL until the module is finally * loaded. This delay-load mechanism doesn't work if other drivers * want to use the i2c device, so explicitly loading the module * is the best alternative. */ if (!i2c_client_has_driver(client)) goto error; /* Lock the module so we can safely get the v4l2_subdev pointer */ if (!try_module_get(client->dev.driver->owner)) goto error; sd = i2c_get_clientdata(client); /* * Register with the v4l2_device which increases the module's * use count as well. */ if (v4l2_device_register_subdev(v4l2_dev, sd)) sd = NULL; /* Decrease the module use count to match the first try_module_get. */ module_put(client->dev.driver->owner); error: /* * If we have a client but no subdev, then something went wrong and * we must unregister the client. */ if (!IS_ERR(client) && !sd) i2c_unregister_device(client); return sd; } EXPORT_SYMBOL_GPL(v4l2_i2c_new_subdev_board); struct v4l2_subdev *v4l2_i2c_new_subdev(struct v4l2_device *v4l2_dev, struct i2c_adapter *adapter, const char *client_type, u8 addr, const unsigned short *probe_addrs) { struct i2c_board_info info; /* * Setup the i2c board info with the device type and * the device address. */ memset(&info, 0, sizeof(info)); strscpy(info.type, client_type, sizeof(info.type)); info.addr = addr; return v4l2_i2c_new_subdev_board(v4l2_dev, adapter, &info, probe_addrs); } EXPORT_SYMBOL_GPL(v4l2_i2c_new_subdev); /* Return i2c client address of v4l2_subdev. */ unsigned short v4l2_i2c_subdev_addr(struct v4l2_subdev *sd) { struct i2c_client *client = v4l2_get_subdevdata(sd); return client ? client->addr : I2C_CLIENT_END; } EXPORT_SYMBOL_GPL(v4l2_i2c_subdev_addr); /* * Return a list of I2C tuner addresses to probe. Use only if the tuner * addresses are unknown. */ const unsigned short *v4l2_i2c_tuner_addrs(enum v4l2_i2c_tuner_type type) { static const unsigned short radio_addrs[] = { #if IS_ENABLED(CONFIG_MEDIA_TUNER_TEA5761) 0x10, #endif 0x60, I2C_CLIENT_END }; static const unsigned short demod_addrs[] = { 0x42, 0x43, 0x4a, 0x4b, I2C_CLIENT_END }; static const unsigned short tv_addrs[] = { 0x42, 0x43, 0x4a, 0x4b, /* tda8290 */ 0x60, 0x61, 0x62, 0x63, 0x64, I2C_CLIENT_END }; switch (type) { case ADDRS_RADIO: return radio_addrs; case ADDRS_DEMOD: return demod_addrs; case ADDRS_TV: return tv_addrs; case ADDRS_TV_WITH_DEMOD: return tv_addrs + 4; } return NULL; } EXPORT_SYMBOL_GPL(v4l2_i2c_tuner_addrs); |