forked from Minki/linux
594fa265e0
Currently the kernel uses the struct device_node.data pointer to resolve a struct gpio_chip pointer from a device tree node. However, the .data member doesn't provide any type checking and there aren't any rules enforced on what it should be used for. There's no guarantee that the data stored in it actually points to an gpio_chip pointer. Instead of relying on the .data pointer, this patch modifies the code to add a lookup function which scans through the registered gpio_chips and returns the gpio_chip that has a pointer to the specified device_node. Signed-off-by: Grant Likely <grant.likely@secretlab.ca> CC: Andrew Morton <akpm@linux-foundation.org> CC: Anton Vorontsov <avorontsov@ru.mvista.com> CC: Grant Likely <grant.likely@secretlab.ca> CC: David Brownell <dbrownell@users.sourceforge.net> CC: Bill Gatliff <bgat@billgatliff.com> CC: Dmitry Eremin-Solenikov <dbaryshkov@gmail.com> CC: Benjamin Herrenschmidt <benh@kernel.crashing.org> CC: Jean Delvare <khali@linux-fr.org> CC: linux-kernel@vger.kernel.org CC: devicetree-discuss@lists.ozlabs.org
141 lines
2.8 KiB
C
141 lines
2.8 KiB
C
/*
|
|
* Copyright (C) 2009 Michal Simek <monstr@monstr.eu>
|
|
* Copyright (C) 2009 PetaLogix
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License. See the file "COPYING" in the main directory of this archive
|
|
* for more details.
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/of_platform.h>
|
|
#include <asm/prom.h>
|
|
|
|
/* Trigger specific functions */
|
|
#ifdef CONFIG_GPIOLIB
|
|
|
|
#include <linux/of_gpio.h>
|
|
|
|
static int handle; /* reset pin handle */
|
|
static unsigned int reset_val;
|
|
|
|
static int of_reset_gpio_handle(void)
|
|
{
|
|
int ret; /* variable which stored handle reset gpio pin */
|
|
struct device_node *root; /* root node */
|
|
struct device_node *gpio; /* gpio node */
|
|
struct gpio_chip *gc;
|
|
u32 flags;
|
|
const void *gpio_spec;
|
|
|
|
/* find out root node */
|
|
root = of_find_node_by_path("/");
|
|
|
|
/* give me handle for gpio node to be possible allocate pin */
|
|
ret = of_parse_phandles_with_args(root, "hard-reset-gpios",
|
|
"#gpio-cells", 0, &gpio, &gpio_spec);
|
|
if (ret) {
|
|
pr_debug("%s: can't parse gpios property\n", __func__);
|
|
goto err0;
|
|
}
|
|
|
|
gc = of_node_to_gpiochip(gpio);
|
|
if (!gc) {
|
|
pr_debug("%s: gpio controller %s isn't registered\n",
|
|
root->full_name, gpio->full_name);
|
|
ret = -ENODEV;
|
|
goto err1;
|
|
}
|
|
|
|
ret = gc->of_xlate(gc, root, gpio_spec, &flags);
|
|
if (ret < 0)
|
|
goto err1;
|
|
|
|
ret += gc->base;
|
|
err1:
|
|
of_node_put(gpio);
|
|
err0:
|
|
pr_debug("%s exited with status %d\n", __func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
void of_platform_reset_gpio_probe(void)
|
|
{
|
|
int ret;
|
|
handle = of_reset_gpio_handle();
|
|
|
|
if (!gpio_is_valid(handle)) {
|
|
printk(KERN_INFO "Skipping unavailable RESET gpio %d (%s)\n",
|
|
handle, "reset");
|
|
}
|
|
|
|
ret = gpio_request(handle, "reset");
|
|
if (ret < 0) {
|
|
printk(KERN_INFO "GPIO pin is already allocated\n");
|
|
return;
|
|
}
|
|
|
|
/* get current setup value */
|
|
reset_val = gpio_get_value(handle);
|
|
/* FIXME maybe worth to perform any action */
|
|
pr_debug("Reset: Gpio output state: 0x%x\n", reset_val);
|
|
|
|
/* Setup GPIO as output */
|
|
ret = gpio_direction_output(handle, 0);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
/* Setup output direction */
|
|
gpio_set_value(handle, 0);
|
|
|
|
printk(KERN_INFO "RESET: Registered gpio device: %d, current val: %d\n",
|
|
handle, reset_val);
|
|
return;
|
|
err:
|
|
gpio_free(handle);
|
|
return;
|
|
}
|
|
|
|
|
|
static void gpio_system_reset(void)
|
|
{
|
|
gpio_set_value(handle, 1 - reset_val);
|
|
}
|
|
#else
|
|
#define gpio_system_reset() do {} while (0)
|
|
void of_platform_reset_gpio_probe(void)
|
|
{
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
void machine_restart(char *cmd)
|
|
{
|
|
printk(KERN_NOTICE "Machine restart...\n");
|
|
gpio_system_reset();
|
|
dump_stack();
|
|
while (1)
|
|
;
|
|
}
|
|
|
|
void machine_shutdown(void)
|
|
{
|
|
printk(KERN_NOTICE "Machine shutdown...\n");
|
|
while (1)
|
|
;
|
|
}
|
|
|
|
void machine_halt(void)
|
|
{
|
|
printk(KERN_NOTICE "Machine halt...\n");
|
|
while (1)
|
|
;
|
|
}
|
|
|
|
void machine_power_off(void)
|
|
{
|
|
printk(KERN_NOTICE "Machine power off...\n");
|
|
while (1)
|
|
;
|
|
}
|