27 static void i2c_mux_gpio_set(const struct gpiomux *mux, unsigned val)  in i2c_mux_gpio_set()  argument
31 	for (i = 0; i < mux->data.n_gpios; i++)  in i2c_mux_gpio_set()
32 		gpio_set_value_cansleep(mux->gpio_base + mux->data.gpios[i],  in i2c_mux_gpio_set()
38 	struct gpiomux *mux = data;  in i2c_mux_gpio_select()  local
40 	i2c_mux_gpio_set(mux, chan);  in i2c_mux_gpio_select()
47 	struct gpiomux *mux = data;  in i2c_mux_gpio_deselect()  local
49 	i2c_mux_gpio_set(mux, mux->data.idle);  in i2c_mux_gpio_deselect()
61 static int i2c_mux_gpio_probe_dt(struct gpiomux *mux,  in i2c_mux_gpio_probe_dt()  argument
82 	mux->data.parent = i2c_adapter_id(adapter);  in i2c_mux_gpio_probe_dt()
85 	mux->data.n_values = of_get_child_count(np);  in i2c_mux_gpio_probe_dt()
88 			      sizeof(*mux->data.values) * mux->data.n_values,  in i2c_mux_gpio_probe_dt()
99 	mux->data.values = values;  in i2c_mux_gpio_probe_dt()
101 	if (of_property_read_u32(np, "idle-state", &mux->data.idle))  in i2c_mux_gpio_probe_dt()
102 		mux->data.idle = I2C_MUX_GPIO_NO_IDLE;  in i2c_mux_gpio_probe_dt()
104 	mux->data.n_gpios = of_gpio_named_count(np, "mux-gpios");  in i2c_mux_gpio_probe_dt()
105 	if (mux->data.n_gpios < 0) {  in i2c_mux_gpio_probe_dt()
111 			     sizeof(*mux->data.gpios) * mux->data.n_gpios, GFP_KERNEL);  in i2c_mux_gpio_probe_dt()
117 	for (i = 0; i < mux->data.n_gpios; i++) {  in i2c_mux_gpio_probe_dt()
124 	mux->data.gpios = gpios;  in i2c_mux_gpio_probe_dt()
129 static int i2c_mux_gpio_probe_dt(struct gpiomux *mux,  in i2c_mux_gpio_probe_dt()  argument
138 	struct gpiomux *mux;  in i2c_mux_gpio_probe()  local
144 	mux = devm_kzalloc(&pdev->dev, sizeof(*mux), GFP_KERNEL);  in i2c_mux_gpio_probe()
145 	if (!mux) {  in i2c_mux_gpio_probe()
150 	platform_set_drvdata(pdev, mux);  in i2c_mux_gpio_probe()
153 		ret = i2c_mux_gpio_probe_dt(mux, pdev);  in i2c_mux_gpio_probe()
157 		memcpy(&mux->data, dev_get_platdata(&pdev->dev),  in i2c_mux_gpio_probe()
158 			sizeof(mux->data));  in i2c_mux_gpio_probe()
165 	if (mux->data.gpio_chip) {  in i2c_mux_gpio_probe()
168 		gpio = gpiochip_find(mux->data.gpio_chip,  in i2c_mux_gpio_probe()
178 	parent = i2c_get_adapter(mux->data.parent);  in i2c_mux_gpio_probe()
182 	mux->parent = parent;  in i2c_mux_gpio_probe()
183 	mux->gpio_base = gpio_base;  in i2c_mux_gpio_probe()
185 	mux->adap = devm_kzalloc(&pdev->dev,  in i2c_mux_gpio_probe()
186 				 sizeof(*mux->adap) * mux->data.n_values,  in i2c_mux_gpio_probe()
188 	if (!mux->adap) {  in i2c_mux_gpio_probe()
194 	if (mux->data.idle != I2C_MUX_GPIO_NO_IDLE) {  in i2c_mux_gpio_probe()
195 		initial_state = mux->data.idle;  in i2c_mux_gpio_probe()
198 		initial_state = mux->data.values[0];  in i2c_mux_gpio_probe()
202 	for (i = 0; i < mux->data.n_gpios; i++) {  in i2c_mux_gpio_probe()
203 		ret = gpio_request(gpio_base + mux->data.gpios[i], "i2c-mux-gpio");  in i2c_mux_gpio_probe()
206 				mux->data.gpios[i]);  in i2c_mux_gpio_probe()
210 		ret = gpio_direction_output(gpio_base + mux->data.gpios[i],  in i2c_mux_gpio_probe()
215 				mux->data.gpios[i]);  in i2c_mux_gpio_probe()
221 	for (i = 0; i < mux->data.n_values; i++) {  in i2c_mux_gpio_probe()
222 		u32 nr = mux->data.base_nr ? (mux->data.base_nr + i) : 0;  in i2c_mux_gpio_probe()
223 		unsigned int class = mux->data.classes ? mux->data.classes[i] : 0;  in i2c_mux_gpio_probe()
225 		mux->adap[i] = i2c_add_mux_adapter(parent, &pdev->dev, mux, nr,  in i2c_mux_gpio_probe()
226 						   mux->data.values[i], class,  in i2c_mux_gpio_probe()
228 		if (!mux->adap[i]) {  in i2c_mux_gpio_probe()
236 		 mux->data.n_values, parent->name);  in i2c_mux_gpio_probe()
242 		i2c_del_mux_adapter(mux->adap[i - 1]);  in i2c_mux_gpio_probe()
243 	i = mux->data.n_gpios;  in i2c_mux_gpio_probe()
246 		gpio_free(gpio_base + mux->data.gpios[i - 1]);  in i2c_mux_gpio_probe()
255 	struct gpiomux *mux = platform_get_drvdata(pdev);  in i2c_mux_gpio_remove()  local
258 	for (i = 0; i < mux->data.n_values; i++)  in i2c_mux_gpio_remove()
259 		i2c_del_mux_adapter(mux->adap[i]);  in i2c_mux_gpio_remove()
261 	for (i = 0; i < mux->data.n_gpios; i++)  in i2c_mux_gpio_remove()
262 		gpio_free(mux->gpio_base + mux->data.gpios[i]);  in i2c_mux_gpio_remove()
264 	i2c_put_adapter(mux->parent);  in i2c_mux_gpio_remove()