| .. | .. |
|---|
| 8 | 8 | */ |
|---|
| 9 | 9 | |
|---|
| 10 | 10 | #include <linux/init.h> |
|---|
| 11 | +#include <linux/delay.h> |
|---|
| 11 | 12 | #include <linux/of_platform.h> |
|---|
| 12 | | - |
|---|
| 13 | | -/* Trigger specific functions */ |
|---|
| 14 | | -#ifdef CONFIG_GPIOLIB |
|---|
| 15 | | - |
|---|
| 16 | | -#include <linux/of_gpio.h> |
|---|
| 17 | | - |
|---|
| 18 | | -static int handle; /* reset pin handle */ |
|---|
| 19 | | -static unsigned int reset_val; |
|---|
| 20 | | - |
|---|
| 21 | | -static int of_platform_reset_gpio_probe(void) |
|---|
| 22 | | -{ |
|---|
| 23 | | - int ret; |
|---|
| 24 | | - handle = of_get_named_gpio(of_find_node_by_path("/"), |
|---|
| 25 | | - "hard-reset-gpios", 0); |
|---|
| 26 | | - |
|---|
| 27 | | - if (!gpio_is_valid(handle)) { |
|---|
| 28 | | - pr_info("Skipping unavailable RESET gpio %d (%s)\n", |
|---|
| 29 | | - handle, "reset"); |
|---|
| 30 | | - return -ENODEV; |
|---|
| 31 | | - } |
|---|
| 32 | | - |
|---|
| 33 | | - ret = gpio_request(handle, "reset"); |
|---|
| 34 | | - if (ret < 0) { |
|---|
| 35 | | - pr_info("GPIO pin is already allocated\n"); |
|---|
| 36 | | - return ret; |
|---|
| 37 | | - } |
|---|
| 38 | | - |
|---|
| 39 | | - /* get current setup value */ |
|---|
| 40 | | - reset_val = gpio_get_value(handle); |
|---|
| 41 | | - /* FIXME maybe worth to perform any action */ |
|---|
| 42 | | - pr_debug("Reset: Gpio output state: 0x%x\n", reset_val); |
|---|
| 43 | | - |
|---|
| 44 | | - /* Setup GPIO as output */ |
|---|
| 45 | | - ret = gpio_direction_output(handle, 0); |
|---|
| 46 | | - if (ret < 0) |
|---|
| 47 | | - goto err; |
|---|
| 48 | | - |
|---|
| 49 | | - /* Setup output direction */ |
|---|
| 50 | | - gpio_set_value(handle, 0); |
|---|
| 51 | | - |
|---|
| 52 | | - pr_info("RESET: Registered gpio device: %d, current val: %d\n", |
|---|
| 53 | | - handle, reset_val); |
|---|
| 54 | | - return 0; |
|---|
| 55 | | -err: |
|---|
| 56 | | - gpio_free(handle); |
|---|
| 57 | | - return ret; |
|---|
| 58 | | -} |
|---|
| 59 | | -device_initcall(of_platform_reset_gpio_probe); |
|---|
| 60 | | - |
|---|
| 61 | | - |
|---|
| 62 | | -static void gpio_system_reset(void) |
|---|
| 63 | | -{ |
|---|
| 64 | | - if (gpio_is_valid(handle)) |
|---|
| 65 | | - gpio_set_value(handle, 1 - reset_val); |
|---|
| 66 | | - else |
|---|
| 67 | | - pr_notice("Reset GPIO unavailable - halting!\n"); |
|---|
| 68 | | -} |
|---|
| 69 | | -#else |
|---|
| 70 | | -static void gpio_system_reset(void) |
|---|
| 71 | | -{ |
|---|
| 72 | | - pr_notice("No reset GPIO present - halting!\n"); |
|---|
| 73 | | -} |
|---|
| 74 | | - |
|---|
| 75 | | -void of_platform_reset_gpio_probe(void) |
|---|
| 76 | | -{ |
|---|
| 77 | | - return; |
|---|
| 78 | | -} |
|---|
| 79 | | -#endif |
|---|
| 80 | | - |
|---|
| 81 | | -void machine_restart(char *cmd) |
|---|
| 82 | | -{ |
|---|
| 83 | | - pr_notice("Machine restart...\n"); |
|---|
| 84 | | - gpio_system_reset(); |
|---|
| 85 | | - while (1) |
|---|
| 86 | | - ; |
|---|
| 87 | | -} |
|---|
| 13 | +#include <linux/reboot.h> |
|---|
| 88 | 14 | |
|---|
| 89 | 15 | void machine_shutdown(void) |
|---|
| 90 | 16 | { |
|---|
| .. | .. |
|---|
| 106 | 32 | while (1) |
|---|
| 107 | 33 | ; |
|---|
| 108 | 34 | } |
|---|
| 35 | + |
|---|
| 36 | +void machine_restart(char *cmd) |
|---|
| 37 | +{ |
|---|
| 38 | + do_kernel_restart(cmd); |
|---|
| 39 | + /* Give the restart hook 1 s to take us down */ |
|---|
| 40 | + mdelay(1000); |
|---|
| 41 | + pr_emerg("Reboot failed -- System halted\n"); |
|---|
| 42 | + while (1); |
|---|
| 43 | +} |
|---|