Greg Kroah-Hartman | b244131 | 2017-11-01 15:07:57 +0100 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | /* apc - Driver implementation for power management functions |
| 3 | * of Aurora Personality Chip (APC) on SPARCstation-4/5 and |
| 4 | * derivatives. |
| 5 | * |
| 6 | * Copyright (c) 2002 Eric Brower (ebrower@usa.net) |
| 7 | */ |
| 8 | |
| 9 | #include <linux/kernel.h> |
| 10 | #include <linux/fs.h> |
| 11 | #include <linux/errno.h> |
| 12 | #include <linux/init.h> |
| 13 | #include <linux/miscdevice.h> |
| 14 | #include <linux/pm.h> |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 15 | #include <linux/of.h> |
| 16 | #include <linux/of_device.h> |
Paul Gortmaker | f060ac5 | 2011-07-31 01:50:31 -0400 | [diff] [blame] | 17 | #include <linux/module.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 18 | |
| 19 | #include <asm/io.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | #include <asm/oplib.h> |
Linus Torvalds | 7c0f6ba | 2016-12-24 11:46:01 -0800 | [diff] [blame] | 21 | #include <linux/uaccess.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 | #include <asm/auxio.h> |
| 23 | #include <asm/apc.h> |
Len Brown | d472ba8 | 2013-02-09 23:27:26 -0500 | [diff] [blame] | 24 | #include <asm/processor.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 25 | |
| 26 | /* Debugging |
| 27 | * |
| 28 | * #define APC_DEBUG_LED |
| 29 | */ |
| 30 | |
| 31 | #define APC_MINOR MISC_DYNAMIC_MINOR |
| 32 | #define APC_OBPNAME "power-management" |
| 33 | #define APC_DEVNAME "apc" |
| 34 | |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 35 | static u8 __iomem *regs; |
Greg Kroah-Hartman | 7c9503b | 2012-12-21 14:03:26 -0800 | [diff] [blame] | 36 | static int apc_no_idle = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 38 | #define apc_readb(offs) (sbus_readb(regs+offs)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | #define apc_writeb(val, offs) (sbus_writeb(val, regs+offs)) |
| 40 | |
| 41 | /* Specify "apc=noidle" on the kernel command line to |
| 42 | * disable APC CPU standby support. Certain prototype |
| 43 | * systems (SPARCstation-Fox) do not play well with APC |
| 44 | * CPU idle, so disable this if your system has APC and |
| 45 | * crashes randomly. |
| 46 | */ |
| 47 | static int __init apc_setup(char *str) |
| 48 | { |
| 49 | if(!strncmp(str, "noidle", strlen("noidle"))) { |
| 50 | apc_no_idle = 1; |
| 51 | return 1; |
| 52 | } |
| 53 | return 0; |
| 54 | } |
| 55 | __setup("apc=", apc_setup); |
| 56 | |
| 57 | /* |
| 58 | * CPU idle callback function |
| 59 | * See .../arch/sparc/kernel/process.c |
| 60 | */ |
Adrian Bunk | c61c65c | 2008-06-05 11:40:58 -0700 | [diff] [blame] | 61 | static void apc_swift_idle(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | { |
| 63 | #ifdef APC_DEBUG_LED |
| 64 | set_auxio(0x00, AUXIO_LED); |
| 65 | #endif |
| 66 | |
| 67 | apc_writeb(apc_readb(APC_IDLE_REG) | APC_IDLE_ON, APC_IDLE_REG); |
| 68 | |
| 69 | #ifdef APC_DEBUG_LED |
| 70 | set_auxio(AUXIO_LED, 0x00); |
| 71 | #endif |
| 72 | } |
| 73 | |
Grant Likely | cd4cd73 | 2010-07-22 16:04:30 -0600 | [diff] [blame] | 74 | static inline void apc_free(struct platform_device *op) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 75 | { |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 76 | of_iounmap(&op->resource[0], regs, resource_size(&op->resource[0])); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | } |
| 78 | |
| 79 | static int apc_open(struct inode *inode, struct file *f) |
| 80 | { |
| 81 | return 0; |
| 82 | } |
| 83 | |
| 84 | static int apc_release(struct inode *inode, struct file *f) |
| 85 | { |
| 86 | return 0; |
| 87 | } |
| 88 | |
Stoyan Gaydarov | ab77202 | 2008-07-14 22:12:29 -0700 | [diff] [blame] | 89 | static long apc_ioctl(struct file *f, unsigned int cmd, unsigned long __arg) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 90 | { |
Thomas Gleixner | 49ab972 | 2009-11-02 21:15:59 -0800 | [diff] [blame] | 91 | __u8 inarg, __user *arg = (__u8 __user *) __arg; |
Stoyan Gaydarov | ab77202 | 2008-07-14 22:12:29 -0700 | [diff] [blame] | 92 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 93 | switch (cmd) { |
| 94 | case APCIOCGFANCTL: |
Thomas Gleixner | 49ab972 | 2009-11-02 21:15:59 -0800 | [diff] [blame] | 95 | if (put_user(apc_readb(APC_FANCTL_REG) & APC_REGMASK, arg)) |
Stoyan Gaydarov | ab77202 | 2008-07-14 22:12:29 -0700 | [diff] [blame] | 96 | return -EFAULT; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | break; |
| 98 | |
| 99 | case APCIOCGCPWR: |
Thomas Gleixner | 49ab972 | 2009-11-02 21:15:59 -0800 | [diff] [blame] | 100 | if (put_user(apc_readb(APC_CPOWER_REG) & APC_REGMASK, arg)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 101 | return -EFAULT; |
| 102 | break; |
| 103 | |
| 104 | case APCIOCGBPORT: |
Thomas Gleixner | 49ab972 | 2009-11-02 21:15:59 -0800 | [diff] [blame] | 105 | if (put_user(apc_readb(APC_BPORT_REG) & APC_BPMASK, arg)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 106 | return -EFAULT; |
| 107 | break; |
| 108 | |
| 109 | case APCIOCSFANCTL: |
Thomas Gleixner | 49ab972 | 2009-11-02 21:15:59 -0800 | [diff] [blame] | 110 | if (get_user(inarg, arg)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 111 | return -EFAULT; |
| 112 | apc_writeb(inarg & APC_REGMASK, APC_FANCTL_REG); |
| 113 | break; |
Thomas Gleixner | 49ab972 | 2009-11-02 21:15:59 -0800 | [diff] [blame] | 114 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 115 | case APCIOCSCPWR: |
Thomas Gleixner | 49ab972 | 2009-11-02 21:15:59 -0800 | [diff] [blame] | 116 | if (get_user(inarg, arg)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 117 | return -EFAULT; |
| 118 | apc_writeb(inarg & APC_REGMASK, APC_CPOWER_REG); |
| 119 | break; |
Thomas Gleixner | 49ab972 | 2009-11-02 21:15:59 -0800 | [diff] [blame] | 120 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 121 | case APCIOCSBPORT: |
Thomas Gleixner | 49ab972 | 2009-11-02 21:15:59 -0800 | [diff] [blame] | 122 | if (get_user(inarg, arg)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 123 | return -EFAULT; |
| 124 | apc_writeb(inarg & APC_BPMASK, APC_BPORT_REG); |
| 125 | break; |
Thomas Gleixner | 49ab972 | 2009-11-02 21:15:59 -0800 | [diff] [blame] | 126 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 127 | default: |
| 128 | return -EINVAL; |
Joe Perches | 6cb79b3 | 2011-06-03 14:45:23 +0000 | [diff] [blame] | 129 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 130 | |
| 131 | return 0; |
| 132 | } |
| 133 | |
Arjan van de Ven | 5dfe4c9 | 2007-02-12 00:55:31 -0800 | [diff] [blame] | 134 | static const struct file_operations apc_fops = { |
Stoyan Gaydarov | ab77202 | 2008-07-14 22:12:29 -0700 | [diff] [blame] | 135 | .unlocked_ioctl = apc_ioctl, |
| 136 | .open = apc_open, |
| 137 | .release = apc_release, |
Arnd Bergmann | 6038f37 | 2010-08-15 18:52:59 +0200 | [diff] [blame] | 138 | .llseek = noop_llseek, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 139 | }; |
| 140 | |
| 141 | static struct miscdevice apc_miscdev = { APC_MINOR, APC_DEVNAME, &apc_fops }; |
| 142 | |
Greg Kroah-Hartman | 7c9503b | 2012-12-21 14:03:26 -0800 | [diff] [blame] | 143 | static int apc_probe(struct platform_device *op) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 144 | { |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 145 | int err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 146 | |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 147 | regs = of_ioremap(&op->resource[0], 0, |
| 148 | resource_size(&op->resource[0]), APC_OBPNAME); |
| 149 | if (!regs) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 | printk(KERN_ERR "%s: unable to map registers\n", APC_DEVNAME); |
| 151 | return -ENODEV; |
| 152 | } |
| 153 | |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 154 | err = misc_register(&apc_miscdev); |
| 155 | if (err) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 156 | printk(KERN_ERR "%s: unable to register device\n", APC_DEVNAME); |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 157 | apc_free(op); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 158 | return -ENODEV; |
| 159 | } |
| 160 | |
| 161 | /* Assign power management IDLE handler */ |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 162 | if (!apc_no_idle) |
Len Brown | d472ba8 | 2013-02-09 23:27:26 -0500 | [diff] [blame] | 163 | sparc_idle = apc_swift_idle; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 164 | |
| 165 | printk(KERN_INFO "%s: power management initialized%s\n", |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 166 | APC_DEVNAME, apc_no_idle ? " (CPU idle disabled)" : ""); |
| 167 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 168 | return 0; |
| 169 | } |
| 170 | |
Arvind Yadav | 69f5797 | 2017-06-23 14:51:35 +0530 | [diff] [blame] | 171 | static const struct of_device_id apc_match[] = { |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 172 | { |
| 173 | .name = APC_OBPNAME, |
| 174 | }, |
| 175 | {}, |
| 176 | }; |
| 177 | MODULE_DEVICE_TABLE(of, apc_match); |
| 178 | |
Grant Likely | 4ebb24f | 2011-02-22 20:01:33 -0700 | [diff] [blame] | 179 | static struct platform_driver apc_driver = { |
Grant Likely | 4018294 | 2010-04-13 16:13:02 -0700 | [diff] [blame] | 180 | .driver = { |
| 181 | .name = "apc", |
Grant Likely | 4018294 | 2010-04-13 16:13:02 -0700 | [diff] [blame] | 182 | .of_match_table = apc_match, |
| 183 | }, |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 184 | .probe = apc_probe, |
| 185 | }; |
| 186 | |
| 187 | static int __init apc_init(void) |
| 188 | { |
Grant Likely | 4ebb24f | 2011-02-22 20:01:33 -0700 | [diff] [blame] | 189 | return platform_driver_register(&apc_driver); |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 190 | } |
| 191 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | /* This driver is not critical to the boot process |
| 193 | * and is easiest to ioremap when SBus is already |
| 194 | * initialized, so we install ourselves thusly: |
| 195 | */ |
David S. Miller | 7e7e2f0 | 2008-08-27 02:45:36 -0700 | [diff] [blame] | 196 | __initcall(apc_init); |