Lines Matching +full:st +full:- +full:plgpio
2 * SPEAr platform PLGPIO driver
4 * Copyright (C) 2012 ST Microelectronics
32 * plgpio pins in all machines are not one to one mapped, bitwise with registers
54 * struct plgpio: plgpio driver specific structure
57 * base: base address of plgpio block
60 * machines where mapping b/w pin and offset is not 1-to-1.
62 * machines where mapping b/w pin and offset is not 1-to-1.
67 struct plgpio { struct
117 struct plgpio *plgpio = gpiochip_get_data(chip); in plgpio_direction_input() local
121 if (plgpio->p2o && (plgpio->p2o_regs & PTO_DIR_REG)) { in plgpio_direction_input()
122 offset = plgpio->p2o(offset); in plgpio_direction_input()
123 if (offset == -1) in plgpio_direction_input()
124 return -EINVAL; in plgpio_direction_input()
127 spin_lock_irqsave(&plgpio->lock, flags); in plgpio_direction_input()
128 plgpio_reg_set(plgpio->regmap, offset, plgpio->regs.dir); in plgpio_direction_input()
129 spin_unlock_irqrestore(&plgpio->lock, flags); in plgpio_direction_input()
137 struct plgpio *plgpio = gpiochip_get_data(chip); in plgpio_direction_output() local
142 if (plgpio->p2o && (plgpio->p2o_regs & (PTO_DIR_REG | PTO_WDATA_REG))) { in plgpio_direction_output()
143 tmp = plgpio->p2o(offset); in plgpio_direction_output()
144 if (tmp == -1) in plgpio_direction_output()
145 return -EINVAL; in plgpio_direction_output()
147 if (plgpio->p2o_regs & PTO_DIR_REG) in plgpio_direction_output()
149 if (plgpio->p2o_regs & PTO_WDATA_REG) in plgpio_direction_output()
153 spin_lock_irqsave(&plgpio->lock, flags); in plgpio_direction_output()
155 plgpio_reg_set(plgpio->regmap, wdata_offset, in plgpio_direction_output()
156 plgpio->regs.wdata); in plgpio_direction_output()
158 plgpio_reg_reset(plgpio->regmap, wdata_offset, in plgpio_direction_output()
159 plgpio->regs.wdata); in plgpio_direction_output()
161 plgpio_reg_reset(plgpio->regmap, dir_offset, plgpio->regs.dir); in plgpio_direction_output()
162 spin_unlock_irqrestore(&plgpio->lock, flags); in plgpio_direction_output()
169 struct plgpio *plgpio = gpiochip_get_data(chip); in plgpio_get_value() local
171 if (offset >= chip->ngpio) in plgpio_get_value()
172 return -EINVAL; in plgpio_get_value()
175 if (plgpio->p2o && (plgpio->p2o_regs & PTO_RDATA_REG)) { in plgpio_get_value()
176 offset = plgpio->p2o(offset); in plgpio_get_value()
177 if (offset == -1) in plgpio_get_value()
178 return -EINVAL; in plgpio_get_value()
181 return is_plgpio_set(plgpio->regmap, offset, plgpio->regs.rdata); in plgpio_get_value()
186 struct plgpio *plgpio = gpiochip_get_data(chip); in plgpio_set_value() local
188 if (offset >= chip->ngpio) in plgpio_set_value()
192 if (plgpio->p2o && (plgpio->p2o_regs & PTO_WDATA_REG)) { in plgpio_set_value()
193 offset = plgpio->p2o(offset); in plgpio_set_value()
194 if (offset == -1) in plgpio_set_value()
199 plgpio_reg_set(plgpio->regmap, offset, plgpio->regs.wdata); in plgpio_set_value()
201 plgpio_reg_reset(plgpio->regmap, offset, plgpio->regs.wdata); in plgpio_set_value()
206 struct plgpio *plgpio = gpiochip_get_data(chip); in plgpio_request() local
210 if (offset >= chip->ngpio) in plgpio_request()
211 return -EINVAL; in plgpio_request()
217 if (!IS_ERR(plgpio->clk)) { in plgpio_request()
218 ret = clk_enable(plgpio->clk); in plgpio_request()
223 if (plgpio->regs.enb == -1) in plgpio_request()
234 if (plgpio->p2o && (plgpio->p2o_regs & PTO_ENB_REG)) { in plgpio_request()
235 offset = plgpio->p2o(offset); in plgpio_request()
236 if (offset == -1) { in plgpio_request()
237 ret = -EINVAL; in plgpio_request()
242 spin_lock_irqsave(&plgpio->lock, flags); in plgpio_request()
243 plgpio_reg_set(plgpio->regmap, offset, plgpio->regs.enb); in plgpio_request()
244 spin_unlock_irqrestore(&plgpio->lock, flags); in plgpio_request()
248 if (!IS_ERR(plgpio->clk)) in plgpio_request()
249 clk_disable(plgpio->clk); in plgpio_request()
257 struct plgpio *plgpio = gpiochip_get_data(chip); in plgpio_free() local
260 if (offset >= chip->ngpio) in plgpio_free()
263 if (plgpio->regs.enb == -1) in plgpio_free()
267 if (plgpio->p2o && (plgpio->p2o_regs & PTO_ENB_REG)) { in plgpio_free()
268 offset = plgpio->p2o(offset); in plgpio_free()
269 if (offset == -1) in plgpio_free()
273 spin_lock_irqsave(&plgpio->lock, flags); in plgpio_free()
274 plgpio_reg_reset(plgpio->regmap, offset, plgpio->regs.enb); in plgpio_free()
275 spin_unlock_irqrestore(&plgpio->lock, flags); in plgpio_free()
278 if (!IS_ERR(plgpio->clk)) in plgpio_free()
279 clk_disable(plgpio->clk); in plgpio_free()
284 /* PLGPIO IRQ */
288 struct plgpio *plgpio = gpiochip_get_data(gc); in plgpio_irq_disable() local
289 int offset = d->hwirq; in plgpio_irq_disable()
293 if (plgpio->p2o && (plgpio->p2o_regs & PTO_IE_REG)) { in plgpio_irq_disable()
294 offset = plgpio->p2o(offset); in plgpio_irq_disable()
295 if (offset == -1) in plgpio_irq_disable()
299 spin_lock_irqsave(&plgpio->lock, flags); in plgpio_irq_disable()
300 plgpio_reg_set(plgpio->regmap, offset, plgpio->regs.ie); in plgpio_irq_disable()
301 spin_unlock_irqrestore(&plgpio->lock, flags); in plgpio_irq_disable()
308 struct plgpio *plgpio = gpiochip_get_data(gc); in plgpio_irq_enable() local
309 int offset = d->hwirq; in plgpio_irq_enable()
313 if (plgpio->p2o && (plgpio->p2o_regs & PTO_IE_REG)) { in plgpio_irq_enable()
314 offset = plgpio->p2o(offset); in plgpio_irq_enable()
315 if (offset == -1) in plgpio_irq_enable()
320 spin_lock_irqsave(&plgpio->lock, flags); in plgpio_irq_enable()
321 plgpio_reg_reset(plgpio->regmap, offset, plgpio->regs.ie); in plgpio_irq_enable()
322 spin_unlock_irqrestore(&plgpio->lock, flags); in plgpio_irq_enable()
328 struct plgpio *plgpio = gpiochip_get_data(gc); in plgpio_irq_set_type() local
329 int offset = d->hwirq; in plgpio_irq_set_type()
333 if (offset >= plgpio->chip.ngpio) in plgpio_irq_set_type()
334 return -EINVAL; in plgpio_irq_set_type()
336 if (plgpio->regs.eit == -1) in plgpio_irq_set_type()
342 return -EINVAL; in plgpio_irq_set_type()
344 if (plgpio->regs.eit == -1) in plgpio_irq_set_type()
347 reg_off = REG_OFFSET(0, plgpio->regs.eit, offset); in plgpio_irq_set_type()
348 regmap_read(plgpio->regmap, reg_off, &val); in plgpio_irq_set_type()
352 regmap_write(plgpio->regmap, reg_off, val | (1 << offset)); in plgpio_irq_set_type()
354 regmap_write(plgpio->regmap, reg_off, val & ~(1 << offset)); in plgpio_irq_set_type()
360 .name = "PLGPIO",
371 struct plgpio *plgpio = gpiochip_get_data(gc); in plgpio_irq_handler() local
377 count = plgpio->chip.ngpio; in plgpio_irq_handler()
381 /* check all plgpio MIS registers for a possible interrupt */ in plgpio_irq_handler()
383 regmap_read(plgpio->regmap, plgpio->regs.mis + in plgpio_irq_handler()
389 regmap_write(plgpio->regmap, plgpio->regs.mis + in plgpio_irq_handler()
394 * must have only (102 - MAX_GPIO_PER_REG * 3) = 6 relevant bits in plgpio_irq_handler()
398 count = count - i * MAX_GPIO_PER_REG; in plgpio_irq_handler()
400 pending &= (1 << count) - 1; in plgpio_irq_handler()
405 if (plgpio->o2p && (plgpio->p2o_regs & PTO_MIS_REG)) { in plgpio_irq_handler()
406 pin = plgpio->o2p(offset); in plgpio_irq_handler()
407 if (pin == -1) in plgpio_irq_handler()
414 generic_handle_domain_irq(gc->irq.domain, pin); in plgpio_irq_handler()
423 * In spear310 there is inconsistency among bit positions in plgpio regiseters,
424 * for different plgpio pins. For example: for pin 27, bit offset is 23, pin
425 * 28-33 are not supported, pin 95 has offset bit 95, bit 100 has offset bit 1
434 offset = -1; in spear310_p2o()
436 offset -= 2; in spear310_p2o()
438 offset = 101 - pin; in spear310_p2o()
440 offset = -1; in spear310_p2o()
448 return 101 - offset; in spear310_o2p()
450 return offset - 4; in spear310_o2p()
455 static int plgpio_probe_dt(struct platform_device *pdev, struct plgpio *plgpio) in plgpio_probe_dt() argument
457 struct device_node *np = pdev->dev.of_node; in plgpio_probe_dt()
458 int ret = -EINVAL; in plgpio_probe_dt()
461 if (of_machine_is_compatible("st,spear310")) { in plgpio_probe_dt()
462 plgpio->p2o = spear310_p2o; in plgpio_probe_dt()
463 plgpio->o2p = spear310_o2p; in plgpio_probe_dt()
464 plgpio->p2o_regs = PTO_WDATA_REG | PTO_DIR_REG | PTO_IE_REG | in plgpio_probe_dt()
468 if (!of_property_read_u32(np, "st-plgpio,ngpio", &val)) { in plgpio_probe_dt()
469 plgpio->chip.ngpio = val; in plgpio_probe_dt()
471 dev_err(&pdev->dev, "DT: Invalid ngpio field\n"); in plgpio_probe_dt()
475 if (!of_property_read_u32(np, "st-plgpio,enb-reg", &val)) in plgpio_probe_dt()
476 plgpio->regs.enb = val; in plgpio_probe_dt()
478 plgpio->regs.enb = -1; in plgpio_probe_dt()
480 if (!of_property_read_u32(np, "st-plgpio,wdata-reg", &val)) { in plgpio_probe_dt()
481 plgpio->regs.wdata = val; in plgpio_probe_dt()
483 dev_err(&pdev->dev, "DT: Invalid wdata reg\n"); in plgpio_probe_dt()
487 if (!of_property_read_u32(np, "st-plgpio,dir-reg", &val)) { in plgpio_probe_dt()
488 plgpio->regs.dir = val; in plgpio_probe_dt()
490 dev_err(&pdev->dev, "DT: Invalid dir reg\n"); in plgpio_probe_dt()
494 if (!of_property_read_u32(np, "st-plgpio,ie-reg", &val)) { in plgpio_probe_dt()
495 plgpio->regs.ie = val; in plgpio_probe_dt()
497 dev_err(&pdev->dev, "DT: Invalid ie reg\n"); in plgpio_probe_dt()
501 if (!of_property_read_u32(np, "st-plgpio,rdata-reg", &val)) { in plgpio_probe_dt()
502 plgpio->regs.rdata = val; in plgpio_probe_dt()
504 dev_err(&pdev->dev, "DT: Invalid rdata reg\n"); in plgpio_probe_dt()
508 if (!of_property_read_u32(np, "st-plgpio,mis-reg", &val)) { in plgpio_probe_dt()
509 plgpio->regs.mis = val; in plgpio_probe_dt()
511 dev_err(&pdev->dev, "DT: Invalid mis reg\n"); in plgpio_probe_dt()
515 if (!of_property_read_u32(np, "st-plgpio,eit-reg", &val)) in plgpio_probe_dt()
516 plgpio->regs.eit = val; in plgpio_probe_dt()
518 plgpio->regs.eit = -1; in plgpio_probe_dt()
529 struct plgpio *plgpio; in plgpio_probe() local
532 plgpio = devm_kzalloc(&pdev->dev, sizeof(*plgpio), GFP_KERNEL); in plgpio_probe()
533 if (!plgpio) in plgpio_probe()
534 return -ENOMEM; in plgpio_probe()
536 regmap_np = of_parse_phandle(pdev->dev.of_node, "regmap", 0); in plgpio_probe()
538 plgpio->regmap = device_node_to_regmap(regmap_np); in plgpio_probe()
540 if (IS_ERR(plgpio->regmap)) { in plgpio_probe()
541 dev_err(&pdev->dev, "Retrieve regmap failed (%pe)\n", in plgpio_probe()
542 plgpio->regmap); in plgpio_probe()
543 return PTR_ERR(plgpio->regmap); in plgpio_probe()
546 plgpio->regmap = device_node_to_regmap(pdev->dev.of_node); in plgpio_probe()
547 if (IS_ERR(plgpio->regmap)) { in plgpio_probe()
548 dev_err(&pdev->dev, "Init regmap failed (%pe)\n", in plgpio_probe()
549 plgpio->regmap); in plgpio_probe()
550 return PTR_ERR(plgpio->regmap); in plgpio_probe()
554 ret = plgpio_probe_dt(pdev, plgpio); in plgpio_probe()
556 dev_err(&pdev->dev, "DT probe failed\n"); in plgpio_probe()
560 plgpio->clk = devm_clk_get(&pdev->dev, NULL); in plgpio_probe()
561 if (IS_ERR(plgpio->clk)) in plgpio_probe()
562 dev_warn(&pdev->dev, "clk_get() failed, work without it\n"); in plgpio_probe()
565 plgpio->csave_regs = devm_kcalloc(&pdev->dev, in plgpio_probe()
566 DIV_ROUND_UP(plgpio->chip.ngpio, MAX_GPIO_PER_REG), in plgpio_probe()
567 sizeof(*plgpio->csave_regs), in plgpio_probe()
569 if (!plgpio->csave_regs) in plgpio_probe()
570 return -ENOMEM; in plgpio_probe()
573 platform_set_drvdata(pdev, plgpio); in plgpio_probe()
574 spin_lock_init(&plgpio->lock); in plgpio_probe()
576 plgpio->chip.base = -1; in plgpio_probe()
577 plgpio->chip.request = plgpio_request; in plgpio_probe()
578 plgpio->chip.free = plgpio_free; in plgpio_probe()
579 plgpio->chip.direction_input = plgpio_direction_input; in plgpio_probe()
580 plgpio->chip.direction_output = plgpio_direction_output; in plgpio_probe()
581 plgpio->chip.get = plgpio_get_value; in plgpio_probe()
582 plgpio->chip.set = plgpio_set_value; in plgpio_probe()
583 plgpio->chip.label = dev_name(&pdev->dev); in plgpio_probe()
584 plgpio->chip.parent = &pdev->dev; in plgpio_probe()
585 plgpio->chip.owner = THIS_MODULE; in plgpio_probe()
587 if (!IS_ERR(plgpio->clk)) { in plgpio_probe()
588 ret = clk_prepare(plgpio->clk); in plgpio_probe()
590 dev_err(&pdev->dev, "clk prepare failed\n"); in plgpio_probe()
599 girq = &plgpio->chip.irq; in plgpio_probe()
601 girq->parent_handler = plgpio_irq_handler; in plgpio_probe()
602 girq->num_parents = 1; in plgpio_probe()
603 girq->parents = devm_kcalloc(&pdev->dev, 1, in plgpio_probe()
604 sizeof(*girq->parents), in plgpio_probe()
606 if (!girq->parents) in plgpio_probe()
607 return -ENOMEM; in plgpio_probe()
608 girq->parents[0] = irq; in plgpio_probe()
609 girq->default_type = IRQ_TYPE_NONE; in plgpio_probe()
610 girq->handler = handle_simple_irq; in plgpio_probe()
611 dev_info(&pdev->dev, "PLGPIO registering with IRQs\n"); in plgpio_probe()
613 dev_info(&pdev->dev, "PLGPIO registering without IRQs\n"); in plgpio_probe()
616 ret = gpiochip_add_data(&plgpio->chip, plgpio); in plgpio_probe()
618 dev_err(&pdev->dev, "unable to add gpio chip\n"); in plgpio_probe()
625 if (!IS_ERR(plgpio->clk)) in plgpio_probe()
626 clk_unprepare(plgpio->clk); in plgpio_probe()
634 struct plgpio *plgpio = dev_get_drvdata(dev); in plgpio_suspend() local
635 int i, reg_count = DIV_ROUND_UP(plgpio->chip.ngpio, MAX_GPIO_PER_REG); in plgpio_suspend()
641 if (plgpio->regs.enb != -1) in plgpio_suspend()
642 regmap_read(plgpio->regmap, plgpio->regs.enb + off, in plgpio_suspend()
643 &plgpio->csave_regs[i].enb); in plgpio_suspend()
644 if (plgpio->regs.eit != -1) in plgpio_suspend()
645 regmap_read(plgpio->regmap, plgpio->regs.eit + off, in plgpio_suspend()
646 &plgpio->csave_regs[i].eit); in plgpio_suspend()
647 regmap_read(plgpio->regmap, plgpio->regs.wdata + off, in plgpio_suspend()
648 &plgpio->csave_regs[i].wdata); in plgpio_suspend()
649 regmap_read(plgpio->regmap, plgpio->regs.dir + off, in plgpio_suspend()
650 &plgpio->csave_regs[i].dir); in plgpio_suspend()
651 regmap_read(plgpio->regmap, plgpio->regs.ie + off, in plgpio_suspend()
652 &plgpio->csave_regs[i].ie); in plgpio_suspend()
662 * bit values (non-plgpio bits), and retain captured value (plgpio bits).
666 regmap_read(plgpio->regmap, plgpio->regs.__reg + _off, &_tmp); \
668 plgpio->csave_regs[i].__reg = \
669 _tmp | (plgpio->csave_regs[i].__reg & _mask); \
674 struct plgpio *plgpio = dev_get_drvdata(dev); in plgpio_resume() local
675 int i, reg_count = DIV_ROUND_UP(plgpio->chip.ngpio, MAX_GPIO_PER_REG); in plgpio_resume()
682 if (i == reg_count - 1) { in plgpio_resume()
683 mask = (1 << (plgpio->chip.ngpio - i * in plgpio_resume()
684 MAX_GPIO_PER_REG)) - 1; in plgpio_resume()
686 if (plgpio->regs.enb != -1) in plgpio_resume()
689 if (plgpio->regs.eit != -1) in plgpio_resume()
697 regmap_write(plgpio->regmap, plgpio->regs.wdata + off, in plgpio_resume()
698 plgpio->csave_regs[i].wdata); in plgpio_resume()
700 regmap_write(plgpio->regmap, plgpio->regs.dir + off, in plgpio_resume()
701 plgpio->csave_regs[i].dir); in plgpio_resume()
703 if (plgpio->regs.eit != -1) in plgpio_resume()
704 regmap_write(plgpio->regmap, plgpio->regs.eit + off, in plgpio_resume()
705 plgpio->csave_regs[i].eit); in plgpio_resume()
707 regmap_write(plgpio->regmap, plgpio->regs.ie + off, in plgpio_resume()
708 plgpio->csave_regs[i].ie); in plgpio_resume()
710 if (plgpio->regs.enb != -1) in plgpio_resume()
711 regmap_write(plgpio->regmap, plgpio->regs.enb + off, in plgpio_resume()
712 plgpio->csave_regs[i].enb); in plgpio_resume()
722 { .compatible = "st,spear-plgpio" },
729 .name = "spear-plgpio",