1 // SPDX-License-Identifier: GPL-2.0-only
3  * nokia-modem.c
19 static unsigned int pm = 1;
20 module_param(pm, int, 0400);
31 	int			nokia_modem_rst_ind_irq;
33 	struct nokia_modem_gpio	*gpios;  member
34 	int			gpio_amount;
46 	dev_info(modem->device, "CMT rst line change detected\n");  in do_nokia_modem_rst_ind_tasklet()
48 	if (modem->ssi_protocol)  in do_nokia_modem_rst_ind_tasklet()
49 		ssip_reset_event(modem->ssi_protocol);  in do_nokia_modem_rst_ind_tasklet()
52 static irqreturn_t nokia_modem_rst_ind_isr(int irq, void *data)  in nokia_modem_rst_ind_isr()
56 	tasklet_schedule(&modem->nokia_modem_rst_ind_tasklet);  in nokia_modem_rst_ind_isr()
64 	int i;  in nokia_modem_gpio_unexport()
66 	for (i = 0; i < modem->gpio_amount; i++) {  in nokia_modem_gpio_unexport()
67 		sysfs_remove_link(&dev->kobj, modem->gpios[i].name);  in nokia_modem_gpio_unexport()
68 		gpiod_unexport(modem->gpios[i].gpio);  in nokia_modem_gpio_unexport()
72 static int nokia_modem_gpio_probe(struct device *dev)  in nokia_modem_gpio_probe()
74 	struct device_node *np = dev->of_node;  in nokia_modem_gpio_probe()
76 	int gpio_count, gpio_name_count, i, err;  in nokia_modem_gpio_probe()
81 		dev_err(dev, "missing gpios: %d\n", gpio_count);  in nokia_modem_gpio_probe()
85 	gpio_name_count = of_property_count_strings(np, "gpio-names");  in nokia_modem_gpio_probe()
88 		dev_err(dev, "number of gpios does not equal number of gpio names\n");  in nokia_modem_gpio_probe()
89 		return -EINVAL;  in nokia_modem_gpio_probe()
92 	modem->gpios = devm_kcalloc(dev, gpio_count, sizeof(*modem->gpios),  in nokia_modem_gpio_probe()
94 	if (!modem->gpios)  in nokia_modem_gpio_probe()
95 		return -ENOMEM;  in nokia_modem_gpio_probe()
97 	modem->gpio_amount = gpio_count;  in nokia_modem_gpio_probe()
100 		modem->gpios[i].gpio = devm_gpiod_get_index(dev, NULL, i,  in nokia_modem_gpio_probe()
102 		if (IS_ERR(modem->gpios[i].gpio)) {  in nokia_modem_gpio_probe()
104 			return PTR_ERR(modem->gpios[i].gpio);  in nokia_modem_gpio_probe()
107 		err = of_property_read_string_index(np, "gpio-names", i,  in nokia_modem_gpio_probe()
108 						&(modem->gpios[i].name));  in nokia_modem_gpio_probe()
114 		err = gpiod_export(modem->gpios[i].gpio, 0);  in nokia_modem_gpio_probe()
118 		err = gpiod_export_link(dev, modem->gpios[i].name,  in nokia_modem_gpio_probe()
119 							modem->gpios[i].gpio);  in nokia_modem_gpio_probe()
127 static int nokia_modem_probe(struct device *dev)  in nokia_modem_probe()
133 	int irq, pflags, err;  in nokia_modem_probe()
137 	np = dev->of_node;  in nokia_modem_probe()
140 		return -ENXIO;  in nokia_modem_probe()
145 		return -ENOMEM;  in nokia_modem_probe()
148 	modem->device = dev;  in nokia_modem_probe()
153 		return -EINVAL;  in nokia_modem_probe()
155 	modem->nokia_modem_rst_ind_irq = irq;  in nokia_modem_probe()
158 	tasklet_init(&modem->nokia_modem_rst_ind_tasklet,  in nokia_modem_probe()
172 			dev_err(dev, "Could not probe GPIOs\n");  in nokia_modem_probe()
177 	ssip.name = "ssi-protocol";  in nokia_modem_probe()
178 	ssip.tx_cfg = cl->tx_cfg;  in nokia_modem_probe()
179 	ssip.rx_cfg = cl->rx_cfg;  in nokia_modem_probe()
183 	modem->ssi_protocol = hsi_new_client(port, &ssip);  in nokia_modem_probe()
184 	if (!modem->ssi_protocol) {  in nokia_modem_probe()
185 		dev_err(dev, "Could not register ssi-protocol device\n");  in nokia_modem_probe()
186 		err = -ENOMEM;  in nokia_modem_probe()
190 	err = device_attach(&modem->ssi_protocol->device);  in nokia_modem_probe()
192 		dev_dbg(dev, "Missing ssi-protocol driver\n");  in nokia_modem_probe()
193 		err = -EPROBE_DEFER;  in nokia_modem_probe()
196 		dev_err(dev, "Could not load ssi-protocol driver (%d)\n", err);  in nokia_modem_probe()
200 	cmtspeech.name = "cmt-speech";  in nokia_modem_probe()
201 	cmtspeech.tx_cfg = cl->tx_cfg;  in nokia_modem_probe()
202 	cmtspeech.rx_cfg = cl->rx_cfg;  in nokia_modem_probe()
206 	modem->cmt_speech = hsi_new_client(port, &cmtspeech);  in nokia_modem_probe()
207 	if (!modem->cmt_speech) {  in nokia_modem_probe()
208 		dev_err(dev, "Could not register cmt-speech device\n");  in nokia_modem_probe()
209 		err = -ENOMEM;  in nokia_modem_probe()
213 	err = device_attach(&modem->cmt_speech->device);  in nokia_modem_probe()
215 		dev_dbg(dev, "Missing cmt-speech driver\n");  in nokia_modem_probe()
216 		err = -EPROBE_DEFER;  in nokia_modem_probe()
219 		dev_err(dev, "Could not load cmt-speech driver (%d)\n", err);  in nokia_modem_probe()
228 	hsi_remove_client(&modem->cmt_speech->device, NULL);  in nokia_modem_probe()
230 	hsi_remove_client(&modem->ssi_protocol->device, NULL);  in nokia_modem_probe()
234 	disable_irq_wake(modem->nokia_modem_rst_ind_irq);  in nokia_modem_probe()
235 	tasklet_kill(&modem->nokia_modem_rst_ind_tasklet);  in nokia_modem_probe()
240 static int nokia_modem_remove(struct device *dev)  in nokia_modem_remove()
247 	if (modem->cmt_speech) {  in nokia_modem_remove()
248 		hsi_remove_client(&modem->cmt_speech->device, NULL);  in nokia_modem_remove()
249 		modem->cmt_speech = NULL;  in nokia_modem_remove()
252 	if (modem->ssi_protocol) {  in nokia_modem_remove()
253 		hsi_remove_client(&modem->ssi_protocol->device, NULL);  in nokia_modem_remove()
254 		modem->ssi_protocol = NULL;  in nokia_modem_remove()
259 	disable_irq_wake(modem->nokia_modem_rst_ind_irq);  in nokia_modem_remove()
260 	tasklet_kill(&modem->nokia_modem_rst_ind_tasklet);  in nokia_modem_remove()
267 	{ .compatible = "nokia,n900-modem", },
268 	{ .compatible = "nokia,n950-modem", },
269 	{ .compatible = "nokia,n9-modem", },
277 		.name	= "nokia-modem",
285 static int __init nokia_modem_init(void)  in nokia_modem_init()
297 MODULE_ALIAS("hsi:nokia-modem");