Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history
yaml
---
r: 251964
b: refs/heads/master
c: dd86a0c
h: refs/heads/master
v: v3
  • Loading branch information
Jamie Iles authored and Grant Likely committed May 20, 2011
1 parent c328cbf commit 805c062
Show file tree
Hide file tree
Showing 2 changed files with 34 additions and 6 deletions.
2 changes: 1 addition & 1 deletion [refs]
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: e027d6f9d52d9ccabb307d0cb0265de3481b1e9e
refs/heads/master: dd86a0cc5e35161538c10e35eb85e2ad0adfe14d
38 changes: 33 additions & 5 deletions trunk/drivers/gpio/basic_mmio_gpio.c
Original file line number Diff line number Diff line change
Expand Up @@ -185,6 +185,24 @@ static void bgpio_set_with_clear(struct gpio_chip *gc, unsigned int gpio,
bgc->write_reg(bgc->reg_clr, mask);
}

static void bgpio_set_set(struct gpio_chip *gc, unsigned int gpio, int val)
{
struct bgpio_chip *bgc = to_bgpio_chip(gc);
unsigned long mask = bgc->pin2mask(bgc, gpio);
unsigned long flags;

spin_lock_irqsave(&bgc->lock, flags);

if (val)
bgc->data |= mask;
else
bgc->data &= ~mask;

bgc->write_reg(bgc->reg_set, bgc->data);

spin_unlock_irqrestore(&bgc->lock, flags);
}

static int bgpio_dir_in(struct gpio_chip *gc, unsigned int gpio)
{
return 0;
Expand Down Expand Up @@ -245,10 +263,12 @@ static int bgpio_setup_accessors(struct platform_device *pdev,

/*
* Create the device and allocate the resources. For setting GPIO's there are
* two supported configurations:
* three supported configurations:
*
* - single output register resource (named "dat").
* - single input/output register resource (named "dat").
* - set/clear pair (named "set" and "clr").
* - single output register resource and single input resource ("set" and
* dat").
*
* For the single output register, this drives a 1 by setting a bit and a zero
* by clearing a bit. For the set clr pair, this drives a 1 by setting a bit
Expand Down Expand Up @@ -292,12 +312,21 @@ static int bgpio_setup_io(struct platform_device *pdev,
return -ENOMEM;

bgc->gc.set = bgpio_set_with_clear;
} else if (res_set || res_clr) {
return -EINVAL;
} else if (res_set && !res_clr) {
if (resource_size(res_set) != resource_size(res_dat))
return -EINVAL;

bgc->reg_set = bgpio_request_and_map(&pdev->dev, res_set);
if (!bgc->reg_set)
return -ENOMEM;

bgc->gc.set = bgpio_set_set;
} else {
bgc->gc.set = bgpio_set;
}

bgc->gc.get = bgpio_get;

return 0;
}

Expand Down Expand Up @@ -336,7 +365,6 @@ static int __devinit bgpio_probe(struct platform_device *pdev)
bgc->gc.ngpio = ngpio;
bgc->gc.direction_input = bgpio_dir_in;
bgc->gc.direction_output = bgpio_dir_out;
bgc->gc.get = bgpio_get;
bgc->gc.dev = dev;
bgc->gc.label = dev_name(dev);

Expand Down

0 comments on commit 805c062

Please sign in to comment.