140 	struct locomo *lchip = irq_desc_get_handler_data(desc);  in locomo_handler()  local
147 	req = locomo_readl(lchip->base + LOCOMO_ICR) & 0x0f00;  in locomo_handler()
153 		irq = lchip->irq_base;  in locomo_handler()
169 	struct locomo *lchip = irq_data_get_irq_chip_data(d);  in locomo_mask_irq()  local
171 	r = locomo_readl(lchip->base + LOCOMO_ICR);  in locomo_mask_irq()
172 	r &= ~(0x0010 << (d->irq - lchip->irq_base));  in locomo_mask_irq()
173 	locomo_writel(r, lchip->base + LOCOMO_ICR);  in locomo_mask_irq()
178 	struct locomo *lchip = irq_data_get_irq_chip_data(d);  in locomo_unmask_irq()  local
180 	r = locomo_readl(lchip->base + LOCOMO_ICR);  in locomo_unmask_irq()
181 	r |= (0x0010 << (d->irq - lchip->irq_base));  in locomo_unmask_irq()
182 	locomo_writel(r, lchip->base + LOCOMO_ICR);  in locomo_unmask_irq()
192 static void locomo_setup_irq(struct locomo *lchip)  in locomo_setup_irq()  argument
194 	int irq = lchip->irq_base;  in locomo_setup_irq()
199 	irq_set_irq_type(lchip->irq, IRQ_TYPE_EDGE_FALLING);  in locomo_setup_irq()
200 	irq_set_chained_handler_and_data(lchip->irq, locomo_handler, lchip);  in locomo_setup_irq()
203 	for ( ; irq <= lchip->irq_base + 3; irq++) {  in locomo_setup_irq()
205 		irq_set_chip_data(irq, lchip);  in locomo_setup_irq()
219 locomo_init_one_child(struct locomo *lchip, struct locomo_dev_info *info)  in locomo_init_one_child()  argument
234 	if (lchip->dev->dma_mask) {  in locomo_init_one_child()
235 		dev->dma_mask = *lchip->dev->dma_mask;  in locomo_init_one_child()
241 	dev->dev.parent  = lchip->dev;  in locomo_init_one_child()
244 	dev->dev.coherent_dma_mask = lchip->dev->coherent_dma_mask;  in locomo_init_one_child()
247 		dev->mapbase = lchip->base + info->offset;  in locomo_init_one_child()
252 	dev->irq[0] = (lchip->irq_base == NO_IRQ) ?  in locomo_init_one_child()
253 			NO_IRQ : lchip->irq_base + info->irq[0];  in locomo_init_one_child()
275 	struct locomo *lchip = platform_get_drvdata(dev);  in locomo_suspend()  local
283 	lchip->saved_state = save;  in locomo_suspend()
285 	spin_lock_irqsave(&lchip->lock, flags);  in locomo_suspend()
287 	save->LCM_GPO     = locomo_readl(lchip->base + LOCOMO_GPO);	/* GPIO */  in locomo_suspend()
288 	locomo_writel(0x00, lchip->base + LOCOMO_GPO);  in locomo_suspend()
289 	save->LCM_SPICT   = locomo_readl(lchip->base + LOCOMO_SPI + LOCOMO_SPICT);	/* SPI */  in locomo_suspend()
290 	locomo_writel(0x40, lchip->base + LOCOMO_SPI + LOCOMO_SPICT);  in locomo_suspend()
291 	save->LCM_GPE     = locomo_readl(lchip->base + LOCOMO_GPE);	/* GPIO */  in locomo_suspend()
292 	locomo_writel(0x00, lchip->base + LOCOMO_GPE);  in locomo_suspend()
293 	save->LCM_ASD     = locomo_readl(lchip->base + LOCOMO_ASD);	/* ADSTART */  in locomo_suspend()
294 	locomo_writel(0x00, lchip->base + LOCOMO_ASD);  in locomo_suspend()
295 	save->LCM_SPIMD   = locomo_readl(lchip->base + LOCOMO_SPI + LOCOMO_SPIMD);	/* SPI */  in locomo_suspend()
296 	locomo_writel(0x3C14, lchip->base + LOCOMO_SPI + LOCOMO_SPIMD);  in locomo_suspend()
298 	locomo_writel(0x00, lchip->base + LOCOMO_PAIF);  in locomo_suspend()
299 	locomo_writel(0x00, lchip->base + LOCOMO_DAC);  in locomo_suspend()
300 	locomo_writel(0x00, lchip->base + LOCOMO_BACKLIGHT + LOCOMO_TC);  in locomo_suspend()
302 …if ((locomo_readl(lchip->base + LOCOMO_LED + LOCOMO_LPT0) & 0x88) && (locomo_readl(lchip->base + L…  in locomo_suspend()
303 		locomo_writel(0x00, lchip->base + LOCOMO_C32K); 	/* CLK32 off */  in locomo_suspend()
306 		locomo_writel(0xc1, lchip->base + LOCOMO_C32K); 	/* CLK32 on */  in locomo_suspend()
308 	locomo_writel(0x00, lchip->base + LOCOMO_TADC);		/* 18MHz clock off*/  in locomo_suspend()
309 	locomo_writel(0x00, lchip->base + LOCOMO_AUDIO + LOCOMO_ACC);			/* 22MHz/24MHz clock off */  in locomo_suspend()
310 	locomo_writel(0x00, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS);			/* FL */  in locomo_suspend()
312 	spin_unlock_irqrestore(&lchip->lock, flags);  in locomo_suspend()
319 	struct locomo *lchip = platform_get_drvdata(dev);  in locomo_resume()  local
324 	save = lchip->saved_state;  in locomo_resume()
328 	spin_lock_irqsave(&lchip->lock, flags);  in locomo_resume()
330 	locomo_writel(save->LCM_GPO, lchip->base + LOCOMO_GPO);  in locomo_resume()
331 	locomo_writel(save->LCM_SPICT, lchip->base + LOCOMO_SPI + LOCOMO_SPICT);  in locomo_resume()
332 	locomo_writel(save->LCM_GPE, lchip->base + LOCOMO_GPE);  in locomo_resume()
333 	locomo_writel(save->LCM_ASD, lchip->base + LOCOMO_ASD);  in locomo_resume()
334 	locomo_writel(save->LCM_SPIMD, lchip->base + LOCOMO_SPI + LOCOMO_SPIMD);  in locomo_resume()
336 	locomo_writel(0x00, lchip->base + LOCOMO_C32K);  in locomo_resume()
337 	locomo_writel(0x90, lchip->base + LOCOMO_TADC);  in locomo_resume()
339 	locomo_writel(0, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KSC);  in locomo_resume()
340 	r = locomo_readl(lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC);  in locomo_resume()
342 	locomo_writel(r, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC);  in locomo_resume()
343 	locomo_writel(0x1, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KCMD);  in locomo_resume()
345 	spin_unlock_irqrestore(&lchip->lock, flags);  in locomo_resume()
347 	lchip->saved_state = NULL;  in locomo_resume()
371 	struct locomo *lchip;  in __locomo_probe()  local
375 	lchip = kzalloc(sizeof(struct locomo), GFP_KERNEL);  in __locomo_probe()
376 	if (!lchip)  in __locomo_probe()
379 	spin_lock_init(&lchip->lock);  in __locomo_probe()
381 	lchip->dev = me;  in __locomo_probe()
382 	dev_set_drvdata(lchip->dev, lchip);  in __locomo_probe()
384 	lchip->phys = mem->start;  in __locomo_probe()
385 	lchip->irq = irq;  in __locomo_probe()
386 	lchip->irq_base = (pdata) ? pdata->irq_base : NO_IRQ;  in __locomo_probe()
392 	lchip->base = ioremap(mem->start, PAGE_SIZE);  in __locomo_probe()
393 	if (!lchip->base) {  in __locomo_probe()
399 	locomo_writel(0, lchip->base + LOCOMO_ICR);  in __locomo_probe()
401 	locomo_writel(0, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC);  in __locomo_probe()
404 	locomo_writel(0, lchip->base + LOCOMO_GPO);  in __locomo_probe()
406 			, lchip->base + LOCOMO_GPE);  in __locomo_probe()
408 			, lchip->base + LOCOMO_GPD);  in __locomo_probe()
409 	locomo_writel(0, lchip->base + LOCOMO_GIE);  in __locomo_probe()
412 	locomo_writel(0, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS);  in __locomo_probe()
413 	locomo_writel(0, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALD);  in __locomo_probe()
416 	locomo_writel(0, lchip->base + LOCOMO_LTINT);  in __locomo_probe()
418 	locomo_writel(0, lchip->base + LOCOMO_SPI + LOCOMO_SPIIE);  in __locomo_probe()
420 	locomo_writel(6 + 8 + 320 + 30 - 10, lchip->base + LOCOMO_ASD);  in __locomo_probe()
421 	r = locomo_readl(lchip->base + LOCOMO_ASD);  in __locomo_probe()
423 	locomo_writel(r, lchip->base + LOCOMO_ASD);  in __locomo_probe()
425 	locomo_writel(6 + 8 + 320 + 30 - 10 - 128 + 4, lchip->base + LOCOMO_HSD);  in __locomo_probe()
426 	r = locomo_readl(lchip->base + LOCOMO_HSD);  in __locomo_probe()
428 	locomo_writel(r, lchip->base + LOCOMO_HSD);  in __locomo_probe()
430 	locomo_writel(128 / 8, lchip->base + LOCOMO_HSC);  in __locomo_probe()
433 	locomo_writel(0x80, lchip->base + LOCOMO_TADC);  in __locomo_probe()
436 	r = locomo_readl(lchip->base + LOCOMO_TADC);  in __locomo_probe()
438 	locomo_writel(r, lchip->base + LOCOMO_TADC);  in __locomo_probe()
442 	r = locomo_readl(lchip->base + LOCOMO_DAC);  in __locomo_probe()
444 	locomo_writel(r, lchip->base + LOCOMO_DAC);  in __locomo_probe()
446 	r = locomo_readl(lchip->base + LOCOMO_VER);  in __locomo_probe()
453 	if (lchip->irq != NO_IRQ && lchip->irq_base != NO_IRQ)  in __locomo_probe()
454 		locomo_setup_irq(lchip);  in __locomo_probe()
457 		locomo_init_one_child(lchip, &locomo_devices[i]);  in __locomo_probe()
461 	kfree(lchip);  in __locomo_probe()
471 static void __locomo_remove(struct locomo *lchip)  in __locomo_remove()  argument
473 	device_for_each_child(lchip->dev, NULL, locomo_remove_child);  in __locomo_remove()
475 	if (lchip->irq != NO_IRQ) {  in __locomo_remove()
476 		irq_set_chained_handler_and_data(lchip->irq, NULL, NULL);  in __locomo_remove()
479 	iounmap(lchip->base);  in __locomo_remove()
480 	kfree(lchip);  in __locomo_remove()
500 	struct locomo *lchip = platform_get_drvdata(dev);  in locomo_remove()  local
502 	if (lchip) {  in locomo_remove()
503 		__locomo_remove(lchip);  in locomo_remove()
539 	struct locomo *lchip = dev_get_drvdata(dev);  in locomo_gpio_set_dir()  local
543 	if (!lchip)  in locomo_gpio_set_dir()
546 	spin_lock_irqsave(&lchip->lock, flags);  in locomo_gpio_set_dir()
548 	r = locomo_readl(lchip->base + LOCOMO_GPD);  in locomo_gpio_set_dir()
553 	locomo_writel(r, lchip->base + LOCOMO_GPD);  in locomo_gpio_set_dir()
555 	r = locomo_readl(lchip->base + LOCOMO_GPE);  in locomo_gpio_set_dir()
560 	locomo_writel(r, lchip->base + LOCOMO_GPE);  in locomo_gpio_set_dir()
562 	spin_unlock_irqrestore(&lchip->lock, flags);  in locomo_gpio_set_dir()
568 	struct locomo *lchip = dev_get_drvdata(dev);  in locomo_gpio_read_level()  local
572 	if (!lchip)  in locomo_gpio_read_level()
575 	spin_lock_irqsave(&lchip->lock, flags);  in locomo_gpio_read_level()
576 	ret = locomo_readl(lchip->base + LOCOMO_GPL);  in locomo_gpio_read_level()
577 	spin_unlock_irqrestore(&lchip->lock, flags);  in locomo_gpio_read_level()
586 	struct locomo *lchip = dev_get_drvdata(dev);  in locomo_gpio_read_output()  local
590 	if (!lchip)  in locomo_gpio_read_output()
593 	spin_lock_irqsave(&lchip->lock, flags);  in locomo_gpio_read_output()
594 	ret = locomo_readl(lchip->base + LOCOMO_GPO);  in locomo_gpio_read_output()
595 	spin_unlock_irqrestore(&lchip->lock, flags);  in locomo_gpio_read_output()
604 	struct locomo *lchip = dev_get_drvdata(dev);  in locomo_gpio_write()  local
608 	if (!lchip)  in locomo_gpio_write()
611 	spin_lock_irqsave(&lchip->lock, flags);  in locomo_gpio_write()
613 	r = locomo_readl(lchip->base + LOCOMO_GPO);  in locomo_gpio_write()
618 	locomo_writel(r, lchip->base + LOCOMO_GPO);  in locomo_gpio_write()
620 	spin_unlock_irqrestore(&lchip->lock, flags);  in locomo_gpio_write()
661 	struct locomo *lchip = locomo_chip_driver(ldev);  in locomo_m62332_senddata()  local
665 	void *mapbase = lchip->base;  in locomo_m62332_senddata()
668 	spin_lock_irqsave(&lchip->lock, flags);  in locomo_m62332_senddata()
785 	spin_unlock_irqrestore(&lchip->lock, flags);  in locomo_m62332_senddata()
796 	struct locomo *lchip = locomo_chip_driver(dev);  in locomo_frontlight_set()  local
803 	spin_lock_irqsave(&lchip->lock, flags);  in locomo_frontlight_set()
804 	locomo_writel(bpwf, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS);  in locomo_frontlight_set()
806 	locomo_writel(duty, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALD);  in locomo_frontlight_set()
807 	locomo_writel(bpwf | LOCOMO_ALC_EN, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS);  in locomo_frontlight_set()
808 	spin_unlock_irqrestore(&lchip->lock, flags);  in locomo_frontlight_set()