| Kirill Smelkov | 4c67045 | 2011-07-03 20:36:56 +0400 | [diff] [blame^] | 1 | /* |
| 2 | * Copyright (C) 2007 by Alan Stern |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or modify it |
| 5 | * under the terms of the GNU General Public License as published by the |
| 6 | * Free Software Foundation; either version 2 of the License, or (at your |
| 7 | * option) any later version. |
| 8 | * |
| 9 | * This program is distributed in the hope that it will be useful, but |
| 10 | * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY |
| 11 | * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License |
| 12 | * for more details. |
| 13 | * |
| 14 | * You should have received a copy of the GNU General Public License |
| 15 | * along with this program; if not, write to the Free Software Foundation, |
| 16 | * Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| 17 | */ |
| 18 | |
| 19 | /* this file is part of ehci-hcd.c */ |
| 20 | |
| 21 | |
| 22 | /* Display the ports dedicated to the companion controller */ |
| 23 | static ssize_t show_companion(struct device *dev, |
| 24 | struct device_attribute *attr, |
| 25 | char *buf) |
| 26 | { |
| 27 | struct ehci_hcd *ehci; |
| 28 | int nports, index, n; |
| 29 | int count = PAGE_SIZE; |
| 30 | char *ptr = buf; |
| 31 | |
| 32 | ehci = hcd_to_ehci(bus_to_hcd(dev_get_drvdata(dev))); |
| 33 | nports = HCS_N_PORTS(ehci->hcs_params); |
| 34 | |
| 35 | for (index = 0; index < nports; ++index) { |
| 36 | if (test_bit(index, &ehci->companion_ports)) { |
| 37 | n = scnprintf(ptr, count, "%d\n", index + 1); |
| 38 | ptr += n; |
| 39 | count -= n; |
| 40 | } |
| 41 | } |
| 42 | return ptr - buf; |
| 43 | } |
| 44 | |
| 45 | /* |
| 46 | * Dedicate or undedicate a port to the companion controller. |
| 47 | * Syntax is "[-]portnum", where a leading '-' sign means |
| 48 | * return control of the port to the EHCI controller. |
| 49 | */ |
| 50 | static ssize_t store_companion(struct device *dev, |
| 51 | struct device_attribute *attr, |
| 52 | const char *buf, size_t count) |
| 53 | { |
| 54 | struct ehci_hcd *ehci; |
| 55 | int portnum, new_owner; |
| 56 | |
| 57 | ehci = hcd_to_ehci(bus_to_hcd(dev_get_drvdata(dev))); |
| 58 | new_owner = PORT_OWNER; /* Owned by companion */ |
| 59 | if (sscanf(buf, "%d", &portnum) != 1) |
| 60 | return -EINVAL; |
| 61 | if (portnum < 0) { |
| 62 | portnum = - portnum; |
| 63 | new_owner = 0; /* Owned by EHCI */ |
| 64 | } |
| 65 | if (portnum <= 0 || portnum > HCS_N_PORTS(ehci->hcs_params)) |
| 66 | return -ENOENT; |
| 67 | portnum--; |
| 68 | if (new_owner) |
| 69 | set_bit(portnum, &ehci->companion_ports); |
| 70 | else |
| 71 | clear_bit(portnum, &ehci->companion_ports); |
| 72 | set_owner(ehci, portnum, new_owner); |
| 73 | return count; |
| 74 | } |
| 75 | static DEVICE_ATTR(companion, 0644, show_companion, store_companion); |
| 76 | |
| 77 | static inline int create_sysfs_files(struct ehci_hcd *ehci) |
| 78 | { |
| 79 | int i = 0; |
| 80 | |
| 81 | /* with integrated TT there is no companion! */ |
| 82 | if (!ehci_is_TDI(ehci)) |
| 83 | i = device_create_file(ehci_to_hcd(ehci)->self.controller, |
| 84 | &dev_attr_companion); |
| 85 | return i; |
| 86 | } |
| 87 | |
| 88 | static inline void remove_sysfs_files(struct ehci_hcd *ehci) |
| 89 | { |
| 90 | /* with integrated TT there is no companion! */ |
| 91 | if (!ehci_is_TDI(ehci)) |
| 92 | device_remove_file(ehci_to_hcd(ehci)->self.controller, |
| 93 | &dev_attr_companion); |
| 94 | } |