Lines Matching +full:pin +full:- +full:count
27 #define PIN_OFFSET(pin) (pin % MAX_GPIO_PER_REG) argument
28 #define REG_OFFSET(base, reg, pin) (base + reg + (pin / MAX_GPIO_PER_REG) \ argument
59 * p2o: function ptr for pin to offset conversion. This is required only for
60 * machines where mapping b/w pin and offset is not 1-to-1.
61 * o2p: function ptr for offset to pin conversion. This is required only for
62 * machines where mapping b/w pin and offset is not 1-to-1.
72 int (*p2o)(int pin); /* pin_to_offset */
82 static inline u32 is_plgpio_set(struct regmap *regmap, u32 pin, u32 reg) in is_plgpio_set() argument
84 u32 offset = PIN_OFFSET(pin); in is_plgpio_set()
85 u32 reg_off = REG_OFFSET(0, reg, pin); in is_plgpio_set()
93 static inline void plgpio_reg_set(struct regmap *regmap, u32 pin, u32 reg) in plgpio_reg_set() argument
95 u32 offset = PIN_OFFSET(pin); in plgpio_reg_set()
96 u32 reg_off = REG_OFFSET(0, reg, pin); in plgpio_reg_set()
103 static inline void plgpio_reg_reset(struct regmap *regmap, u32 pin, u32 reg) in plgpio_reg_reset() argument
105 u32 offset = PIN_OFFSET(pin); in plgpio_reg_reset()
106 u32 reg_off = REG_OFFSET(0, reg, pin); in plgpio_reg_reset()
120 /* get correct offset for "offset" pin */ in plgpio_direction_input()
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()
141 /* get correct offset for "offset" pin */ in plgpio_direction_output()
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()
171 if (offset >= chip->ngpio) in plgpio_get_value()
172 return -EINVAL; in plgpio_get_value()
174 /* get correct offset for "offset" pin */ 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()
188 if (offset >= chip->ngpio) in plgpio_set_value()
191 /* get correct offset for "offset" pin */ 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()
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()
233 /* get correct offset for "offset" pin */ 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()
260 if (offset >= chip->ngpio) in plgpio_free()
263 if (plgpio->regs.enb == -1) in plgpio_free()
266 /* get correct offset for "offset" pin */ 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()
289 int offset = d->hwirq; in plgpio_irq_disable()
292 /* get correct offset for "offset" pin */ 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()
309 int offset = d->hwirq; in plgpio_irq_enable()
312 /* get correct offset for "offset" pin */ 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()
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()
373 int regs_count, count, pin, offset, i = 0; in plgpio_irq_handler() local
377 count = plgpio->chip.ngpio; in plgpio_irq_handler()
378 regs_count = DIV_ROUND_UP(count, MAX_GPIO_PER_REG); 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()
399 if (count < MAX_GPIO_PER_REG) in plgpio_irq_handler()
400 pending &= (1 << count) - 1; in plgpio_irq_handler()
404 /* get correct pin for "offset" */ 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()
410 pin = offset; in plgpio_irq_handler()
413 pin = i * MAX_GPIO_PER_REG + pin; in plgpio_irq_handler()
414 generic_handle_domain_irq(gc->irq.domain, pin); in plgpio_irq_handler()
421 * pin to offset and offset to pin converter functions
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
427 static int spear310_p2o(int pin) in spear310_p2o() argument
429 int offset = pin; in spear310_p2o()
431 if (pin <= 27) in spear310_p2o()
433 else if (pin <= 33) in spear310_p2o()
434 offset = -1; in spear310_p2o()
435 else if (pin <= 97) in spear310_p2o()
436 offset -= 2; in spear310_p2o()
437 else if (pin <= 101) 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()
457 struct device_node *np = pdev->dev.of_node; in plgpio_probe_dt()
458 int ret = -EINVAL; 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()
532 plgpio = devm_kzalloc(&pdev->dev, sizeof(*plgpio), GFP_KERNEL); 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()
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()
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()
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); \
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",