12 #include <linux/i2c-mux.h>
13 #include <linux/platform_data/i2c-mux-gpio.h>
28 static void i2c_mux_gpio_set(const struct gpiomux *mux, unsigned val)  in i2c_mux_gpio_set()  argument
32 	for (i = 0; i < mux->data.n_gpios; i++)  in i2c_mux_gpio_set()
33 		mux->values[i] = (val >> i) & 1;  in i2c_mux_gpio_set()
35 	gpiod_set_array_value_cansleep(mux->data.n_gpios,  in i2c_mux_gpio_set()
36 				       mux->gpios, mux->values);  in i2c_mux_gpio_set()
41 	struct gpiomux *mux = i2c_mux_priv(muxc);  in i2c_mux_gpio_select()  local
43 	i2c_mux_gpio_set(mux, chan);  in i2c_mux_gpio_select()
50 	struct gpiomux *mux = i2c_mux_priv(muxc);  in i2c_mux_gpio_deselect()  local
52 	i2c_mux_gpio_set(mux, mux->data.idle);  in i2c_mux_gpio_deselect()
64 static int i2c_mux_gpio_probe_dt(struct gpiomux *mux,  in i2c_mux_gpio_probe_dt()  argument
86 	mux->data.parent = i2c_adapter_id(adapter);  in i2c_mux_gpio_probe_dt()
89 	mux->data.n_values = of_get_child_count(np);  in i2c_mux_gpio_probe_dt()
92 			      mux->data.n_values, sizeof(*mux->data.values),  in i2c_mux_gpio_probe_dt()
103 	mux->data.values = values;  in i2c_mux_gpio_probe_dt()
105 	if (of_property_read_u32(np, "idle-state", &mux->data.idle))  in i2c_mux_gpio_probe_dt()
106 		mux->data.idle = I2C_MUX_GPIO_NO_IDLE;  in i2c_mux_gpio_probe_dt()
108 	mux->data.n_gpios = of_gpio_named_count(np, "mux-gpios");  in i2c_mux_gpio_probe_dt()
109 	if (mux->data.n_gpios < 0) {  in i2c_mux_gpio_probe_dt()
110 		dev_err(&pdev->dev, "Missing mux-gpios property in the DT.\n");  in i2c_mux_gpio_probe_dt()
115 			     mux->data.n_gpios, sizeof(*mux->data.gpios),  in i2c_mux_gpio_probe_dt()
122 	for (i = 0; i < mux->data.n_gpios; i++) {  in i2c_mux_gpio_probe_dt()
123 		ret = of_get_named_gpio(np, "mux-gpios", i);  in i2c_mux_gpio_probe_dt()
129 	mux->data.gpios = gpios;  in i2c_mux_gpio_probe_dt()
134 static int i2c_mux_gpio_probe_dt(struct gpiomux *mux,  in i2c_mux_gpio_probe_dt()  argument
144 	struct gpiomux *mux;  in i2c_mux_gpio_probe()  local
150 	mux = devm_kzalloc(&pdev->dev, sizeof(*mux), GFP_KERNEL);  in i2c_mux_gpio_probe()
151 	if (!mux)  in i2c_mux_gpio_probe()
155 		ret = i2c_mux_gpio_probe_dt(mux, pdev);  in i2c_mux_gpio_probe()
159 		memcpy(&mux->data, dev_get_platdata(&pdev->dev),  in i2c_mux_gpio_probe()
160 			sizeof(mux->data));  in i2c_mux_gpio_probe()
167 	if (mux->data.gpio_chip) {  in i2c_mux_gpio_probe()
170 		gpio = gpiochip_find(mux->data.gpio_chip,  in i2c_mux_gpio_probe()
180 	parent = i2c_get_adapter(mux->data.parent);  in i2c_mux_gpio_probe()
184 	muxc = i2c_mux_alloc(parent, &pdev->dev, mux->data.n_values,  in i2c_mux_gpio_probe()
185 			     mux->data.n_gpios * sizeof(*mux->gpios) +  in i2c_mux_gpio_probe()
186 			     mux->data.n_gpios * sizeof(*mux->values), 0,  in i2c_mux_gpio_probe()
192 	mux->gpios = muxc->priv;  in i2c_mux_gpio_probe()
193 	mux->values = (int *)(mux->gpios + mux->data.n_gpios);  in i2c_mux_gpio_probe()
194 	muxc->priv = mux;  in i2c_mux_gpio_probe()
201 	mux->gpio_base = gpio_base;  in i2c_mux_gpio_probe()
203 	if (mux->data.idle != I2C_MUX_GPIO_NO_IDLE) {  in i2c_mux_gpio_probe()
204 		initial_state = mux->data.idle;  in i2c_mux_gpio_probe()
207 		initial_state = mux->data.values[0];  in i2c_mux_gpio_probe()
210 	for (i = 0; i < mux->data.n_gpios; i++) {  in i2c_mux_gpio_probe()
214 		ret = gpio_request(gpio_base + mux->data.gpios[i], "i2c-mux-gpio");  in i2c_mux_gpio_probe()
217 				mux->data.gpios[i]);  in i2c_mux_gpio_probe()
221 		ret = gpio_direction_output(gpio_base + mux->data.gpios[i],  in i2c_mux_gpio_probe()
226 				mux->data.gpios[i]);  in i2c_mux_gpio_probe()
231 		gpio_desc = gpio_to_desc(gpio_base + mux->data.gpios[i]);  in i2c_mux_gpio_probe()
232 		mux->gpios[i] = gpio_desc;  in i2c_mux_gpio_probe()
242 		dev_info(&pdev->dev, "mux-locked i2c mux\n");  in i2c_mux_gpio_probe()
244 	for (i = 0; i < mux->data.n_values; i++) {  in i2c_mux_gpio_probe()
245 		u32 nr = mux->data.base_nr ? (mux->data.base_nr + i) : 0;  in i2c_mux_gpio_probe()
246 		unsigned int class = mux->data.classes ? mux->data.classes[i] : 0;  in i2c_mux_gpio_probe()
248 		ret = i2c_mux_add_adapter(muxc, nr, mux->data.values[i], class);  in i2c_mux_gpio_probe()
253 	dev_info(&pdev->dev, "%d port mux on %s adapter\n",  in i2c_mux_gpio_probe()
254 		 mux->data.n_values, parent->name);  in i2c_mux_gpio_probe()
260 	i = mux->data.n_gpios;  in i2c_mux_gpio_probe()
263 		gpio_free(gpio_base + mux->data.gpios[i - 1]);  in i2c_mux_gpio_probe()
273 	struct gpiomux *mux = i2c_mux_priv(muxc);  in i2c_mux_gpio_remove()  local
278 	for (i = 0; i < mux->data.n_gpios; i++)  in i2c_mux_gpio_remove()
279 		gpio_free(mux->gpio_base + mux->data.gpios[i]);  in i2c_mux_gpio_remove()
287 	{ .compatible = "i2c-mux-gpio", },
296 		.name	= "i2c-mux-gpio",
306 MODULE_ALIAS("platform:i2c-mux-gpio");