2  * nokia-modem.c
4  * HSI client driver for Nokia N900 modem.
20  * 02110-1301 USA
25 #include <linux/init.h>
54 	struct nokia_modem_device *modem = (struct nokia_modem_device *)data;  in do_nokia_modem_rst_ind_tasklet()  local
56 	if (!modem)  in do_nokia_modem_rst_ind_tasklet()
59 	dev_info(modem->device, "CMT rst line change detected\n");  in do_nokia_modem_rst_ind_tasklet()
61 	if (modem->ssi_protocol)  in do_nokia_modem_rst_ind_tasklet()
62 		ssip_reset_event(modem->ssi_protocol);  in do_nokia_modem_rst_ind_tasklet()
67 	struct nokia_modem_device *modem = (struct nokia_modem_device *)data;  in nokia_modem_rst_ind_isr()  local
69 	tasklet_schedule(&modem->nokia_modem_rst_ind_tasklet);  in nokia_modem_rst_ind_isr()
76 	struct nokia_modem_device *modem = dev_get_drvdata(dev);  in nokia_modem_gpio_unexport()  local
79 	for (i = 0; i < modem->gpio_amount; i++) {  in nokia_modem_gpio_unexport()
80 		sysfs_remove_link(&dev->kobj, modem->gpios[i].name);  in nokia_modem_gpio_unexport()
81 		gpiod_unexport(modem->gpios[i].gpio);  in nokia_modem_gpio_unexport()
87 	struct device_node *np = dev->of_node;  in nokia_modem_gpio_probe()
88 	struct nokia_modem_device *modem = dev_get_drvdata(dev);  in nokia_modem_gpio_probe()  local
98 	gpio_name_count = of_property_count_strings(np, "gpio-names");  in nokia_modem_gpio_probe()
102 		return -EINVAL;  in nokia_modem_gpio_probe()
105 	modem->gpios = devm_kcalloc(dev, gpio_count, sizeof(*modem->gpios),  in nokia_modem_gpio_probe()
107 	if (!modem->gpios)  in nokia_modem_gpio_probe()
108 		return -ENOMEM;  in nokia_modem_gpio_probe()
110 	modem->gpio_amount = gpio_count;  in nokia_modem_gpio_probe()
113 		modem->gpios[i].gpio = devm_gpiod_get_index(dev, NULL, i,  in nokia_modem_gpio_probe()
115 		if (IS_ERR(modem->gpios[i].gpio)) {  in nokia_modem_gpio_probe()
117 			return PTR_ERR(modem->gpios[i].gpio);  in nokia_modem_gpio_probe()
120 		err = of_property_read_string_index(np, "gpio-names", i,  in nokia_modem_gpio_probe()
121 						&(modem->gpios[i].name));  in nokia_modem_gpio_probe()
127 		err = gpiod_export(modem->gpios[i].gpio, 0);  in nokia_modem_gpio_probe()
131 		err = gpiod_export_link(dev, modem->gpios[i].name,  in nokia_modem_gpio_probe()
132 							modem->gpios[i].gpio);  in nokia_modem_gpio_probe()
143 	struct nokia_modem_device *modem;  in nokia_modem_probe()  local
150 	np = dev->of_node;  in nokia_modem_probe()
153 		return -ENXIO;  in nokia_modem_probe()
156 	modem = devm_kzalloc(dev, sizeof(*modem), GFP_KERNEL);  in nokia_modem_probe()
157 	if (!modem)  in nokia_modem_probe()
158 		return -ENOMEM;  in nokia_modem_probe()
160 	dev_set_drvdata(dev, modem);  in nokia_modem_probe()
161 	modem->device = dev;  in nokia_modem_probe()
166 		return -EINVAL;  in nokia_modem_probe()
168 	modem->nokia_modem_rst_ind_irq = irq;  in nokia_modem_probe()
171 	tasklet_init(&modem->nokia_modem_rst_ind_tasklet,  in nokia_modem_probe()
172 			do_nokia_modem_rst_ind_tasklet, (unsigned long)modem);  in nokia_modem_probe()
174 				pflags, "modem_rst_ind", modem);  in nokia_modem_probe()
190 	ssip.name = "ssi-protocol";  in nokia_modem_probe()
191 	ssip.tx_cfg = cl->tx_cfg;  in nokia_modem_probe()
192 	ssip.rx_cfg = cl->rx_cfg;  in nokia_modem_probe()
196 	modem->ssi_protocol = hsi_new_client(port, &ssip);  in nokia_modem_probe()
197 	if (!modem->ssi_protocol) {  in nokia_modem_probe()
198 		dev_err(dev, "Could not register ssi-protocol device\n");  in nokia_modem_probe()
199 		err = -ENOMEM;  in nokia_modem_probe()
203 	err = device_attach(&modem->ssi_protocol->device);  in nokia_modem_probe()
205 		dev_dbg(dev, "Missing ssi-protocol driver\n");  in nokia_modem_probe()
206 		err = -EPROBE_DEFER;  in nokia_modem_probe()
209 		dev_err(dev, "Could not load ssi-protocol driver (%d)\n", err);  in nokia_modem_probe()
213 	cmtspeech.name = "cmt-speech";  in nokia_modem_probe()
214 	cmtspeech.tx_cfg = cl->tx_cfg;  in nokia_modem_probe()
215 	cmtspeech.rx_cfg = cl->rx_cfg;  in nokia_modem_probe()
219 	modem->cmt_speech = hsi_new_client(port, &cmtspeech);  in nokia_modem_probe()
220 	if (!modem->cmt_speech) {  in nokia_modem_probe()
221 		dev_err(dev, "Could not register cmt-speech device\n");  in nokia_modem_probe()
222 		err = -ENOMEM;  in nokia_modem_probe()
226 	err = device_attach(&modem->cmt_speech->device);  in nokia_modem_probe()
228 		dev_dbg(dev, "Missing cmt-speech driver\n");  in nokia_modem_probe()
229 		err = -EPROBE_DEFER;  in nokia_modem_probe()
232 		dev_err(dev, "Could not load cmt-speech driver (%d)\n", err);  in nokia_modem_probe()
236 	dev_info(dev, "Registered Nokia HSI modem\n");  in nokia_modem_probe()
241 	hsi_remove_client(&modem->cmt_speech->device, NULL);  in nokia_modem_probe()
243 	hsi_remove_client(&modem->ssi_protocol->device, NULL);  in nokia_modem_probe()
247 	disable_irq_wake(modem->nokia_modem_rst_ind_irq);  in nokia_modem_probe()
248 	tasklet_kill(&modem->nokia_modem_rst_ind_tasklet);  in nokia_modem_probe()
255 	struct nokia_modem_device *modem = dev_get_drvdata(dev);  in nokia_modem_remove()  local
257 	if (!modem)  in nokia_modem_remove()
260 	if (modem->cmt_speech) {  in nokia_modem_remove()
261 		hsi_remove_client(&modem->cmt_speech->device, NULL);  in nokia_modem_remove()
262 		modem->cmt_speech = NULL;  in nokia_modem_remove()
265 	if (modem->ssi_protocol) {  in nokia_modem_remove()
266 		hsi_remove_client(&modem->ssi_protocol->device, NULL);  in nokia_modem_remove()
267 		modem->ssi_protocol = NULL;  in nokia_modem_remove()
272 	disable_irq_wake(modem->nokia_modem_rst_ind_irq);  in nokia_modem_remove()
273 	tasklet_kill(&modem->nokia_modem_rst_ind_tasklet);  in nokia_modem_remove()
280 	{ .compatible = "nokia,n900-modem", },
281 	{ .compatible = "nokia,n950-modem", },
282 	{ .compatible = "nokia,n9-modem", },
290 		.name	= "nokia-modem",
310 MODULE_ALIAS("hsi:nokia-modem");
312 MODULE_DESCRIPTION("HSI driver module for Nokia N900 Modem");