Lines Matching refs:gc
125 static unsigned long bgpio_line2mask(struct gpio_chip *gc, unsigned int line) in bgpio_line2mask() argument
127 if (gc->be_bits) in bgpio_line2mask()
128 return BIT(gc->bgpio_bits - 1 - line); in bgpio_line2mask()
132 static int bgpio_get_set(struct gpio_chip *gc, unsigned int gpio) in bgpio_get_set() argument
134 unsigned long pinmask = bgpio_line2mask(gc, gpio); in bgpio_get_set()
135 bool dir = !!(gc->bgpio_dir & pinmask); in bgpio_get_set()
138 return !!(gc->read_reg(gc->reg_set) & pinmask); in bgpio_get_set()
140 return !!(gc->read_reg(gc->reg_dat) & pinmask); in bgpio_get_set()
147 static int bgpio_get_set_multiple(struct gpio_chip *gc, unsigned long *mask, in bgpio_get_set_multiple() argument
156 set_mask = *mask & gc->bgpio_dir; in bgpio_get_set_multiple()
157 get_mask = *mask & ~gc->bgpio_dir; in bgpio_get_set_multiple()
160 *bits |= gc->read_reg(gc->reg_set) & set_mask; in bgpio_get_set_multiple()
162 *bits |= gc->read_reg(gc->reg_dat) & get_mask; in bgpio_get_set_multiple()
167 static int bgpio_get(struct gpio_chip *gc, unsigned int gpio) in bgpio_get() argument
169 return !!(gc->read_reg(gc->reg_dat) & bgpio_line2mask(gc, gpio)); in bgpio_get()
175 static int bgpio_get_multiple(struct gpio_chip *gc, unsigned long *mask, in bgpio_get_multiple() argument
180 *bits |= gc->read_reg(gc->reg_dat) & *mask; in bgpio_get_multiple()
187 static int bgpio_get_multiple_be(struct gpio_chip *gc, unsigned long *mask, in bgpio_get_multiple_be() argument
198 for_each_set_bit(bit, mask, gc->ngpio) in bgpio_get_multiple_be()
199 readmask |= bgpio_line2mask(gc, bit); in bgpio_get_multiple_be()
202 val = gc->read_reg(gc->reg_dat) & readmask; in bgpio_get_multiple_be()
208 for_each_set_bit(bit, &val, gc->ngpio) in bgpio_get_multiple_be()
209 *bits |= bgpio_line2mask(gc, bit); in bgpio_get_multiple_be()
214 static void bgpio_set_none(struct gpio_chip *gc, unsigned int gpio, int val) in bgpio_set_none() argument
218 static void bgpio_set(struct gpio_chip *gc, unsigned int gpio, int val) in bgpio_set() argument
220 unsigned long mask = bgpio_line2mask(gc, gpio); in bgpio_set()
223 raw_spin_lock_irqsave(&gc->bgpio_lock, flags); in bgpio_set()
226 gc->bgpio_data |= mask; in bgpio_set()
228 gc->bgpio_data &= ~mask; in bgpio_set()
230 gc->write_reg(gc->reg_dat, gc->bgpio_data); in bgpio_set()
232 raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags); in bgpio_set()
235 static void bgpio_set_with_clear(struct gpio_chip *gc, unsigned int gpio, in bgpio_set_with_clear() argument
238 unsigned long mask = bgpio_line2mask(gc, gpio); in bgpio_set_with_clear()
241 gc->write_reg(gc->reg_set, mask); in bgpio_set_with_clear()
243 gc->write_reg(gc->reg_clr, mask); in bgpio_set_with_clear()
246 static void bgpio_set_set(struct gpio_chip *gc, unsigned int gpio, int val) in bgpio_set_set() argument
248 unsigned long mask = bgpio_line2mask(gc, gpio); in bgpio_set_set()
251 raw_spin_lock_irqsave(&gc->bgpio_lock, flags); in bgpio_set_set()
254 gc->bgpio_data |= mask; in bgpio_set_set()
256 gc->bgpio_data &= ~mask; in bgpio_set_set()
258 gc->write_reg(gc->reg_set, gc->bgpio_data); in bgpio_set_set()
260 raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags); in bgpio_set_set()
263 static void bgpio_multiple_get_masks(struct gpio_chip *gc, in bgpio_multiple_get_masks() argument
273 for_each_set_bit(i, mask, gc->bgpio_bits) { in bgpio_multiple_get_masks()
275 *set_mask |= bgpio_line2mask(gc, i); in bgpio_multiple_get_masks()
277 *clear_mask |= bgpio_line2mask(gc, i); in bgpio_multiple_get_masks()
281 static void bgpio_set_multiple_single_reg(struct gpio_chip *gc, in bgpio_set_multiple_single_reg() argument
289 raw_spin_lock_irqsave(&gc->bgpio_lock, flags); in bgpio_set_multiple_single_reg()
291 bgpio_multiple_get_masks(gc, mask, bits, &set_mask, &clear_mask); in bgpio_set_multiple_single_reg()
293 gc->bgpio_data |= set_mask; in bgpio_set_multiple_single_reg()
294 gc->bgpio_data &= ~clear_mask; in bgpio_set_multiple_single_reg()
296 gc->write_reg(reg, gc->bgpio_data); in bgpio_set_multiple_single_reg()
298 raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags); in bgpio_set_multiple_single_reg()
301 static void bgpio_set_multiple(struct gpio_chip *gc, unsigned long *mask, in bgpio_set_multiple() argument
304 bgpio_set_multiple_single_reg(gc, mask, bits, gc->reg_dat); in bgpio_set_multiple()
307 static void bgpio_set_multiple_set(struct gpio_chip *gc, unsigned long *mask, in bgpio_set_multiple_set() argument
310 bgpio_set_multiple_single_reg(gc, mask, bits, gc->reg_set); in bgpio_set_multiple_set()
313 static void bgpio_set_multiple_with_clear(struct gpio_chip *gc, in bgpio_set_multiple_with_clear() argument
319 bgpio_multiple_get_masks(gc, mask, bits, &set_mask, &clear_mask); in bgpio_set_multiple_with_clear()
322 gc->write_reg(gc->reg_set, set_mask); in bgpio_set_multiple_with_clear()
324 gc->write_reg(gc->reg_clr, clear_mask); in bgpio_set_multiple_with_clear()
327 static int bgpio_simple_dir_in(struct gpio_chip *gc, unsigned int gpio) in bgpio_simple_dir_in() argument
332 static int bgpio_dir_out_err(struct gpio_chip *gc, unsigned int gpio, in bgpio_dir_out_err() argument
338 static int bgpio_simple_dir_out(struct gpio_chip *gc, unsigned int gpio, in bgpio_simple_dir_out() argument
341 gc->set(gc, gpio, val); in bgpio_simple_dir_out()
346 static int bgpio_dir_in(struct gpio_chip *gc, unsigned int gpio) in bgpio_dir_in() argument
350 raw_spin_lock_irqsave(&gc->bgpio_lock, flags); in bgpio_dir_in()
352 gc->bgpio_dir &= ~bgpio_line2mask(gc, gpio); in bgpio_dir_in()
354 if (gc->reg_dir_in) in bgpio_dir_in()
355 gc->write_reg(gc->reg_dir_in, ~gc->bgpio_dir); in bgpio_dir_in()
356 if (gc->reg_dir_out) in bgpio_dir_in()
357 gc->write_reg(gc->reg_dir_out, gc->bgpio_dir); in bgpio_dir_in()
359 raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags); in bgpio_dir_in()
364 static int bgpio_get_dir(struct gpio_chip *gc, unsigned int gpio) in bgpio_get_dir() argument
367 if (gc->bgpio_dir_unreadable) { in bgpio_get_dir()
368 if (gc->bgpio_dir & bgpio_line2mask(gc, gpio)) in bgpio_get_dir()
373 if (gc->reg_dir_out) { in bgpio_get_dir()
374 if (gc->read_reg(gc->reg_dir_out) & bgpio_line2mask(gc, gpio)) in bgpio_get_dir()
379 if (gc->reg_dir_in) in bgpio_get_dir()
380 if (!(gc->read_reg(gc->reg_dir_in) & bgpio_line2mask(gc, gpio))) in bgpio_get_dir()
386 static void bgpio_dir_out(struct gpio_chip *gc, unsigned int gpio, int val) in bgpio_dir_out() argument
390 raw_spin_lock_irqsave(&gc->bgpio_lock, flags); in bgpio_dir_out()
392 gc->bgpio_dir |= bgpio_line2mask(gc, gpio); in bgpio_dir_out()
394 if (gc->reg_dir_in) in bgpio_dir_out()
395 gc->write_reg(gc->reg_dir_in, ~gc->bgpio_dir); in bgpio_dir_out()
396 if (gc->reg_dir_out) in bgpio_dir_out()
397 gc->write_reg(gc->reg_dir_out, gc->bgpio_dir); in bgpio_dir_out()
399 raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags); in bgpio_dir_out()
402 static int bgpio_dir_out_dir_first(struct gpio_chip *gc, unsigned int gpio, in bgpio_dir_out_dir_first() argument
405 bgpio_dir_out(gc, gpio, val); in bgpio_dir_out_dir_first()
406 gc->set(gc, gpio, val); in bgpio_dir_out_dir_first()
410 static int bgpio_dir_out_val_first(struct gpio_chip *gc, unsigned int gpio, in bgpio_dir_out_val_first() argument
413 gc->set(gc, gpio, val); in bgpio_dir_out_val_first()
414 bgpio_dir_out(gc, gpio, val); in bgpio_dir_out_val_first()
419 struct gpio_chip *gc, in bgpio_setup_accessors() argument
423 switch (gc->bgpio_bits) { in bgpio_setup_accessors()
425 gc->read_reg = bgpio_read8; in bgpio_setup_accessors()
426 gc->write_reg = bgpio_write8; in bgpio_setup_accessors()
430 gc->read_reg = bgpio_read16be; in bgpio_setup_accessors()
431 gc->write_reg = bgpio_write16be; in bgpio_setup_accessors()
433 gc->read_reg = bgpio_read16; in bgpio_setup_accessors()
434 gc->write_reg = bgpio_write16; in bgpio_setup_accessors()
439 gc->read_reg = bgpio_read32be; in bgpio_setup_accessors()
440 gc->write_reg = bgpio_write32be; in bgpio_setup_accessors()
442 gc->read_reg = bgpio_read32; in bgpio_setup_accessors()
443 gc->write_reg = bgpio_write32; in bgpio_setup_accessors()
453 gc->read_reg = bgpio_read64; in bgpio_setup_accessors()
454 gc->write_reg = bgpio_write64; in bgpio_setup_accessors()
459 dev_err(dev, "unsupported data width %u bits\n", gc->bgpio_bits); in bgpio_setup_accessors()
488 static int bgpio_setup_io(struct gpio_chip *gc, in bgpio_setup_io() argument
495 gc->reg_dat = dat; in bgpio_setup_io()
496 if (!gc->reg_dat) in bgpio_setup_io()
500 gc->reg_set = set; in bgpio_setup_io()
501 gc->reg_clr = clr; in bgpio_setup_io()
502 gc->set = bgpio_set_with_clear; in bgpio_setup_io()
503 gc->set_multiple = bgpio_set_multiple_with_clear; in bgpio_setup_io()
505 gc->reg_set = set; in bgpio_setup_io()
506 gc->set = bgpio_set_set; in bgpio_setup_io()
507 gc->set_multiple = bgpio_set_multiple_set; in bgpio_setup_io()
509 gc->set = bgpio_set_none; in bgpio_setup_io()
510 gc->set_multiple = NULL; in bgpio_setup_io()
512 gc->set = bgpio_set; in bgpio_setup_io()
513 gc->set_multiple = bgpio_set_multiple; in bgpio_setup_io()
518 gc->get = bgpio_get_set; in bgpio_setup_io()
519 if (!gc->be_bits) in bgpio_setup_io()
520 gc->get_multiple = bgpio_get_set_multiple; in bgpio_setup_io()
529 gc->get = bgpio_get; in bgpio_setup_io()
530 if (gc->be_bits) in bgpio_setup_io()
531 gc->get_multiple = bgpio_get_multiple_be; in bgpio_setup_io()
533 gc->get_multiple = bgpio_get_multiple; in bgpio_setup_io()
539 static int bgpio_setup_direction(struct gpio_chip *gc, in bgpio_setup_direction() argument
545 gc->reg_dir_out = dirout; in bgpio_setup_direction()
546 gc->reg_dir_in = dirin; in bgpio_setup_direction()
548 gc->direction_output = bgpio_dir_out_dir_first; in bgpio_setup_direction()
550 gc->direction_output = bgpio_dir_out_val_first; in bgpio_setup_direction()
551 gc->direction_input = bgpio_dir_in; in bgpio_setup_direction()
552 gc->get_direction = bgpio_get_dir; in bgpio_setup_direction()
555 gc->direction_output = bgpio_dir_out_err; in bgpio_setup_direction()
557 gc->direction_output = bgpio_simple_dir_out; in bgpio_setup_direction()
558 gc->direction_input = bgpio_simple_dir_in; in bgpio_setup_direction()
599 int bgpio_init(struct gpio_chip *gc, struct device *dev, in bgpio_init() argument
609 gc->bgpio_bits = sz * 8; in bgpio_init()
610 if (gc->bgpio_bits > BITS_PER_LONG) in bgpio_init()
613 raw_spin_lock_init(&gc->bgpio_lock); in bgpio_init()
614 gc->parent = dev; in bgpio_init()
615 gc->label = dev_name(dev); in bgpio_init()
616 gc->base = -1; in bgpio_init()
617 gc->ngpio = gc->bgpio_bits; in bgpio_init()
618 gc->request = bgpio_request; in bgpio_init()
619 gc->be_bits = !!(flags & BGPIOF_BIG_ENDIAN); in bgpio_init()
621 ret = bgpio_setup_io(gc, dat, set, clr, flags); in bgpio_init()
625 ret = bgpio_setup_accessors(dev, gc, flags & BGPIOF_BIG_ENDIAN_BYTE_ORDER); in bgpio_init()
629 ret = bgpio_setup_direction(gc, dirout, dirin, flags); in bgpio_init()
633 gc->bgpio_data = gc->read_reg(gc->reg_dat); in bgpio_init()
634 if (gc->set == bgpio_set_set && in bgpio_init()
636 gc->bgpio_data = gc->read_reg(gc->reg_set); in bgpio_init()
639 gc->bgpio_dir_unreadable = true; in bgpio_init()
644 if ((gc->reg_dir_out || gc->reg_dir_in) && in bgpio_init()
646 if (gc->reg_dir_out) in bgpio_init()
647 gc->bgpio_dir = gc->read_reg(gc->reg_dir_out); in bgpio_init()
648 else if (gc->reg_dir_in) in bgpio_init()
649 gc->bgpio_dir = ~gc->read_reg(gc->reg_dir_in); in bgpio_init()
656 if (gc->reg_dir_out && gc->reg_dir_in) in bgpio_init()
657 gc->write_reg(gc->reg_dir_in, ~gc->bgpio_dir); in bgpio_init()
736 struct gpio_chip *gc; in bgpio_pdev_probe() local
774 gc = devm_kzalloc(&pdev->dev, sizeof(*gc), GFP_KERNEL); in bgpio_pdev_probe()
775 if (!gc) in bgpio_pdev_probe()
778 err = bgpio_init(gc, dev, sz, dat, set, clr, dirout, dirin, flags); in bgpio_pdev_probe()
784 gc->label = pdata->label; in bgpio_pdev_probe()
785 gc->base = pdata->base; in bgpio_pdev_probe()
787 gc->ngpio = pdata->ngpio; in bgpio_pdev_probe()
790 platform_set_drvdata(pdev, gc); in bgpio_pdev_probe()
792 return devm_gpiochip_add_data(&pdev->dev, gc, NULL); in bgpio_pdev_probe()