diff options
Diffstat (limited to 'drivers')
113 files changed, 9667 insertions, 11669 deletions
diff --git a/drivers/char/pcmcia/Kconfig b/drivers/char/pcmcia/Kconfig index f25facd97bb4..00b8a84b0319 100644 --- a/drivers/char/pcmcia/Kconfig +++ b/drivers/char/pcmcia/Kconfig | |||
| @@ -43,5 +43,14 @@ config CARDMAN_4040 | |||
| 43 | (http://www.omnikey.com/), or a current development version of OpenCT | 43 | (http://www.omnikey.com/), or a current development version of OpenCT |
| 44 | (http://www.opensc.org/). | 44 | (http://www.opensc.org/). |
| 45 | 45 | ||
| 46 | config IPWIRELESS | ||
| 47 | tristate "IPWireless 3G UMTS PCMCIA card support" | ||
| 48 | depends on PCMCIA | ||
| 49 | select PPP | ||
| 50 | help | ||
| 51 | This is a driver for 3G UMTS PCMCIA card from IPWireless company. In | ||
| 52 | some countries (for example Czech Republic, T-Mobile ISP) this card | ||
| 53 | is shipped for service called UMTS 4G. | ||
| 54 | |||
| 46 | endmenu | 55 | endmenu |
| 47 | 56 | ||
diff --git a/drivers/char/pcmcia/Makefile b/drivers/char/pcmcia/Makefile index 0aae20985d57..be8f287aa398 100644 --- a/drivers/char/pcmcia/Makefile +++ b/drivers/char/pcmcia/Makefile | |||
| @@ -4,6 +4,8 @@ | |||
| 4 | # Makefile for the Linux PCMCIA char device drivers. | 4 | # Makefile for the Linux PCMCIA char device drivers. |
| 5 | # | 5 | # |
| 6 | 6 | ||
| 7 | obj-y += ipwireless/ | ||
| 8 | |||
| 7 | obj-$(CONFIG_SYNCLINK_CS) += synclink_cs.o | 9 | obj-$(CONFIG_SYNCLINK_CS) += synclink_cs.o |
| 8 | obj-$(CONFIG_CARDMAN_4000) += cm4000_cs.o | 10 | obj-$(CONFIG_CARDMAN_4000) += cm4000_cs.o |
| 9 | obj-$(CONFIG_CARDMAN_4040) += cm4040_cs.o | 11 | obj-$(CONFIG_CARDMAN_4040) += cm4040_cs.o |
diff --git a/drivers/char/pcmcia/ipwireless/Makefile b/drivers/char/pcmcia/ipwireless/Makefile new file mode 100644 index 000000000000..b71eb593643d --- /dev/null +++ b/drivers/char/pcmcia/ipwireless/Makefile | |||
| @@ -0,0 +1,10 @@ | |||
| 1 | # | ||
| 2 | # drivers/char/pcmcia/ipwireless/Makefile | ||
| 3 | # | ||
| 4 | # Makefile for the IPWireless driver | ||
| 5 | # | ||
| 6 | |||
| 7 | obj-$(CONFIG_IPWIRELESS) += ipwireless.o | ||
| 8 | |||
| 9 | ipwireless-objs := hardware.o main.o network.o tty.o | ||
| 10 | |||
diff --git a/drivers/char/pcmcia/ipwireless/hardware.c b/drivers/char/pcmcia/ipwireless/hardware.c new file mode 100644 index 000000000000..1f978ff87fa8 --- /dev/null +++ b/drivers/char/pcmcia/ipwireless/hardware.c | |||
| @@ -0,0 +1,1787 @@ | |||
| 1 | /* | ||
| 2 | * IPWireless 3G PCMCIA Network Driver | ||
| 3 | * | ||
| 4 | * Original code | ||
| 5 | * by Stephen Blackheath <stephen@blacksapphire.com>, | ||
| 6 | * Ben Martel <benm@symmetric.co.nz> | ||
| 7 | * | ||
| 8 | * Copyrighted as follows: | ||
| 9 | * Copyright (C) 2004 by Symmetric Systems Ltd (NZ) | ||
| 10 | * | ||
| 11 | * Various driver changes and rewrites, port to new kernels | ||
| 12 | * Copyright (C) 2006-2007 Jiri Kosina | ||
| 13 | * | ||
| 14 | * Misc code cleanups and updates | ||
| 15 | * Copyright (C) 2007 David Sterba | ||
| 16 | */ | ||
| 17 | |||
| 18 | #include <linux/interrupt.h> | ||
| 19 | #include <linux/io.h> | ||
| 20 | #include <linux/irq.h> | ||
| 21 | #include <linux/kernel.h> | ||
| 22 | #include <linux/list.h> | ||
| 23 | #include <linux/slab.h> | ||
| 24 | |||
| 25 | #include "hardware.h" | ||
| 26 | #include "setup_protocol.h" | ||
| 27 | #include "network.h" | ||
| 28 | #include "main.h" | ||
| 29 | |||
| 30 | static void ipw_send_setup_packet(struct ipw_hardware *hw); | ||
| 31 | static void handle_received_SETUP_packet(struct ipw_hardware *ipw, | ||
| 32 | unsigned int address, | ||
| 33 | unsigned char *data, int len, | ||
| 34 | int is_last); | ||
| 35 | static void ipwireless_setup_timer(unsigned long data); | ||
| 36 | static void handle_received_CTRL_packet(struct ipw_hardware *hw, | ||
| 37 | unsigned int channel_idx, unsigned char *data, int len); | ||
| 38 | |||
| 39 | /*#define TIMING_DIAGNOSTICS*/ | ||
| 40 | |||
| 41 | #ifdef TIMING_DIAGNOSTICS | ||
| 42 | |||
| 43 | static struct timing_stats { | ||
| 44 | unsigned long last_report_time; | ||
| 45 | unsigned long read_time; | ||
| 46 | unsigned long write_time; | ||
| 47 | unsigned long read_bytes; | ||
| 48 | unsigned long write_bytes; | ||
| 49 | unsigned long start_time; | ||
| 50 | }; | ||
| 51 | |||
| 52 | static void start_timing(void) | ||
| 53 | { | ||
| 54 | timing_stats.start_time = jiffies; | ||
| 55 | } | ||
| 56 | |||
| 57 | static void end_read_timing(unsigned length) | ||
| 58 | { | ||
| 59 | timing_stats.read_time += (jiffies - start_time); | ||
| 60 | timing_stats.read_bytes += length + 2; | ||
| 61 | report_timing(); | ||
| 62 | } | ||
| 63 | |||
| 64 | static void end_write_timing(unsigned length) | ||
| 65 | { | ||
| 66 | timing_stats.write_time += (jiffies - start_time); | ||
| 67 | timing_stats.write_bytes += length + 2; | ||
| 68 | report_timing(); | ||
| 69 | } | ||
| 70 | |||
| 71 | static void report_timing(void) | ||
| 72 | { | ||
| 73 | unsigned long since = jiffies - timing_stats.last_report_time; | ||
| 74 | |||
| 75 | /* If it's been more than one second... */ | ||
| 76 | if (since >= HZ) { | ||
| 77 | int first = (timing_stats.last_report_time == 0); | ||
| 78 | |||
| 79 | timing_stats.last_report_time = jiffies; | ||
| 80 | if (!first) | ||
| 81 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 82 | ": %u us elapsed - read %lu bytes in %u us, " | ||
| 83 | "wrote %lu bytes in %u us\n", | ||
| 84 | jiffies_to_usecs(since), | ||
| 85 | timing_stats.read_bytes, | ||
| 86 | jiffies_to_usecs(timing_stats.read_time), | ||
| 87 | timing_stats.write_bytes, | ||
| 88 | jiffies_to_usecs(timing_stats.write_time)); | ||
| 89 | |||
| 90 | timing_stats.read_time = 0; | ||
| 91 | timing_stats.write_time = 0; | ||
| 92 | timing_stats.read_bytes = 0; | ||
| 93 | timing_stats.write_bytes = 0; | ||
| 94 | } | ||
| 95 | } | ||
| 96 | #else | ||
| 97 | static void start_timing(void) { } | ||
| 98 | static void end_read_timing(unsigned length) { } | ||
| 99 | static void end_write_timing(unsigned length) { } | ||
| 100 | #endif | ||
| 101 | |||
| 102 | /* Imported IPW definitions */ | ||
| 103 | |||
| 104 | #define LL_MTU_V1 318 | ||
| 105 | #define LL_MTU_V2 250 | ||
| 106 | #define LL_MTU_MAX (LL_MTU_V1 > LL_MTU_V2 ? LL_MTU_V1 : LL_MTU_V2) | ||
| 107 | |||
| 108 | #define PRIO_DATA 2 | ||
| 109 | #define PRIO_CTRL 1 | ||
| 110 | #define PRIO_SETUP 0 | ||
| 111 | |||
| 112 | /* Addresses */ | ||
| 113 | #define ADDR_SETUP_PROT 0 | ||
| 114 | |||
| 115 | /* Protocol ids */ | ||
| 116 | enum { | ||
| 117 | /* Identifier for the Com Data protocol */ | ||
| 118 | TL_PROTOCOLID_COM_DATA = 0, | ||
| 119 | |||
| 120 | /* Identifier for the Com Control protocol */ | ||
| 121 | TL_PROTOCOLID_COM_CTRL = 1, | ||
| 122 | |||
| 123 | /* Identifier for the Setup protocol */ | ||
| 124 | TL_PROTOCOLID_SETUP = 2 | ||
| 125 | }; | ||
| 126 | |||
| 127 | /* Number of bytes in NL packet header (cannot do | ||
| 128 | * sizeof(nl_packet_header) since it's a bitfield) */ | ||
| 129 | #define NL_FIRST_PACKET_HEADER_SIZE 3 | ||
| 130 | |||
| 131 | /* Number of bytes in NL packet header (cannot do | ||
| 132 | * sizeof(nl_packet_header) since it's a bitfield) */ | ||
| 133 | #define NL_FOLLOWING_PACKET_HEADER_SIZE 1 | ||
| 134 | |||
| 135 | struct nl_first_packet_header { | ||
| 136 | #if defined(__BIG_ENDIAN_BITFIELD) | ||
| 137 | unsigned char packet_rank:2; | ||
| 138 | unsigned char address:3; | ||
| 139 | unsigned char protocol:3; | ||
| 140 | #else | ||
| 141 | unsigned char protocol:3; | ||
| 142 | unsigned char address:3; | ||
| 143 | unsigned char packet_rank:2; | ||
| 144 | #endif | ||
| 145 | unsigned char length_lsb; | ||
| 146 | unsigned char length_msb; | ||
| 147 | }; | ||
| 148 | |||
| 149 | struct nl_packet_header { | ||
| 150 | #if defined(__BIG_ENDIAN_BITFIELD) | ||
| 151 | unsigned char packet_rank:2; | ||
| 152 | unsigned char address:3; | ||
| 153 | unsigned char protocol:3; | ||
| 154 | #else | ||
| 155 | unsigned char protocol:3; | ||
| 156 | unsigned char address:3; | ||
| 157 | unsigned char packet_rank:2; | ||
| 158 | #endif | ||
| 159 | }; | ||
| 160 | |||
| 161 | /* Value of 'packet_rank' above */ | ||
| 162 | #define NL_INTERMEDIATE_PACKET 0x0 | ||
| 163 | #define NL_LAST_PACKET 0x1 | ||
| 164 | #define NL_FIRST_PACKET 0x2 | ||
| 165 | |||
| 166 | union nl_packet { | ||
| 167 | /* Network packet header of the first packet (a special case) */ | ||
| 168 | struct nl_first_packet_header hdr_first; | ||
| 169 | /* Network packet header of the following packets (if any) */ | ||
| 170 | struct nl_packet_header hdr; | ||
| 171 | /* Complete network packet (header + data) */ | ||
| 172 | unsigned char rawpkt[LL_MTU_MAX]; | ||
| 173 | } __attribute__ ((__packed__)); | ||
| 174 | |||
| 175 | #define HW_VERSION_UNKNOWN -1 | ||
| 176 | #define HW_VERSION_1 1 | ||
| 177 | #define HW_VERSION_2 2 | ||
| 178 | |||
| 179 | /* IPW I/O ports */ | ||
| 180 | #define IOIER 0x00 /* Interrupt Enable Register */ | ||
| 181 | #define IOIR 0x02 /* Interrupt Source/ACK register */ | ||
| 182 | #define IODCR 0x04 /* Data Control Register */ | ||
| 183 | #define IODRR 0x06 /* Data Read Register */ | ||
| 184 | #define IODWR 0x08 /* Data Write Register */ | ||
| 185 | #define IOESR 0x0A /* Embedded Driver Status Register */ | ||
| 186 | #define IORXR 0x0C /* Rx Fifo Register (Host to Embedded) */ | ||
| 187 | #define IOTXR 0x0E /* Tx Fifo Register (Embedded to Host) */ | ||
| 188 | |||
| 189 | /* I/O ports and bit definitions for version 1 of the hardware */ | ||
| 190 | |||
| 191 | /* IER bits*/ | ||
| 192 | #define IER_RXENABLED 0x1 | ||
| 193 | #define IER_TXENABLED 0x2 | ||
| 194 | |||
| 195 | /* ISR bits */ | ||
| 196 | #define IR_RXINTR 0x1 | ||
| 197 | #define IR_TXINTR 0x2 | ||
| 198 | |||
| 199 | /* DCR bits */ | ||
| 200 | #define DCR_RXDONE 0x1 | ||
| 201 | #define DCR_TXDONE 0x2 | ||
| 202 | #define DCR_RXRESET 0x4 | ||
| 203 | #define DCR_TXRESET 0x8 | ||
| 204 | |||
| 205 | /* I/O ports and bit definitions for version 2 of the hardware */ | ||
| 206 | |||
| 207 | struct MEMCCR { | ||
| 208 | unsigned short reg_config_option; /* PCCOR: Configuration Option Register */ | ||
| 209 | unsigned short reg_config_and_status; /* PCCSR: Configuration and Status Register */ | ||
| 210 | unsigned short reg_pin_replacement; /* PCPRR: Pin Replacemant Register */ | ||
| 211 | unsigned short reg_socket_and_copy; /* PCSCR: Socket and Copy Register */ | ||
| 212 | unsigned short reg_ext_status; /* PCESR: Extendend Status Register */ | ||
| 213 | unsigned short reg_io_base; /* PCIOB: I/O Base Register */ | ||
| 214 | }; | ||
| 215 | |||
| 216 | struct MEMINFREG { | ||
| 217 | unsigned short memreg_tx_old; /* TX Register (R/W) */ | ||
| 218 | unsigned short pad1; | ||
| 219 | unsigned short memreg_rx_done; /* RXDone Register (R/W) */ | ||
| 220 | unsigned short pad2; | ||
| 221 | unsigned short memreg_rx; /* RX Register (R/W) */ | ||
| 222 | unsigned short pad3; | ||
| 223 | unsigned short memreg_pc_interrupt_ack; /* PC intr Ack Register (W) */ | ||
| 224 | unsigned short pad4; | ||
| 225 | unsigned long memreg_card_present;/* Mask for Host to check (R) for | ||
| 226 | * CARD_PRESENT_VALUE */ | ||
| 227 | unsigned short memreg_tx_new; /* TX2 (new) Register (R/W) */ | ||
| 228 | }; | ||
| 229 | |||
| 230 | #define IODMADPR 0x00 /* DMA Data Port Register (R/W) */ | ||
| 231 | |||
| 232 | #define CARD_PRESENT_VALUE (0xBEEFCAFEUL) | ||
| 233 | |||
| 234 | #define MEMTX_TX 0x0001 | ||
| 235 | #define MEMRX_RX 0x0001 | ||
| 236 | #define MEMRX_RX_DONE 0x0001 | ||
| 237 | #define MEMRX_PCINTACKK 0x0001 | ||
| 238 | #define MEMRX_MEMSPURIOUSINT 0x0001 | ||
| 239 | |||
| 240 | #define NL_NUM_OF_PRIORITIES 3 | ||
| 241 | #define NL_NUM_OF_PROTOCOLS 3 | ||
| 242 | #define NL_NUM_OF_ADDRESSES NO_OF_IPW_CHANNELS | ||
| 243 | |||
| 244 | struct ipw_hardware { | ||
| 245 | unsigned int base_port; | ||
| 246 | short hw_version; | ||
| 247 | unsigned short ll_mtu; | ||
| 248 | spinlock_t spinlock; | ||
| 249 | |||
| 250 | int initializing; | ||
| 251 | int init_loops; | ||
| 252 | struct timer_list setup_timer; | ||
| 253 | |||
| 254 | int tx_ready; | ||
| 255 | struct list_head tx_queue[NL_NUM_OF_PRIORITIES]; | ||
| 256 | /* True if any packets are queued for transmission */ | ||
| 257 | int tx_queued; | ||
| 258 | |||
| 259 | int rx_bytes_queued; | ||
| 260 | struct list_head rx_queue; | ||
| 261 | /* Pool of rx_packet structures that are not currently used. */ | ||
| 262 | struct list_head rx_pool; | ||
| 263 | int rx_pool_size; | ||
| 264 | /* True if reception of data is blocked while userspace processes it. */ | ||
| 265 | int blocking_rx; | ||
| 266 | /* True if there is RX data ready on the hardware. */ | ||
| 267 | int rx_ready; | ||
| 268 | unsigned short last_memtx_serial; | ||
| 269 | /* | ||
| 270 | * Newer versions of the V2 card firmware send serial numbers in the | ||
| 271 | * MemTX register. 'serial_number_detected' is set true when we detect | ||
| 272 | * a non-zero serial number (indicating the new firmware). Thereafter, | ||
| 273 | * the driver can safely ignore the Timer Recovery re-sends to avoid | ||
| 274 | * out-of-sync problems. | ||
| 275 | */ | ||
| 276 | int serial_number_detected; | ||
| 277 | struct work_struct work_rx; | ||
| 278 | |||
| 279 | /* True if we are to send the set-up data to the hardware. */ | ||
| 280 | int to_setup; | ||
| 281 | |||
| 282 | /* Card has been removed */ | ||
| 283 | int removed; | ||
| 284 | /* Saved irq value when we disable the interrupt. */ | ||
| 285 | int irq; | ||
| 286 | /* True if this driver is shutting down. */ | ||
| 287 | int shutting_down; | ||
| 288 | /* Modem control lines */ | ||
| 289 | unsigned int control_lines[NL_NUM_OF_ADDRESSES]; | ||
| 290 | struct ipw_rx_packet *packet_assembler[NL_NUM_OF_ADDRESSES]; | ||
| 291 | |||
| 292 | struct tasklet_struct tasklet; | ||
| 293 | |||
| 294 | /* The handle for the network layer, for the sending of events to it. */ | ||
| 295 | struct ipw_network *network; | ||
| 296 | struct MEMINFREG __iomem *memory_info_regs; | ||
| 297 | struct MEMCCR __iomem *memregs_CCR; | ||
| 298 | void (*reboot_callback) (void *data); | ||
| 299 | void *reboot_callback_data; | ||
| 300 | |||
| 301 | unsigned short __iomem *memreg_tx; | ||
| 302 | }; | ||
| 303 | |||
| 304 | /* | ||
| 305 | * Packet info structure for tx packets. | ||
| 306 | * Note: not all the fields defined here are required for all protocols | ||
| 307 | */ | ||
| 308 | struct ipw_tx_packet { | ||
| 309 | struct list_head queue; | ||
| 310 | /* channel idx + 1 */ | ||
| 311 | unsigned char dest_addr; | ||
| 312 | /* SETUP, CTRL or DATA */ | ||
| 313 | unsigned char protocol; | ||
| 314 | /* Length of data block, which starts at the end of this structure */ | ||
| 315 | unsigned short length; | ||
| 316 | /* Sending state */ | ||
| 317 | /* Offset of where we've sent up to so far */ | ||
| 318 | unsigned long offset; | ||
| 319 | /* Count of packet fragments, starting at 0 */ | ||
| 320 | int fragment_count; | ||
| 321 | |||
| 322 | /* Called after packet is sent and before is freed */ | ||
| 323 | void (*packet_callback) (void *cb_data, unsigned int packet_length); | ||
| 324 | void *callback_data; | ||
| 325 | }; | ||
| 326 | |||
| 327 | /* Signals from DTE */ | ||
| 328 | #define COMCTRL_RTS 0 | ||
| 329 | #define COMCTRL_DTR 1 | ||
| 330 | |||
| 331 | /* Signals from DCE */ | ||
| 332 | #define COMCTRL_CTS 2 | ||
| 333 | #define COMCTRL_DCD 3 | ||
| 334 | #define COMCTRL_DSR 4 | ||
| 335 | #define COMCTRL_RI 5 | ||
| 336 | |||
| 337 | struct ipw_control_packet_body { | ||
| 338 | /* DTE signal or DCE signal */ | ||
| 339 | unsigned char sig_no; | ||
| 340 | /* 0: set signal, 1: clear signal */ | ||
| 341 | unsigned char value; | ||
| 342 | } __attribute__ ((__packed__)); | ||
| 343 | |||
| 344 | struct ipw_control_packet { | ||
| 345 | struct ipw_tx_packet header; | ||
| 346 | struct ipw_control_packet_body body; | ||
| 347 | }; | ||
| 348 | |||
| 349 | struct ipw_rx_packet { | ||
| 350 | struct list_head queue; | ||
| 351 | unsigned int capacity; | ||
| 352 | unsigned int length; | ||
| 353 | unsigned int protocol; | ||
| 354 | unsigned int channel_idx; | ||
| 355 | }; | ||
| 356 | |||
| 357 | #ifdef IPWIRELESS_STATE_DEBUG | ||
| 358 | int ipwireless_dump_hardware_state(char *p, size_t limit, | ||
| 359 | struct ipw_hardware *hw) | ||
| 360 | { | ||
| 361 | return snprintf(p, limit, | ||
| 362 | "debug: initializing=%d\n" | ||
| 363 | "debug: tx_ready=%d\n" | ||
| 364 | "debug: tx_queued=%d\n" | ||
| 365 | "debug: rx_ready=%d\n" | ||
| 366 | "debug: rx_bytes_queued=%d\n" | ||
| 367 | "debug: blocking_rx=%d\n" | ||
| 368 | "debug: removed=%d\n" | ||
| 369 | "debug: hardware.shutting_down=%d\n" | ||
| 370 | "debug: to_setup=%d\n", | ||
| 371 | hw->initializing, | ||
| 372 | hw->tx_ready, | ||
| 373 | hw->tx_queued, | ||
| 374 | hw->rx_ready, | ||
| 375 | hw->rx_bytes_queued, | ||
| 376 | hw->blocking_rx, | ||
| 377 | hw->removed, | ||
| 378 | hw->shutting_down, | ||
| 379 | hw->to_setup); | ||
| 380 | } | ||
| 381 | #endif | ||
| 382 | |||
| 383 | static char *data_type(const unsigned char *buf, unsigned length) | ||
| 384 | { | ||
| 385 | struct nl_packet_header *hdr = (struct nl_packet_header *) buf; | ||
| 386 | |||
| 387 | if (length == 0) | ||
| 388 | return " "; | ||
| 389 | |||
| 390 | if (hdr->packet_rank & NL_FIRST_PACKET) { | ||
| 391 | switch (hdr->protocol) { | ||
| 392 | case TL_PROTOCOLID_COM_DATA: return "DATA "; | ||
| 393 | case TL_PROTOCOLID_COM_CTRL: return "CTRL "; | ||
| 394 | case TL_PROTOCOLID_SETUP: return "SETUP"; | ||
| 395 | default: return "???? "; | ||
| 396 | } | ||
| 397 | } else | ||
| 398 | return " "; | ||
| 399 | } | ||
| 400 | |||
| 401 | #define DUMP_MAX_BYTES 64 | ||
| 402 | |||
| 403 | static void dump_data_bytes(const char *type, const unsigned char *data, | ||
| 404 | unsigned length) | ||
| 405 | { | ||
| 406 | char prefix[56]; | ||
| 407 | |||
| 408 | sprintf(prefix, IPWIRELESS_PCCARD_NAME ": %s %s ", | ||
| 409 | type, data_type(data, length)); | ||
| 410 | print_hex_dump_bytes(prefix, 0, (void *)data, | ||
| 411 | length < DUMP_MAX_BYTES ? length : DUMP_MAX_BYTES); | ||
| 412 | } | ||
| 413 | |||
| 414 | static int do_send_fragment(struct ipw_hardware *hw, const unsigned char *data, | ||
| 415 | unsigned length) | ||
| 416 | { | ||
| 417 | int i; | ||
| 418 | unsigned long flags; | ||
| 419 | |||
| 420 | start_timing(); | ||
| 421 | |||
| 422 | if (length == 0) | ||
| 423 | return 0; | ||
| 424 | |||
| 425 | if (length > hw->ll_mtu) | ||
| 426 | return -1; | ||
| 427 | |||
| 428 | if (ipwireless_debug) | ||
| 429 | dump_data_bytes("send", data, length); | ||
| 430 | |||
| 431 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 432 | |||
| 433 | if (hw->hw_version == HW_VERSION_1) { | ||
| 434 | outw((unsigned short) length, hw->base_port + IODWR); | ||
| 435 | |||
| 436 | for (i = 0; i < length; i += 2) { | ||
| 437 | unsigned short d = data[i]; | ||
| 438 | __le16 raw_data; | ||
| 439 | |||
| 440 | if (likely(i + 1 < length)) | ||
| 441 | d |= data[i + 1] << 8; | ||
| 442 | raw_data = cpu_to_le16(d); | ||
| 443 | outw(raw_data, hw->base_port + IODWR); | ||
| 444 | } | ||
| 445 | |||
| 446 | outw(DCR_TXDONE, hw->base_port + IODCR); | ||
| 447 | } else if (hw->hw_version == HW_VERSION_2) { | ||
| 448 | outw((unsigned short) length, hw->base_port + IODMADPR); | ||
| 449 | |||
| 450 | for (i = 0; i < length; i += 2) { | ||
| 451 | unsigned short d = data[i]; | ||
| 452 | __le16 raw_data; | ||
| 453 | |||
| 454 | if ((i + 1 < length)) | ||
| 455 | d |= data[i + 1] << 8; | ||
| 456 | raw_data = cpu_to_le16(d); | ||
| 457 | outw(raw_data, hw->base_port + IODMADPR); | ||
| 458 | } | ||
| 459 | while ((i & 3) != 2) { | ||
| 460 | outw((unsigned short) 0xDEAD, hw->base_port + IODMADPR); | ||
| 461 | i += 2; | ||
| 462 | } | ||
| 463 | writew(MEMRX_RX, &hw->memory_info_regs->memreg_rx); | ||
| 464 | } | ||
| 465 | |||
| 466 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 467 | |||
| 468 | end_write_timing(length); | ||
| 469 | |||
| 470 | return 0; | ||
| 471 | } | ||
| 472 | |||
| 473 | static int do_send_packet(struct ipw_hardware *hw, struct ipw_tx_packet *packet) | ||
| 474 | { | ||
| 475 | unsigned short fragment_data_len; | ||
| 476 | unsigned short data_left = packet->length - packet->offset; | ||
| 477 | unsigned short header_size; | ||
| 478 | union nl_packet pkt; | ||
| 479 | |||
| 480 | header_size = | ||
| 481 | (packet->fragment_count == 0) | ||
| 482 | ? NL_FIRST_PACKET_HEADER_SIZE | ||
| 483 | : NL_FOLLOWING_PACKET_HEADER_SIZE; | ||
| 484 | fragment_data_len = hw->ll_mtu - header_size; | ||
| 485 | if (data_left < fragment_data_len) | ||
| 486 | fragment_data_len = data_left; | ||
| 487 | |||
| 488 | pkt.hdr_first.protocol = packet->protocol; | ||
| 489 | pkt.hdr_first.address = packet->dest_addr; | ||
| 490 | pkt.hdr_first.packet_rank = 0; | ||
| 491 | |||
| 492 | /* First packet? */ | ||
| 493 | if (packet->fragment_count == 0) { | ||
| 494 | pkt.hdr_first.packet_rank |= NL_FIRST_PACKET; | ||
| 495 | pkt.hdr_first.length_lsb = (unsigned char) packet->length; | ||
| 496 | pkt.hdr_first.length_msb = | ||
| 497 | (unsigned char) (packet->length >> 8); | ||
| 498 | } | ||
| 499 | |||
| 500 | memcpy(pkt.rawpkt + header_size, | ||
| 501 | ((unsigned char *) packet) + sizeof(struct ipw_tx_packet) + | ||
| 502 | packet->offset, fragment_data_len); | ||
| 503 | packet->offset += fragment_data_len; | ||
| 504 | packet->fragment_count++; | ||
| 505 | |||
| 506 | /* Last packet? (May also be first packet.) */ | ||
| 507 | if (packet->offset == packet->length) | ||
| 508 | pkt.hdr_first.packet_rank |= NL_LAST_PACKET; | ||
| 509 | do_send_fragment(hw, pkt.rawpkt, header_size + fragment_data_len); | ||
| 510 | |||
| 511 | /* If this packet has unsent data, then re-queue it. */ | ||
| 512 | if (packet->offset < packet->length) { | ||
| 513 | /* | ||
| 514 | * Re-queue it at the head of the highest priority queue so | ||
| 515 | * it goes before all other packets | ||
| 516 | */ | ||
| 517 | unsigned long flags; | ||
| 518 | |||
| 519 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 520 | list_add(&packet->queue, &hw->tx_queue[0]); | ||
| 521 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 522 | } else { | ||
| 523 | if (packet->packet_callback) | ||
| 524 | packet->packet_callback(packet->callback_data, | ||
| 525 | packet->length); | ||
| 526 | kfree(packet); | ||
| 527 | } | ||
| 528 | |||
| 529 | return 0; | ||
| 530 | } | ||
| 531 | |||
| 532 | static void ipw_setup_hardware(struct ipw_hardware *hw) | ||
| 533 | { | ||
| 534 | unsigned long flags; | ||
| 535 | |||
| 536 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 537 | if (hw->hw_version == HW_VERSION_1) { | ||
| 538 | /* Reset RX FIFO */ | ||
| 539 | outw(DCR_RXRESET, hw->base_port + IODCR); | ||
| 540 | /* SB: Reset TX FIFO */ | ||
| 541 | outw(DCR_TXRESET, hw->base_port + IODCR); | ||
| 542 | |||
| 543 | /* Enable TX and RX interrupts. */ | ||
| 544 | outw(IER_TXENABLED | IER_RXENABLED, hw->base_port + IOIER); | ||
| 545 | } else { | ||
| 546 | /* | ||
| 547 | * Set INTRACK bit (bit 0), which means we must explicitly | ||
| 548 | * acknowledge interrupts by clearing bit 2 of reg_config_and_status. | ||
| 549 | */ | ||
| 550 | unsigned short csr = readw(&hw->memregs_CCR->reg_config_and_status); | ||
| 551 | |||
| 552 | csr |= 1; | ||
| 553 | writew(csr, &hw->memregs_CCR->reg_config_and_status); | ||
| 554 | } | ||
| 555 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 556 | } | ||
| 557 | |||
| 558 | /* | ||
| 559 | * If 'packet' is NULL, then this function allocates a new packet, setting its | ||
| 560 | * length to 0 and ensuring it has the specified minimum amount of free space. | ||
| 561 | * | ||
| 562 | * If 'packet' is not NULL, then this function enlarges it if it doesn't | ||
| 563 | * have the specified minimum amount of free space. | ||
| 564 | * | ||
| 565 | */ | ||
| 566 | static struct ipw_rx_packet *pool_allocate(struct ipw_hardware *hw, | ||
| 567 | struct ipw_rx_packet *packet, | ||
| 568 | int minimum_free_space) | ||
| 569 | { | ||
| 570 | |||
| 571 | if (!packet) { | ||
| 572 | unsigned long flags; | ||
| 573 | |||
| 574 | /* | ||
| 575 | * If this is the first fragment, then we will need to fetch a | ||
| 576 | * packet to put it in. | ||
| 577 | */ | ||
| 578 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 579 | /* If we have one in our pool, then pull it out. */ | ||
| 580 | if (!list_empty(&hw->rx_pool)) { | ||
| 581 | packet = list_first_entry(&hw->rx_pool, | ||
| 582 | struct ipw_rx_packet, queue); | ||
| 583 | list_del(&packet->queue); | ||
| 584 | hw->rx_pool_size--; | ||
| 585 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 586 | } else { | ||
| 587 | /* Otherwise allocate a new one. */ | ||
| 588 | static int min_capacity = 256; | ||
| 589 | int new_capacity; | ||
| 590 | |||
| 591 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 592 | new_capacity = | ||
| 593 | minimum_free_space > min_capacity | ||
| 594 | ? minimum_free_space | ||
| 595 | : min_capacity; | ||
| 596 | packet = kmalloc(sizeof(struct ipw_rx_packet) | ||
| 597 | + new_capacity, GFP_ATOMIC); | ||
| 598 | if (!packet) | ||
| 599 | return NULL; | ||
| 600 | packet->capacity = new_capacity; | ||
| 601 | } | ||
| 602 | packet->length = 0; | ||
| 603 | } | ||
| 604 | |||
| 605 | /* | ||
| 606 | * If this packet does not have sufficient capacity for the data we | ||
| 607 | * want to add, then make it bigger. | ||
| 608 | */ | ||
| 609 | if (packet->length + minimum_free_space > packet->capacity) { | ||
| 610 | struct ipw_rx_packet *old_packet = packet; | ||
| 611 | |||
| 612 | packet = kmalloc(sizeof(struct ipw_rx_packet) + | ||
| 613 | old_packet->length + minimum_free_space, | ||
| 614 | GFP_ATOMIC); | ||
| 615 | if (!packet) | ||
| 616 | return NULL; | ||
| 617 | memcpy(packet, old_packet, | ||
| 618 | sizeof(struct ipw_rx_packet) | ||
| 619 | + old_packet->length); | ||
| 620 | packet->capacity = old_packet->length + minimum_free_space; | ||
| 621 | kfree(old_packet); | ||
| 622 | } | ||
| 623 | |||
| 624 | return packet; | ||
| 625 | } | ||
| 626 | |||
| 627 | static void pool_free(struct ipw_hardware *hw, struct ipw_rx_packet *packet) | ||
| 628 | { | ||
| 629 | if (hw->rx_pool_size > 6) | ||
| 630 | kfree(packet); | ||
| 631 | else { | ||
| 632 | hw->rx_pool_size++; | ||
| 633 | list_add_tail(&packet->queue, &hw->rx_pool); | ||
| 634 | } | ||
| 635 | } | ||
| 636 | |||
| 637 | static void queue_received_packet(struct ipw_hardware *hw, | ||
| 638 | unsigned int protocol, unsigned int address, | ||
| 639 | unsigned char *data, int length, int is_last) | ||
| 640 | { | ||
| 641 | unsigned int channel_idx = address - 1; | ||
| 642 | struct ipw_rx_packet *packet = NULL; | ||
| 643 | unsigned long flags; | ||
| 644 | |||
| 645 | /* Discard packet if channel index is out of range. */ | ||
| 646 | if (channel_idx >= NL_NUM_OF_ADDRESSES) { | ||
| 647 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 648 | ": data packet has bad address %u\n", address); | ||
| 649 | return; | ||
| 650 | } | ||
| 651 | |||
| 652 | /* | ||
| 653 | * ->packet_assembler is safe to touch unlocked, this is the only place | ||
| 654 | */ | ||
| 655 | if (protocol == TL_PROTOCOLID_COM_DATA) { | ||
| 656 | struct ipw_rx_packet **assem = | ||
| 657 | &hw->packet_assembler[channel_idx]; | ||
| 658 | |||
| 659 | /* | ||
| 660 | * Create a new packet, or assembler already contains one | ||
| 661 | * enlarge it by 'length' bytes. | ||
| 662 | */ | ||
| 663 | (*assem) = pool_allocate(hw, *assem, length); | ||
| 664 | if (!(*assem)) { | ||
| 665 | printk(KERN_ERR IPWIRELESS_PCCARD_NAME | ||
| 666 | ": no memory for incomming data packet, dropped!\n"); | ||
| 667 | return; | ||
| 668 | } | ||
| 669 | (*assem)->protocol = protocol; | ||
| 670 | (*assem)->channel_idx = channel_idx; | ||
| 671 | |||
| 672 | /* Append this packet data onto existing data. */ | ||
| 673 | memcpy((unsigned char *)(*assem) + | ||
| 674 | sizeof(struct ipw_rx_packet) | ||
| 675 | + (*assem)->length, data, length); | ||
| 676 | (*assem)->length += length; | ||
| 677 | if (is_last) { | ||
| 678 | packet = *assem; | ||
| 679 | *assem = NULL; | ||
| 680 | /* Count queued DATA bytes only */ | ||
| 681 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 682 | hw->rx_bytes_queued += packet->length; | ||
| 683 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 684 | } | ||
| 685 | } else { | ||
| 686 | /* If it's a CTRL packet, don't assemble, just queue it. */ | ||
| 687 | packet = pool_allocate(hw, NULL, length); | ||
| 688 | if (!packet) { | ||
| 689 | printk(KERN_ERR IPWIRELESS_PCCARD_NAME | ||
| 690 | ": no memory for incomming ctrl packet, dropped!\n"); | ||
| 691 | return; | ||
| 692 | } | ||
| 693 | packet->protocol = protocol; | ||
| 694 | packet->channel_idx = channel_idx; | ||
| 695 | memcpy((unsigned char *)packet + sizeof(struct ipw_rx_packet), | ||
| 696 | data, length); | ||
| 697 | packet->length = length; | ||
| 698 | } | ||
| 699 | |||
| 700 | /* | ||
| 701 | * If this is the last packet, then send the assembled packet on to the | ||
| 702 | * network layer. | ||
| 703 | */ | ||
| 704 | if (packet) { | ||
| 705 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 706 | list_add_tail(&packet->queue, &hw->rx_queue); | ||
| 707 | /* Block reception of incoming packets if queue is full. */ | ||
| 708 | hw->blocking_rx = | ||
| 709 | hw->rx_bytes_queued >= IPWIRELESS_RX_QUEUE_SIZE; | ||
| 710 | |||
| 711 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 712 | schedule_work(&hw->work_rx); | ||
| 713 | } | ||
| 714 | } | ||
| 715 | |||
| 716 | /* | ||
| 717 | * Workqueue callback | ||
| 718 | */ | ||
| 719 | static void ipw_receive_data_work(struct work_struct *work_rx) | ||
| 720 | { | ||
| 721 | struct ipw_hardware *hw = | ||
| 722 | container_of(work_rx, struct ipw_hardware, work_rx); | ||
| 723 | unsigned long flags; | ||
| 724 | |||
| 725 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 726 | while (!list_empty(&hw->rx_queue)) { | ||
| 727 | struct ipw_rx_packet *packet = | ||
| 728 | list_first_entry(&hw->rx_queue, | ||
| 729 | struct ipw_rx_packet, queue); | ||
| 730 | |||
| 731 | if (hw->shutting_down) | ||
| 732 | break; | ||
| 733 | list_del(&packet->queue); | ||
| 734 | |||
| 735 | /* | ||
| 736 | * Note: ipwireless_network_packet_received must be called in a | ||
| 737 | * process context (i.e. via schedule_work) because the tty | ||
| 738 | * output code can sleep in the tty_flip_buffer_push call. | ||
| 739 | */ | ||
| 740 | if (packet->protocol == TL_PROTOCOLID_COM_DATA) { | ||
| 741 | if (hw->network != NULL) { | ||
| 742 | /* If the network hasn't been disconnected. */ | ||
| 743 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 744 | /* | ||
| 745 | * This must run unlocked due to tty processing | ||
| 746 | * and mutex locking | ||
| 747 | */ | ||
| 748 | ipwireless_network_packet_received( | ||
| 749 | hw->network, | ||
| 750 | packet->channel_idx, | ||
| 751 | (unsigned char *)packet | ||
| 752 | + sizeof(struct ipw_rx_packet), | ||
| 753 | packet->length); | ||
| 754 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 755 | } | ||
| 756 | /* Count queued DATA bytes only */ | ||
| 757 | hw->rx_bytes_queued -= packet->length; | ||
| 758 | } else { | ||
| 759 | /* | ||
| 760 | * This is safe to be called locked, callchain does | ||
| 761 | * not block | ||
| 762 | */ | ||
| 763 | handle_received_CTRL_packet(hw, packet->channel_idx, | ||
| 764 | (unsigned char *)packet | ||
| 765 | + sizeof(struct ipw_rx_packet), | ||
| 766 | packet->length); | ||
| 767 | } | ||
| 768 | pool_free(hw, packet); | ||
| 769 | /* | ||
| 770 | * Unblock reception of incoming packets if queue is no longer | ||
| 771 | * full. | ||
| 772 | */ | ||
| 773 | hw->blocking_rx = | ||
| 774 | hw->rx_bytes_queued >= IPWIRELESS_RX_QUEUE_SIZE; | ||
| 775 | if (hw->shutting_down) | ||
| 776 | break; | ||
| 777 | } | ||
| 778 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 779 | } | ||
| 780 | |||
| 781 | static void handle_received_CTRL_packet(struct ipw_hardware *hw, | ||
| 782 | unsigned int channel_idx, | ||
| 783 | unsigned char *data, int len) | ||
| 784 | { | ||
| 785 | struct ipw_control_packet_body *body = | ||
| 786 | (struct ipw_control_packet_body *) data; | ||
| 787 | unsigned int changed_mask; | ||
| 788 | |||
| 789 | if (len != sizeof(struct ipw_control_packet_body)) { | ||
| 790 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 791 | ": control packet was %d bytes - wrong size!\n", | ||
| 792 | len); | ||
| 793 | return; | ||
| 794 | } | ||
| 795 | |||
| 796 | switch (body->sig_no) { | ||
| 797 | case COMCTRL_CTS: | ||
| 798 | changed_mask = IPW_CONTROL_LINE_CTS; | ||
| 799 | break; | ||
| 800 | case COMCTRL_DCD: | ||
| 801 | changed_mask = IPW_CONTROL_LINE_DCD; | ||
| 802 | break; | ||
| 803 | case COMCTRL_DSR: | ||
| 804 | changed_mask = IPW_CONTROL_LINE_DSR; | ||
| 805 | break; | ||
| 806 | case COMCTRL_RI: | ||
| 807 | changed_mask = IPW_CONTROL_LINE_RI; | ||
| 808 | break; | ||
| 809 | default: | ||
| 810 | changed_mask = 0; | ||
| 811 | } | ||
| 812 | |||
| 813 | if (changed_mask != 0) { | ||
| 814 | if (body->value) | ||
| 815 | hw->control_lines[channel_idx] |= changed_mask; | ||
| 816 | else | ||
| 817 | hw->control_lines[channel_idx] &= ~changed_mask; | ||
| 818 | if (hw->network) | ||
| 819 | ipwireless_network_notify_control_line_change( | ||
| 820 | hw->network, | ||
| 821 | channel_idx, | ||
| 822 | hw->control_lines[channel_idx], | ||
| 823 | changed_mask); | ||
| 824 | } | ||
| 825 | } | ||
| 826 | |||
| 827 | static void handle_received_packet(struct ipw_hardware *hw, | ||
| 828 | union nl_packet *packet, | ||
| 829 | unsigned short len) | ||
| 830 | { | ||
| 831 | unsigned int protocol = packet->hdr.protocol; | ||
| 832 | unsigned int address = packet->hdr.address; | ||
| 833 | unsigned int header_length; | ||
| 834 | unsigned char *data; | ||
| 835 | unsigned int data_len; | ||
| 836 | int is_last = packet->hdr.packet_rank & NL_LAST_PACKET; | ||
| 837 | |||
| 838 | if (packet->hdr.packet_rank & NL_FIRST_PACKET) | ||
| 839 | header_length = NL_FIRST_PACKET_HEADER_SIZE; | ||
| 840 | else | ||
| 841 | header_length = NL_FOLLOWING_PACKET_HEADER_SIZE; | ||
| 842 | |||
| 843 | data = packet->rawpkt + header_length; | ||
| 844 | data_len = len - header_length; | ||
| 845 | switch (protocol) { | ||
| 846 | case TL_PROTOCOLID_COM_DATA: | ||
| 847 | case TL_PROTOCOLID_COM_CTRL: | ||
| 848 | queue_received_packet(hw, protocol, address, data, data_len, | ||
| 849 | is_last); | ||
| 850 | break; | ||
| 851 | case TL_PROTOCOLID_SETUP: | ||
| 852 | handle_received_SETUP_packet(hw, address, data, data_len, | ||
| 853 | is_last); | ||
| 854 | break; | ||
| 855 | } | ||
| 856 | } | ||
| 857 | |||
| 858 | static void acknowledge_data_read(struct ipw_hardware *hw) | ||
| 859 | { | ||
| 860 | if (hw->hw_version == HW_VERSION_1) | ||
| 861 | outw(DCR_RXDONE, hw->base_port + IODCR); | ||
| 862 | else | ||
| 863 | writew(MEMRX_PCINTACKK, | ||
| 864 | &hw->memory_info_regs->memreg_pc_interrupt_ack); | ||
| 865 | } | ||
| 866 | |||
| 867 | /* | ||
| 868 | * Retrieve a packet from the IPW hardware. | ||
| 869 | */ | ||
| 870 | static void do_receive_packet(struct ipw_hardware *hw) | ||
| 871 | { | ||
| 872 | unsigned len; | ||
| 873 | unsigned int i; | ||
| 874 | unsigned char pkt[LL_MTU_MAX]; | ||
| 875 | |||
| 876 | start_timing(); | ||
| 877 | |||
| 878 | if (hw->hw_version == HW_VERSION_1) { | ||
| 879 | len = inw(hw->base_port + IODRR); | ||
| 880 | if (len > hw->ll_mtu) { | ||
| 881 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 882 | ": received a packet of %u bytes - " | ||
| 883 | "longer than the MTU!\n", len); | ||
| 884 | outw(DCR_RXDONE | DCR_RXRESET, hw->base_port + IODCR); | ||
| 885 | return; | ||
| 886 | } | ||
| 887 | |||
| 888 | for (i = 0; i < len; i += 2) { | ||
| 889 | __le16 raw_data = inw(hw->base_port + IODRR); | ||
| 890 | unsigned short data = le16_to_cpu(raw_data); | ||
| 891 | |||
| 892 | pkt[i] = (unsigned char) data; | ||
| 893 | pkt[i + 1] = (unsigned char) (data >> 8); | ||
| 894 | } | ||
| 895 | } else { | ||
| 896 | len = inw(hw->base_port + IODMADPR); | ||
| 897 | if (len > hw->ll_mtu) { | ||
| 898 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 899 | ": received a packet of %u bytes - " | ||
| 900 | "longer than the MTU!\n", len); | ||
| 901 | writew(MEMRX_PCINTACKK, | ||
| 902 | &hw->memory_info_regs->memreg_pc_interrupt_ack); | ||
| 903 | return; | ||
| 904 | } | ||
| 905 | |||
| 906 | for (i = 0; i < len; i += 2) { | ||
| 907 | __le16 raw_data = inw(hw->base_port + IODMADPR); | ||
| 908 | unsigned short data = le16_to_cpu(raw_data); | ||
| 909 | |||
| 910 | pkt[i] = (unsigned char) data; | ||
| 911 | pkt[i + 1] = (unsigned char) (data >> 8); | ||
| 912 | } | ||
| 913 | |||
| 914 | while ((i & 3) != 2) { | ||
| 915 | inw(hw->base_port + IODMADPR); | ||
| 916 | i += 2; | ||
| 917 | } | ||
| 918 | } | ||
| 919 | |||
| 920 | acknowledge_data_read(hw); | ||
| 921 | |||
| 922 | if (ipwireless_debug) | ||
| 923 | dump_data_bytes("recv", pkt, len); | ||
| 924 | |||
| 925 | handle_received_packet(hw, (union nl_packet *) pkt, len); | ||
| 926 | |||
| 927 | end_read_timing(len); | ||
| 928 | } | ||
| 929 | |||
| 930 | static int get_current_packet_priority(struct ipw_hardware *hw) | ||
| 931 | { | ||
| 932 | /* | ||
| 933 | * If we're initializing, don't send anything of higher priority than | ||
| 934 | * PRIO_SETUP. The network layer therefore need not care about | ||
| 935 | * hardware initialization - any of its stuff will simply be queued | ||
| 936 | * until setup is complete. | ||
| 937 | */ | ||
| 938 | return (hw->to_setup || hw->initializing | ||
| 939 | ? PRIO_SETUP + 1 : | ||
| 940 | NL_NUM_OF_PRIORITIES); | ||
| 941 | } | ||
| 942 | |||
| 943 | /* | ||
| 944 | * return 1 if something has been received from hw | ||
| 945 | */ | ||
| 946 | static int get_packets_from_hw(struct ipw_hardware *hw) | ||
| 947 | { | ||
| 948 | int received = 0; | ||
| 949 | unsigned long flags; | ||
| 950 | |||
| 951 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 952 | while (hw->rx_ready && !hw->blocking_rx) { | ||
| 953 | received = 1; | ||
| 954 | hw->rx_ready--; | ||
| 955 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 956 | |||
| 957 | do_receive_packet(hw); | ||
| 958 | |||
| 959 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 960 | } | ||
| 961 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 962 | |||
| 963 | return received; | ||
| 964 | } | ||
| 965 | |||
| 966 | /* | ||
| 967 | * Send pending packet up to given priority, prioritize SETUP data until | ||
| 968 | * hardware is fully setup. | ||
| 969 | * | ||
| 970 | * return 1 if more packets can be sent | ||
| 971 | */ | ||
| 972 | static int send_pending_packet(struct ipw_hardware *hw, int priority_limit) | ||
| 973 | { | ||
| 974 | int more_to_send = 0; | ||
| 975 | unsigned long flags; | ||
| 976 | |||
| 977 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 978 | if (hw->tx_queued && hw->tx_ready != 0) { | ||
| 979 | int priority; | ||
| 980 | struct ipw_tx_packet *packet = NULL; | ||
| 981 | |||
| 982 | hw->tx_ready--; | ||
| 983 | |||
| 984 | /* Pick a packet */ | ||
| 985 | for (priority = 0; priority < priority_limit; priority++) { | ||
| 986 | if (!list_empty(&hw->tx_queue[priority])) { | ||
| 987 | packet = list_first_entry( | ||
| 988 | &hw->tx_queue[priority], | ||
| 989 | struct ipw_tx_packet, | ||
| 990 | queue); | ||
| 991 | |||
| 992 | list_del(&packet->queue); | ||
| 993 | |||
| 994 | break; | ||
| 995 | } | ||
| 996 | } | ||
| 997 | if (!packet) { | ||
| 998 | hw->tx_queued = 0; | ||
| 999 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1000 | return 0; | ||
| 1001 | } | ||
| 1002 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1003 | |||
| 1004 | /* Send */ | ||
| 1005 | do_send_packet(hw, packet); | ||
| 1006 | |||
| 1007 | /* Check if more to send */ | ||
| 1008 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 1009 | for (priority = 0; priority < priority_limit; priority++) | ||
| 1010 | if (!list_empty(&hw->tx_queue[priority])) { | ||
| 1011 | more_to_send = 1; | ||
| 1012 | break; | ||
| 1013 | } | ||
| 1014 | |||
| 1015 | if (!more_to_send) | ||
| 1016 | hw->tx_queued = 0; | ||
| 1017 | } | ||
| 1018 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1019 | |||
| 1020 | return more_to_send; | ||
| 1021 | } | ||
| 1022 | |||
| 1023 | /* | ||
| 1024 | * Send and receive all queued packets. | ||
| 1025 | */ | ||
| 1026 | static void ipwireless_do_tasklet(unsigned long hw_) | ||
| 1027 | { | ||
| 1028 | struct ipw_hardware *hw = (struct ipw_hardware *) hw_; | ||
| 1029 | unsigned long flags; | ||
| 1030 | |||
| 1031 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 1032 | if (hw->shutting_down) { | ||
| 1033 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1034 | return; | ||
| 1035 | } | ||
| 1036 | |||
| 1037 | if (hw->to_setup == 1) { | ||
| 1038 | /* | ||
| 1039 | * Initial setup data sent to hardware | ||
| 1040 | */ | ||
| 1041 | hw->to_setup = 2; | ||
| 1042 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1043 | |||
| 1044 | ipw_setup_hardware(hw); | ||
| 1045 | ipw_send_setup_packet(hw); | ||
| 1046 | |||
| 1047 | send_pending_packet(hw, PRIO_SETUP + 1); | ||
| 1048 | get_packets_from_hw(hw); | ||
| 1049 | } else { | ||
| 1050 | int priority_limit = get_current_packet_priority(hw); | ||
| 1051 | int again; | ||
| 1052 | |||
| 1053 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1054 | |||
| 1055 | do { | ||
| 1056 | again = send_pending_packet(hw, priority_limit); | ||
| 1057 | again |= get_packets_from_hw(hw); | ||
| 1058 | } while (again); | ||
| 1059 | } | ||
| 1060 | } | ||
| 1061 | |||
| 1062 | /* | ||
| 1063 | * return true if the card is physically present. | ||
| 1064 | */ | ||
| 1065 | static int is_card_present(struct ipw_hardware *hw) | ||
| 1066 | { | ||
| 1067 | if (hw->hw_version == HW_VERSION_1) | ||
| 1068 | return inw(hw->base_port + IOIR) != 0xFFFF; | ||
| 1069 | else | ||
| 1070 | return readl(&hw->memory_info_regs->memreg_card_present) == | ||
| 1071 | CARD_PRESENT_VALUE; | ||
| 1072 | } | ||
| 1073 | |||
| 1074 | static irqreturn_t ipwireless_handle_v1_interrupt(int irq, | ||
| 1075 | struct ipw_hardware *hw) | ||
| 1076 | { | ||
| 1077 | unsigned short irqn; | ||
| 1078 | |||
| 1079 | irqn = inw(hw->base_port + IOIR); | ||
| 1080 | |||
| 1081 | /* Check if card is present */ | ||
| 1082 | if (irqn == 0xFFFF) | ||
| 1083 | return IRQ_NONE; | ||
| 1084 | else if (irqn != 0) { | ||
| 1085 | unsigned short ack = 0; | ||
| 1086 | unsigned long flags; | ||
| 1087 | |||
| 1088 | /* Transmit complete. */ | ||
| 1089 | if (irqn & IR_TXINTR) { | ||
| 1090 | ack |= IR_TXINTR; | ||
| 1091 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 1092 | hw->tx_ready++; | ||
| 1093 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1094 | } | ||
| 1095 | /* Received data */ | ||
| 1096 | if (irqn & IR_RXINTR) { | ||
| 1097 | ack |= IR_RXINTR; | ||
| 1098 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 1099 | hw->rx_ready++; | ||
| 1100 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1101 | } | ||
| 1102 | if (ack != 0) { | ||
| 1103 | outw(ack, hw->base_port + IOIR); | ||
| 1104 | tasklet_schedule(&hw->tasklet); | ||
| 1105 | } | ||
| 1106 | return IRQ_HANDLED; | ||
| 1107 | } | ||
| 1108 | return IRQ_NONE; | ||
| 1109 | } | ||
| 1110 | |||
| 1111 | static void acknowledge_pcmcia_interrupt(struct ipw_hardware *hw) | ||
| 1112 | { | ||
| 1113 | unsigned short csr = readw(&hw->memregs_CCR->reg_config_and_status); | ||
| 1114 | |||
| 1115 | csr &= 0xfffd; | ||
| 1116 | writew(csr, &hw->memregs_CCR->reg_config_and_status); | ||
| 1117 | } | ||
| 1118 | |||
| 1119 | static irqreturn_t ipwireless_handle_v2_v3_interrupt(int irq, | ||
| 1120 | struct ipw_hardware *hw) | ||
| 1121 | { | ||
| 1122 | int tx = 0; | ||
| 1123 | int rx = 0; | ||
| 1124 | int rx_repeat = 0; | ||
| 1125 | int try_mem_tx_old; | ||
| 1126 | unsigned long flags; | ||
| 1127 | |||
| 1128 | do { | ||
| 1129 | |||
| 1130 | unsigned short memtx = readw(hw->memreg_tx); | ||
| 1131 | unsigned short memtx_serial; | ||
| 1132 | unsigned short memrxdone = | ||
| 1133 | readw(&hw->memory_info_regs->memreg_rx_done); | ||
| 1134 | |||
| 1135 | try_mem_tx_old = 0; | ||
| 1136 | |||
| 1137 | /* check whether the interrupt was generated by ipwireless card */ | ||
| 1138 | if (!(memtx & MEMTX_TX) && !(memrxdone & MEMRX_RX_DONE)) { | ||
| 1139 | |||
| 1140 | /* check if the card uses memreg_tx_old register */ | ||
| 1141 | if (hw->memreg_tx == &hw->memory_info_regs->memreg_tx_new) { | ||
| 1142 | memtx = readw(&hw->memory_info_regs->memreg_tx_old); | ||
| 1143 | if (memtx & MEMTX_TX) { | ||
| 1144 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 1145 | ": Using memreg_tx_old\n"); | ||
| 1146 | hw->memreg_tx = | ||
| 1147 | &hw->memory_info_regs->memreg_tx_old; | ||
| 1148 | } else { | ||
| 1149 | return IRQ_NONE; | ||
| 1150 | } | ||
| 1151 | } else { | ||
| 1152 | return IRQ_NONE; | ||
| 1153 | } | ||
| 1154 | } | ||
| 1155 | |||
| 1156 | /* | ||
| 1157 | * See if the card is physically present. Note that while it is | ||
| 1158 | * powering up, it appears not to be present. | ||
| 1159 | */ | ||
| 1160 | if (!is_card_present(hw)) { | ||
| 1161 | acknowledge_pcmcia_interrupt(hw); | ||
| 1162 | return IRQ_HANDLED; | ||
| 1163 | } | ||
| 1164 | |||
| 1165 | memtx_serial = memtx & (unsigned short) 0xff00; | ||
| 1166 | if (memtx & MEMTX_TX) { | ||
| 1167 | writew(memtx_serial, hw->memreg_tx); | ||
| 1168 | |||
| 1169 | if (hw->serial_number_detected) { | ||
| 1170 | if (memtx_serial != hw->last_memtx_serial) { | ||
| 1171 | hw->last_memtx_serial = memtx_serial; | ||
| 1172 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 1173 | hw->rx_ready++; | ||
| 1174 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1175 | rx = 1; | ||
| 1176 | } else | ||
| 1177 | /* Ignore 'Timer Recovery' duplicates. */ | ||
| 1178 | rx_repeat = 1; | ||
| 1179 | } else { | ||
| 1180 | /* | ||
| 1181 | * If a non-zero serial number is seen, then enable | ||
| 1182 | * serial number checking. | ||
| 1183 | */ | ||
| 1184 | if (memtx_serial != 0) { | ||
| 1185 | hw->serial_number_detected = 1; | ||
| 1186 | printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME | ||
| 1187 | ": memreg_tx serial num detected\n"); | ||
| 1188 | |||
| 1189 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 1190 | hw->rx_ready++; | ||
| 1191 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1192 | } | ||
| 1193 | rx = 1; | ||
| 1194 | } | ||
| 1195 | } | ||
| 1196 | if (memrxdone & MEMRX_RX_DONE) { | ||
| 1197 | writew(0, &hw->memory_info_regs->memreg_rx_done); | ||
| 1198 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 1199 | hw->tx_ready++; | ||
| 1200 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1201 | tx = 1; | ||
| 1202 | } | ||
| 1203 | if (tx) | ||
| 1204 | writew(MEMRX_PCINTACKK, | ||
| 1205 | &hw->memory_info_regs->memreg_pc_interrupt_ack); | ||
| 1206 | |||
| 1207 | acknowledge_pcmcia_interrupt(hw); | ||
| 1208 | |||
| 1209 | if (tx || rx) | ||
| 1210 | tasklet_schedule(&hw->tasklet); | ||
| 1211 | else if (!rx_repeat) { | ||
| 1212 | if (hw->memreg_tx == &hw->memory_info_regs->memreg_tx_new) { | ||
| 1213 | if (hw->serial_number_detected) | ||
| 1214 | printk(KERN_WARNING IPWIRELESS_PCCARD_NAME | ||
| 1215 | ": spurious interrupt - new_tx mode\n"); | ||
| 1216 | else { | ||
| 1217 | printk(KERN_WARNING IPWIRELESS_PCCARD_NAME | ||
| 1218 | ": no valid memreg_tx value - " | ||
| 1219 | "switching to the old memreg_tx\n"); | ||
| 1220 | hw->memreg_tx = | ||
| 1221 | &hw->memory_info_regs->memreg_tx_old; | ||
| 1222 | try_mem_tx_old = 1; | ||
| 1223 | } | ||
| 1224 | } else | ||
| 1225 | printk(KERN_WARNING IPWIRELESS_PCCARD_NAME | ||
| 1226 | ": spurious interrupt - old_tx mode\n"); | ||
| 1227 | } | ||
| 1228 | |||
| 1229 | } while (try_mem_tx_old == 1); | ||
| 1230 | |||
| 1231 | return IRQ_HANDLED; | ||
| 1232 | } | ||
| 1233 | |||
| 1234 | irqreturn_t ipwireless_interrupt(int irq, void *dev_id, struct pt_regs *regs) | ||
| 1235 | { | ||
| 1236 | struct ipw_hardware *hw = dev_id; | ||
| 1237 | |||
| 1238 | if (hw->hw_version == HW_VERSION_1) | ||
| 1239 | return ipwireless_handle_v1_interrupt(irq, hw); | ||
| 1240 | else | ||
| 1241 | return ipwireless_handle_v2_v3_interrupt(irq, hw); | ||
| 1242 | } | ||
| 1243 | |||
| 1244 | static void flush_packets_to_hw(struct ipw_hardware *hw) | ||
| 1245 | { | ||
| 1246 | int priority_limit; | ||
| 1247 | unsigned long flags; | ||
| 1248 | |||
| 1249 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 1250 | priority_limit = get_current_packet_priority(hw); | ||
| 1251 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1252 | |||
| 1253 | while (send_pending_packet(hw, priority_limit)); | ||
| 1254 | } | ||
| 1255 | |||
| 1256 | static void send_packet(struct ipw_hardware *hw, int priority, | ||
| 1257 | struct ipw_tx_packet *packet) | ||
| 1258 | { | ||
| 1259 | unsigned long flags; | ||
| 1260 | |||
| 1261 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 1262 | list_add_tail(&packet->queue, &hw->tx_queue[priority]); | ||
| 1263 | hw->tx_queued = 1; | ||
| 1264 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1265 | |||
| 1266 | flush_packets_to_hw(hw); | ||
| 1267 | } | ||
| 1268 | |||
| 1269 | /* Create data packet, non-atomic allocation */ | ||
| 1270 | static void *alloc_data_packet(int data_size, | ||
| 1271 | unsigned char dest_addr, | ||
| 1272 | unsigned char protocol) | ||
| 1273 | { | ||
| 1274 | struct ipw_tx_packet *packet = kzalloc( | ||
| 1275 | sizeof(struct ipw_tx_packet) + data_size, | ||
| 1276 | GFP_ATOMIC); | ||
| 1277 | |||
| 1278 | if (!packet) | ||
| 1279 | return NULL; | ||
| 1280 | |||
| 1281 | INIT_LIST_HEAD(&packet->queue); | ||
| 1282 | packet->dest_addr = dest_addr; | ||
| 1283 | packet->protocol = protocol; | ||
| 1284 | packet->length = data_size; | ||
| 1285 | |||
| 1286 | return packet; | ||
| 1287 | } | ||
| 1288 | |||
| 1289 | static void *alloc_ctrl_packet(int header_size, | ||
| 1290 | unsigned char dest_addr, | ||
| 1291 | unsigned char protocol, | ||
| 1292 | unsigned char sig_no) | ||
| 1293 | { | ||
| 1294 | /* | ||
| 1295 | * sig_no is located right after ipw_tx_packet struct in every | ||
| 1296 | * CTRL or SETUP packets, we can use ipw_control_packet as a | ||
| 1297 | * common struct | ||
| 1298 | */ | ||
| 1299 | struct ipw_control_packet *packet = kzalloc(header_size, GFP_ATOMIC); | ||
| 1300 | |||
| 1301 | if (!packet) | ||
| 1302 | return NULL; | ||
| 1303 | |||
| 1304 | INIT_LIST_HEAD(&packet->header.queue); | ||
| 1305 | packet->header.dest_addr = dest_addr; | ||
| 1306 | packet->header.protocol = protocol; | ||
| 1307 | packet->header.length = header_size - sizeof(struct ipw_tx_packet); | ||
| 1308 | packet->body.sig_no = sig_no; | ||
| 1309 | |||
| 1310 | return packet; | ||
| 1311 | } | ||
| 1312 | |||
| 1313 | int ipwireless_send_packet(struct ipw_hardware *hw, unsigned int channel_idx, | ||
| 1314 | unsigned char *data, unsigned int length, | ||
| 1315 | void (*callback) (void *cb, unsigned int length), | ||
| 1316 | void *callback_data) | ||
| 1317 | { | ||
| 1318 | struct ipw_tx_packet *packet; | ||
| 1319 | |||
| 1320 | packet = alloc_data_packet(length, | ||
| 1321 | (unsigned char) (channel_idx + 1), | ||
| 1322 | TL_PROTOCOLID_COM_DATA); | ||
| 1323 | if (!packet) | ||
| 1324 | return -ENOMEM; | ||
| 1325 | packet->packet_callback = callback; | ||
| 1326 | packet->callback_data = callback_data; | ||
| 1327 | memcpy((unsigned char *) packet + | ||
| 1328 | sizeof(struct ipw_tx_packet), data, length); | ||
| 1329 | |||
| 1330 | send_packet(hw, PRIO_DATA, packet); | ||
| 1331 | return 0; | ||
| 1332 | } | ||
| 1333 | |||
| 1334 | static int set_control_line(struct ipw_hardware *hw, int prio, | ||
| 1335 | unsigned int channel_idx, int line, int state) | ||
| 1336 | { | ||
| 1337 | struct ipw_control_packet *packet; | ||
| 1338 | int protocolid = TL_PROTOCOLID_COM_CTRL; | ||
| 1339 | |||
| 1340 | if (prio == PRIO_SETUP) | ||
| 1341 | protocolid = TL_PROTOCOLID_SETUP; | ||
| 1342 | |||
| 1343 | packet = alloc_ctrl_packet(sizeof(struct ipw_control_packet), | ||
| 1344 | (unsigned char) (channel_idx + 1), | ||
| 1345 | protocolid, line); | ||
| 1346 | if (!packet) | ||
| 1347 | return -ENOMEM; | ||
| 1348 | packet->header.length = sizeof(struct ipw_control_packet_body); | ||
| 1349 | packet->body.value = (unsigned char) (state == 0 ? 0 : 1); | ||
| 1350 | send_packet(hw, prio, &packet->header); | ||
| 1351 | return 0; | ||
| 1352 | } | ||
| 1353 | |||
| 1354 | |||
| 1355 | static int set_DTR(struct ipw_hardware *hw, int priority, | ||
| 1356 | unsigned int channel_idx, int state) | ||
| 1357 | { | ||
| 1358 | if (state != 0) | ||
| 1359 | hw->control_lines[channel_idx] |= IPW_CONTROL_LINE_DTR; | ||
| 1360 | else | ||
| 1361 | hw->control_lines[channel_idx] &= ~IPW_CONTROL_LINE_DTR; | ||
| 1362 | |||
| 1363 | return set_control_line(hw, priority, channel_idx, COMCTRL_DTR, state); | ||
| 1364 | } | ||
| 1365 | |||
| 1366 | static int set_RTS(struct ipw_hardware *hw, int priority, | ||
| 1367 | unsigned int channel_idx, int state) | ||
| 1368 | { | ||
| 1369 | if (state != 0) | ||
| 1370 | hw->control_lines[channel_idx] |= IPW_CONTROL_LINE_RTS; | ||
| 1371 | else | ||
| 1372 | hw->control_lines[channel_idx] &= ~IPW_CONTROL_LINE_RTS; | ||
| 1373 | |||
| 1374 | return set_control_line(hw, priority, channel_idx, COMCTRL_RTS, state); | ||
| 1375 | } | ||
| 1376 | |||
| 1377 | int ipwireless_set_DTR(struct ipw_hardware *hw, unsigned int channel_idx, | ||
| 1378 | int state) | ||
| 1379 | { | ||
| 1380 | return set_DTR(hw, PRIO_CTRL, channel_idx, state); | ||
| 1381 | } | ||
| 1382 | |||
| 1383 | int ipwireless_set_RTS(struct ipw_hardware *hw, unsigned int channel_idx, | ||
| 1384 | int state) | ||
| 1385 | { | ||
| 1386 | return set_RTS(hw, PRIO_CTRL, channel_idx, state); | ||
| 1387 | } | ||
| 1388 | |||
| 1389 | struct ipw_setup_get_version_query_packet { | ||
| 1390 | struct ipw_tx_packet header; | ||
| 1391 | struct tl_setup_get_version_qry body; | ||
| 1392 | }; | ||
| 1393 | |||
| 1394 | struct ipw_setup_config_packet { | ||
| 1395 | struct ipw_tx_packet header; | ||
| 1396 | struct tl_setup_config_msg body; | ||
| 1397 | }; | ||
| 1398 | |||
| 1399 | struct ipw_setup_config_done_packet { | ||
| 1400 | struct ipw_tx_packet header; | ||
| 1401 | struct tl_setup_config_done_msg body; | ||
| 1402 | }; | ||
| 1403 | |||
| 1404 | struct ipw_setup_open_packet { | ||
| 1405 | struct ipw_tx_packet header; | ||
| 1406 | struct tl_setup_open_msg body; | ||
| 1407 | }; | ||
| 1408 | |||
| 1409 | struct ipw_setup_info_packet { | ||
| 1410 | struct ipw_tx_packet header; | ||
| 1411 | struct tl_setup_info_msg body; | ||
| 1412 | }; | ||
| 1413 | |||
| 1414 | struct ipw_setup_reboot_msg_ack { | ||
| 1415 | struct ipw_tx_packet header; | ||
| 1416 | struct TlSetupRebootMsgAck body; | ||
| 1417 | }; | ||
| 1418 | |||
| 1419 | /* This handles the actual initialization of the card */ | ||
| 1420 | static void __handle_setup_get_version_rsp(struct ipw_hardware *hw) | ||
| 1421 | { | ||
| 1422 | struct ipw_setup_config_packet *config_packet; | ||
| 1423 | struct ipw_setup_config_done_packet *config_done_packet; | ||
| 1424 | struct ipw_setup_open_packet *open_packet; | ||
| 1425 | struct ipw_setup_info_packet *info_packet; | ||
| 1426 | int port; | ||
| 1427 | unsigned int channel_idx; | ||
| 1428 | |||
| 1429 | /* generate config packet */ | ||
| 1430 | for (port = 1; port <= NL_NUM_OF_ADDRESSES; port++) { | ||
| 1431 | config_packet = alloc_ctrl_packet( | ||
| 1432 | sizeof(struct ipw_setup_config_packet), | ||
| 1433 | ADDR_SETUP_PROT, | ||
| 1434 | TL_PROTOCOLID_SETUP, | ||
| 1435 | TL_SETUP_SIGNO_CONFIG_MSG); | ||
| 1436 | if (!config_packet) | ||
| 1437 | goto exit_nomem; | ||
| 1438 | config_packet->header.length = sizeof(struct tl_setup_config_msg); | ||
| 1439 | config_packet->body.port_no = port; | ||
| 1440 | config_packet->body.prio_data = PRIO_DATA; | ||
| 1441 | config_packet->body.prio_ctrl = PRIO_CTRL; | ||
| 1442 | send_packet(hw, PRIO_SETUP, &config_packet->header); | ||
| 1443 | } | ||
| 1444 | config_done_packet = alloc_ctrl_packet( | ||
| 1445 | sizeof(struct ipw_setup_config_done_packet), | ||
| 1446 | ADDR_SETUP_PROT, | ||
| 1447 | TL_PROTOCOLID_SETUP, | ||
| 1448 | TL_SETUP_SIGNO_CONFIG_DONE_MSG); | ||
| 1449 | if (!config_done_packet) | ||
| 1450 | goto exit_nomem; | ||
| 1451 | config_done_packet->header.length = sizeof(struct tl_setup_config_done_msg); | ||
| 1452 | send_packet(hw, PRIO_SETUP, &config_done_packet->header); | ||
| 1453 | |||
| 1454 | /* generate open packet */ | ||
| 1455 | for (port = 1; port <= NL_NUM_OF_ADDRESSES; port++) { | ||
| 1456 | open_packet = alloc_ctrl_packet( | ||
| 1457 | sizeof(struct ipw_setup_open_packet), | ||
| 1458 | ADDR_SETUP_PROT, | ||
| 1459 | TL_PROTOCOLID_SETUP, | ||
| 1460 | TL_SETUP_SIGNO_OPEN_MSG); | ||
| 1461 | if (!open_packet) | ||
| 1462 | goto exit_nomem; | ||
| 1463 | open_packet->header.length = sizeof(struct tl_setup_open_msg); | ||
| 1464 | open_packet->body.port_no = port; | ||
| 1465 | send_packet(hw, PRIO_SETUP, &open_packet->header); | ||
| 1466 | } | ||
| 1467 | for (channel_idx = 0; | ||
| 1468 | channel_idx < NL_NUM_OF_ADDRESSES; channel_idx++) { | ||
| 1469 | int ret; | ||
| 1470 | |||
| 1471 | ret = set_DTR(hw, PRIO_SETUP, channel_idx, | ||
| 1472 | (hw->control_lines[channel_idx] & | ||
| 1473 | IPW_CONTROL_LINE_DTR) != 0); | ||
| 1474 | if (ret) { | ||
| 1475 | printk(KERN_ERR IPWIRELESS_PCCARD_NAME | ||
| 1476 | ": error setting DTR (%d)\n", ret); | ||
| 1477 | return; | ||
| 1478 | } | ||
| 1479 | |||
| 1480 | set_RTS(hw, PRIO_SETUP, channel_idx, | ||
| 1481 | (hw->control_lines [channel_idx] & | ||
| 1482 | IPW_CONTROL_LINE_RTS) != 0); | ||
| 1483 | if (ret) { | ||
| 1484 | printk(KERN_ERR IPWIRELESS_PCCARD_NAME | ||
| 1485 | ": error setting RTS (%d)\n", ret); | ||
| 1486 | return; | ||
| 1487 | } | ||
| 1488 | } | ||
| 1489 | /* | ||
| 1490 | * For NDIS we assume that we are using sync PPP frames, for COM async. | ||
| 1491 | * This driver uses NDIS mode too. We don't bother with translation | ||
| 1492 | * from async -> sync PPP. | ||
| 1493 | */ | ||
| 1494 | info_packet = alloc_ctrl_packet(sizeof(struct ipw_setup_info_packet), | ||
| 1495 | ADDR_SETUP_PROT, | ||
| 1496 | TL_PROTOCOLID_SETUP, | ||
| 1497 | TL_SETUP_SIGNO_INFO_MSG); | ||
| 1498 | if (!info_packet) | ||
| 1499 | goto exit_nomem; | ||
| 1500 | info_packet->header.length = sizeof(struct tl_setup_info_msg); | ||
| 1501 | info_packet->body.driver_type = NDISWAN_DRIVER; | ||
| 1502 | info_packet->body.major_version = NDISWAN_DRIVER_MAJOR_VERSION; | ||
| 1503 | info_packet->body.minor_version = NDISWAN_DRIVER_MINOR_VERSION; | ||
| 1504 | send_packet(hw, PRIO_SETUP, &info_packet->header); | ||
| 1505 | |||
| 1506 | /* Initialization is now complete, so we clear the 'to_setup' flag */ | ||
| 1507 | hw->to_setup = 0; | ||
| 1508 | |||
| 1509 | return; | ||
| 1510 | |||
| 1511 | exit_nomem: | ||
| 1512 | printk(KERN_ERR IPWIRELESS_PCCARD_NAME | ||
| 1513 | ": not enough memory to alloc control packet\n"); | ||
| 1514 | hw->to_setup = -1; | ||
| 1515 | } | ||
| 1516 | |||
| 1517 | static void handle_setup_get_version_rsp(struct ipw_hardware *hw, | ||
| 1518 | unsigned char vers_no) | ||
| 1519 | { | ||
| 1520 | del_timer(&hw->setup_timer); | ||
| 1521 | hw->initializing = 0; | ||
| 1522 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME ": card is ready.\n"); | ||
| 1523 | |||
| 1524 | if (vers_no == TL_SETUP_VERSION) | ||
| 1525 | __handle_setup_get_version_rsp(hw); | ||
| 1526 | else | ||
| 1527 | printk(KERN_ERR | ||
| 1528 | IPWIRELESS_PCCARD_NAME | ||
| 1529 | ": invalid hardware version no %u\n", | ||
| 1530 | (unsigned int) vers_no); | ||
| 1531 | } | ||
| 1532 | |||
| 1533 | static void ipw_send_setup_packet(struct ipw_hardware *hw) | ||
| 1534 | { | ||
| 1535 | struct ipw_setup_get_version_query_packet *ver_packet; | ||
| 1536 | |||
| 1537 | ver_packet = alloc_ctrl_packet( | ||
| 1538 | sizeof(struct ipw_setup_get_version_query_packet), | ||
| 1539 | ADDR_SETUP_PROT, TL_PROTOCOLID_SETUP, | ||
| 1540 | TL_SETUP_SIGNO_GET_VERSION_QRY); | ||
| 1541 | ver_packet->header.length = sizeof(struct tl_setup_get_version_qry); | ||
| 1542 | |||
| 1543 | /* | ||
| 1544 | * Response is handled in handle_received_SETUP_packet | ||
| 1545 | */ | ||
| 1546 | send_packet(hw, PRIO_SETUP, &ver_packet->header); | ||
| 1547 | } | ||
| 1548 | |||
| 1549 | static void handle_received_SETUP_packet(struct ipw_hardware *hw, | ||
| 1550 | unsigned int address, | ||
| 1551 | unsigned char *data, int len, | ||
| 1552 | int is_last) | ||
| 1553 | { | ||
| 1554 | union ipw_setup_rx_msg *rx_msg = (union ipw_setup_rx_msg *) data; | ||
| 1555 | |||
| 1556 | if (address != ADDR_SETUP_PROT) { | ||
| 1557 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 1558 | ": setup packet has bad address %d\n", address); | ||
| 1559 | return; | ||
| 1560 | } | ||
| 1561 | |||
| 1562 | switch (rx_msg->sig_no) { | ||
| 1563 | case TL_SETUP_SIGNO_GET_VERSION_RSP: | ||
| 1564 | if (hw->to_setup) | ||
| 1565 | handle_setup_get_version_rsp(hw, | ||
| 1566 | rx_msg->version_rsp_msg.version); | ||
| 1567 | break; | ||
| 1568 | |||
| 1569 | case TL_SETUP_SIGNO_OPEN_MSG: | ||
| 1570 | if (ipwireless_debug) { | ||
| 1571 | unsigned int channel_idx = rx_msg->open_msg.port_no - 1; | ||
| 1572 | |||
| 1573 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 1574 | ": OPEN_MSG [channel %u] reply received\n", | ||
| 1575 | channel_idx); | ||
| 1576 | } | ||
| 1577 | break; | ||
| 1578 | |||
| 1579 | case TL_SETUP_SIGNO_INFO_MSG_ACK: | ||
| 1580 | if (ipwireless_debug) | ||
| 1581 | printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME | ||
| 1582 | ": card successfully configured as NDISWAN\n"); | ||
| 1583 | break; | ||
| 1584 | |||
| 1585 | case TL_SETUP_SIGNO_REBOOT_MSG: | ||
| 1586 | if (hw->to_setup) | ||
| 1587 | printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME | ||
| 1588 | ": Setup not completed - ignoring reboot msg\n"); | ||
| 1589 | else { | ||
| 1590 | struct ipw_setup_reboot_msg_ack *packet; | ||
| 1591 | |||
| 1592 | printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME | ||
| 1593 | ": Acknowledging REBOOT message\n"); | ||
| 1594 | packet = alloc_ctrl_packet( | ||
| 1595 | sizeof(struct ipw_setup_reboot_msg_ack), | ||
| 1596 | ADDR_SETUP_PROT, TL_PROTOCOLID_SETUP, | ||
| 1597 | TL_SETUP_SIGNO_REBOOT_MSG_ACK); | ||
| 1598 | packet->header.length = | ||
| 1599 | sizeof(struct TlSetupRebootMsgAck); | ||
| 1600 | send_packet(hw, PRIO_SETUP, &packet->header); | ||
| 1601 | if (hw->reboot_callback) | ||
| 1602 | hw->reboot_callback(hw->reboot_callback_data); | ||
| 1603 | } | ||
| 1604 | break; | ||
| 1605 | |||
| 1606 | default: | ||
| 1607 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 1608 | ": unknown setup message %u received\n", | ||
| 1609 | (unsigned int) rx_msg->sig_no); | ||
| 1610 | } | ||
| 1611 | } | ||
| 1612 | |||
| 1613 | static void do_close_hardware(struct ipw_hardware *hw) | ||
| 1614 | { | ||
| 1615 | unsigned int irqn; | ||
| 1616 | |||
| 1617 | if (hw->hw_version == HW_VERSION_1) { | ||
| 1618 | /* Disable TX and RX interrupts. */ | ||
| 1619 | outw(0, hw->base_port + IOIER); | ||
| 1620 | |||
| 1621 | /* Acknowledge any outstanding interrupt requests */ | ||
| 1622 | irqn = inw(hw->base_port + IOIR); | ||
| 1623 | if (irqn & IR_TXINTR) | ||
| 1624 | outw(IR_TXINTR, hw->base_port + IOIR); | ||
| 1625 | if (irqn & IR_RXINTR) | ||
| 1626 | outw(IR_RXINTR, hw->base_port + IOIR); | ||
| 1627 | |||
| 1628 | synchronize_irq(hw->irq); | ||
| 1629 | } | ||
| 1630 | } | ||
| 1631 | |||
| 1632 | struct ipw_hardware *ipwireless_hardware_create(void) | ||
| 1633 | { | ||
| 1634 | int i; | ||
| 1635 | struct ipw_hardware *hw = | ||
| 1636 | kzalloc(sizeof(struct ipw_hardware), GFP_KERNEL); | ||
| 1637 | |||
| 1638 | if (!hw) | ||
| 1639 | return NULL; | ||
| 1640 | |||
| 1641 | hw->irq = -1; | ||
| 1642 | hw->initializing = 1; | ||
| 1643 | hw->tx_ready = 1; | ||
| 1644 | hw->rx_bytes_queued = 0; | ||
| 1645 | hw->rx_pool_size = 0; | ||
| 1646 | hw->last_memtx_serial = (unsigned short) 0xffff; | ||
| 1647 | for (i = 0; i < NL_NUM_OF_PRIORITIES; i++) | ||
| 1648 | INIT_LIST_HEAD(&hw->tx_queue[i]); | ||
| 1649 | |||
| 1650 | INIT_LIST_HEAD(&hw->rx_queue); | ||
| 1651 | INIT_LIST_HEAD(&hw->rx_pool); | ||
| 1652 | spin_lock_init(&hw->spinlock); | ||
| 1653 | tasklet_init(&hw->tasklet, ipwireless_do_tasklet, (unsigned long) hw); | ||
| 1654 | INIT_WORK(&hw->work_rx, ipw_receive_data_work); | ||
| 1655 | setup_timer(&hw->setup_timer, ipwireless_setup_timer, | ||
| 1656 | (unsigned long) hw); | ||
| 1657 | |||
| 1658 | return hw; | ||
| 1659 | } | ||
| 1660 | |||
| 1661 | void ipwireless_init_hardware_v1(struct ipw_hardware *hw, | ||
| 1662 | unsigned int base_port, | ||
| 1663 | void __iomem *attr_memory, | ||
| 1664 | void __iomem *common_memory, | ||
| 1665 | int is_v2_card, | ||
| 1666 | void (*reboot_callback) (void *data), | ||
| 1667 | void *reboot_callback_data) | ||
| 1668 | { | ||
| 1669 | if (hw->removed) { | ||
| 1670 | hw->removed = 0; | ||
| 1671 | enable_irq(hw->irq); | ||
| 1672 | } | ||
| 1673 | hw->base_port = base_port; | ||
| 1674 | hw->hw_version = is_v2_card ? HW_VERSION_2 : HW_VERSION_1; | ||
| 1675 | hw->ll_mtu = hw->hw_version == HW_VERSION_1 ? LL_MTU_V1 : LL_MTU_V2; | ||
| 1676 | hw->memregs_CCR = (struct MEMCCR __iomem *) | ||
| 1677 | ((unsigned short __iomem *) attr_memory + 0x200); | ||
| 1678 | hw->memory_info_regs = (struct MEMINFREG __iomem *) common_memory; | ||
| 1679 | hw->memreg_tx = &hw->memory_info_regs->memreg_tx_new; | ||
| 1680 | hw->reboot_callback = reboot_callback; | ||
| 1681 | hw->reboot_callback_data = reboot_callback_data; | ||
| 1682 | } | ||
| 1683 | |||
| 1684 | void ipwireless_init_hardware_v2_v3(struct ipw_hardware *hw) | ||
| 1685 | { | ||
| 1686 | hw->initializing = 1; | ||
| 1687 | hw->init_loops = 0; | ||
| 1688 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 1689 | ": waiting for card to start up...\n"); | ||
| 1690 | ipwireless_setup_timer((unsigned long) hw); | ||
| 1691 | } | ||
| 1692 | |||
| 1693 | static void ipwireless_setup_timer(unsigned long data) | ||
| 1694 | { | ||
| 1695 | struct ipw_hardware *hw = (struct ipw_hardware *) data; | ||
| 1696 | |||
| 1697 | hw->init_loops++; | ||
| 1698 | |||
| 1699 | if (hw->init_loops == TL_SETUP_MAX_VERSION_QRY && | ||
| 1700 | hw->hw_version == HW_VERSION_2 && | ||
| 1701 | hw->memreg_tx == &hw->memory_info_regs->memreg_tx_new) { | ||
| 1702 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 1703 | ": failed to startup using TX2, trying TX\n"); | ||
| 1704 | |||
| 1705 | hw->memreg_tx = &hw->memory_info_regs->memreg_tx_old; | ||
| 1706 | hw->init_loops = 0; | ||
| 1707 | } | ||
| 1708 | /* Give up after a certain number of retries */ | ||
| 1709 | if (hw->init_loops == TL_SETUP_MAX_VERSION_QRY) { | ||
| 1710 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 1711 | ": card failed to start up!\n"); | ||
| 1712 | hw->initializing = 0; | ||
| 1713 | } else { | ||
| 1714 | /* Do not attempt to write to the board if it is not present. */ | ||
| 1715 | if (is_card_present(hw)) { | ||
| 1716 | unsigned long flags; | ||
| 1717 | |||
| 1718 | spin_lock_irqsave(&hw->spinlock, flags); | ||
| 1719 | hw->to_setup = 1; | ||
| 1720 | hw->tx_ready = 1; | ||
| 1721 | spin_unlock_irqrestore(&hw->spinlock, flags); | ||
| 1722 | tasklet_schedule(&hw->tasklet); | ||
| 1723 | } | ||
| 1724 | |||
| 1725 | mod_timer(&hw->setup_timer, | ||
| 1726 | jiffies + msecs_to_jiffies(TL_SETUP_VERSION_QRY_TMO)); | ||
| 1727 | } | ||
| 1728 | } | ||
| 1729 | |||
| 1730 | /* | ||
| 1731 | * Stop any interrupts from executing so that, once this function returns, | ||
| 1732 | * other layers of the driver can be sure they won't get any more callbacks. | ||
| 1733 | * Thus must be called on a proper process context. | ||
| 1734 | */ | ||
| 1735 | void ipwireless_stop_interrupts(struct ipw_hardware *hw) | ||
| 1736 | { | ||
| 1737 | if (!hw->shutting_down) { | ||
| 1738 | /* Tell everyone we are going down. */ | ||
| 1739 | hw->shutting_down = 1; | ||
| 1740 | del_timer(&hw->setup_timer); | ||
| 1741 | |||
| 1742 | /* Prevent the hardware from sending any more interrupts */ | ||
| 1743 | do_close_hardware(hw); | ||
| 1744 | } | ||
| 1745 | } | ||
| 1746 | |||
| 1747 | void ipwireless_hardware_free(struct ipw_hardware *hw) | ||
| 1748 | { | ||
| 1749 | int i; | ||
| 1750 | struct ipw_rx_packet *rp, *rq; | ||
| 1751 | struct ipw_tx_packet *tp, *tq; | ||
| 1752 | |||
| 1753 | ipwireless_stop_interrupts(hw); | ||
| 1754 | |||
| 1755 | flush_scheduled_work(); | ||
| 1756 | |||
| 1757 | for (i = 0; i < NL_NUM_OF_ADDRESSES; i++) | ||
| 1758 | if (hw->packet_assembler[i] != NULL) | ||
| 1759 | kfree(hw->packet_assembler[i]); | ||
| 1760 | |||
| 1761 | for (i = 0; i < NL_NUM_OF_PRIORITIES; i++) | ||
| 1762 | list_for_each_entry_safe(tp, tq, &hw->tx_queue[i], queue) { | ||
| 1763 | list_del(&tp->queue); | ||
| 1764 | kfree(tp); | ||
| 1765 | } | ||
| 1766 | |||
| 1767 | list_for_each_entry_safe(rp, rq, &hw->rx_queue, queue) { | ||
| 1768 | list_del(&rp->queue); | ||
| 1769 | kfree(rp); | ||
| 1770 | } | ||
| 1771 | |||
| 1772 | list_for_each_entry_safe(rp, rq, &hw->rx_pool, queue) { | ||
| 1773 | list_del(&rp->queue); | ||
| 1774 | kfree(rp); | ||
| 1775 | } | ||
| 1776 | kfree(hw); | ||
| 1777 | } | ||
| 1778 | |||
| 1779 | /* | ||
| 1780 | * Associate the specified network with this hardware, so it will receive events | ||
| 1781 | * from it. | ||
| 1782 | */ | ||
| 1783 | void ipwireless_associate_network(struct ipw_hardware *hw, | ||
| 1784 | struct ipw_network *network) | ||
| 1785 | { | ||
| 1786 | hw->network = network; | ||
| 1787 | } | ||
diff --git a/drivers/char/pcmcia/ipwireless/hardware.h b/drivers/char/pcmcia/ipwireless/hardware.h new file mode 100644 index 000000000000..c83190ffb0e7 --- /dev/null +++ b/drivers/char/pcmcia/ipwireless/hardware.h | |||
| @@ -0,0 +1,64 @@ | |||
| 1 | /* | ||
| 2 | * IPWireless 3G PCMCIA Network Driver | ||
| 3 | * | ||
| 4 | * Original code | ||
| 5 | * by Stephen Blackheath <stephen@blacksapphire.com>, | ||
| 6 | * Ben Martel <benm@symmetric.co.nz> | ||
| 7 | * | ||
| 8 | * Copyrighted as follows: | ||
| 9 | * Copyright (C) 2004 by Symmetric Systems Ltd (NZ) | ||
| 10 | * | ||
| 11 | * Various driver changes and rewrites, port to new kernels | ||
| 12 | * Copyright (C) 2006-2007 Jiri Kosina | ||
| 13 | * | ||
| 14 | * Misc code cleanups and updates | ||
| 15 | * Copyright (C) 2007 David Sterba | ||
| 16 | */ | ||
| 17 | |||
| 18 | #ifndef _IPWIRELESS_CS_HARDWARE_H_ | ||
| 19 | #define _IPWIRELESS_CS_HARDWARE_H_ | ||
| 20 | |||
| 21 | #include <linux/types.h> | ||
| 22 | #include <linux/sched.h> | ||
| 23 | #include <linux/interrupt.h> | ||
| 24 | |||
| 25 | #define IPW_CONTROL_LINE_CTS 0x0001 | ||
| 26 | #define IPW_CONTROL_LINE_DCD 0x0002 | ||
| 27 | #define IPW_CONTROL_LINE_DSR 0x0004 | ||
| 28 | #define IPW_CONTROL_LINE_RI 0x0008 | ||
| 29 | #define IPW_CONTROL_LINE_DTR 0x0010 | ||
| 30 | #define IPW_CONTROL_LINE_RTS 0x0020 | ||
| 31 | |||
| 32 | struct ipw_hardware; | ||
| 33 | struct ipw_network; | ||
| 34 | |||
| 35 | struct ipw_hardware *ipwireless_hardware_create(void); | ||
| 36 | void ipwireless_hardware_free(struct ipw_hardware *hw); | ||
| 37 | irqreturn_t ipwireless_interrupt(int irq, void *dev_id, struct pt_regs *regs); | ||
| 38 | int ipwireless_set_DTR(struct ipw_hardware *hw, unsigned int channel_idx, | ||
| 39 | int state); | ||
| 40 | int ipwireless_set_RTS(struct ipw_hardware *hw, unsigned int channel_idx, | ||
| 41 | int state); | ||
| 42 | int ipwireless_send_packet(struct ipw_hardware *hw, | ||
| 43 | unsigned int channel_idx, | ||
| 44 | unsigned char *data, | ||
| 45 | unsigned int length, | ||
| 46 | void (*packet_sent_callback) (void *cb, | ||
| 47 | unsigned int length), | ||
| 48 | void *sent_cb_data); | ||
| 49 | void ipwireless_associate_network(struct ipw_hardware *hw, | ||
| 50 | struct ipw_network *net); | ||
| 51 | void ipwireless_stop_interrupts(struct ipw_hardware *hw); | ||
| 52 | void ipwireless_init_hardware_v1(struct ipw_hardware *hw, | ||
| 53 | unsigned int base_port, | ||
| 54 | void __iomem *attr_memory, | ||
| 55 | void __iomem *common_memory, | ||
| 56 | int is_v2_card, | ||
| 57 | void (*reboot_cb) (void *data), | ||
| 58 | void *reboot_cb_data); | ||
| 59 | void ipwireless_init_hardware_v2_v3(struct ipw_hardware *hw); | ||
| 60 | void ipwireless_sleep(unsigned int tenths); | ||
| 61 | int ipwireless_dump_hardware_state(char *p, size_t limit, | ||
| 62 | struct ipw_hardware *hw); | ||
| 63 | |||
| 64 | #endif | ||
diff --git a/drivers/char/pcmcia/ipwireless/main.c b/drivers/char/pcmcia/ipwireless/main.c new file mode 100644 index 000000000000..00c7f8407e3e --- /dev/null +++ b/drivers/char/pcmcia/ipwireless/main.c | |||
| @@ -0,0 +1,501 @@ | |||
| 1 | /* | ||
| 2 | * IPWireless 3G PCMCIA Network Driver | ||
| 3 | * | ||
| 4 | * Original code | ||
| 5 | * by Stephen Blackheath <stephen@blacksapphire.com>, | ||
| 6 | * Ben Martel <benm@symmetric.co.nz> | ||
| 7 | * | ||
| 8 | * Copyrighted as follows: | ||
| 9 | * Copyright (C) 2004 by Symmetric Systems Ltd (NZ) | ||
| 10 | * | ||
| 11 | * Various driver changes and rewrites, port to new kernels | ||
| 12 | * Copyright (C) 2006-2007 Jiri Kosina | ||
| 13 | * | ||
| 14 | * Misc code cleanups and updates | ||
| 15 | * Copyright (C) 2007 David Sterba | ||
| 16 | */ | ||
| 17 | |||
| 18 | #include "hardware.h" | ||
| 19 | #include "network.h" | ||
| 20 | #include "main.h" | ||
| 21 | #include "tty.h" | ||
| 22 | |||
| 23 | #include <linux/delay.h> | ||
| 24 | #include <linux/init.h> | ||
| 25 | #include <linux/io.h> | ||
| 26 | #include <linux/kernel.h> | ||
| 27 | #include <linux/module.h> | ||
| 28 | #include <linux/sched.h> | ||
| 29 | #include <linux/slab.h> | ||
| 30 | |||
| 31 | #include <pcmcia/version.h> | ||
| 32 | #include <pcmcia/cisreg.h> | ||
| 33 | #include <pcmcia/device_id.h> | ||
| 34 | #include <pcmcia/ss.h> | ||
| 35 | #include <pcmcia/ds.h> | ||
| 36 | #include <pcmcia/cs.h> | ||
| 37 | |||
| 38 | static struct pcmcia_device_id ipw_ids[] = { | ||
| 39 | PCMCIA_DEVICE_MANF_CARD(0x02f2, 0x0100), | ||
| 40 | PCMCIA_DEVICE_MANF_CARD(0x02f2, 0x0200), | ||
| 41 | PCMCIA_DEVICE_NULL | ||
| 42 | }; | ||
| 43 | MODULE_DEVICE_TABLE(pcmcia, ipw_ids); | ||
| 44 | |||
| 45 | static void ipwireless_detach(struct pcmcia_device *link); | ||
| 46 | |||
| 47 | /* | ||
| 48 | * Module params | ||
| 49 | */ | ||
| 50 | /* Debug mode: more verbose, print sent/recv bytes */ | ||
| 51 | int ipwireless_debug; | ||
| 52 | int ipwireless_loopback; | ||
| 53 | int ipwireless_out_queue = 1; | ||
| 54 | |||
| 55 | module_param_named(debug, ipwireless_debug, int, 0); | ||
| 56 | module_param_named(loopback, ipwireless_loopback, int, 0); | ||
| 57 | module_param_named(out_queue, ipwireless_out_queue, int, 0); | ||
| 58 | MODULE_PARM_DESC(debug, "switch on debug messages [0]"); | ||
| 59 | MODULE_PARM_DESC(loopback, | ||
| 60 | "debug: enable ras_raw channel [0]"); | ||
| 61 | MODULE_PARM_DESC(out_queue, "debug: set size of outgoing queue [1]"); | ||
| 62 | |||
| 63 | /* Executes in process context. */ | ||
| 64 | static void signalled_reboot_work(struct work_struct *work_reboot) | ||
| 65 | { | ||
| 66 | struct ipw_dev *ipw = container_of(work_reboot, struct ipw_dev, | ||
| 67 | work_reboot); | ||
| 68 | struct pcmcia_device *link = ipw->link; | ||
| 69 | int ret = pccard_reset_card(link->socket); | ||
| 70 | |||
| 71 | if (ret != CS_SUCCESS) | ||
| 72 | cs_error(link, ResetCard, ret); | ||
| 73 | } | ||
| 74 | |||
| 75 | static void signalled_reboot_callback(void *callback_data) | ||
| 76 | { | ||
| 77 | struct ipw_dev *ipw = (struct ipw_dev *) callback_data; | ||
| 78 | |||
| 79 | /* Delegate to process context. */ | ||
| 80 | schedule_work(&ipw->work_reboot); | ||
| 81 | } | ||
| 82 | |||
| 83 | static int config_ipwireless(struct ipw_dev *ipw) | ||
| 84 | { | ||
| 85 | struct pcmcia_device *link = ipw->link; | ||
| 86 | int ret; | ||
| 87 | config_info_t conf; | ||
| 88 | tuple_t tuple; | ||
| 89 | unsigned short buf[64]; | ||
| 90 | cisparse_t parse; | ||
| 91 | unsigned short cor_value; | ||
| 92 | win_req_t request_attr_memory; | ||
| 93 | win_req_t request_common_memory; | ||
| 94 | memreq_t memreq_attr_memory; | ||
| 95 | memreq_t memreq_common_memory; | ||
| 96 | |||
| 97 | ipw->is_v2_card = 0; | ||
| 98 | |||
| 99 | tuple.Attributes = 0; | ||
| 100 | tuple.TupleData = (cisdata_t *) buf; | ||
| 101 | tuple.TupleDataMax = sizeof(buf); | ||
| 102 | tuple.TupleOffset = 0; | ||
| 103 | |||
| 104 | tuple.DesiredTuple = RETURN_FIRST_TUPLE; | ||
| 105 | |||
| 106 | ret = pcmcia_get_first_tuple(link, &tuple); | ||
| 107 | |||
| 108 | while (ret == 0) { | ||
| 109 | ret = pcmcia_get_tuple_data(link, &tuple); | ||
| 110 | |||
| 111 | if (ret != CS_SUCCESS) { | ||
| 112 | cs_error(link, GetTupleData, ret); | ||
| 113 | goto exit0; | ||
| 114 | } | ||
| 115 | ret = pcmcia_get_next_tuple(link, &tuple); | ||
| 116 | } | ||
| 117 | |||
| 118 | tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY; | ||
| 119 | |||
| 120 | ret = pcmcia_get_first_tuple(link, &tuple); | ||
| 121 | |||
| 122 | if (ret != CS_SUCCESS) { | ||
| 123 | cs_error(link, GetFirstTuple, ret); | ||
| 124 | goto exit0; | ||
| 125 | } | ||
| 126 | |||
| 127 | ret = pcmcia_get_tuple_data(link, &tuple); | ||
| 128 | |||
| 129 | if (ret != CS_SUCCESS) { | ||
| 130 | cs_error(link, GetTupleData, ret); | ||
| 131 | goto exit0; | ||
| 132 | } | ||
| 133 | |||
| 134 | ret = pcmcia_parse_tuple(link, &tuple, &parse); | ||
| 135 | |||
| 136 | if (ret != CS_SUCCESS) { | ||
| 137 | cs_error(link, ParseTuple, ret); | ||
| 138 | goto exit0; | ||
| 139 | } | ||
| 140 | |||
| 141 | link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO; | ||
| 142 | link->io.BasePort1 = parse.cftable_entry.io.win[0].base; | ||
| 143 | link->io.NumPorts1 = parse.cftable_entry.io.win[0].len; | ||
| 144 | link->io.IOAddrLines = 16; | ||
| 145 | |||
| 146 | link->irq.IRQInfo1 = parse.cftable_entry.irq.IRQInfo1; | ||
| 147 | |||
| 148 | /* 0x40 causes it to generate level mode interrupts. */ | ||
| 149 | /* 0x04 enables IREQ pin. */ | ||
| 150 | cor_value = parse.cftable_entry.index | 0x44; | ||
| 151 | link->conf.ConfigIndex = cor_value; | ||
| 152 | |||
| 153 | /* IRQ and I/O settings */ | ||
| 154 | tuple.DesiredTuple = CISTPL_CONFIG; | ||
| 155 | |||
| 156 | ret = pcmcia_get_first_tuple(link, &tuple); | ||
| 157 | |||
| 158 | if (ret != CS_SUCCESS) { | ||
| 159 | cs_error(link, GetFirstTuple, ret); | ||
| 160 | goto exit0; | ||
| 161 | } | ||
| 162 | |||
| 163 | ret = pcmcia_get_tuple_data(link, &tuple); | ||
| 164 | |||
| 165 | if (ret != CS_SUCCESS) { | ||
| 166 | cs_error(link, GetTupleData, ret); | ||
| 167 | goto exit0; | ||
| 168 | } | ||
| 169 | |||
| 170 | ret = pcmcia_parse_tuple(link, &tuple, &parse); | ||
| 171 | |||
| 172 | if (ret != CS_SUCCESS) { | ||
| 173 | cs_error(link, GetTupleData, ret); | ||
| 174 | goto exit0; | ||
| 175 | } | ||
| 176 | link->conf.Attributes = CONF_ENABLE_IRQ; | ||
| 177 | link->conf.ConfigBase = parse.config.base; | ||
| 178 | link->conf.Present = parse.config.rmask[0]; | ||
| 179 | link->conf.IntType = INT_MEMORY_AND_IO; | ||
| 180 | |||
| 181 | link->irq.Attributes = IRQ_TYPE_DYNAMIC_SHARING | IRQ_HANDLE_PRESENT; | ||
| 182 | link->irq.Handler = ipwireless_interrupt; | ||
| 183 | link->irq.Instance = ipw->hardware; | ||
| 184 | |||
| 185 | ret = pcmcia_request_io(link, &link->io); | ||
| 186 | |||
| 187 | if (ret != CS_SUCCESS) { | ||
| 188 | cs_error(link, RequestIO, ret); | ||
| 189 | goto exit0; | ||
| 190 | } | ||
| 191 | |||
| 192 | /* memory settings */ | ||
| 193 | |||
| 194 | tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY; | ||
| 195 | |||
| 196 | ret = pcmcia_get_first_tuple(link, &tuple); | ||
| 197 | |||
| 198 | if (ret != CS_SUCCESS) { | ||
| 199 | cs_error(link, GetFirstTuple, ret); | ||
| 200 | goto exit1; | ||
| 201 | } | ||
| 202 | |||
| 203 | ret = pcmcia_get_tuple_data(link, &tuple); | ||
| 204 | |||
| 205 | if (ret != CS_SUCCESS) { | ||
| 206 | cs_error(link, GetTupleData, ret); | ||
| 207 | goto exit1; | ||
| 208 | } | ||
| 209 | |||
| 210 | ret = pcmcia_parse_tuple(link, &tuple, &parse); | ||
| 211 | |||
| 212 | if (ret != CS_SUCCESS) { | ||
| 213 | cs_error(link, ParseTuple, ret); | ||
| 214 | goto exit1; | ||
| 215 | } | ||
| 216 | |||
| 217 | if (parse.cftable_entry.mem.nwin > 0) { | ||
| 218 | request_common_memory.Attributes = | ||
| 219 | WIN_DATA_WIDTH_16 | WIN_MEMORY_TYPE_CM | WIN_ENABLE; | ||
| 220 | request_common_memory.Base = | ||
| 221 | parse.cftable_entry.mem.win[0].host_addr; | ||
| 222 | request_common_memory.Size = parse.cftable_entry.mem.win[0].len; | ||
| 223 | if (request_common_memory.Size < 0x1000) | ||
| 224 | request_common_memory.Size = 0x1000; | ||
| 225 | request_common_memory.AccessSpeed = 0; | ||
| 226 | |||
| 227 | ret = pcmcia_request_window(&link, &request_common_memory, | ||
| 228 | &ipw->handle_common_memory); | ||
| 229 | |||
| 230 | if (ret != CS_SUCCESS) { | ||
| 231 | cs_error(link, RequestWindow, ret); | ||
| 232 | goto exit1; | ||
| 233 | } | ||
| 234 | |||
| 235 | memreq_common_memory.CardOffset = | ||
| 236 | parse.cftable_entry.mem.win[0].card_addr; | ||
| 237 | memreq_common_memory.Page = 0; | ||
| 238 | |||
| 239 | ret = pcmcia_map_mem_page(ipw->handle_common_memory, | ||
| 240 | &memreq_common_memory); | ||
| 241 | |||
| 242 | if (ret != CS_SUCCESS) { | ||
| 243 | cs_error(link, MapMemPage, ret); | ||
| 244 | goto exit1; | ||
| 245 | } | ||
| 246 | |||
| 247 | ipw->is_v2_card = | ||
| 248 | parse.cftable_entry.mem.win[0].len == 0x100; | ||
| 249 | |||
| 250 | ipw->common_memory = ioremap(request_common_memory.Base, | ||
| 251 | request_common_memory.Size); | ||
| 252 | |||
| 253 | request_attr_memory.Attributes = | ||
| 254 | WIN_DATA_WIDTH_16 | WIN_MEMORY_TYPE_AM | WIN_ENABLE; | ||
| 255 | request_attr_memory.Base = 0; | ||
| 256 | request_attr_memory.Size = 0; /* this used to be 0x1000 */ | ||
| 257 | request_attr_memory.AccessSpeed = 0; | ||
| 258 | |||
| 259 | ret = pcmcia_request_window(&link, &request_attr_memory, | ||
| 260 | &ipw->handle_attr_memory); | ||
| 261 | |||
| 262 | if (ret != CS_SUCCESS) { | ||
| 263 | cs_error(link, RequestWindow, ret); | ||
| 264 | goto exit2; | ||
| 265 | } | ||
| 266 | |||
| 267 | memreq_attr_memory.CardOffset = 0; | ||
| 268 | memreq_attr_memory.Page = 0; | ||
| 269 | |||
| 270 | ret = pcmcia_map_mem_page(ipw->handle_attr_memory, | ||
| 271 | &memreq_attr_memory); | ||
| 272 | |||
| 273 | if (ret != CS_SUCCESS) { | ||
| 274 | cs_error(link, MapMemPage, ret); | ||
| 275 | goto exit2; | ||
| 276 | } | ||
| 277 | |||
| 278 | ipw->attr_memory = ioremap(request_attr_memory.Base, | ||
| 279 | request_attr_memory.Size); | ||
| 280 | } | ||
| 281 | |||
| 282 | INIT_WORK(&ipw->work_reboot, signalled_reboot_work); | ||
| 283 | |||
| 284 | ipwireless_init_hardware_v1(ipw->hardware, link->io.BasePort1, | ||
| 285 | ipw->attr_memory, ipw->common_memory, | ||
| 286 | ipw->is_v2_card, signalled_reboot_callback, | ||
| 287 | ipw); | ||
| 288 | |||
| 289 | ret = pcmcia_request_irq(link, &link->irq); | ||
| 290 | |||
| 291 | if (ret != CS_SUCCESS) { | ||
| 292 | cs_error(link, RequestIRQ, ret); | ||
| 293 | goto exit3; | ||
| 294 | } | ||
| 295 | |||
| 296 | /* Look up current Vcc */ | ||
| 297 | |||
| 298 | ret = pcmcia_get_configuration_info(link, &conf); | ||
| 299 | |||
| 300 | if (ret != CS_SUCCESS) { | ||
| 301 | cs_error(link, GetConfigurationInfo, ret); | ||
| 302 | goto exit4; | ||
| 303 | } | ||
| 304 | |||
| 305 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME ": Card type %s\n", | ||
| 306 | ipw->is_v2_card ? "V2/V3" : "V1"); | ||
| 307 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 308 | ": I/O ports 0x%04x-0x%04x, irq %d\n", | ||
| 309 | (unsigned int) link->io.BasePort1, | ||
| 310 | (unsigned int) (link->io.BasePort1 + | ||
| 311 | link->io.NumPorts1 - 1), | ||
| 312 | (unsigned int) link->irq.AssignedIRQ); | ||
| 313 | if (ipw->attr_memory && ipw->common_memory) | ||
| 314 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 315 | ": attr memory 0x%08lx-0x%08lx, " | ||
| 316 | "common memory 0x%08lx-0x%08lx\n", | ||
| 317 | request_attr_memory.Base, | ||
| 318 | request_attr_memory.Base | ||
| 319 | + request_attr_memory.Size - 1, | ||
| 320 | request_common_memory.Base, | ||
| 321 | request_common_memory.Base | ||
| 322 | + request_common_memory.Size - 1); | ||
| 323 | |||
| 324 | ipw->network = ipwireless_network_create(ipw->hardware); | ||
| 325 | if (!ipw->network) | ||
| 326 | goto exit3; | ||
| 327 | |||
| 328 | ipw->tty = ipwireless_tty_create(ipw->hardware, ipw->network, | ||
| 329 | ipw->nodes); | ||
| 330 | if (!ipw->tty) | ||
| 331 | goto exit3; | ||
| 332 | |||
| 333 | ipwireless_init_hardware_v2_v3(ipw->hardware); | ||
| 334 | |||
| 335 | /* | ||
| 336 | * Do the RequestConfiguration last, because it enables interrupts. | ||
| 337 | * Then we don't get any interrupts before we're ready for them. | ||
| 338 | */ | ||
| 339 | ret = pcmcia_request_configuration(link, &link->conf); | ||
| 340 | |||
| 341 | if (ret != CS_SUCCESS) { | ||
| 342 | cs_error(link, RequestConfiguration, ret); | ||
| 343 | goto exit4; | ||
| 344 | } | ||
| 345 | |||
| 346 | link->dev_node = &ipw->nodes[0]; | ||
| 347 | |||
| 348 | return 0; | ||
| 349 | |||
| 350 | exit4: | ||
| 351 | pcmcia_disable_device(link); | ||
| 352 | exit3: | ||
| 353 | if (ipw->attr_memory) { | ||
| 354 | iounmap(ipw->attr_memory); | ||
| 355 | pcmcia_release_window(ipw->handle_attr_memory); | ||
| 356 | pcmcia_disable_device(link); | ||
| 357 | } | ||
| 358 | exit2: | ||
| 359 | if (ipw->common_memory) { | ||
| 360 | iounmap(ipw->common_memory); | ||
| 361 | pcmcia_release_window(ipw->handle_common_memory); | ||
| 362 | } | ||
| 363 | exit1: | ||
| 364 | pcmcia_disable_device(link); | ||
| 365 | exit0: | ||
| 366 | return -1; | ||
| 367 | } | ||
| 368 | |||
| 369 | static void release_ipwireless(struct ipw_dev *ipw) | ||
| 370 | { | ||
| 371 | struct pcmcia_device *link = ipw->link; | ||
| 372 | |||
| 373 | pcmcia_disable_device(link); | ||
| 374 | |||
| 375 | if (ipw->common_memory) | ||
| 376 | iounmap(ipw->common_memory); | ||
| 377 | if (ipw->attr_memory) | ||
| 378 | iounmap(ipw->attr_memory); | ||
| 379 | if (ipw->common_memory) | ||
| 380 | pcmcia_release_window(ipw->handle_common_memory); | ||
| 381 | if (ipw->attr_memory) | ||
| 382 | pcmcia_release_window(ipw->handle_attr_memory); | ||
| 383 | pcmcia_disable_device(link); | ||
| 384 | } | ||
| 385 | |||
| 386 | /* | ||
| 387 | * ipwireless_attach() creates an "instance" of the driver, allocating | ||
| 388 | * local data structures for one device (one interface). The device | ||
| 389 | * is registered with Card Services. | ||
| 390 | * | ||
| 391 | * The pcmcia_device structure is initialized, but we don't actually | ||
| 392 | * configure the card at this point -- we wait until we receive a | ||
| 393 | * card insertion event. | ||
| 394 | */ | ||
| 395 | static int ipwireless_attach(struct pcmcia_device *link) | ||
| 396 | { | ||
| 397 | struct ipw_dev *ipw; | ||
| 398 | int ret; | ||
| 399 | |||
| 400 | ipw = kzalloc(sizeof(struct ipw_dev), GFP_KERNEL); | ||
| 401 | if (!ipw) | ||
| 402 | return -ENOMEM; | ||
| 403 | |||
| 404 | ipw->link = link; | ||
| 405 | link->priv = ipw; | ||
| 406 | link->irq.Instance = ipw; | ||
| 407 | |||
| 408 | /* Link this device into our device list. */ | ||
| 409 | link->dev_node = &ipw->nodes[0]; | ||
| 410 | |||
| 411 | ipw->hardware = ipwireless_hardware_create(); | ||
| 412 | if (!ipw->hardware) { | ||
| 413 | kfree(ipw); | ||
| 414 | return -ENOMEM; | ||
| 415 | } | ||
| 416 | /* RegisterClient will call config_ipwireless */ | ||
| 417 | |||
| 418 | ret = config_ipwireless(ipw); | ||
| 419 | |||
| 420 | if (ret != 0) { | ||
| 421 | cs_error(link, RegisterClient, ret); | ||
| 422 | ipwireless_detach(link); | ||
| 423 | return ret; | ||
| 424 | } | ||
| 425 | |||
| 426 | return 0; | ||
| 427 | } | ||
| 428 | |||
| 429 | /* | ||
| 430 | * This deletes a driver "instance". The device is de-registered with | ||
| 431 | * Card Services. If it has been released, all local data structures | ||
| 432 | * are freed. Otherwise, the structures will be freed when the device | ||
| 433 | * is released. | ||
| 434 | */ | ||
| 435 | static void ipwireless_detach(struct pcmcia_device *link) | ||
| 436 | { | ||
| 437 | struct ipw_dev *ipw = link->priv; | ||
| 438 | |||
| 439 | release_ipwireless(ipw); | ||
| 440 | |||
| 441 | /* Break the link with Card Services */ | ||
| 442 | if (link) | ||
| 443 | pcmcia_disable_device(link); | ||
| 444 | |||
| 445 | if (ipw->tty != NULL) | ||
| 446 | ipwireless_tty_free(ipw->tty); | ||
| 447 | if (ipw->network != NULL) | ||
| 448 | ipwireless_network_free(ipw->network); | ||
| 449 | if (ipw->hardware != NULL) | ||
| 450 | ipwireless_hardware_free(ipw->hardware); | ||
| 451 | kfree(ipw); | ||
| 452 | } | ||
| 453 | |||
| 454 | static struct pcmcia_driver me = { | ||
| 455 | .owner = THIS_MODULE, | ||
| 456 | .probe = ipwireless_attach, | ||
| 457 | .remove = ipwireless_detach, | ||
| 458 | .drv = { .name = IPWIRELESS_PCCARD_NAME }, | ||
| 459 | .id_table = ipw_ids | ||
| 460 | }; | ||
| 461 | |||
| 462 | /* | ||
| 463 | * Module insertion : initialisation of the module. | ||
| 464 | * Register the card with cardmgr... | ||
| 465 | */ | ||
| 466 | static int __init init_ipwireless(void) | ||
| 467 | { | ||
| 468 | int ret; | ||
| 469 | |||
| 470 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME " " | ||
| 471 | IPWIRELESS_PCMCIA_VERSION " by " IPWIRELESS_PCMCIA_AUTHOR "\n"); | ||
| 472 | |||
| 473 | ret = ipwireless_tty_init(); | ||
| 474 | if (ret != 0) | ||
| 475 | return ret; | ||
| 476 | |||
| 477 | ret = pcmcia_register_driver(&me); | ||
| 478 | if (ret != 0) | ||
| 479 | ipwireless_tty_release(); | ||
| 480 | |||
| 481 | return ret; | ||
| 482 | } | ||
| 483 | |||
| 484 | /* | ||
| 485 | * Module removal | ||
| 486 | */ | ||
| 487 | static void __exit exit_ipwireless(void) | ||
| 488 | { | ||
| 489 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME " " | ||
| 490 | IPWIRELESS_PCMCIA_VERSION " removed\n"); | ||
| 491 | |||
| 492 | pcmcia_unregister_driver(&me); | ||
| 493 | ipwireless_tty_release(); | ||
| 494 | } | ||
| 495 | |||
| 496 | module_init(init_ipwireless); | ||
| 497 | module_exit(exit_ipwireless); | ||
| 498 | |||
| 499 | MODULE_AUTHOR(IPWIRELESS_PCMCIA_AUTHOR); | ||
| 500 | MODULE_DESCRIPTION(IPWIRELESS_PCCARD_NAME " " IPWIRELESS_PCMCIA_VERSION); | ||
| 501 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/char/pcmcia/ipwireless/main.h b/drivers/char/pcmcia/ipwireless/main.h new file mode 100644 index 000000000000..1bfdcc8d47d6 --- /dev/null +++ b/drivers/char/pcmcia/ipwireless/main.h | |||
| @@ -0,0 +1,70 @@ | |||
| 1 | /* | ||
| 2 | * IPWireless 3G PCMCIA Network Driver | ||
| 3 | * | ||
| 4 | * Original code | ||
| 5 | * by Stephen Blackheath <stephen@blacksapphire.com>, | ||
| 6 | * Ben Martel <benm@symmetric.co.nz> | ||
| 7 | * | ||
| 8 | * Copyrighted as follows: | ||
| 9 | * Copyright (C) 2004 by Symmetric Systems Ltd (NZ) | ||
| 10 | * | ||
| 11 | * Various driver changes and rewrites, port to new kernels | ||
| 12 | * Copyright (C) 2006-2007 Jiri Kosina | ||
| 13 | * | ||
| 14 | * Misc code cleanups and updates | ||
| 15 | * Copyright (C) 2007 David Sterba | ||
| 16 | */ | ||
| 17 | |||
| 18 | #ifndef _IPWIRELESS_CS_H_ | ||
| 19 | #define _IPWIRELESS_CS_H_ | ||
| 20 | |||
| 21 | #include <linux/sched.h> | ||
| 22 | #include <linux/types.h> | ||
| 23 | |||
| 24 | #include <pcmcia/cs_types.h> | ||
| 25 | #include <pcmcia/cs.h> | ||
| 26 | #include <pcmcia/cistpl.h> | ||
| 27 | #include <pcmcia/ds.h> | ||
| 28 | |||
| 29 | #include "hardware.h" | ||
| 30 | |||
| 31 | #define IPWIRELESS_PCCARD_NAME "ipwireless" | ||
| 32 | #define IPWIRELESS_PCMCIA_VERSION "1.1" | ||
| 33 | #define IPWIRELESS_PCMCIA_AUTHOR \ | ||
| 34 | "Stephen Blackheath, Ben Martel, Jiri Kosina and David Sterba" | ||
| 35 | |||
| 36 | #define IPWIRELESS_TX_QUEUE_SIZE 262144 | ||
| 37 | #define IPWIRELESS_RX_QUEUE_SIZE 262144 | ||
| 38 | |||
| 39 | #define IPWIRELESS_STATE_DEBUG | ||
| 40 | |||
| 41 | struct ipw_hardware; | ||
| 42 | struct ipw_network; | ||
| 43 | struct ipw_tty; | ||
| 44 | |||
| 45 | struct ipw_dev { | ||
| 46 | struct pcmcia_device *link; | ||
| 47 | int is_v2_card; | ||
| 48 | window_handle_t handle_attr_memory; | ||
| 49 | void __iomem *attr_memory; | ||
| 50 | window_handle_t handle_common_memory; | ||
| 51 | void __iomem *common_memory; | ||
| 52 | dev_node_t nodes[2]; | ||
| 53 | /* Reference to attribute memory, containing CIS data */ | ||
| 54 | void *attribute_memory; | ||
| 55 | |||
| 56 | /* Hardware context */ | ||
| 57 | struct ipw_hardware *hardware; | ||
| 58 | /* Network layer context */ | ||
| 59 | struct ipw_network *network; | ||
| 60 | /* TTY device context */ | ||
| 61 | struct ipw_tty *tty; | ||
| 62 | struct work_struct work_reboot; | ||
| 63 | }; | ||
| 64 | |||
| 65 | /* Module parametres */ | ||
| 66 | extern int ipwireless_debug; | ||
| 67 | extern int ipwireless_loopback; | ||
| 68 | extern int ipwireless_out_queue; | ||
| 69 | |||
| 70 | #endif | ||
diff --git a/drivers/char/pcmcia/ipwireless/network.c b/drivers/char/pcmcia/ipwireless/network.c new file mode 100644 index 000000000000..ff35230058d3 --- /dev/null +++ b/drivers/char/pcmcia/ipwireless/network.c | |||
| @@ -0,0 +1,512 @@ | |||
| 1 | /* | ||
| 2 | * IPWireless 3G PCMCIA Network Driver | ||
| 3 | * | ||
| 4 | * Original code | ||
| 5 | * by Stephen Blackheath <stephen@blacksapphire.com>, | ||
| 6 | * Ben Martel <benm@symmetric.co.nz> | ||
| 7 | * | ||
| 8 | * Copyrighted as follows: | ||
| 9 | * Copyright (C) 2004 by Symmetric Systems Ltd (NZ) | ||
| 10 | * | ||
| 11 | * Various driver changes and rewrites, port to new kernels | ||
| 12 | * Copyright (C) 2006-2007 Jiri Kosina | ||
| 13 | * | ||
| 14 | * Misc code cleanups and updates | ||
| 15 | * Copyright (C) 2007 David Sterba | ||
| 16 | */ | ||
| 17 | |||
| 18 | #include <linux/interrupt.h> | ||
| 19 | #include <linux/kernel.h> | ||
| 20 | #include <linux/mutex.h> | ||
| 21 | #include <linux/netdevice.h> | ||
| 22 | #include <linux/ppp_channel.h> | ||
| 23 | #include <linux/ppp_defs.h> | ||
| 24 | #include <linux/if_ppp.h> | ||
| 25 | #include <linux/skbuff.h> | ||
| 26 | |||
| 27 | #include "network.h" | ||
| 28 | #include "hardware.h" | ||
| 29 | #include "main.h" | ||
| 30 | #include "tty.h" | ||
| 31 | |||
| 32 | #define MAX_OUTGOING_PACKETS_QUEUED ipwireless_out_queue | ||
| 33 | #define MAX_ASSOCIATED_TTYS 2 | ||
| 34 | |||
| 35 | #define SC_RCV_BITS (SC_RCV_B7_1|SC_RCV_B7_0|SC_RCV_ODDP|SC_RCV_EVNP) | ||
| 36 | |||
| 37 | struct ipw_network { | ||
| 38 | /* Hardware context, used for calls to hardware layer. */ | ||
| 39 | struct ipw_hardware *hardware; | ||
| 40 | /* Context for kernel 'generic_ppp' functionality */ | ||
| 41 | struct ppp_channel *ppp_channel; | ||
| 42 | /* tty context connected with IPW console */ | ||
| 43 | struct ipw_tty *associated_ttys[NO_OF_IPW_CHANNELS][MAX_ASSOCIATED_TTYS]; | ||
| 44 | /* True if ppp needs waking up once we're ready to xmit */ | ||
| 45 | int ppp_blocked; | ||
| 46 | /* Number of packets queued up in hardware module. */ | ||
| 47 | int outgoing_packets_queued; | ||
| 48 | /* Spinlock to avoid interrupts during shutdown */ | ||
| 49 | spinlock_t spinlock; | ||
| 50 | struct mutex close_lock; | ||
| 51 | |||
| 52 | /* PPP ioctl data, not actually used anywere */ | ||
| 53 | unsigned int flags; | ||
| 54 | unsigned int rbits; | ||
| 55 | u32 xaccm[8]; | ||
| 56 | u32 raccm; | ||
| 57 | int mru; | ||
| 58 | |||
| 59 | int shutting_down; | ||
| 60 | unsigned int ras_control_lines; | ||
| 61 | |||
| 62 | struct work_struct work_go_online; | ||
| 63 | struct work_struct work_go_offline; | ||
| 64 | }; | ||
| 65 | |||
| 66 | |||
| 67 | #ifdef IPWIRELESS_STATE_DEBUG | ||
| 68 | int ipwireless_dump_network_state(char *p, size_t limit, | ||
| 69 | struct ipw_network *network) | ||
| 70 | { | ||
| 71 | return snprintf(p, limit, | ||
| 72 | "debug: ppp_blocked=%d\n" | ||
| 73 | "debug: outgoing_packets_queued=%d\n" | ||
| 74 | "debug: network.shutting_down=%d\n", | ||
| 75 | network->ppp_blocked, | ||
| 76 | network->outgoing_packets_queued, | ||
| 77 | network->shutting_down); | ||
| 78 | } | ||
| 79 | #endif | ||
| 80 | |||
| 81 | static void notify_packet_sent(void *callback_data, unsigned int packet_length) | ||
| 82 | { | ||
| 83 | struct ipw_network *network = callback_data; | ||
| 84 | unsigned long flags; | ||
| 85 | |||
| 86 | spin_lock_irqsave(&network->spinlock, flags); | ||
| 87 | network->outgoing_packets_queued--; | ||
| 88 | if (network->ppp_channel != NULL) { | ||
| 89 | if (network->ppp_blocked) { | ||
| 90 | network->ppp_blocked = 0; | ||
| 91 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 92 | ppp_output_wakeup(network->ppp_channel); | ||
| 93 | if (ipwireless_debug) | ||
| 94 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 95 | ": ppp unblocked\n"); | ||
| 96 | } else | ||
| 97 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 98 | } else | ||
| 99 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 100 | } | ||
| 101 | |||
| 102 | /* | ||
| 103 | * Called by the ppp system when it has a packet to send to the hardware. | ||
| 104 | */ | ||
| 105 | static int ipwireless_ppp_start_xmit(struct ppp_channel *ppp_channel, | ||
| 106 | struct sk_buff *skb) | ||
| 107 | { | ||
| 108 | struct ipw_network *network = ppp_channel->private; | ||
| 109 | unsigned long flags; | ||
| 110 | |||
| 111 | spin_lock_irqsave(&network->spinlock, flags); | ||
| 112 | if (network->outgoing_packets_queued < MAX_OUTGOING_PACKETS_QUEUED) { | ||
| 113 | unsigned char *buf; | ||
| 114 | static unsigned char header[] = { | ||
| 115 | PPP_ALLSTATIONS, /* 0xff */ | ||
| 116 | PPP_UI, /* 0x03 */ | ||
| 117 | }; | ||
| 118 | int ret; | ||
| 119 | |||
| 120 | network->outgoing_packets_queued++; | ||
| 121 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 122 | |||
| 123 | /* | ||
| 124 | * If we have the requested amount of headroom in the skb we | ||
| 125 | * were handed, then we can add the header efficiently. | ||
| 126 | */ | ||
| 127 | if (skb_headroom(skb) >= 2) { | ||
| 128 | memcpy(skb_push(skb, 2), header, 2); | ||
| 129 | ret = ipwireless_send_packet(network->hardware, | ||
| 130 | IPW_CHANNEL_RAS, skb->data, | ||
| 131 | skb->len, | ||
| 132 | notify_packet_sent, | ||
| 133 | network); | ||
| 134 | if (ret == -1) { | ||
| 135 | skb_pull(skb, 2); | ||
| 136 | return 0; | ||
| 137 | } | ||
| 138 | } else { | ||
| 139 | /* Otherwise (rarely) we do it inefficiently. */ | ||
| 140 | buf = kmalloc(skb->len + 2, GFP_ATOMIC); | ||
| 141 | if (!buf) | ||
| 142 | return 0; | ||
| 143 | memcpy(buf + 2, skb->data, skb->len); | ||
| 144 | memcpy(buf, header, 2); | ||
| 145 | ret = ipwireless_send_packet(network->hardware, | ||
| 146 | IPW_CHANNEL_RAS, buf, | ||
| 147 | skb->len + 2, | ||
| 148 | notify_packet_sent, | ||
| 149 | network); | ||
| 150 | kfree(buf); | ||
| 151 | if (ret == -1) | ||
| 152 | return 0; | ||
| 153 | } | ||
| 154 | kfree_skb(skb); | ||
| 155 | return 1; | ||
| 156 | } else { | ||
| 157 | /* | ||
| 158 | * Otherwise reject the packet, and flag that the ppp system | ||
| 159 | * needs to be unblocked once we are ready to send. | ||
| 160 | */ | ||
| 161 | network->ppp_blocked = 1; | ||
| 162 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 163 | return 0; | ||
| 164 | } | ||
| 165 | } | ||
| 166 | |||
| 167 | /* Handle an ioctl call that has come in via ppp. (copy of ppp_async_ioctl() */ | ||
| 168 | static int ipwireless_ppp_ioctl(struct ppp_channel *ppp_channel, | ||
| 169 | unsigned int cmd, unsigned long arg) | ||
| 170 | { | ||
| 171 | struct ipw_network *network = ppp_channel->private; | ||
| 172 | int err, val; | ||
| 173 | u32 accm[8]; | ||
| 174 | int __user *user_arg = (int __user *) arg; | ||
| 175 | |||
| 176 | err = -EFAULT; | ||
| 177 | switch (cmd) { | ||
| 178 | case PPPIOCGFLAGS: | ||
| 179 | val = network->flags | network->rbits; | ||
| 180 | if (put_user(val, user_arg)) | ||
| 181 | break; | ||
| 182 | err = 0; | ||
| 183 | break; | ||
| 184 | |||
| 185 | case PPPIOCSFLAGS: | ||
| 186 | if (get_user(val, user_arg)) | ||
| 187 | break; | ||
| 188 | network->flags = val & ~SC_RCV_BITS; | ||
| 189 | network->rbits = val & SC_RCV_BITS; | ||
| 190 | err = 0; | ||
| 191 | break; | ||
| 192 | |||
| 193 | case PPPIOCGASYNCMAP: | ||
| 194 | if (put_user(network->xaccm[0], user_arg)) | ||
| 195 | break; | ||
| 196 | err = 0; | ||
| 197 | break; | ||
| 198 | |||
| 199 | case PPPIOCSASYNCMAP: | ||
| 200 | if (get_user(network->xaccm[0], user_arg)) | ||
| 201 | break; | ||
| 202 | err = 0; | ||
| 203 | break; | ||
| 204 | |||
| 205 | case PPPIOCGRASYNCMAP: | ||
| 206 | if (put_user(network->raccm, user_arg)) | ||
| 207 | break; | ||
| 208 | err = 0; | ||
| 209 | break; | ||
| 210 | |||
| 211 | case PPPIOCSRASYNCMAP: | ||
| 212 | if (get_user(network->raccm, user_arg)) | ||
| 213 | break; | ||
| 214 | err = 0; | ||
| 215 | break; | ||
| 216 | |||
| 217 | case PPPIOCGXASYNCMAP: | ||
| 218 | if (copy_to_user((void __user *) arg, network->xaccm, | ||
| 219 | sizeof(network->xaccm))) | ||
| 220 | break; | ||
| 221 | err = 0; | ||
| 222 | break; | ||
| 223 | |||
| 224 | case PPPIOCSXASYNCMAP: | ||
| 225 | if (copy_from_user(accm, (void __user *) arg, sizeof(accm))) | ||
| 226 | break; | ||
| 227 | accm[2] &= ~0x40000000U; /* can't escape 0x5e */ | ||
| 228 | accm[3] |= 0x60000000U; /* must escape 0x7d, 0x7e */ | ||
| 229 | memcpy(network->xaccm, accm, sizeof(network->xaccm)); | ||
| 230 | err = 0; | ||
| 231 | break; | ||
| 232 | |||
| 233 | case PPPIOCGMRU: | ||
| 234 | if (put_user(network->mru, user_arg)) | ||
| 235 | break; | ||
| 236 | err = 0; | ||
| 237 | break; | ||
| 238 | |||
| 239 | case PPPIOCSMRU: | ||
| 240 | if (get_user(val, user_arg)) | ||
| 241 | break; | ||
| 242 | if (val < PPP_MRU) | ||
| 243 | val = PPP_MRU; | ||
| 244 | network->mru = val; | ||
| 245 | err = 0; | ||
| 246 | break; | ||
| 247 | |||
| 248 | default: | ||
| 249 | err = -ENOTTY; | ||
| 250 | } | ||
| 251 | |||
| 252 | return err; | ||
| 253 | } | ||
| 254 | |||
| 255 | static struct ppp_channel_ops ipwireless_ppp_channel_ops = { | ||
| 256 | .start_xmit = ipwireless_ppp_start_xmit, | ||
| 257 | .ioctl = ipwireless_ppp_ioctl | ||
| 258 | }; | ||
| 259 | |||
| 260 | static void do_go_online(struct work_struct *work_go_online) | ||
| 261 | { | ||
| 262 | struct ipw_network *network = | ||
| 263 | container_of(work_go_online, struct ipw_network, | ||
| 264 | work_go_online); | ||
| 265 | unsigned long flags; | ||
| 266 | |||
| 267 | spin_lock_irqsave(&network->spinlock, flags); | ||
| 268 | if (!network->ppp_channel) { | ||
| 269 | struct ppp_channel *channel; | ||
| 270 | |||
| 271 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 272 | channel = kzalloc(sizeof(struct ppp_channel), GFP_KERNEL); | ||
| 273 | if (!channel) { | ||
| 274 | printk(KERN_ERR IPWIRELESS_PCCARD_NAME | ||
| 275 | ": unable to allocate PPP channel\n"); | ||
| 276 | return; | ||
| 277 | } | ||
| 278 | channel->private = network; | ||
| 279 | channel->mtu = 16384; /* Wild guess */ | ||
| 280 | channel->hdrlen = 2; | ||
| 281 | channel->ops = &ipwireless_ppp_channel_ops; | ||
| 282 | |||
| 283 | network->flags = 0; | ||
| 284 | network->rbits = 0; | ||
| 285 | network->mru = PPP_MRU; | ||
| 286 | memset(network->xaccm, 0, sizeof(network->xaccm)); | ||
| 287 | network->xaccm[0] = ~0U; | ||
| 288 | network->xaccm[3] = 0x60000000U; | ||
| 289 | network->raccm = ~0U; | ||
| 290 | ppp_register_channel(channel); | ||
| 291 | spin_lock_irqsave(&network->spinlock, flags); | ||
| 292 | network->ppp_channel = channel; | ||
| 293 | } | ||
| 294 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 295 | } | ||
| 296 | |||
| 297 | static void do_go_offline(struct work_struct *work_go_offline) | ||
| 298 | { | ||
| 299 | struct ipw_network *network = | ||
| 300 | container_of(work_go_offline, struct ipw_network, | ||
| 301 | work_go_offline); | ||
| 302 | unsigned long flags; | ||
| 303 | |||
| 304 | mutex_lock(&network->close_lock); | ||
| 305 | spin_lock_irqsave(&network->spinlock, flags); | ||
| 306 | if (network->ppp_channel != NULL) { | ||
| 307 | struct ppp_channel *channel = network->ppp_channel; | ||
| 308 | |||
| 309 | network->ppp_channel = NULL; | ||
| 310 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 311 | mutex_unlock(&network->close_lock); | ||
| 312 | ppp_unregister_channel(channel); | ||
| 313 | } else { | ||
| 314 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 315 | mutex_unlock(&network->close_lock); | ||
| 316 | } | ||
| 317 | } | ||
| 318 | |||
| 319 | void ipwireless_network_notify_control_line_change(struct ipw_network *network, | ||
| 320 | unsigned int channel_idx, | ||
| 321 | unsigned int control_lines, | ||
| 322 | unsigned int changed_mask) | ||
| 323 | { | ||
| 324 | int i; | ||
| 325 | |||
| 326 | if (channel_idx == IPW_CHANNEL_RAS) | ||
| 327 | network->ras_control_lines = control_lines; | ||
| 328 | |||
| 329 | for (i = 0; i < MAX_ASSOCIATED_TTYS; i++) { | ||
| 330 | struct ipw_tty *tty = | ||
| 331 | network->associated_ttys[channel_idx][i]; | ||
| 332 | |||
| 333 | /* | ||
| 334 | * If it's associated with a tty (other than the RAS channel | ||
| 335 | * when we're online), then send the data to that tty. The RAS | ||
| 336 | * channel's data is handled above - it always goes through | ||
| 337 | * ppp_generic. | ||
| 338 | */ | ||
| 339 | if (tty) | ||
| 340 | ipwireless_tty_notify_control_line_change(tty, | ||
| 341 | channel_idx, | ||
| 342 | control_lines, | ||
| 343 | changed_mask); | ||
| 344 | } | ||
| 345 | } | ||
| 346 | |||
| 347 | /* | ||
| 348 | * Some versions of firmware stuff packets with 0xff 0x03 (PPP: ALLSTATIONS, UI) | ||
| 349 | * bytes, which are required on sent packet, but not always present on received | ||
| 350 | * packets | ||
| 351 | */ | ||
| 352 | static struct sk_buff *ipw_packet_received_skb(unsigned char *data, | ||
| 353 | unsigned int length) | ||
| 354 | { | ||
| 355 | struct sk_buff *skb; | ||
| 356 | |||
| 357 | if (length > 2 && data[0] == PPP_ALLSTATIONS && data[1] == PPP_UI) { | ||
| 358 | length -= 2; | ||
| 359 | data += 2; | ||
| 360 | } | ||
| 361 | |||
| 362 | skb = dev_alloc_skb(length + 4); | ||
| 363 | skb_reserve(skb, 2); | ||
| 364 | memcpy(skb_put(skb, length), data, length); | ||
| 365 | |||
| 366 | return skb; | ||
| 367 | } | ||
| 368 | |||
| 369 | void ipwireless_network_packet_received(struct ipw_network *network, | ||
| 370 | unsigned int channel_idx, | ||
| 371 | unsigned char *data, | ||
| 372 | unsigned int length) | ||
| 373 | { | ||
| 374 | int i; | ||
| 375 | unsigned long flags; | ||
| 376 | |||
| 377 | for (i = 0; i < MAX_ASSOCIATED_TTYS; i++) { | ||
| 378 | struct ipw_tty *tty = network->associated_ttys[channel_idx][i]; | ||
| 379 | |||
| 380 | /* | ||
| 381 | * If it's associated with a tty (other than the RAS channel | ||
| 382 | * when we're online), then send the data to that tty. The RAS | ||
| 383 | * channel's data is handled above - it always goes through | ||
| 384 | * ppp_generic. | ||
| 385 | */ | ||
| 386 | if (tty && channel_idx == IPW_CHANNEL_RAS | ||
| 387 | && (network->ras_control_lines & | ||
| 388 | IPW_CONTROL_LINE_DCD) != 0 | ||
| 389 | && ipwireless_tty_is_modem(tty)) { | ||
| 390 | /* | ||
| 391 | * If data came in on the RAS channel and this tty is | ||
| 392 | * the modem tty, and we are online, then we send it to | ||
| 393 | * the PPP layer. | ||
| 394 | */ | ||
| 395 | mutex_lock(&network->close_lock); | ||
| 396 | spin_lock_irqsave(&network->spinlock, flags); | ||
| 397 | if (network->ppp_channel != NULL) { | ||
| 398 | struct sk_buff *skb; | ||
| 399 | |||
| 400 | spin_unlock_irqrestore(&network->spinlock, | ||
| 401 | flags); | ||
| 402 | |||
| 403 | /* Send the data to the ppp_generic module. */ | ||
| 404 | skb = ipw_packet_received_skb(data, length); | ||
| 405 | ppp_input(network->ppp_channel, skb); | ||
| 406 | } else | ||
| 407 | spin_unlock_irqrestore(&network->spinlock, | ||
| 408 | flags); | ||
| 409 | mutex_unlock(&network->close_lock); | ||
| 410 | } | ||
| 411 | /* Otherwise we send it out the tty. */ | ||
| 412 | else | ||
| 413 | ipwireless_tty_received(tty, data, length); | ||
| 414 | } | ||
| 415 | } | ||
| 416 | |||
| 417 | struct ipw_network *ipwireless_network_create(struct ipw_hardware *hw) | ||
| 418 | { | ||
| 419 | struct ipw_network *network = | ||
| 420 | kzalloc(sizeof(struct ipw_network), GFP_ATOMIC); | ||
| 421 | |||
| 422 | if (!network) | ||
| 423 | return NULL; | ||
| 424 | |||
| 425 | spin_lock_init(&network->spinlock); | ||
| 426 | mutex_init(&network->close_lock); | ||
| 427 | |||
| 428 | network->hardware = hw; | ||
| 429 | |||
| 430 | INIT_WORK(&network->work_go_online, do_go_online); | ||
| 431 | INIT_WORK(&network->work_go_offline, do_go_offline); | ||
| 432 | |||
| 433 | ipwireless_associate_network(hw, network); | ||
| 434 | |||
| 435 | return network; | ||
| 436 | } | ||
| 437 | |||
| 438 | void ipwireless_network_free(struct ipw_network *network) | ||
| 439 | { | ||
| 440 | network->shutting_down = 1; | ||
| 441 | |||
| 442 | ipwireless_ppp_close(network); | ||
| 443 | flush_scheduled_work(); | ||
| 444 | |||
| 445 | ipwireless_stop_interrupts(network->hardware); | ||
| 446 | ipwireless_associate_network(network->hardware, NULL); | ||
| 447 | |||
| 448 | kfree(network); | ||
| 449 | } | ||
| 450 | |||
| 451 | void ipwireless_associate_network_tty(struct ipw_network *network, | ||
| 452 | unsigned int channel_idx, | ||
| 453 | struct ipw_tty *tty) | ||
| 454 | { | ||
| 455 | int i; | ||
| 456 | |||
| 457 | for (i = 0; i < MAX_ASSOCIATED_TTYS; i++) | ||
| 458 | if (network->associated_ttys[channel_idx][i] == NULL) { | ||
| 459 | network->associated_ttys[channel_idx][i] = tty; | ||
| 460 | break; | ||
| 461 | } | ||
| 462 | } | ||
| 463 | |||
| 464 | void ipwireless_disassociate_network_ttys(struct ipw_network *network, | ||
| 465 | unsigned int channel_idx) | ||
| 466 | { | ||
| 467 | int i; | ||
| 468 | |||
| 469 | for (i = 0; i < MAX_ASSOCIATED_TTYS; i++) | ||
| 470 | network->associated_ttys[channel_idx][i] = NULL; | ||
| 471 | } | ||
| 472 | |||
| 473 | void ipwireless_ppp_open(struct ipw_network *network) | ||
| 474 | { | ||
| 475 | if (ipwireless_debug) | ||
| 476 | printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME ": online\n"); | ||
| 477 | schedule_work(&network->work_go_online); | ||
| 478 | } | ||
| 479 | |||
| 480 | void ipwireless_ppp_close(struct ipw_network *network) | ||
| 481 | { | ||
| 482 | /* Disconnect from the wireless network. */ | ||
| 483 | if (ipwireless_debug) | ||
| 484 | printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME ": offline\n"); | ||
| 485 | schedule_work(&network->work_go_offline); | ||
| 486 | } | ||
| 487 | |||
| 488 | int ipwireless_ppp_channel_index(struct ipw_network *network) | ||
| 489 | { | ||
| 490 | int ret = -1; | ||
| 491 | unsigned long flags; | ||
| 492 | |||
| 493 | spin_lock_irqsave(&network->spinlock, flags); | ||
| 494 | if (network->ppp_channel != NULL) | ||
| 495 | ret = ppp_channel_index(network->ppp_channel); | ||
| 496 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 497 | |||
| 498 | return ret; | ||
| 499 | } | ||
| 500 | |||
| 501 | int ipwireless_ppp_unit_number(struct ipw_network *network) | ||
| 502 | { | ||
| 503 | int ret = -1; | ||
| 504 | unsigned long flags; | ||
| 505 | |||
| 506 | spin_lock_irqsave(&network->spinlock, flags); | ||
| 507 | if (network->ppp_channel != NULL) | ||
| 508 | ret = ppp_unit_number(network->ppp_channel); | ||
| 509 | spin_unlock_irqrestore(&network->spinlock, flags); | ||
| 510 | |||
| 511 | return ret; | ||
| 512 | } | ||
diff --git a/drivers/char/pcmcia/ipwireless/network.h b/drivers/char/pcmcia/ipwireless/network.h new file mode 100644 index 000000000000..b0e1e952fd14 --- /dev/null +++ b/drivers/char/pcmcia/ipwireless/network.h | |||
| @@ -0,0 +1,55 @@ | |||
| 1 | /* | ||
| 2 | * IPWireless 3G PCMCIA Network Driver | ||
| 3 | * | ||
| 4 | * Original code | ||
| 5 | * by Stephen Blackheath <stephen@blacksapphire.com>, | ||
| 6 | * Ben Martel <benm@symmetric.co.nz> | ||
| 7 | * | ||
| 8 | * Copyrighted as follows: | ||
| 9 | * Copyright (C) 2004 by Symmetric Systems Ltd (NZ) | ||
| 10 | * | ||
| 11 | * Various driver changes and rewrites, port to new kernels | ||
| 12 | * Copyright (C) 2006-2007 Jiri Kosina | ||
| 13 | * | ||
| 14 | * Misc code cleanups and updates | ||
| 15 | * Copyright (C) 2007 David Sterba | ||
| 16 | */ | ||
| 17 | |||
| 18 | #ifndef _IPWIRELESS_CS_NETWORK_H_ | ||
| 19 | #define _IPWIRELESS_CS_NETWORK_H_ | ||
| 20 | |||
| 21 | #include <linux/types.h> | ||
| 22 | |||
| 23 | struct ipw_network; | ||
| 24 | struct ipw_tty; | ||
| 25 | struct ipw_hardware; | ||
| 26 | |||
| 27 | /* Definitions of the different channels on the PCMCIA UE */ | ||
| 28 | #define IPW_CHANNEL_RAS 0 | ||
| 29 | #define IPW_CHANNEL_DIALLER 1 | ||
| 30 | #define IPW_CHANNEL_CONSOLE 2 | ||
| 31 | #define NO_OF_IPW_CHANNELS 5 | ||
| 32 | |||
| 33 | void ipwireless_network_notify_control_line_change(struct ipw_network *net, | ||
| 34 | unsigned int channel_idx, unsigned int control_lines, | ||
| 35 | unsigned int control_mask); | ||
| 36 | void ipwireless_network_packet_received(struct ipw_network *net, | ||
| 37 | unsigned int channel_idx, unsigned char *data, | ||
| 38 | unsigned int length); | ||
| 39 | struct ipw_network *ipwireless_network_create(struct ipw_hardware *hw); | ||
| 40 | void ipwireless_network_free(struct ipw_network *net); | ||
| 41 | void ipwireless_associate_network_tty(struct ipw_network *net, | ||
| 42 | unsigned int channel_idx, struct ipw_tty *tty); | ||
| 43 | void ipwireless_disassociate_network_ttys(struct ipw_network *net, | ||
| 44 | unsigned int channel_idx); | ||
| 45 | |||
| 46 | void ipwireless_ppp_open(struct ipw_network *net); | ||
| 47 | |||
| 48 | void ipwireless_ppp_close(struct ipw_network *net); | ||
| 49 | int ipwireless_ppp_channel_index(struct ipw_network *net); | ||
| 50 | int ipwireless_ppp_unit_number(struct ipw_network *net); | ||
| 51 | |||
| 52 | int ipwireless_dump_network_state(char *p, size_t limit, | ||
| 53 | struct ipw_network *net); | ||
| 54 | |||
| 55 | #endif | ||
diff --git a/drivers/char/pcmcia/ipwireless/setup_protocol.h b/drivers/char/pcmcia/ipwireless/setup_protocol.h new file mode 100644 index 000000000000..9d6bcc77c73c --- /dev/null +++ b/drivers/char/pcmcia/ipwireless/setup_protocol.h | |||
| @@ -0,0 +1,108 @@ | |||
| 1 | /* | ||
| 2 | * IPWireless 3G PCMCIA Network Driver | ||
| 3 | * | ||
| 4 | * Original code | ||
| 5 | * by Stephen Blackheath <stephen@blacksapphire.com>, | ||
| 6 | * Ben Martel <benm@symmetric.co.nz> | ||
| 7 | * | ||
| 8 | * Copyrighted as follows: | ||
| 9 | * Copyright (C) 2004 by Symmetric Systems Ltd (NZ) | ||
| 10 | * | ||
| 11 | * Various driver changes and rewrites, port to new kernels | ||
| 12 | * Copyright (C) 2006-2007 Jiri Kosina | ||
| 13 | * | ||
| 14 | * Misc code cleanups and updates | ||
| 15 | * Copyright (C) 2007 David Sterba | ||
| 16 | */ | ||
| 17 | |||
| 18 | #ifndef _IPWIRELESS_CS_SETUP_PROTOCOL_H_ | ||
| 19 | #define _IPWIRELESS_CS_SETUP_PROTOCOL_H_ | ||
| 20 | |||
| 21 | /* Version of the setup protocol and transport protocols */ | ||
| 22 | #define TL_SETUP_VERSION 1 | ||
| 23 | |||
| 24 | #define TL_SETUP_VERSION_QRY_TMO 1000 | ||
| 25 | #define TL_SETUP_MAX_VERSION_QRY 30 | ||
| 26 | |||
| 27 | /* Message numbers 0-9 are obsoleted and must not be reused! */ | ||
| 28 | #define TL_SETUP_SIGNO_GET_VERSION_QRY 10 | ||
| 29 | #define TL_SETUP_SIGNO_GET_VERSION_RSP 11 | ||
| 30 | #define TL_SETUP_SIGNO_CONFIG_MSG 12 | ||
| 31 | #define TL_SETUP_SIGNO_CONFIG_DONE_MSG 13 | ||
| 32 | #define TL_SETUP_SIGNO_OPEN_MSG 14 | ||
| 33 | #define TL_SETUP_SIGNO_CLOSE_MSG 15 | ||
| 34 | |||
| 35 | #define TL_SETUP_SIGNO_INFO_MSG 20 | ||
| 36 | #define TL_SETUP_SIGNO_INFO_MSG_ACK 21 | ||
| 37 | |||
| 38 | #define TL_SETUP_SIGNO_REBOOT_MSG 22 | ||
| 39 | #define TL_SETUP_SIGNO_REBOOT_MSG_ACK 23 | ||
| 40 | |||
| 41 | /* Synchronous start-messages */ | ||
| 42 | struct tl_setup_get_version_qry { | ||
| 43 | unsigned char sig_no; /* TL_SETUP_SIGNO_GET_VERSION_QRY */ | ||
| 44 | } __attribute__ ((__packed__)); | ||
| 45 | |||
| 46 | struct tl_setup_get_version_rsp { | ||
| 47 | unsigned char sig_no; /* TL_SETUP_SIGNO_GET_VERSION_RSP */ | ||
| 48 | unsigned char version; /* TL_SETUP_VERSION */ | ||
| 49 | } __attribute__ ((__packed__)); | ||
| 50 | |||
| 51 | struct tl_setup_config_msg { | ||
| 52 | unsigned char sig_no; /* TL_SETUP_SIGNO_CONFIG_MSG */ | ||
| 53 | unsigned char port_no; | ||
| 54 | unsigned char prio_data; | ||
| 55 | unsigned char prio_ctrl; | ||
| 56 | } __attribute__ ((__packed__)); | ||
| 57 | |||
| 58 | struct tl_setup_config_done_msg { | ||
| 59 | unsigned char sig_no; /* TL_SETUP_SIGNO_CONFIG_DONE_MSG */ | ||
| 60 | } __attribute__ ((__packed__)); | ||
| 61 | |||
| 62 | /* Asyncronous messages */ | ||
| 63 | struct tl_setup_open_msg { | ||
| 64 | unsigned char sig_no; /* TL_SETUP_SIGNO_OPEN_MSG */ | ||
| 65 | unsigned char port_no; | ||
| 66 | } __attribute__ ((__packed__)); | ||
| 67 | |||
| 68 | struct tl_setup_close_msg { | ||
| 69 | unsigned char sig_no; /* TL_SETUP_SIGNO_CLOSE_MSG */ | ||
| 70 | unsigned char port_no; | ||
| 71 | } __attribute__ ((__packed__)); | ||
| 72 | |||
| 73 | /* Driver type - for use in tl_setup_info_msg.driver_type */ | ||
| 74 | #define COMM_DRIVER 0 | ||
| 75 | #define NDISWAN_DRIVER 1 | ||
| 76 | #define NDISWAN_DRIVER_MAJOR_VERSION 2 | ||
| 77 | #define NDISWAN_DRIVER_MINOR_VERSION 0 | ||
| 78 | |||
| 79 | /* | ||
| 80 | * It should not matter when this message comes over as we just store the | ||
| 81 | * results and send the ACK. | ||
| 82 | */ | ||
| 83 | struct tl_setup_info_msg { | ||
| 84 | unsigned char sig_no; /* TL_SETUP_SIGNO_INFO_MSG */ | ||
| 85 | unsigned char driver_type; | ||
| 86 | unsigned char major_version; | ||
| 87 | unsigned char minor_version; | ||
| 88 | } __attribute__ ((__packed__)); | ||
| 89 | |||
| 90 | struct tl_setup_info_msgAck { | ||
| 91 | unsigned char sig_no; /* TL_SETUP_SIGNO_INFO_MSG_ACK */ | ||
| 92 | } __attribute__ ((__packed__)); | ||
| 93 | |||
| 94 | struct TlSetupRebootMsgAck { | ||
| 95 | unsigned char sig_no; /* TL_SETUP_SIGNO_REBOOT_MSG_ACK */ | ||
| 96 | } __attribute__ ((__packed__)); | ||
| 97 | |||
| 98 | /* Define a union of all the msgs that the driver can receive from the card.*/ | ||
| 99 | union ipw_setup_rx_msg { | ||
| 100 | unsigned char sig_no; | ||
| 101 | struct tl_setup_get_version_rsp version_rsp_msg; | ||
| 102 | struct tl_setup_open_msg open_msg; | ||
| 103 | struct tl_setup_close_msg close_msg; | ||
| 104 | struct tl_setup_info_msg InfoMsg; | ||
| 105 | struct tl_setup_info_msgAck info_msg_ack; | ||
| 106 | } __attribute__ ((__packed__)); | ||
| 107 | |||
| 108 | #endif /* _IPWIRELESS_CS_SETUP_PROTOCOL_H_ */ | ||
diff --git a/drivers/char/pcmcia/ipwireless/tty.c b/drivers/char/pcmcia/ipwireless/tty.c new file mode 100644 index 000000000000..42f3815c5ce3 --- /dev/null +++ b/drivers/char/pcmcia/ipwireless/tty.c | |||
| @@ -0,0 +1,688 @@ | |||
| 1 | /* | ||
| 2 | * IPWireless 3G PCMCIA Network Driver | ||
| 3 | * | ||
| 4 | * Original code | ||
| 5 | * by Stephen Blackheath <stephen@blacksapphire.com>, | ||
| 6 | * Ben Martel <benm@symmetric.co.nz> | ||
| 7 | * | ||
| 8 | * Copyrighted as follows: | ||
| 9 | * Copyright (C) 2004 by Symmetric Systems Ltd (NZ) | ||
| 10 | * | ||
| 11 | * Various driver changes and rewrites, port to new kernels | ||
| 12 | * Copyright (C) 2006-2007 Jiri Kosina | ||
| 13 | * | ||
| 14 | * Misc code cleanups and updates | ||
| 15 | * Copyright (C) 2007 David Sterba | ||
| 16 | */ | ||
| 17 | |||
| 18 | #include <linux/init.h> | ||
| 19 | #include <linux/kernel.h> | ||
| 20 | #include <linux/module.h> | ||
| 21 | #include <linux/mutex.h> | ||
| 22 | #include <linux/ppp_defs.h> | ||
| 23 | #include <linux/if.h> | ||
| 24 | #include <linux/if_ppp.h> | ||
| 25 | #include <linux/sched.h> | ||
| 26 | #include <linux/serial.h> | ||
| 27 | #include <linux/slab.h> | ||
| 28 | #include <linux/tty.h> | ||
| 29 | #include <linux/tty_driver.h> | ||
| 30 | #include <linux/tty_flip.h> | ||
| 31 | #include <linux/uaccess.h> | ||
| 32 | #include <linux/version.h> | ||
| 33 | |||
| 34 | #include "tty.h" | ||
| 35 | #include "network.h" | ||
| 36 | #include "hardware.h" | ||
| 37 | #include "main.h" | ||
| 38 | |||
| 39 | #define IPWIRELESS_PCMCIA_START (0) | ||
| 40 | #define IPWIRELESS_PCMCIA_MINORS (24) | ||
| 41 | #define IPWIRELESS_PCMCIA_MINOR_RANGE (8) | ||
| 42 | |||
| 43 | #define TTYTYPE_MODEM (0) | ||
| 44 | #define TTYTYPE_MONITOR (1) | ||
| 45 | #define TTYTYPE_RAS_RAW (2) | ||
| 46 | |||
| 47 | struct ipw_tty { | ||
| 48 | int index; | ||
| 49 | struct ipw_hardware *hardware; | ||
| 50 | unsigned int channel_idx; | ||
| 51 | unsigned int secondary_channel_idx; | ||
| 52 | int tty_type; | ||
| 53 | struct ipw_network *network; | ||
| 54 | struct tty_struct *linux_tty; | ||
| 55 | int open_count; | ||
| 56 | unsigned int control_lines; | ||
| 57 | struct mutex ipw_tty_mutex; | ||
| 58 | int tx_bytes_queued; | ||
| 59 | int closing; | ||
| 60 | }; | ||
| 61 | |||
| 62 | static struct ipw_tty *ttys[IPWIRELESS_PCMCIA_MINORS]; | ||
| 63 | |||
| 64 | static struct tty_driver *ipw_tty_driver; | ||
| 65 | |||
| 66 | static char *tty_type_name(int tty_type) | ||
| 67 | { | ||
| 68 | static char *channel_names[] = { | ||
| 69 | "modem", | ||
| 70 | "monitor", | ||
| 71 | "RAS-raw" | ||
| 72 | }; | ||
| 73 | |||
| 74 | return channel_names[tty_type]; | ||
| 75 | } | ||
| 76 | |||
| 77 | static void report_registering(struct ipw_tty *tty) | ||
| 78 | { | ||
| 79 | char *iftype = tty_type_name(tty->tty_type); | ||
| 80 | |||
| 81 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 82 | ": registering %s device ttyIPWp%d\n", iftype, tty->index); | ||
| 83 | } | ||
| 84 | |||
| 85 | static void report_deregistering(struct ipw_tty *tty) | ||
| 86 | { | ||
| 87 | char *iftype = tty_type_name(tty->tty_type); | ||
| 88 | |||
| 89 | printk(KERN_INFO IPWIRELESS_PCCARD_NAME | ||
| 90 | ": deregistering %s device ttyIPWp%d\n", iftype, | ||
| 91 | tty->index); | ||
| 92 | } | ||
| 93 | |||
| 94 | static struct ipw_tty *get_tty(int minor) | ||
| 95 | { | ||
| 96 | if (minor < ipw_tty_driver->minor_start | ||
| 97 | || minor >= ipw_tty_driver->minor_start + | ||
| 98 | IPWIRELESS_PCMCIA_MINORS) | ||
| 99 | return NULL; | ||
| 100 | else { | ||
| 101 | int minor_offset = minor - ipw_tty_driver->minor_start; | ||
| 102 | |||
| 103 | /* | ||
| 104 | * The 'ras_raw' channel is only available when 'loopback' mode | ||
| 105 | * is enabled. | ||
| 106 | * Number of minor starts with 16 (_RANGE * _RAS_RAW). | ||
| 107 | */ | ||
| 108 | if (!ipwireless_loopback && | ||
| 109 | minor_offset >= | ||
| 110 | IPWIRELESS_PCMCIA_MINOR_RANGE * TTYTYPE_RAS_RAW) | ||
| 111 | return NULL; | ||
| 112 | |||
| 113 | return ttys[minor_offset]; | ||
| 114 | } | ||
| 115 | } | ||
| 116 | |||
| 117 | static int ipw_open(struct tty_struct *linux_tty, struct file *filp) | ||
| 118 | { | ||
| 119 | int minor = linux_tty->index; | ||
| 120 | struct ipw_tty *tty = get_tty(minor); | ||
| 121 | |||
| 122 | if (!tty) | ||
| 123 | return -ENODEV; | ||
| 124 | |||
| 125 | mutex_lock(&tty->ipw_tty_mutex); | ||
| 126 | |||
| 127 | if (tty->closing) { | ||
| 128 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 129 | return -ENODEV; | ||
| 130 | } | ||
| 131 | if (tty->open_count == 0) | ||
| 132 | tty->tx_bytes_queued = 0; | ||
| 133 | |||
| 134 | tty->open_count++; | ||
| 135 | |||
| 136 | tty->linux_tty = linux_tty; | ||
| 137 | linux_tty->driver_data = tty; | ||
| 138 | linux_tty->low_latency = 1; | ||
| 139 | |||
| 140 | if (tty->tty_type == TTYTYPE_MODEM) | ||
| 141 | ipwireless_ppp_open(tty->network); | ||
| 142 | |||
| 143 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 144 | |||
| 145 | return 0; | ||
| 146 | } | ||
| 147 | |||
| 148 | static void do_ipw_close(struct ipw_tty *tty) | ||
| 149 | { | ||
| 150 | tty->open_count--; | ||
| 151 | |||
| 152 | if (tty->open_count == 0) { | ||
| 153 | struct tty_struct *linux_tty = tty->linux_tty; | ||
| 154 | |||
| 155 | if (linux_tty != NULL) { | ||
| 156 | tty->linux_tty = NULL; | ||
| 157 | linux_tty->driver_data = NULL; | ||
| 158 | |||
| 159 | if (tty->tty_type == TTYTYPE_MODEM) | ||
| 160 | ipwireless_ppp_close(tty->network); | ||
| 161 | } | ||
| 162 | } | ||
| 163 | } | ||
| 164 | |||
| 165 | static void ipw_hangup(struct tty_struct *linux_tty) | ||
| 166 | { | ||
| 167 | struct ipw_tty *tty = linux_tty->driver_data; | ||
| 168 | |||
| 169 | if (!tty) | ||
| 170 | return; | ||
| 171 | |||
| 172 | mutex_lock(&tty->ipw_tty_mutex); | ||
| 173 | if (tty->open_count == 0) { | ||
| 174 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 175 | return; | ||
| 176 | } | ||
| 177 | |||
| 178 | do_ipw_close(tty); | ||
| 179 | |||
| 180 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 181 | } | ||
| 182 | |||
| 183 | static void ipw_close(struct tty_struct *linux_tty, struct file *filp) | ||
| 184 | { | ||
| 185 | ipw_hangup(linux_tty); | ||
| 186 | } | ||
| 187 | |||
| 188 | /* Take data received from hardware, and send it out the tty */ | ||
| 189 | void ipwireless_tty_received(struct ipw_tty *tty, unsigned char *data, | ||
| 190 | unsigned int length) | ||
| 191 | { | ||
| 192 | struct tty_struct *linux_tty; | ||
| 193 | int work = 0; | ||
| 194 | |||
| 195 | mutex_lock(&tty->ipw_tty_mutex); | ||
| 196 | linux_tty = tty->linux_tty; | ||
| 197 | if (linux_tty == NULL) { | ||
| 198 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 199 | return; | ||
| 200 | } | ||
| 201 | |||
| 202 | if (!tty->open_count) { | ||
| 203 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 204 | return; | ||
| 205 | } | ||
| 206 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 207 | |||
| 208 | work = tty_insert_flip_string(linux_tty, data, length); | ||
| 209 | |||
| 210 | if (work != length) | ||
| 211 | printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME | ||
| 212 | ": %d chars not inserted to flip buffer!\n", | ||
| 213 | length - work); | ||
| 214 | |||
| 215 | /* | ||
| 216 | * This may sleep if ->low_latency is set | ||
| 217 | */ | ||
| 218 | if (work) | ||
| 219 | tty_flip_buffer_push(linux_tty); | ||
| 220 | } | ||
| 221 | |||
| 222 | static void ipw_write_packet_sent_callback(void *callback_data, | ||
| 223 | unsigned int packet_length) | ||
| 224 | { | ||
| 225 | struct ipw_tty *tty = callback_data; | ||
| 226 | |||
| 227 | /* | ||
| 228 | * Packet has been sent, so we subtract the number of bytes from our | ||
| 229 | * tally of outstanding TX bytes. | ||
| 230 | */ | ||
| 231 | tty->tx_bytes_queued -= packet_length; | ||
| 232 | } | ||
| 233 | |||
| 234 | static int ipw_write(struct tty_struct *linux_tty, | ||
| 235 | const unsigned char *buf, int count) | ||
| 236 | { | ||
| 237 | struct ipw_tty *tty = linux_tty->driver_data; | ||
| 238 | int room, ret; | ||
| 239 | |||
| 240 | if (!tty) | ||
| 241 | return -ENODEV; | ||
| 242 | |||
| 243 | mutex_lock(&tty->ipw_tty_mutex); | ||
| 244 | if (!tty->open_count) { | ||
| 245 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 246 | return -EINVAL; | ||
| 247 | } | ||
| 248 | |||
| 249 | room = IPWIRELESS_TX_QUEUE_SIZE - tty->tx_bytes_queued; | ||
| 250 | if (room < 0) | ||
| 251 | room = 0; | ||
| 252 | /* Don't allow caller to write any more than we have room for */ | ||
| 253 | if (count > room) | ||
| 254 | count = room; | ||
| 255 | |||
| 256 | if (count == 0) { | ||
| 257 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 258 | return 0; | ||
| 259 | } | ||
| 260 | |||
| 261 | ret = ipwireless_send_packet(tty->hardware, IPW_CHANNEL_RAS, | ||
| 262 | (unsigned char *) buf, count, | ||
| 263 | ipw_write_packet_sent_callback, tty); | ||
| 264 | if (ret == -1) { | ||
| 265 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 266 | return 0; | ||
| 267 | } | ||
| 268 | |||
| 269 | tty->tx_bytes_queued += count; | ||
| 270 | mutex_unlock(&tty->ipw_tty_mutex); | ||
| 271 | |||
| 272 | return count; | ||
| 273 | } | ||
| 274 | |||
| 275 | static int ipw_write_room(struct tty_struct *linux_tty) | ||
| 276 | { | ||
| 277 | struct ipw_tty *tty = linux_tty->driver_data; | ||
| 278 | int room; | ||
| 279 | |||
| 280 | if (!tty) | ||
| 281 | return -ENODEV; | ||
| 282 | |||
| 283 | if (!tty->open_count) | ||
| 284 | return -EINVAL; | ||
| 285 | |||
| 286 | room = IPWIRELESS_TX_QUEUE_SIZE - tty->tx_bytes_queued; | ||
| 287 | if (room < 0) | ||
| 288 | room = 0; | ||
| 289 | |||
| 290 | return room; | ||
| 291 | } | ||
| 292 | |||
| 293 | static int ipwireless_get_serial_info(struct ipw_tty *tty, | ||
| 294 | struct serial_struct __user *retinfo) | ||
| 295 | { | ||
| 296 | struct serial_struct tmp; | ||
| 297 | |||
| 298 | if (!retinfo) | ||
| 299 | return (-EFAULT); | ||
| 300 | |||
| 301 | memset(&tmp, 0, sizeof(tmp)); | ||
| 302 | tmp.type = PORT_UNKNOWN; | ||
| 303 | tmp.line = tty->index; | ||
| 304 | tmp.port = 0; | ||
| 305 | tmp.irq = 0; | ||
| 306 | tmp.flags = 0; | ||
| 307 | tmp.baud_base = 115200; | ||
| 308 | tmp.close_delay = 0; | ||
| 309 | tmp.closing_wait = 0; | ||
| 310 | tmp.custom_divisor = 0; | ||
| 311 | tmp.hub6 = 0; | ||
| 312 | if (copy_to_user(retinfo, &tmp, sizeof(*retinfo))) | ||
| 313 | return -EFAULT; | ||
| 314 | |||
| 315 | return 0; | ||
| 316 | } | ||
| 317 | |||
| 318 | static int ipw_chars_in_buffer(struct tty_struct *linux_tty) | ||
| 319 | { | ||
| 320 | struct ipw_tty *tty = linux_tty->driver_data; | ||
| 321 | |||
| 322 | if (!tty) | ||
| 323 | return -ENODEV; | ||
| 324 | |||
| 325 | if (!tty->open_count) | ||
| 326 | return -EINVAL; | ||
| 327 | |||
| 328 | return tty->tx_bytes_queued; | ||
| 329 | } | ||
| 330 | |||
| 331 | static int get_control_lines(struct ipw_tty *tty) | ||
| 332 | { | ||
| 333 | unsigned int my = tty->control_lines; | ||
| 334 | unsigned int out = 0; | ||
| 335 | |||
| 336 | if (my & IPW_CONTROL_LINE_RTS) | ||
| 337 | out |= TIOCM_RTS; | ||
| 338 | if (my & IPW_CONTROL_LINE_DTR) | ||
| 339 | out |= TIOCM_DTR; | ||
| 340 | if (my & IPW_CONTROL_LINE_CTS) | ||
| 341 | out |= TIOCM_CTS; | ||
| 342 | if (my & IPW_CONTROL_LINE_DSR) | ||
| 343 | out |= TIOCM_DSR; | ||
| 344 | if (my & IPW_CONTROL_LINE_DCD) | ||
| 345 | out |= TIOCM_CD; | ||
| 346 | |||
| 347 | return out; | ||
| 348 | } | ||
| 349 | |||
| 350 | static int set_control_lines(struct ipw_tty *tty, unsigned int set, | ||
| 351 | unsigned int clear) | ||
| 352 | { | ||
| 353 | int ret; | ||
| 354 | |||
| 355 | if (set & TIOCM_RTS) { | ||
| 356 | ret = ipwireless_set_RTS(tty->hardware, tty->channel_idx, 1); | ||
| 357 | if (ret) | ||
| 358 | return ret; | ||
| 359 | if (tty->secondary_channel_idx != -1) { | ||
| 360 | ret = ipwireless_set_RTS(tty->hardware, | ||
| 361 | tty->secondary_channel_idx, 1); | ||
| 362 | if (ret) | ||
| 363 | return ret; | ||
| 364 | } | ||
| 365 | } | ||
| 366 | if (set & TIOCM_DTR) { | ||
| 367 | ret = ipwireless_set_DTR(tty->hardware, tty->channel_idx, 1); | ||
| 368 | if (ret) | ||
| 369 | return ret; | ||
| 370 | if (tty->secondary_channel_idx != -1) { | ||
| 371 | ret = ipwireless_set_DTR(tty->hardware, | ||
| 372 | tty->secondary_channel_idx, 1); | ||
| 373 | if (ret) | ||
| 374 | return ret; | ||
| 375 | } | ||
| 376 | } | ||
| 377 | if (clear & TIOCM_RTS) { | ||
| 378 | ret = ipwireless_set_RTS(tty->hardware, tty->channel_idx, 0); | ||
| 379 | if (tty->secondary_channel_idx != -1) { | ||
| 380 | ret = ipwireless_set_RTS(tty->hardware, | ||
| 381 | tty->secondary_channel_idx, 0); | ||
| 382 | if (ret) | ||
| 383 | return ret; | ||
| 384 | } | ||
| 385 | } | ||
| 386 | if (clear & TIOCM_DTR) { | ||
| 387 | ret = ipwireless_set_DTR(tty->hardware, tty->channel_idx, 0); | ||
| 388 | if (tty->secondary_channel_idx != -1) { | ||
| 389 | ret = ipwireless_set_DTR(tty->hardware, | ||
| 390 | tty->secondary_channel_idx, 0); | ||
| 391 | if (ret) | ||
| 392 | return ret; | ||
| 393 | } | ||
| 394 | } | ||
| 395 | return 0; | ||
| 396 | } | ||
| 397 | |||
| 398 | static int ipw_tiocmget(struct tty_struct *linux_tty, struct file *file) | ||
| 399 | { | ||
| 400 | struct ipw_tty *tty = linux_tty->driver_data; | ||
| 401 | |||
| 402 | if (!tty) | ||
| 403 | return -ENODEV; | ||
| 404 | |||
| 405 | if (!tty->open_count) | ||
| 406 | return -EINVAL; | ||
| 407 | |||
| 408 | return get_control_lines(tty); | ||
| 409 | } | ||
| 410 | |||
| 411 | static int | ||
| 412 | ipw_tiocmset(struct tty_struct *linux_tty, struct file *file, | ||
| 413 | unsigned int set, unsigned int clear) | ||
| 414 | { | ||
| 415 | struct ipw_tty *tty = linux_tty->driver_data; | ||
| 416 | |||
| 417 | if (!tty) | ||
| 418 | return -ENODEV; | ||
| 419 | |||
| 420 | if (!tty->open_count) | ||
| 421 | return -EINVAL; | ||
| 422 | |||
| 423 | return set_control_lines(tty, set, clear); | ||
| 424 | } | ||
| 425 | |||
| 426 | static int ipw_ioctl(struct tty_struct *linux_tty, struct file *file, | ||
| 427 | unsigned int cmd, unsigned long arg) | ||
| 428 | { | ||
| 429 | struct ipw_tty *tty = linux_tty->driver_data; | ||
| 430 | |||
| 431 | if (!tty) | ||
| 432 | return -ENODEV; | ||
| 433 | |||
| 434 | if (!tty->open_count) | ||
| 435 | return -EINVAL; | ||
| 436 | |||
| 437 | switch (cmd) { | ||
| 438 | case TIOCGSERIAL: | ||
| 439 | return ipwireless_get_serial_info(tty, (void __user *) arg); | ||
| 440 | |||
| 441 | case TIOCSSERIAL: | ||
| 442 | return 0; /* Keeps the PCMCIA scripts happy. */ | ||
| 443 | } | ||
| 444 | |||
| 445 | if (tty->tty_type == TTYTYPE_MODEM) { | ||
| 446 | switch (cmd) { | ||
| 447 | case PPPIOCGCHAN: | ||
| 448 | { | ||
| 449 | int chan = ipwireless_ppp_channel_index( | ||
| 450 | tty->network); | ||
| 451 | |||
| 452 | if (chan < 0) | ||
| 453 | return -ENODEV; | ||
| 454 | if (put_user(chan, (int __user *) arg)) | ||
| 455 | return -EFAULT; | ||
| 456 | } | ||
| 457 | return 0; | ||
| 458 | |||
| 459 | case PPPIOCGUNIT: | ||
| 460 | { | ||
| 461 | int unit = ipwireless_ppp_unit_number( | ||
| 462 | tty->network); | ||
| 463 | |||
| 464 | if (unit < 0) | ||
| 465 | return -ENODEV; | ||
| 466 | if (put_user(unit, (int __user *) arg)) | ||
| 467 | return -EFAULT; | ||
| 468 | } | ||
| 469 | return 0; | ||
| 470 | |||
| 471 | case TCGETS: | ||
| 472 | case TCGETA: | ||
| 473 | return n_tty_ioctl(linux_tty, file, cmd, arg); | ||
| 474 | |||
| 475 | case TCFLSH: | ||
| 476 | return n_tty_ioctl(linux_tty, file, cmd, arg); | ||
| 477 | |||
| 478 | case FIONREAD: | ||
| 479 | { | ||
| 480 | int val = 0; | ||
| 481 | |||
| 482 | if (put_user(val, (int __user *) arg)) | ||
| 483 | return -EFAULT; | ||
| 484 | } | ||
| 485 | return 0; | ||
| 486 | } | ||
| 487 | } | ||
| 488 | |||
| 489 | return -ENOIOCTLCMD; | ||
| 490 | } | ||
| 491 | |||
| 492 | static int add_tty(dev_node_t *nodesp, int j, | ||
| 493 | struct ipw_hardware *hardware, | ||
| 494 | struct ipw_network *network, int channel_idx, | ||
| 495 | int secondary_channel_idx, int tty_type) | ||
| 496 | { | ||
| 497 | ttys[j] = kzalloc(sizeof(struct ipw_tty), GFP_KERNEL); | ||
| 498 | if (!ttys[j]) | ||
| 499 | return -ENOMEM; | ||
| 500 | ttys[j]->index = j; | ||
| 501 | ttys[j]->hardware = hardware; | ||
| 502 | ttys[j]->channel_idx = channel_idx; | ||
| 503 | ttys[j]->secondary_channel_idx = secondary_channel_idx; | ||
| 504 | ttys[j]->network = network; | ||
| 505 | ttys[j]->tty_type = tty_type; | ||
| 506 | mutex_init(&ttys[j]->ipw_tty_mutex); | ||
| 507 | |||
| 508 | tty_register_device(ipw_tty_driver, j, NULL); | ||
| 509 | ipwireless_associate_network_tty(network, channel_idx, ttys[j]); | ||
| 510 | |||
| 511 | if (secondary_channel_idx != -1) | ||
| 512 | ipwireless_associate_network_tty(network, | ||
| 513 | secondary_channel_idx, | ||
| 514 | ttys[j]); | ||
| 515 | if (nodesp != NULL) { | ||
| 516 | sprintf(nodesp->dev_name, "ttyIPWp%d", j); | ||
| 517 | nodesp->major = ipw_tty_driver->major; | ||
| 518 | nodesp->minor = j + ipw_tty_driver->minor_start; | ||
| 519 | } | ||
| 520 | if (get_tty(j + ipw_tty_driver->minor_start) == ttys[j]) | ||
| 521 | report_registering(ttys[j]); | ||
| 522 | return 0; | ||
| 523 | } | ||
| 524 | |||
| 525 | struct ipw_tty *ipwireless_tty_create(struct ipw_hardware *hardware, | ||
| 526 | struct ipw_network *network, | ||
| 527 | dev_node_t *nodes) | ||
| 528 | { | ||
| 529 | int i, j; | ||
| 530 | |||
| 531 | for (i = 0; i < IPWIRELESS_PCMCIA_MINOR_RANGE; i++) { | ||
| 532 | int allfree = 1; | ||
| 533 | |||
| 534 | for (j = i; j < IPWIRELESS_PCMCIA_MINORS; | ||
| 535 | j += IPWIRELESS_PCMCIA_MINOR_RANGE) | ||
| 536 | if (ttys[j] != NULL) { | ||
| 537 | allfree = 0; | ||
| 538 | break; | ||
| 539 | } | ||
| 540 | |||
| 541 | if (allfree) { | ||
| 542 | j = i; | ||
| 543 | |||
| 544 | if (add_tty(&nodes[0], j, hardware, network, | ||
| 545 | IPW_CHANNEL_DIALLER, IPW_CHANNEL_RAS, | ||
| 546 | TTYTYPE_MODEM)) | ||
| 547 | return NULL; | ||
| 548 | |||
| 549 | j += IPWIRELESS_PCMCIA_MINOR_RANGE; | ||
| 550 | if (add_tty(&nodes[1], j, hardware, network, | ||
| 551 | IPW_CHANNEL_DIALLER, -1, | ||
| 552 | TTYTYPE_MONITOR)) | ||
| 553 | return NULL; | ||
| 554 | |||
| 555 | j += IPWIRELESS_PCMCIA_MINOR_RANGE; | ||
| 556 | if (add_tty(NULL, j, hardware, network, | ||
| 557 | IPW_CHANNEL_RAS, -1, | ||
| 558 | TTYTYPE_RAS_RAW)) | ||
| 559 | return NULL; | ||
| 560 | |||
| 561 | nodes[0].next = &nodes[1]; | ||
| 562 | nodes[1].next = NULL; | ||
| 563 | |||
| 564 | return ttys[i]; | ||
| 565 | } | ||
| 566 | } | ||
| 567 | return NULL; | ||
| 568 | } | ||
| 569 | |||
| 570 | /* | ||
| 571 | * Must be called before ipwireless_network_free(). | ||
| 572 | */ | ||
| 573 | void ipwireless_tty_free(struct ipw_tty *tty) | ||
| 574 | { | ||
| 575 | int j; | ||
| 576 | struct ipw_network *network = ttys[tty->index]->network; | ||
| 577 | |||
| 578 | for (j = tty->index; j < IPWIRELESS_PCMCIA_MINORS; | ||
| 579 | j += IPWIRELESS_PCMCIA_MINOR_RANGE) { | ||
| 580 | struct ipw_tty *ttyj = ttys[j]; | ||
| 581 | |||
| 582 | if (ttyj) { | ||
| 583 | mutex_lock(&ttyj->ipw_tty_mutex); | ||
| 584 | if (get_tty(j + ipw_tty_driver->minor_start) == ttyj) | ||
| 585 | report_deregistering(ttyj); | ||
| 586 | ttyj->closing = 1; | ||
| 587 | if (ttyj->linux_tty != NULL) { | ||
| 588 | mutex_unlock(&ttyj->ipw_tty_mutex); | ||
| 589 | tty_hangup(ttyj->linux_tty); | ||
| 590 | /* Wait till the tty_hangup has completed */ | ||
| 591 | flush_scheduled_work(); | ||
| 592 | mutex_lock(&ttyj->ipw_tty_mutex); | ||
| 593 | } | ||
| 594 | while (ttyj->open_count) | ||
| 595 | do_ipw_close(ttyj); | ||
| 596 | ipwireless_disassociate_network_ttys(network, | ||
| 597 | ttyj->channel_idx); | ||
| 598 | tty_unregister_device(ipw_tty_driver, j); | ||
| 599 | ttys[j] = NULL; | ||
| 600 | mutex_unlock(&ttyj->ipw_tty_mutex); | ||
| 601 | kfree(ttyj); | ||
| 602 | } | ||
| 603 | } | ||
| 604 | } | ||
| 605 | |||
| 606 | static struct tty_operations tty_ops = { | ||
| 607 | .open = ipw_open, | ||
| 608 | .close = ipw_close, | ||
| 609 | .hangup = ipw_hangup, | ||
| 610 | .write = ipw_write, | ||
| 611 | .write_room = ipw_write_room, | ||
| 612 | .ioctl = ipw_ioctl, | ||
| 613 | .chars_in_buffer = ipw_chars_in_buffer, | ||
| 614 | .tiocmget = ipw_tiocmget, | ||
| 615 | .tiocmset = ipw_tiocmset, | ||
| 616 | }; | ||
| 617 | |||
| 618 | int ipwireless_tty_init(void) | ||
| 619 | { | ||
| 620 | int result; | ||
| 621 | |||
| 622 | ipw_tty_driver = alloc_tty_driver(IPWIRELESS_PCMCIA_MINORS); | ||
| 623 | if (!ipw_tty_driver) | ||
| 624 | return -ENOMEM; | ||
| 625 | |||
| 626 | ipw_tty_driver->owner = THIS_MODULE; | ||
| 627 | ipw_tty_driver->driver_name = IPWIRELESS_PCCARD_NAME; | ||
| 628 | ipw_tty_driver->name = "ttyIPWp"; | ||
| 629 | ipw_tty_driver->major = 0; | ||
| 630 | ipw_tty_driver->minor_start = IPWIRELESS_PCMCIA_START; | ||
| 631 | ipw_tty_driver->type = TTY_DRIVER_TYPE_SERIAL; | ||
| 632 | ipw_tty_driver->subtype = SERIAL_TYPE_NORMAL; | ||
| 633 | ipw_tty_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV; | ||
| 634 | ipw_tty_driver->init_termios = tty_std_termios; | ||
| 635 | ipw_tty_driver->init_termios.c_cflag = | ||
| 636 | B9600 | CS8 | CREAD | HUPCL | CLOCAL; | ||
| 637 | ipw_tty_driver->init_termios.c_ispeed = 9600; | ||
| 638 | ipw_tty_driver->init_termios.c_ospeed = 9600; | ||
| 639 | tty_set_operations(ipw_tty_driver, &tty_ops); | ||
| 640 | result = tty_register_driver(ipw_tty_driver); | ||
| 641 | if (result) { | ||
| 642 | printk(KERN_ERR IPWIRELESS_PCCARD_NAME | ||
| 643 | ": failed to register tty driver\n"); | ||
| 644 | put_tty_driver(ipw_tty_driver); | ||
| 645 | return result; | ||
| 646 | } | ||
| 647 | |||
| 648 | return 0; | ||
| 649 | } | ||
| 650 | |||
| 651 | void ipwireless_tty_release(void) | ||
| 652 | { | ||
| 653 | int ret; | ||
| 654 | |||
| 655 | ret = tty_unregister_driver(ipw_tty_driver); | ||
| 656 | put_tty_driver(ipw_tty_driver); | ||
| 657 | if (ret != 0) | ||
| 658 | printk(KERN_ERR IPWIRELESS_PCCARD_NAME | ||
| 659 | ": tty_unregister_driver failed with code %d\n", ret); | ||
| 660 | } | ||
| 661 | |||
| 662 | int ipwireless_tty_is_modem(struct ipw_tty *tty) | ||
| 663 | { | ||
| 664 | return tty->tty_type == TTYTYPE_MODEM; | ||
| 665 | } | ||
| 666 | |||
| 667 | void | ||
| 668 | ipwireless_tty_notify_control_line_change(struct ipw_tty *tty, | ||
| 669 | unsigned int channel_idx, | ||
| 670 | unsigned int control_lines, | ||
| 671 | unsigned int changed_mask) | ||
| 672 | { | ||
| 673 | unsigned int old_control_lines = tty->control_lines; | ||
| 674 | |||
| 675 | tty->control_lines = (tty->control_lines & ~changed_mask) | ||
| 676 | | (control_lines & changed_mask); | ||
| 677 | |||
| 678 | /* | ||
| 679 | * If DCD is de-asserted, we close the tty so pppd can tell that we | ||
| 680 | * have gone offline. | ||
| 681 | */ | ||
| 682 | if ((old_control_lines & IPW_CONTROL_LINE_DCD) | ||
| 683 | && !(tty->control_lines & IPW_CONTROL_LINE_DCD) | ||
| 684 | && tty->linux_tty) { | ||
| 685 | tty_hangup(tty->linux_tty); | ||
| 686 | } | ||
| 687 | } | ||
| 688 | |||
diff --git a/drivers/char/pcmcia/ipwireless/tty.h b/drivers/char/pcmcia/ipwireless/tty.h new file mode 100644 index 000000000000..b0deb9168b6b --- /dev/null +++ b/drivers/char/pcmcia/ipwireless/tty.h | |||
| @@ -0,0 +1,48 @@ | |||
| 1 | /* | ||
| 2 | * IPWireless 3G PCMCIA Network Driver | ||
| 3 | * | ||
| 4 | * Original code | ||
| 5 | * by Stephen Blackheath <stephen@blacksapphire.com>, | ||
| 6 | * Ben Martel <benm@symmetric.co.nz> | ||
| 7 | * | ||
| 8 | * Copyrighted as follows: | ||
| 9 | * Copyright (C) 2004 by Symmetric Systems Ltd (NZ) | ||
| 10 | * | ||
| 11 | * Various driver changes and rewrites, port to new kernels | ||
| 12 | * Copyright (C) 2006-2007 Jiri Kosina | ||
| 13 | * | ||
| 14 | * Misc code cleanups and updates | ||
| 15 | * Copyright (C) 2007 David Sterba | ||
| 16 | */ | ||
| 17 | |||
| 18 | #ifndef _IPWIRELESS_CS_TTY_H_ | ||
| 19 | #define _IPWIRELESS_CS_TTY_H_ | ||
| 20 | |||
| 21 | #include <linux/types.h> | ||
| 22 | #include <linux/sched.h> | ||
| 23 | |||
| 24 | #include <pcmcia/cs_types.h> | ||
| 25 | #include <pcmcia/cs.h> | ||
| 26 | #include <pcmcia/cistpl.h> | ||
| 27 | #include <pcmcia/ds.h> | ||
| 28 | |||
| 29 | struct ipw_tty; | ||
| 30 | struct ipw_network; | ||
| 31 | struct ipw_hardware; | ||
| 32 | |||
| 33 | int ipwireless_tty_init(void); | ||
| 34 | void ipwireless_tty_release(void); | ||
| 35 | |||
| 36 | struct ipw_tty *ipwireless_tty_create(struct ipw_hardware *hw, | ||
| 37 | struct ipw_network *net, | ||
| 38 | dev_node_t *nodes); | ||
| 39 | void ipwireless_tty_free(struct ipw_tty *tty); | ||
| 40 | void ipwireless_tty_received(struct ipw_tty *tty, unsigned char *data, | ||
| 41 | unsigned int length); | ||
| 42 | int ipwireless_tty_is_modem(struct ipw_tty *tty); | ||
| 43 | void ipwireless_tty_notify_control_line_change(struct ipw_tty *tty, | ||
| 44 | unsigned int channel_idx, | ||
| 45 | unsigned int control_lines, | ||
| 46 | unsigned int changed_mask); | ||
| 47 | |||
| 48 | #endif | ||
diff --git a/drivers/firmware/dmi_scan.c b/drivers/firmware/dmi_scan.c index e0bade732376..1412d7bcdbd1 100644 --- a/drivers/firmware/dmi_scan.c +++ b/drivers/firmware/dmi_scan.c | |||
| @@ -43,18 +43,12 @@ static char * __init dmi_string(const struct dmi_header *dm, u8 s) | |||
| 43 | * We have to be cautious here. We have seen BIOSes with DMI pointers | 43 | * We have to be cautious here. We have seen BIOSes with DMI pointers |
| 44 | * pointing to completely the wrong place for example | 44 | * pointing to completely the wrong place for example |
| 45 | */ | 45 | */ |
| 46 | static int __init dmi_table(u32 base, int len, int num, | 46 | static void dmi_table(u8 *buf, int len, int num, |
| 47 | void (*decode)(const struct dmi_header *)) | 47 | void (*decode)(const struct dmi_header *)) |
| 48 | { | 48 | { |
| 49 | u8 *buf, *data; | 49 | u8 *data = buf; |
| 50 | int i = 0; | 50 | int i = 0; |
| 51 | 51 | ||
| 52 | buf = dmi_ioremap(base, len); | ||
| 53 | if (buf == NULL) | ||
| 54 | return -1; | ||
| 55 | |||
| 56 | data = buf; | ||
| 57 | |||
| 58 | /* | 52 | /* |
| 59 | * Stop when we see all the items the table claimed to have | 53 | * Stop when we see all the items the table claimed to have |
| 60 | * OR we run off the end of the table (also happens) | 54 | * OR we run off the end of the table (also happens) |
| @@ -75,7 +69,23 @@ static int __init dmi_table(u32 base, int len, int num, | |||
| 75 | data += 2; | 69 | data += 2; |
| 76 | i++; | 70 | i++; |
| 77 | } | 71 | } |
| 78 | dmi_iounmap(buf, len); | 72 | } |
| 73 | |||
| 74 | static u32 dmi_base; | ||
| 75 | static u16 dmi_len; | ||
| 76 | static u16 dmi_num; | ||
| 77 | |||
| 78 | static int __init dmi_walk_early(void (*decode)(const struct dmi_header *)) | ||
| 79 | { | ||
| 80 | u8 *buf; | ||
| 81 | |||
| 82 | buf = dmi_ioremap(dmi_base, dmi_len); | ||
| 83 | if (buf == NULL) | ||
| 84 | return -1; | ||
| 85 | |||
| 86 | dmi_table(buf, dmi_len, dmi_num, decode); | ||
| 87 | |||
| 88 | dmi_iounmap(buf, dmi_len); | ||
| 79 | return 0; | 89 | return 0; |
| 80 | } | 90 | } |
| 81 | 91 | ||
| @@ -291,9 +301,9 @@ static int __init dmi_present(const char __iomem *p) | |||
| 291 | 301 | ||
| 292 | memcpy_fromio(buf, p, 15); | 302 | memcpy_fromio(buf, p, 15); |
| 293 | if ((memcmp(buf, "_DMI_", 5) == 0) && dmi_checksum(buf)) { | 303 | if ((memcmp(buf, "_DMI_", 5) == 0) && dmi_checksum(buf)) { |
| 294 | u16 num = (buf[13] << 8) | buf[12]; | 304 | dmi_num = (buf[13] << 8) | buf[12]; |
| 295 | u16 len = (buf[7] << 8) | buf[6]; | 305 | dmi_len = (buf[7] << 8) | buf[6]; |
| 296 | u32 base = (buf[11] << 24) | (buf[10] << 16) | | 306 | dmi_base = (buf[11] << 24) | (buf[10] << 16) | |
| 297 | (buf[9] << 8) | buf[8]; | 307 | (buf[9] << 8) | buf[8]; |
| 298 | 308 | ||
| 299 | /* | 309 | /* |
| @@ -305,7 +315,7 @@ static int __init dmi_present(const char __iomem *p) | |||
| 305 | buf[14] >> 4, buf[14] & 0xF); | 315 | buf[14] >> 4, buf[14] & 0xF); |
| 306 | else | 316 | else |
| 307 | printk(KERN_INFO "DMI present.\n"); | 317 | printk(KERN_INFO "DMI present.\n"); |
| 308 | if (dmi_table(base,len, num, dmi_decode) == 0) | 318 | if (dmi_walk_early(dmi_decode) == 0) |
| 309 | return 0; | 319 | return 0; |
| 310 | } | 320 | } |
| 311 | return 1; | 321 | return 1; |
| @@ -489,3 +499,27 @@ int dmi_get_year(int field) | |||
| 489 | 499 | ||
| 490 | return year; | 500 | return year; |
| 491 | } | 501 | } |
| 502 | |||
| 503 | /** | ||
| 504 | * dmi_walk - Walk the DMI table and get called back for every record | ||
| 505 | * @decode: Callback function | ||
| 506 | * | ||
| 507 | * Returns -1 when the DMI table can't be reached, 0 on success. | ||
| 508 | */ | ||
| 509 | int dmi_walk(void (*decode)(const struct dmi_header *)) | ||
| 510 | { | ||
| 511 | u8 *buf; | ||
| 512 | |||
| 513 | if (!dmi_available) | ||
| 514 | return -1; | ||
| 515 | |||
| 516 | buf = ioremap(dmi_base, dmi_len); | ||
| 517 | if (buf == NULL) | ||
| 518 | return -1; | ||
| 519 | |||
| 520 | dmi_table(buf, dmi_len, dmi_num, decode); | ||
| 521 | |||
| 522 | iounmap(buf); | ||
| 523 | return 0; | ||
| 524 | } | ||
| 525 | EXPORT_SYMBOL_GPL(dmi_walk); | ||
diff --git a/drivers/hwmon/Kconfig b/drivers/hwmon/Kconfig index a0445bea9f75..410ffe4e9d80 100644 --- a/drivers/hwmon/Kconfig +++ b/drivers/hwmon/Kconfig | |||
| @@ -433,12 +433,12 @@ config SENSORS_LM85 | |||
| 433 | will be called lm85. | 433 | will be called lm85. |
| 434 | 434 | ||
| 435 | config SENSORS_LM87 | 435 | config SENSORS_LM87 |
| 436 | tristate "National Semiconductor LM87" | 436 | tristate "National Semiconductor LM87 and compatibles" |
| 437 | depends on I2C | 437 | depends on I2C |
| 438 | select HWMON_VID | 438 | select HWMON_VID |
| 439 | help | 439 | help |
| 440 | If you say yes here you get support for National Semiconductor LM87 | 440 | If you say yes here you get support for National Semiconductor LM87 |
| 441 | sensor chips. | 441 | and Analog Devices ADM1024 sensor chips. |
| 442 | 442 | ||
| 443 | This driver can also be built as a module. If so, the module | 443 | This driver can also be built as a module. If so, the module |
| 444 | will be called lm87. | 444 | will be called lm87. |
| @@ -588,6 +588,16 @@ config SENSORS_SMSC47B397 | |||
| 588 | This driver can also be built as a module. If so, the module | 588 | This driver can also be built as a module. If so, the module |
| 589 | will be called smsc47b397. | 589 | will be called smsc47b397. |
| 590 | 590 | ||
| 591 | config SENSORS_ADS7828 | ||
| 592 | tristate "Texas Instruments ADS7828" | ||
| 593 | depends on I2C | ||
| 594 | help | ||
| 595 | If you say yes here you get support for Texas Instruments ADS7828 | ||
| 596 | 12-bit 8-channel ADC device. | ||
| 597 | |||
| 598 | This driver can also be built as a module. If so, the module | ||
| 599 | will be called ads7828. | ||
| 600 | |||
| 591 | config SENSORS_THMC50 | 601 | config SENSORS_THMC50 |
| 592 | tristate "Texas Instruments THMC50 / Analog Devices ADM1022" | 602 | tristate "Texas Instruments THMC50 / Analog Devices ADM1022" |
| 593 | depends on I2C && EXPERIMENTAL | 603 | depends on I2C && EXPERIMENTAL |
| @@ -631,13 +641,13 @@ config SENSORS_VT8231 | |||
| 631 | will be called vt8231. | 641 | will be called vt8231. |
| 632 | 642 | ||
| 633 | config SENSORS_W83781D | 643 | config SENSORS_W83781D |
| 634 | tristate "Winbond W83781D, W83782D, W83783S, W83627HF, Asus AS99127F" | 644 | tristate "Winbond W83781D, W83782D, W83783S, Asus AS99127F" |
| 635 | depends on I2C | 645 | depends on I2C |
| 636 | select HWMON_VID | 646 | select HWMON_VID |
| 637 | help | 647 | help |
| 638 | If you say yes here you get support for the Winbond W8378x series | 648 | If you say yes here you get support for the Winbond W8378x series |
| 639 | of sensor chips: the W83781D, W83782D, W83783S and W83627HF, | 649 | of sensor chips: the W83781D, W83782D and W83783S, and the similar |
| 640 | and the similar Asus AS99127F. | 650 | Asus AS99127F. |
| 641 | 651 | ||
| 642 | This driver can also be built as a module. If so, the module | 652 | This driver can also be built as a module. If so, the module |
| 643 | will be called w83781d. | 653 | will be called w83781d. |
| @@ -683,6 +693,16 @@ config SENSORS_W83L785TS | |||
| 683 | This driver can also be built as a module. If so, the module | 693 | This driver can also be built as a module. If so, the module |
| 684 | will be called w83l785ts. | 694 | will be called w83l785ts. |
| 685 | 695 | ||
| 696 | config SENSORS_W83L786NG | ||
| 697 | tristate "Winbond W83L786NG, W83L786NR" | ||
| 698 | depends on I2C && EXPERIMENTAL | ||
| 699 | help | ||
| 700 | If you say yes here you get support for the Winbond W83L786NG | ||
| 701 | and W83L786NR sensor chips. | ||
| 702 | |||
| 703 | This driver can also be built as a module. If so, the module | ||
| 704 | will be called w83l786ng. | ||
| 705 | |||
| 686 | config SENSORS_W83627HF | 706 | config SENSORS_W83627HF |
| 687 | tristate "Winbond W83627HF, W83627THF, W83637HF, W83687THF, W83697HF" | 707 | tristate "Winbond W83627HF, W83627THF, W83637HF, W83687THF, W83697HF" |
| 688 | select HWMON_VID | 708 | select HWMON_VID |
diff --git a/drivers/hwmon/Makefile b/drivers/hwmon/Makefile index 55595f6e1aa6..824161337f1c 100644 --- a/drivers/hwmon/Makefile +++ b/drivers/hwmon/Makefile | |||
| @@ -22,6 +22,7 @@ obj-$(CONFIG_SENSORS_ADM1026) += adm1026.o | |||
| 22 | obj-$(CONFIG_SENSORS_ADM1029) += adm1029.o | 22 | obj-$(CONFIG_SENSORS_ADM1029) += adm1029.o |
| 23 | obj-$(CONFIG_SENSORS_ADM1031) += adm1031.o | 23 | obj-$(CONFIG_SENSORS_ADM1031) += adm1031.o |
| 24 | obj-$(CONFIG_SENSORS_ADM9240) += adm9240.o | 24 | obj-$(CONFIG_SENSORS_ADM9240) += adm9240.o |
| 25 | obj-$(CONFIG_SENSORS_ADS7828) += ads7828.o | ||
| 25 | obj-$(CONFIG_SENSORS_ADT7470) += adt7470.o | 26 | obj-$(CONFIG_SENSORS_ADT7470) += adt7470.o |
| 26 | obj-$(CONFIG_SENSORS_APPLESMC) += applesmc.o | 27 | obj-$(CONFIG_SENSORS_APPLESMC) += applesmc.o |
| 27 | obj-$(CONFIG_SENSORS_AMS) += ams/ | 28 | obj-$(CONFIG_SENSORS_AMS) += ams/ |
| @@ -68,6 +69,7 @@ obj-$(CONFIG_SENSORS_VT1211) += vt1211.o | |||
| 68 | obj-$(CONFIG_SENSORS_VT8231) += vt8231.o | 69 | obj-$(CONFIG_SENSORS_VT8231) += vt8231.o |
| 69 | obj-$(CONFIG_SENSORS_W83627EHF) += w83627ehf.o | 70 | obj-$(CONFIG_SENSORS_W83627EHF) += w83627ehf.o |
| 70 | obj-$(CONFIG_SENSORS_W83L785TS) += w83l785ts.o | 71 | obj-$(CONFIG_SENSORS_W83L785TS) += w83l785ts.o |
| 72 | obj-$(CONFIG_SENSORS_W83L786NG) += w83l786ng.o | ||
| 71 | 73 | ||
| 72 | ifeq ($(CONFIG_HWMON_DEBUG_CHIP),y) | 74 | ifeq ($(CONFIG_HWMON_DEBUG_CHIP),y) |
| 73 | EXTRA_CFLAGS += -DDEBUG | 75 | EXTRA_CFLAGS += -DDEBUG |
diff --git a/drivers/hwmon/abituguru3.c b/drivers/hwmon/abituguru3.c index d9f04ce90327..ed33fddc4dee 100644 --- a/drivers/hwmon/abituguru3.c +++ b/drivers/hwmon/abituguru3.c | |||
| @@ -528,6 +528,7 @@ static const struct abituguru3_motherboard_info abituguru3_motherboards[] = { | |||
| 528 | { "AUX1 Fan", 33, 2, 60, 1, 0 }, | 528 | { "AUX1 Fan", 33, 2, 60, 1, 0 }, |
| 529 | { "AUX2 Fan", 35, 2, 60, 1, 0 }, | 529 | { "AUX2 Fan", 35, 2, 60, 1, 0 }, |
| 530 | { "AUX3 Fan", 36, 2, 60, 1, 0 }, | 530 | { "AUX3 Fan", 36, 2, 60, 1, 0 }, |
| 531 | { "AUX4 Fan", 37, 2, 60, 1, 0 }, | ||
| 531 | { NULL, 0, 0, 0, 0, 0 } } | 532 | { NULL, 0, 0, 0, 0, 0 } } |
| 532 | }, | 533 | }, |
| 533 | { 0x001B, "unknown", { | 534 | { 0x001B, "unknown", { |
diff --git a/drivers/hwmon/adm1021.c b/drivers/hwmon/adm1021.c index ebdc6d7db231..b96be772e498 100644 --- a/drivers/hwmon/adm1021.c +++ b/drivers/hwmon/adm1021.c | |||
| @@ -115,7 +115,6 @@ static struct i2c_driver adm1021_driver = { | |||
| 115 | .driver = { | 115 | .driver = { |
| 116 | .name = "adm1021", | 116 | .name = "adm1021", |
| 117 | }, | 117 | }, |
| 118 | .id = I2C_DRIVERID_ADM1021, | ||
| 119 | .attach_adapter = adm1021_attach_adapter, | 118 | .attach_adapter = adm1021_attach_adapter, |
| 120 | .detach_client = adm1021_detach_client, | 119 | .detach_client = adm1021_detach_client, |
| 121 | }; | 120 | }; |
diff --git a/drivers/hwmon/adm1025.c b/drivers/hwmon/adm1025.c index 041ecb0bdf48..e96c3725203d 100644 --- a/drivers/hwmon/adm1025.c +++ b/drivers/hwmon/adm1025.c | |||
| @@ -51,6 +51,7 @@ | |||
| 51 | #include <linux/jiffies.h> | 51 | #include <linux/jiffies.h> |
| 52 | #include <linux/i2c.h> | 52 | #include <linux/i2c.h> |
| 53 | #include <linux/hwmon.h> | 53 | #include <linux/hwmon.h> |
| 54 | #include <linux/hwmon-sysfs.h> | ||
| 54 | #include <linux/hwmon-vid.h> | 55 | #include <linux/hwmon-vid.h> |
| 55 | #include <linux/err.h> | 56 | #include <linux/err.h> |
| 56 | #include <linux/mutex.h> | 57 | #include <linux/mutex.h> |
| @@ -74,7 +75,7 @@ I2C_CLIENT_INSMOD_2(adm1025, ne1619); | |||
| 74 | */ | 75 | */ |
| 75 | 76 | ||
| 76 | #define ADM1025_REG_MAN_ID 0x3E | 77 | #define ADM1025_REG_MAN_ID 0x3E |
| 77 | #define ADM1025_REG_CHIP_ID 0x3F | 78 | #define ADM1025_REG_CHIP_ID 0x3F |
| 78 | #define ADM1025_REG_CONFIG 0x40 | 79 | #define ADM1025_REG_CONFIG 0x40 |
| 79 | #define ADM1025_REG_STATUS1 0x41 | 80 | #define ADM1025_REG_STATUS1 0x41 |
| 80 | #define ADM1025_REG_STATUS2 0x42 | 81 | #define ADM1025_REG_STATUS2 0x42 |
| @@ -92,7 +93,7 @@ I2C_CLIENT_INSMOD_2(adm1025, ne1619); | |||
| 92 | * The ADM1025 uses signed 8-bit values for temperatures. | 93 | * The ADM1025 uses signed 8-bit values for temperatures. |
| 93 | */ | 94 | */ |
| 94 | 95 | ||
| 95 | static int in_scale[6] = { 2500, 2250, 3300, 5000, 12000, 3300 }; | 96 | static const int in_scale[6] = { 2500, 2250, 3300, 5000, 12000, 3300 }; |
| 96 | 97 | ||
| 97 | #define IN_FROM_REG(reg,scale) (((reg) * (scale) + 96) / 192) | 98 | #define IN_FROM_REG(reg,scale) (((reg) * (scale) + 96) / 192) |
| 98 | #define IN_TO_REG(val,scale) ((val) <= 0 ? 0 : \ | 99 | #define IN_TO_REG(val,scale) ((val) <= 0 ? 0 : \ |
| @@ -122,7 +123,6 @@ static struct i2c_driver adm1025_driver = { | |||
| 122 | .driver = { | 123 | .driver = { |
| 123 | .name = "adm1025", | 124 | .name = "adm1025", |
| 124 | }, | 125 | }, |
| 125 | .id = I2C_DRIVERID_ADM1025, | ||
| 126 | .attach_adapter = adm1025_attach_adapter, | 126 | .attach_adapter = adm1025_attach_adapter, |
| 127 | .detach_client = adm1025_detach_client, | 127 | .detach_client = adm1025_detach_client, |
| 128 | }; | 128 | }; |
| @@ -153,86 +153,96 @@ struct adm1025_data { | |||
| 153 | * Sysfs stuff | 153 | * Sysfs stuff |
| 154 | */ | 154 | */ |
| 155 | 155 | ||
| 156 | #define show_in(offset) \ | 156 | static ssize_t |
| 157 | static ssize_t show_in##offset(struct device *dev, struct device_attribute *attr, char *buf) \ | 157 | show_in(struct device *dev, struct device_attribute *attr, char *buf) |
| 158 | { \ | 158 | { |
| 159 | struct adm1025_data *data = adm1025_update_device(dev); \ | 159 | int index = to_sensor_dev_attr(attr)->index; |
| 160 | return sprintf(buf, "%u\n", IN_FROM_REG(data->in[offset], \ | 160 | struct adm1025_data *data = adm1025_update_device(dev); |
| 161 | in_scale[offset])); \ | 161 | return sprintf(buf, "%u\n", IN_FROM_REG(data->in[index], |
| 162 | } \ | 162 | in_scale[index])); |
| 163 | static ssize_t show_in##offset##_min(struct device *dev, struct device_attribute *attr, char *buf) \ | 163 | } |
| 164 | { \ | 164 | |
| 165 | struct adm1025_data *data = adm1025_update_device(dev); \ | 165 | static ssize_t |
| 166 | return sprintf(buf, "%u\n", IN_FROM_REG(data->in_min[offset], \ | 166 | show_in_min(struct device *dev, struct device_attribute *attr, char *buf) |
| 167 | in_scale[offset])); \ | 167 | { |
| 168 | } \ | 168 | int index = to_sensor_dev_attr(attr)->index; |
| 169 | static ssize_t show_in##offset##_max(struct device *dev, struct device_attribute *attr, char *buf) \ | 169 | struct adm1025_data *data = adm1025_update_device(dev); |
| 170 | { \ | 170 | return sprintf(buf, "%u\n", IN_FROM_REG(data->in_min[index], |
| 171 | struct adm1025_data *data = adm1025_update_device(dev); \ | 171 | in_scale[index])); |
| 172 | return sprintf(buf, "%u\n", IN_FROM_REG(data->in_max[offset], \ | 172 | } |
| 173 | in_scale[offset])); \ | 173 | |
| 174 | } \ | 174 | static ssize_t |
| 175 | static DEVICE_ATTR(in##offset##_input, S_IRUGO, show_in##offset, NULL); | 175 | show_in_max(struct device *dev, struct device_attribute *attr, char *buf) |
| 176 | show_in(0); | 176 | { |
| 177 | show_in(1); | 177 | int index = to_sensor_dev_attr(attr)->index; |
| 178 | show_in(2); | 178 | struct adm1025_data *data = adm1025_update_device(dev); |
| 179 | show_in(3); | 179 | return sprintf(buf, "%u\n", IN_FROM_REG(data->in_max[index], |
| 180 | show_in(4); | 180 | in_scale[index])); |
| 181 | show_in(5); | 181 | } |
| 182 | 182 | ||
| 183 | #define show_temp(offset) \ | 183 | static ssize_t |
| 184 | static ssize_t show_temp##offset(struct device *dev, struct device_attribute *attr, char *buf) \ | 184 | show_temp(struct device *dev, struct device_attribute *attr, char *buf) |
| 185 | { \ | 185 | { |
| 186 | struct adm1025_data *data = adm1025_update_device(dev); \ | 186 | int index = to_sensor_dev_attr(attr)->index; |
| 187 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[offset-1])); \ | 187 | struct adm1025_data *data = adm1025_update_device(dev); |
| 188 | } \ | 188 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[index])); |
| 189 | static ssize_t show_temp##offset##_min(struct device *dev, struct device_attribute *attr, char *buf) \ | 189 | } |
| 190 | { \ | 190 | |
| 191 | struct adm1025_data *data = adm1025_update_device(dev); \ | 191 | static ssize_t |
| 192 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[offset-1])); \ | 192 | show_temp_min(struct device *dev, struct device_attribute *attr, char *buf) |
| 193 | } \ | 193 | { |
| 194 | static ssize_t show_temp##offset##_max(struct device *dev, struct device_attribute *attr, char *buf) \ | 194 | int index = to_sensor_dev_attr(attr)->index; |
| 195 | { \ | 195 | struct adm1025_data *data = adm1025_update_device(dev); |
| 196 | struct adm1025_data *data = adm1025_update_device(dev); \ | 196 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[index])); |
| 197 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[offset-1])); \ | 197 | } |
| 198 | }\ | 198 | |
| 199 | static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp##offset, NULL); | 199 | static ssize_t |
| 200 | show_temp(1); | 200 | show_temp_max(struct device *dev, struct device_attribute *attr, char *buf) |
| 201 | show_temp(2); | 201 | { |
| 202 | int index = to_sensor_dev_attr(attr)->index; | ||
| 203 | struct adm1025_data *data = adm1025_update_device(dev); | ||
| 204 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[index])); | ||
| 205 | } | ||
| 206 | |||
| 207 | static ssize_t set_in_min(struct device *dev, struct device_attribute *attr, | ||
| 208 | const char *buf, size_t count) | ||
| 209 | { | ||
| 210 | int index = to_sensor_dev_attr(attr)->index; | ||
| 211 | struct i2c_client *client = to_i2c_client(dev); | ||
| 212 | struct adm1025_data *data = i2c_get_clientdata(client); | ||
| 213 | long val = simple_strtol(buf, NULL, 10); | ||
| 214 | |||
| 215 | mutex_lock(&data->update_lock); | ||
| 216 | data->in_min[index] = IN_TO_REG(val, in_scale[index]); | ||
| 217 | i2c_smbus_write_byte_data(client, ADM1025_REG_IN_MIN(index), | ||
| 218 | data->in_min[index]); | ||
| 219 | mutex_unlock(&data->update_lock); | ||
| 220 | return count; | ||
| 221 | } | ||
| 222 | |||
| 223 | static ssize_t set_in_max(struct device *dev, struct device_attribute *attr, | ||
| 224 | const char *buf, size_t count) | ||
| 225 | { | ||
| 226 | int index = to_sensor_dev_attr(attr)->index; | ||
| 227 | struct i2c_client *client = to_i2c_client(dev); | ||
| 228 | struct adm1025_data *data = i2c_get_clientdata(client); | ||
| 229 | long val = simple_strtol(buf, NULL, 10); | ||
| 230 | |||
| 231 | mutex_lock(&data->update_lock); | ||
| 232 | data->in_max[index] = IN_TO_REG(val, in_scale[index]); | ||
| 233 | i2c_smbus_write_byte_data(client, ADM1025_REG_IN_MAX(index), | ||
| 234 | data->in_max[index]); | ||
| 235 | mutex_unlock(&data->update_lock); | ||
| 236 | return count; | ||
| 237 | } | ||
| 202 | 238 | ||
| 203 | #define set_in(offset) \ | 239 | #define set_in(offset) \ |
| 204 | static ssize_t set_in##offset##_min(struct device *dev, struct device_attribute *attr, const char *buf, \ | 240 | static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \ |
| 205 | size_t count) \ | 241 | show_in, NULL, offset); \ |
| 206 | { \ | 242 | static SENSOR_DEVICE_ATTR(in##offset##_min, S_IWUSR | S_IRUGO, \ |
| 207 | struct i2c_client *client = to_i2c_client(dev); \ | 243 | show_in_min, set_in_min, offset); \ |
| 208 | struct adm1025_data *data = i2c_get_clientdata(client); \ | 244 | static SENSOR_DEVICE_ATTR(in##offset##_max, S_IWUSR | S_IRUGO, \ |
| 209 | long val = simple_strtol(buf, NULL, 10); \ | 245 | show_in_max, set_in_max, offset) |
| 210 | \ | ||
| 211 | mutex_lock(&data->update_lock); \ | ||
| 212 | data->in_min[offset] = IN_TO_REG(val, in_scale[offset]); \ | ||
| 213 | i2c_smbus_write_byte_data(client, ADM1025_REG_IN_MIN(offset), \ | ||
| 214 | data->in_min[offset]); \ | ||
| 215 | mutex_unlock(&data->update_lock); \ | ||
| 216 | return count; \ | ||
| 217 | } \ | ||
| 218 | static ssize_t set_in##offset##_max(struct device *dev, struct device_attribute *attr, const char *buf, \ | ||
| 219 | size_t count) \ | ||
| 220 | { \ | ||
| 221 | struct i2c_client *client = to_i2c_client(dev); \ | ||
| 222 | struct adm1025_data *data = i2c_get_clientdata(client); \ | ||
| 223 | long val = simple_strtol(buf, NULL, 10); \ | ||
| 224 | \ | ||
| 225 | mutex_lock(&data->update_lock); \ | ||
| 226 | data->in_max[offset] = IN_TO_REG(val, in_scale[offset]); \ | ||
| 227 | i2c_smbus_write_byte_data(client, ADM1025_REG_IN_MAX(offset), \ | ||
| 228 | data->in_max[offset]); \ | ||
| 229 | mutex_unlock(&data->update_lock); \ | ||
| 230 | return count; \ | ||
| 231 | } \ | ||
| 232 | static DEVICE_ATTR(in##offset##_min, S_IWUSR | S_IRUGO, \ | ||
| 233 | show_in##offset##_min, set_in##offset##_min); \ | ||
| 234 | static DEVICE_ATTR(in##offset##_max, S_IWUSR | S_IRUGO, \ | ||
| 235 | show_in##offset##_max, set_in##offset##_max); | ||
| 236 | set_in(0); | 246 | set_in(0); |
| 237 | set_in(1); | 247 | set_in(1); |
| 238 | set_in(2); | 248 | set_in(2); |
| @@ -240,65 +250,91 @@ set_in(3); | |||
| 240 | set_in(4); | 250 | set_in(4); |
| 241 | set_in(5); | 251 | set_in(5); |
| 242 | 252 | ||
| 253 | static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr, | ||
| 254 | const char *buf, size_t count) | ||
| 255 | { | ||
| 256 | int index = to_sensor_dev_attr(attr)->index; | ||
| 257 | struct i2c_client *client = to_i2c_client(dev); | ||
| 258 | struct adm1025_data *data = i2c_get_clientdata(client); | ||
| 259 | long val = simple_strtol(buf, NULL, 10); | ||
| 260 | |||
| 261 | mutex_lock(&data->update_lock); | ||
| 262 | data->temp_min[index] = TEMP_TO_REG(val); | ||
| 263 | i2c_smbus_write_byte_data(client, ADM1025_REG_TEMP_LOW(index), | ||
| 264 | data->temp_min[index]); | ||
| 265 | mutex_unlock(&data->update_lock); | ||
| 266 | return count; | ||
| 267 | } | ||
| 268 | |||
| 269 | static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr, | ||
| 270 | const char *buf, size_t count) | ||
| 271 | { | ||
| 272 | int index = to_sensor_dev_attr(attr)->index; | ||
| 273 | struct i2c_client *client = to_i2c_client(dev); | ||
| 274 | struct adm1025_data *data = i2c_get_clientdata(client); | ||
| 275 | long val = simple_strtol(buf, NULL, 10); | ||
| 276 | |||
| 277 | mutex_lock(&data->update_lock); | ||
| 278 | data->temp_max[index] = TEMP_TO_REG(val); | ||
| 279 | i2c_smbus_write_byte_data(client, ADM1025_REG_TEMP_HIGH(index), | ||
| 280 | data->temp_max[index]); | ||
| 281 | mutex_unlock(&data->update_lock); | ||
| 282 | return count; | ||
| 283 | } | ||
| 284 | |||
| 243 | #define set_temp(offset) \ | 285 | #define set_temp(offset) \ |
| 244 | static ssize_t set_temp##offset##_min(struct device *dev, struct device_attribute *attr, const char *buf, \ | 286 | static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, \ |
| 245 | size_t count) \ | 287 | show_temp, NULL, offset - 1); \ |
| 246 | { \ | 288 | static SENSOR_DEVICE_ATTR(temp##offset##_min, S_IWUSR | S_IRUGO, \ |
| 247 | struct i2c_client *client = to_i2c_client(dev); \ | 289 | show_temp_min, set_temp_min, offset - 1); \ |
| 248 | struct adm1025_data *data = i2c_get_clientdata(client); \ | 290 | static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IWUSR | S_IRUGO, \ |
| 249 | long val = simple_strtol(buf, NULL, 10); \ | 291 | show_temp_max, set_temp_max, offset - 1) |
| 250 | \ | ||
| 251 | mutex_lock(&data->update_lock); \ | ||
| 252 | data->temp_min[offset-1] = TEMP_TO_REG(val); \ | ||
| 253 | i2c_smbus_write_byte_data(client, ADM1025_REG_TEMP_LOW(offset-1), \ | ||
| 254 | data->temp_min[offset-1]); \ | ||
| 255 | mutex_unlock(&data->update_lock); \ | ||
| 256 | return count; \ | ||
| 257 | } \ | ||
| 258 | static ssize_t set_temp##offset##_max(struct device *dev, struct device_attribute *attr, const char *buf, \ | ||
| 259 | size_t count) \ | ||
| 260 | { \ | ||
| 261 | struct i2c_client *client = to_i2c_client(dev); \ | ||
| 262 | struct adm1025_data *data = i2c_get_clientdata(client); \ | ||
| 263 | long val = simple_strtol(buf, NULL, 10); \ | ||
| 264 | \ | ||
| 265 | mutex_lock(&data->update_lock); \ | ||
| 266 | data->temp_max[offset-1] = TEMP_TO_REG(val); \ | ||
| 267 | i2c_smbus_write_byte_data(client, ADM1025_REG_TEMP_HIGH(offset-1), \ | ||
| 268 | data->temp_max[offset-1]); \ | ||
| 269 | mutex_unlock(&data->update_lock); \ | ||
| 270 | return count; \ | ||
| 271 | } \ | ||
| 272 | static DEVICE_ATTR(temp##offset##_min, S_IWUSR | S_IRUGO, \ | ||
| 273 | show_temp##offset##_min, set_temp##offset##_min); \ | ||
| 274 | static DEVICE_ATTR(temp##offset##_max, S_IWUSR | S_IRUGO, \ | ||
| 275 | show_temp##offset##_max, set_temp##offset##_max); | ||
| 276 | set_temp(1); | 292 | set_temp(1); |
| 277 | set_temp(2); | 293 | set_temp(2); |
| 278 | 294 | ||
| 279 | static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf) | 295 | static ssize_t |
| 296 | show_alarms(struct device *dev, struct device_attribute *attr, char *buf) | ||
| 280 | { | 297 | { |
| 281 | struct adm1025_data *data = adm1025_update_device(dev); | 298 | struct adm1025_data *data = adm1025_update_device(dev); |
| 282 | return sprintf(buf, "%u\n", data->alarms); | 299 | return sprintf(buf, "%u\n", data->alarms); |
| 283 | } | 300 | } |
| 284 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); | 301 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); |
| 285 | 302 | ||
| 286 | static ssize_t show_vid(struct device *dev, struct device_attribute *attr, char *buf) | 303 | static ssize_t |
| 304 | show_alarm(struct device *dev, struct device_attribute *attr, char *buf) | ||
| 305 | { | ||
| 306 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 307 | struct adm1025_data *data = adm1025_update_device(dev); | ||
| 308 | return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); | ||
| 309 | } | ||
| 310 | static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0); | ||
| 311 | static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1); | ||
| 312 | static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2); | ||
| 313 | static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3); | ||
| 314 | static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8); | ||
| 315 | static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9); | ||
| 316 | static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 5); | ||
| 317 | static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 4); | ||
| 318 | static SENSOR_DEVICE_ATTR(temp1_fault, S_IRUGO, show_alarm, NULL, 14); | ||
| 319 | |||
| 320 | static ssize_t | ||
| 321 | show_vid(struct device *dev, struct device_attribute *attr, char *buf) | ||
| 287 | { | 322 | { |
| 288 | struct adm1025_data *data = adm1025_update_device(dev); | 323 | struct adm1025_data *data = adm1025_update_device(dev); |
| 289 | return sprintf(buf, "%u\n", vid_from_reg(data->vid, data->vrm)); | 324 | return sprintf(buf, "%u\n", vid_from_reg(data->vid, data->vrm)); |
| 290 | } | 325 | } |
| 291 | static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL); | 326 | static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL); |
| 292 | 327 | ||
| 293 | static ssize_t show_vrm(struct device *dev, struct device_attribute *attr, char *buf) | 328 | static ssize_t |
| 329 | show_vrm(struct device *dev, struct device_attribute *attr, char *buf) | ||
| 294 | { | 330 | { |
| 295 | struct adm1025_data *data = dev_get_drvdata(dev); | 331 | struct adm1025_data *data = dev_get_drvdata(dev); |
| 296 | return sprintf(buf, "%u\n", data->vrm); | 332 | return sprintf(buf, "%u\n", data->vrm); |
| 297 | } | 333 | } |
| 298 | static ssize_t set_vrm(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | 334 | static ssize_t set_vrm(struct device *dev, struct device_attribute *attr, |
| 335 | const char *buf, size_t count) | ||
| 299 | { | 336 | { |
| 300 | struct i2c_client *client = to_i2c_client(dev); | 337 | struct adm1025_data *data = dev_get_drvdata(dev); |
| 301 | struct adm1025_data *data = i2c_get_clientdata(client); | ||
| 302 | data->vrm = simple_strtoul(buf, NULL, 10); | 338 | data->vrm = simple_strtoul(buf, NULL, 10); |
| 303 | return count; | 339 | return count; |
| 304 | } | 340 | } |
| @@ -316,27 +352,35 @@ static int adm1025_attach_adapter(struct i2c_adapter *adapter) | |||
| 316 | } | 352 | } |
| 317 | 353 | ||
| 318 | static struct attribute *adm1025_attributes[] = { | 354 | static struct attribute *adm1025_attributes[] = { |
| 319 | &dev_attr_in0_input.attr, | 355 | &sensor_dev_attr_in0_input.dev_attr.attr, |
| 320 | &dev_attr_in1_input.attr, | 356 | &sensor_dev_attr_in1_input.dev_attr.attr, |
| 321 | &dev_attr_in2_input.attr, | 357 | &sensor_dev_attr_in2_input.dev_attr.attr, |
| 322 | &dev_attr_in3_input.attr, | 358 | &sensor_dev_attr_in3_input.dev_attr.attr, |
| 323 | &dev_attr_in5_input.attr, | 359 | &sensor_dev_attr_in5_input.dev_attr.attr, |
| 324 | &dev_attr_in0_min.attr, | 360 | &sensor_dev_attr_in0_min.dev_attr.attr, |
| 325 | &dev_attr_in1_min.attr, | 361 | &sensor_dev_attr_in1_min.dev_attr.attr, |
| 326 | &dev_attr_in2_min.attr, | 362 | &sensor_dev_attr_in2_min.dev_attr.attr, |
| 327 | &dev_attr_in3_min.attr, | 363 | &sensor_dev_attr_in3_min.dev_attr.attr, |
| 328 | &dev_attr_in5_min.attr, | 364 | &sensor_dev_attr_in5_min.dev_attr.attr, |
| 329 | &dev_attr_in0_max.attr, | 365 | &sensor_dev_attr_in0_max.dev_attr.attr, |
| 330 | &dev_attr_in1_max.attr, | 366 | &sensor_dev_attr_in1_max.dev_attr.attr, |
| 331 | &dev_attr_in2_max.attr, | 367 | &sensor_dev_attr_in2_max.dev_attr.attr, |
| 332 | &dev_attr_in3_max.attr, | 368 | &sensor_dev_attr_in3_max.dev_attr.attr, |
| 333 | &dev_attr_in5_max.attr, | 369 | &sensor_dev_attr_in5_max.dev_attr.attr, |
| 334 | &dev_attr_temp1_input.attr, | 370 | &sensor_dev_attr_in0_alarm.dev_attr.attr, |
| 335 | &dev_attr_temp2_input.attr, | 371 | &sensor_dev_attr_in1_alarm.dev_attr.attr, |
| 336 | &dev_attr_temp1_min.attr, | 372 | &sensor_dev_attr_in2_alarm.dev_attr.attr, |
| 337 | &dev_attr_temp2_min.attr, | 373 | &sensor_dev_attr_in3_alarm.dev_attr.attr, |
| 338 | &dev_attr_temp1_max.attr, | 374 | &sensor_dev_attr_in5_alarm.dev_attr.attr, |
| 339 | &dev_attr_temp2_max.attr, | 375 | &sensor_dev_attr_temp1_input.dev_attr.attr, |
| 376 | &sensor_dev_attr_temp2_input.dev_attr.attr, | ||
| 377 | &sensor_dev_attr_temp1_min.dev_attr.attr, | ||
| 378 | &sensor_dev_attr_temp2_min.dev_attr.attr, | ||
| 379 | &sensor_dev_attr_temp1_max.dev_attr.attr, | ||
| 380 | &sensor_dev_attr_temp2_max.dev_attr.attr, | ||
| 381 | &sensor_dev_attr_temp1_alarm.dev_attr.attr, | ||
| 382 | &sensor_dev_attr_temp2_alarm.dev_attr.attr, | ||
| 383 | &sensor_dev_attr_temp1_fault.dev_attr.attr, | ||
| 340 | &dev_attr_alarms.attr, | 384 | &dev_attr_alarms.attr, |
| 341 | &dev_attr_cpu0_vid.attr, | 385 | &dev_attr_cpu0_vid.attr, |
| 342 | &dev_attr_vrm.attr, | 386 | &dev_attr_vrm.attr, |
| @@ -347,15 +391,16 @@ static const struct attribute_group adm1025_group = { | |||
| 347 | .attrs = adm1025_attributes, | 391 | .attrs = adm1025_attributes, |
| 348 | }; | 392 | }; |
| 349 | 393 | ||
| 350 | static struct attribute *adm1025_attributes_opt[] = { | 394 | static struct attribute *adm1025_attributes_in4[] = { |
| 351 | &dev_attr_in4_input.attr, | 395 | &sensor_dev_attr_in4_input.dev_attr.attr, |
| 352 | &dev_attr_in4_min.attr, | 396 | &sensor_dev_attr_in4_min.dev_attr.attr, |
| 353 | &dev_attr_in4_max.attr, | 397 | &sensor_dev_attr_in4_max.dev_attr.attr, |
| 398 | &sensor_dev_attr_in4_alarm.dev_attr.attr, | ||
| 354 | NULL | 399 | NULL |
| 355 | }; | 400 | }; |
| 356 | 401 | ||
| 357 | static const struct attribute_group adm1025_group_opt = { | 402 | static const struct attribute_group adm1025_group_in4 = { |
| 358 | .attrs = adm1025_attributes_opt, | 403 | .attrs = adm1025_attributes_in4, |
| 359 | }; | 404 | }; |
| 360 | 405 | ||
| 361 | /* | 406 | /* |
| @@ -364,7 +409,7 @@ static const struct attribute_group adm1025_group_opt = { | |||
| 364 | */ | 409 | */ |
| 365 | static int adm1025_detect(struct i2c_adapter *adapter, int address, int kind) | 410 | static int adm1025_detect(struct i2c_adapter *adapter, int address, int kind) |
| 366 | { | 411 | { |
| 367 | struct i2c_client *new_client; | 412 | struct i2c_client *client; |
| 368 | struct adm1025_data *data; | 413 | struct adm1025_data *data; |
| 369 | int err = 0; | 414 | int err = 0; |
| 370 | const char *name = ""; | 415 | const char *name = ""; |
| @@ -378,14 +423,11 @@ static int adm1025_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 378 | goto exit; | 423 | goto exit; |
| 379 | } | 424 | } |
| 380 | 425 | ||
| 381 | /* The common I2C client data is placed right before the | 426 | client = &data->client; |
| 382 | ADM1025-specific data. */ | 427 | i2c_set_clientdata(client, data); |
| 383 | new_client = &data->client; | 428 | client->addr = address; |
| 384 | i2c_set_clientdata(new_client, data); | 429 | client->adapter = adapter; |
| 385 | new_client->addr = address; | 430 | client->driver = &adm1025_driver; |
| 386 | new_client->adapter = adapter; | ||
| 387 | new_client->driver = &adm1025_driver; | ||
| 388 | new_client->flags = 0; | ||
| 389 | 431 | ||
| 390 | /* | 432 | /* |
| 391 | * Now we do the remaining detection. A negative kind means that | 433 | * Now we do the remaining detection. A negative kind means that |
| @@ -397,12 +439,12 @@ static int adm1025_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 397 | * requested, so both the detection and the identification steps | 439 | * requested, so both the detection and the identification steps |
| 398 | * are skipped. | 440 | * are skipped. |
| 399 | */ | 441 | */ |
| 400 | config = i2c_smbus_read_byte_data(new_client, ADM1025_REG_CONFIG); | 442 | config = i2c_smbus_read_byte_data(client, ADM1025_REG_CONFIG); |
| 401 | if (kind < 0) { /* detection */ | 443 | if (kind < 0) { /* detection */ |
| 402 | if ((config & 0x80) != 0x00 | 444 | if ((config & 0x80) != 0x00 |
| 403 | || (i2c_smbus_read_byte_data(new_client, | 445 | || (i2c_smbus_read_byte_data(client, |
| 404 | ADM1025_REG_STATUS1) & 0xC0) != 0x00 | 446 | ADM1025_REG_STATUS1) & 0xC0) != 0x00 |
| 405 | || (i2c_smbus_read_byte_data(new_client, | 447 | || (i2c_smbus_read_byte_data(client, |
| 406 | ADM1025_REG_STATUS2) & 0xBC) != 0x00) { | 448 | ADM1025_REG_STATUS2) & 0xBC) != 0x00) { |
| 407 | dev_dbg(&adapter->dev, | 449 | dev_dbg(&adapter->dev, |
| 408 | "ADM1025 detection failed at 0x%02x.\n", | 450 | "ADM1025 detection failed at 0x%02x.\n", |
| @@ -414,11 +456,9 @@ static int adm1025_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 414 | if (kind <= 0) { /* identification */ | 456 | if (kind <= 0) { /* identification */ |
| 415 | u8 man_id, chip_id; | 457 | u8 man_id, chip_id; |
| 416 | 458 | ||
| 417 | man_id = i2c_smbus_read_byte_data(new_client, | 459 | man_id = i2c_smbus_read_byte_data(client, ADM1025_REG_MAN_ID); |
| 418 | ADM1025_REG_MAN_ID); | 460 | chip_id = i2c_smbus_read_byte_data(client, ADM1025_REG_CHIP_ID); |
| 419 | chip_id = i2c_smbus_read_byte_data(new_client, | 461 | |
| 420 | ADM1025_REG_CHIP_ID); | ||
| 421 | |||
| 422 | if (man_id == 0x41) { /* Analog Devices */ | 462 | if (man_id == 0x41) { /* Analog Devices */ |
| 423 | if ((chip_id & 0xF0) == 0x20) { /* ADM1025/ADM1025A */ | 463 | if ((chip_id & 0xF0) == 0x20) { /* ADM1025/ADM1025A */ |
| 424 | kind = adm1025; | 464 | kind = adm1025; |
| @@ -446,33 +486,28 @@ static int adm1025_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 446 | } | 486 | } |
| 447 | 487 | ||
| 448 | /* We can fill in the remaining client fields */ | 488 | /* We can fill in the remaining client fields */ |
| 449 | strlcpy(new_client->name, name, I2C_NAME_SIZE); | 489 | strlcpy(client->name, name, I2C_NAME_SIZE); |
| 450 | data->valid = 0; | ||
| 451 | mutex_init(&data->update_lock); | 490 | mutex_init(&data->update_lock); |
| 452 | 491 | ||
| 453 | /* Tell the I2C layer a new client has arrived */ | 492 | /* Tell the I2C layer a new client has arrived */ |
| 454 | if ((err = i2c_attach_client(new_client))) | 493 | if ((err = i2c_attach_client(client))) |
| 455 | goto exit_free; | 494 | goto exit_free; |
| 456 | 495 | ||
| 457 | /* Initialize the ADM1025 chip */ | 496 | /* Initialize the ADM1025 chip */ |
| 458 | adm1025_init_client(new_client); | 497 | adm1025_init_client(client); |
| 459 | 498 | ||
| 460 | /* Register sysfs hooks */ | 499 | /* Register sysfs hooks */ |
| 461 | if ((err = sysfs_create_group(&new_client->dev.kobj, &adm1025_group))) | 500 | if ((err = sysfs_create_group(&client->dev.kobj, &adm1025_group))) |
| 462 | goto exit_detach; | 501 | goto exit_detach; |
| 463 | 502 | ||
| 464 | /* Pin 11 is either in4 (+12V) or VID4 */ | 503 | /* Pin 11 is either in4 (+12V) or VID4 */ |
| 465 | if (!(config & 0x20)) { | 504 | if (!(config & 0x20)) { |
| 466 | if ((err = device_create_file(&new_client->dev, | 505 | if ((err = sysfs_create_group(&client->dev.kobj, |
| 467 | &dev_attr_in4_input)) | 506 | &adm1025_group_in4))) |
| 468 | || (err = device_create_file(&new_client->dev, | ||
| 469 | &dev_attr_in4_min)) | ||
| 470 | || (err = device_create_file(&new_client->dev, | ||
| 471 | &dev_attr_in4_max))) | ||
| 472 | goto exit_remove; | 507 | goto exit_remove; |
| 473 | } | 508 | } |
| 474 | 509 | ||
| 475 | data->hwmon_dev = hwmon_device_register(&new_client->dev); | 510 | data->hwmon_dev = hwmon_device_register(&client->dev); |
| 476 | if (IS_ERR(data->hwmon_dev)) { | 511 | if (IS_ERR(data->hwmon_dev)) { |
| 477 | err = PTR_ERR(data->hwmon_dev); | 512 | err = PTR_ERR(data->hwmon_dev); |
| 478 | goto exit_remove; | 513 | goto exit_remove; |
| @@ -481,10 +516,10 @@ static int adm1025_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 481 | return 0; | 516 | return 0; |
| 482 | 517 | ||
| 483 | exit_remove: | 518 | exit_remove: |
| 484 | sysfs_remove_group(&new_client->dev.kobj, &adm1025_group); | 519 | sysfs_remove_group(&client->dev.kobj, &adm1025_group); |
| 485 | sysfs_remove_group(&new_client->dev.kobj, &adm1025_group_opt); | 520 | sysfs_remove_group(&client->dev.kobj, &adm1025_group_in4); |
| 486 | exit_detach: | 521 | exit_detach: |
| 487 | i2c_detach_client(new_client); | 522 | i2c_detach_client(client); |
| 488 | exit_free: | 523 | exit_free: |
| 489 | kfree(data); | 524 | kfree(data); |
| 490 | exit: | 525 | exit: |
| @@ -540,7 +575,7 @@ static int adm1025_detach_client(struct i2c_client *client) | |||
| 540 | 575 | ||
| 541 | hwmon_device_unregister(data->hwmon_dev); | 576 | hwmon_device_unregister(data->hwmon_dev); |
| 542 | sysfs_remove_group(&client->dev.kobj, &adm1025_group); | 577 | sysfs_remove_group(&client->dev.kobj, &adm1025_group); |
| 543 | sysfs_remove_group(&client->dev.kobj, &adm1025_group_opt); | 578 | sysfs_remove_group(&client->dev.kobj, &adm1025_group_in4); |
| 544 | 579 | ||
| 545 | if ((err = i2c_detach_client(client))) | 580 | if ((err = i2c_detach_client(client))) |
| 546 | return err; | 581 | return err; |
diff --git a/drivers/hwmon/adm1026.c b/drivers/hwmon/adm1026.c index 3e63c1486770..8002f68240c4 100644 --- a/drivers/hwmon/adm1026.c +++ b/drivers/hwmon/adm1026.c | |||
| @@ -40,8 +40,8 @@ static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END }; | |||
| 40 | /* Insmod parameters */ | 40 | /* Insmod parameters */ |
| 41 | I2C_CLIENT_INSMOD_1(adm1026); | 41 | I2C_CLIENT_INSMOD_1(adm1026); |
| 42 | 42 | ||
| 43 | static int gpio_input[17] = { -1, -1, -1, -1, -1, -1, -1, -1, -1, | 43 | static int gpio_input[17] = { -1, -1, -1, -1, -1, -1, -1, -1, -1, |
| 44 | -1, -1, -1, -1, -1, -1, -1, -1 }; | 44 | -1, -1, -1, -1, -1, -1, -1, -1 }; |
| 45 | static int gpio_output[17] = { -1, -1, -1, -1, -1, -1, -1, -1, -1, | 45 | static int gpio_output[17] = { -1, -1, -1, -1, -1, -1, -1, -1, -1, |
| 46 | -1, -1, -1, -1, -1, -1, -1, -1 }; | 46 | -1, -1, -1, -1, -1, -1, -1, -1 }; |
| 47 | static int gpio_inverted[17] = { -1, -1, -1, -1, -1, -1, -1, -1, -1, | 47 | static int gpio_inverted[17] = { -1, -1, -1, -1, -1, -1, -1, -1, -1, |
| @@ -49,46 +49,49 @@ static int gpio_inverted[17] = { -1, -1, -1, -1, -1, -1, -1, -1, -1, | |||
| 49 | static int gpio_normal[17] = { -1, -1, -1, -1, -1, -1, -1, -1, -1, | 49 | static int gpio_normal[17] = { -1, -1, -1, -1, -1, -1, -1, -1, -1, |
| 50 | -1, -1, -1, -1, -1, -1, -1, -1 }; | 50 | -1, -1, -1, -1, -1, -1, -1, -1 }; |
| 51 | static int gpio_fan[8] = { -1, -1, -1, -1, -1, -1, -1, -1 }; | 51 | static int gpio_fan[8] = { -1, -1, -1, -1, -1, -1, -1, -1 }; |
| 52 | module_param_array(gpio_input,int,NULL,0); | 52 | module_param_array(gpio_input, int, NULL, 0); |
| 53 | MODULE_PARM_DESC(gpio_input,"List of GPIO pins (0-16) to program as inputs"); | 53 | MODULE_PARM_DESC(gpio_input, "List of GPIO pins (0-16) to program as inputs"); |
| 54 | module_param_array(gpio_output,int,NULL,0); | 54 | module_param_array(gpio_output, int, NULL, 0); |
| 55 | MODULE_PARM_DESC(gpio_output,"List of GPIO pins (0-16) to program as " | 55 | MODULE_PARM_DESC(gpio_output, "List of GPIO pins (0-16) to program as " |
| 56 | "outputs"); | 56 | "outputs"); |
| 57 | module_param_array(gpio_inverted,int,NULL,0); | 57 | module_param_array(gpio_inverted, int, NULL, 0); |
| 58 | MODULE_PARM_DESC(gpio_inverted,"List of GPIO pins (0-16) to program as " | 58 | MODULE_PARM_DESC(gpio_inverted, "List of GPIO pins (0-16) to program as " |
| 59 | "inverted"); | 59 | "inverted"); |
| 60 | module_param_array(gpio_normal,int,NULL,0); | 60 | module_param_array(gpio_normal, int, NULL, 0); |
| 61 | MODULE_PARM_DESC(gpio_normal,"List of GPIO pins (0-16) to program as " | 61 | MODULE_PARM_DESC(gpio_normal, "List of GPIO pins (0-16) to program as " |
| 62 | "normal/non-inverted"); | 62 | "normal/non-inverted"); |
| 63 | module_param_array(gpio_fan,int,NULL,0); | 63 | module_param_array(gpio_fan, int, NULL, 0); |
| 64 | MODULE_PARM_DESC(gpio_fan,"List of GPIO pins (0-7) to program as fan tachs"); | 64 | MODULE_PARM_DESC(gpio_fan, "List of GPIO pins (0-7) to program as fan tachs"); |
| 65 | 65 | ||
| 66 | /* Many ADM1026 constants specified below */ | 66 | /* Many ADM1026 constants specified below */ |
| 67 | 67 | ||
| 68 | /* The ADM1026 registers */ | 68 | /* The ADM1026 registers */ |
| 69 | #define ADM1026_REG_CONFIG1 0x00 | 69 | #define ADM1026_REG_CONFIG1 0x00 |
| 70 | #define CFG1_MONITOR 0x01 | 70 | #define CFG1_MONITOR 0x01 |
| 71 | #define CFG1_INT_ENABLE 0x02 | 71 | #define CFG1_INT_ENABLE 0x02 |
| 72 | #define CFG1_INT_CLEAR 0x04 | 72 | #define CFG1_INT_CLEAR 0x04 |
| 73 | #define CFG1_AIN8_9 0x08 | 73 | #define CFG1_AIN8_9 0x08 |
| 74 | #define CFG1_THERM_HOT 0x10 | 74 | #define CFG1_THERM_HOT 0x10 |
| 75 | #define CFG1_DAC_AFC 0x20 | 75 | #define CFG1_DAC_AFC 0x20 |
| 76 | #define CFG1_PWM_AFC 0x40 | 76 | #define CFG1_PWM_AFC 0x40 |
| 77 | #define CFG1_RESET 0x80 | 77 | #define CFG1_RESET 0x80 |
| 78 | #define ADM1026_REG_CONFIG2 0x01 | 78 | |
| 79 | #define ADM1026_REG_CONFIG2 0x01 | ||
| 79 | /* CONFIG2 controls FAN0/GPIO0 through FAN7/GPIO7 */ | 80 | /* CONFIG2 controls FAN0/GPIO0 through FAN7/GPIO7 */ |
| 80 | #define ADM1026_REG_CONFIG3 0x07 | 81 | |
| 81 | #define CFG3_GPIO16_ENABLE 0x01 | 82 | #define ADM1026_REG_CONFIG3 0x07 |
| 82 | #define CFG3_CI_CLEAR 0x02 | 83 | #define CFG3_GPIO16_ENABLE 0x01 |
| 83 | #define CFG3_VREF_250 0x04 | 84 | #define CFG3_CI_CLEAR 0x02 |
| 84 | #define CFG3_GPIO16_DIR 0x40 | 85 | #define CFG3_VREF_250 0x04 |
| 85 | #define CFG3_GPIO16_POL 0x80 | 86 | #define CFG3_GPIO16_DIR 0x40 |
| 86 | #define ADM1026_REG_E2CONFIG 0x13 | 87 | #define CFG3_GPIO16_POL 0x80 |
| 87 | #define E2CFG_READ 0x01 | 88 | |
| 88 | #define E2CFG_WRITE 0x02 | 89 | #define ADM1026_REG_E2CONFIG 0x13 |
| 89 | #define E2CFG_ERASE 0x04 | 90 | #define E2CFG_READ 0x01 |
| 90 | #define E2CFG_ROM 0x08 | 91 | #define E2CFG_WRITE 0x02 |
| 91 | #define E2CFG_CLK_EXT 0x80 | 92 | #define E2CFG_ERASE 0x04 |
| 93 | #define E2CFG_ROM 0x08 | ||
| 94 | #define E2CFG_CLK_EXT 0x80 | ||
| 92 | 95 | ||
| 93 | /* There are 10 general analog inputs and 7 dedicated inputs | 96 | /* There are 10 general analog inputs and 7 dedicated inputs |
| 94 | * They are: | 97 | * They are: |
| @@ -129,48 +132,48 @@ static u16 ADM1026_REG_TEMP_TMIN[] = { 0x10, 0x11, 0x12 }; | |||
| 129 | static u16 ADM1026_REG_TEMP_THERM[] = { 0x0d, 0x0e, 0x0f }; | 132 | static u16 ADM1026_REG_TEMP_THERM[] = { 0x0d, 0x0e, 0x0f }; |
| 130 | static u16 ADM1026_REG_TEMP_OFFSET[] = { 0x1e, 0x6e, 0x6f }; | 133 | static u16 ADM1026_REG_TEMP_OFFSET[] = { 0x1e, 0x6e, 0x6f }; |
| 131 | 134 | ||
| 132 | #define ADM1026_REG_FAN(nr) (0x38 + (nr)) | 135 | #define ADM1026_REG_FAN(nr) (0x38 + (nr)) |
| 133 | #define ADM1026_REG_FAN_MIN(nr) (0x60 + (nr)) | 136 | #define ADM1026_REG_FAN_MIN(nr) (0x60 + (nr)) |
| 134 | #define ADM1026_REG_FAN_DIV_0_3 0x02 | 137 | #define ADM1026_REG_FAN_DIV_0_3 0x02 |
| 135 | #define ADM1026_REG_FAN_DIV_4_7 0x03 | 138 | #define ADM1026_REG_FAN_DIV_4_7 0x03 |
| 136 | 139 | ||
| 137 | #define ADM1026_REG_DAC 0x04 | 140 | #define ADM1026_REG_DAC 0x04 |
| 138 | #define ADM1026_REG_PWM 0x05 | 141 | #define ADM1026_REG_PWM 0x05 |
| 139 | 142 | ||
| 140 | #define ADM1026_REG_GPIO_CFG_0_3 0x08 | 143 | #define ADM1026_REG_GPIO_CFG_0_3 0x08 |
| 141 | #define ADM1026_REG_GPIO_CFG_4_7 0x09 | 144 | #define ADM1026_REG_GPIO_CFG_4_7 0x09 |
| 142 | #define ADM1026_REG_GPIO_CFG_8_11 0x0a | 145 | #define ADM1026_REG_GPIO_CFG_8_11 0x0a |
| 143 | #define ADM1026_REG_GPIO_CFG_12_15 0x0b | 146 | #define ADM1026_REG_GPIO_CFG_12_15 0x0b |
| 144 | /* CFG_16 in REG_CFG3 */ | 147 | /* CFG_16 in REG_CFG3 */ |
| 145 | #define ADM1026_REG_GPIO_STATUS_0_7 0x24 | 148 | #define ADM1026_REG_GPIO_STATUS_0_7 0x24 |
| 146 | #define ADM1026_REG_GPIO_STATUS_8_15 0x25 | 149 | #define ADM1026_REG_GPIO_STATUS_8_15 0x25 |
| 147 | /* STATUS_16 in REG_STATUS4 */ | 150 | /* STATUS_16 in REG_STATUS4 */ |
| 148 | #define ADM1026_REG_GPIO_MASK_0_7 0x1c | 151 | #define ADM1026_REG_GPIO_MASK_0_7 0x1c |
| 149 | #define ADM1026_REG_GPIO_MASK_8_15 0x1d | 152 | #define ADM1026_REG_GPIO_MASK_8_15 0x1d |
| 150 | /* MASK_16 in REG_MASK4 */ | 153 | /* MASK_16 in REG_MASK4 */ |
| 151 | 154 | ||
| 152 | #define ADM1026_REG_COMPANY 0x16 | 155 | #define ADM1026_REG_COMPANY 0x16 |
| 153 | #define ADM1026_REG_VERSTEP 0x17 | 156 | #define ADM1026_REG_VERSTEP 0x17 |
| 154 | /* These are the recognized values for the above regs */ | 157 | /* These are the recognized values for the above regs */ |
| 155 | #define ADM1026_COMPANY_ANALOG_DEV 0x41 | 158 | #define ADM1026_COMPANY_ANALOG_DEV 0x41 |
| 156 | #define ADM1026_VERSTEP_GENERIC 0x40 | 159 | #define ADM1026_VERSTEP_GENERIC 0x40 |
| 157 | #define ADM1026_VERSTEP_ADM1026 0x44 | 160 | #define ADM1026_VERSTEP_ADM1026 0x44 |
| 158 | 161 | ||
| 159 | #define ADM1026_REG_MASK1 0x18 | 162 | #define ADM1026_REG_MASK1 0x18 |
| 160 | #define ADM1026_REG_MASK2 0x19 | 163 | #define ADM1026_REG_MASK2 0x19 |
| 161 | #define ADM1026_REG_MASK3 0x1a | 164 | #define ADM1026_REG_MASK3 0x1a |
| 162 | #define ADM1026_REG_MASK4 0x1b | 165 | #define ADM1026_REG_MASK4 0x1b |
| 163 | 166 | ||
| 164 | #define ADM1026_REG_STATUS1 0x20 | 167 | #define ADM1026_REG_STATUS1 0x20 |
| 165 | #define ADM1026_REG_STATUS2 0x21 | 168 | #define ADM1026_REG_STATUS2 0x21 |
| 166 | #define ADM1026_REG_STATUS3 0x22 | 169 | #define ADM1026_REG_STATUS3 0x22 |
| 167 | #define ADM1026_REG_STATUS4 0x23 | 170 | #define ADM1026_REG_STATUS4 0x23 |
| 168 | 171 | ||
| 169 | #define ADM1026_FAN_ACTIVATION_TEMP_HYST -6 | 172 | #define ADM1026_FAN_ACTIVATION_TEMP_HYST -6 |
| 170 | #define ADM1026_FAN_CONTROL_TEMP_RANGE 20 | 173 | #define ADM1026_FAN_CONTROL_TEMP_RANGE 20 |
| 171 | #define ADM1026_PWM_MAX 255 | 174 | #define ADM1026_PWM_MAX 255 |
| 172 | 175 | ||
| 173 | /* Conversions. Rounding and limit checking is only done on the TO_REG | 176 | /* Conversions. Rounding and limit checking is only done on the TO_REG |
| 174 | * variants. Note that you should be a bit careful with which arguments | 177 | * variants. Note that you should be a bit careful with which arguments |
| 175 | * these macros are called: arguments may be evaluated more than once. | 178 | * these macros are called: arguments may be evaluated more than once. |
| 176 | */ | 179 | */ |
| @@ -186,52 +189,49 @@ static u16 ADM1026_REG_TEMP_OFFSET[] = { 0x1e, 0x6e, 0x6f }; | |||
| 186 | * The values in this table are based on Table II, page 15 of the | 189 | * The values in this table are based on Table II, page 15 of the |
| 187 | * datasheet. | 190 | * datasheet. |
| 188 | */ | 191 | */ |
| 189 | static int adm1026_scaling[] = { /* .001 Volts */ | 192 | static int adm1026_scaling[] = { /* .001 Volts */ |
| 190 | 2250, 2250, 2250, 2250, 2250, 2250, | 193 | 2250, 2250, 2250, 2250, 2250, 2250, |
| 191 | 1875, 1875, 1875, 1875, 3000, 3330, | 194 | 1875, 1875, 1875, 1875, 3000, 3330, |
| 192 | 3330, 4995, 2250, 12000, 13875 | 195 | 3330, 4995, 2250, 12000, 13875 |
| 193 | }; | 196 | }; |
| 194 | #define NEG12_OFFSET 16000 | 197 | #define NEG12_OFFSET 16000 |
| 195 | #define SCALE(val,from,to) (((val)*(to) + ((from)/2))/(from)) | 198 | #define SCALE(val, from, to) (((val)*(to) + ((from)/2))/(from)) |
| 196 | #define INS_TO_REG(n,val) (SENSORS_LIMIT(SCALE(val,adm1026_scaling[n],192),\ | 199 | #define INS_TO_REG(n, val) (SENSORS_LIMIT(SCALE(val, adm1026_scaling[n], 192),\ |
| 197 | 0,255)) | 200 | 0, 255)) |
| 198 | #define INS_FROM_REG(n,val) (SCALE(val,192,adm1026_scaling[n])) | 201 | #define INS_FROM_REG(n, val) (SCALE(val, 192, adm1026_scaling[n])) |
| 199 | 202 | ||
| 200 | /* FAN speed is measured using 22.5kHz clock and counts for 2 pulses | 203 | /* FAN speed is measured using 22.5kHz clock and counts for 2 pulses |
| 201 | * and we assume a 2 pulse-per-rev fan tach signal | 204 | * and we assume a 2 pulse-per-rev fan tach signal |
| 202 | * 22500 kHz * 60 (sec/min) * 2 (pulse) / 2 (pulse/rev) == 1350000 | 205 | * 22500 kHz * 60 (sec/min) * 2 (pulse) / 2 (pulse/rev) == 1350000 |
| 203 | */ | 206 | */ |
| 204 | #define FAN_TO_REG(val,div) ((val)<=0 ? 0xff : SENSORS_LIMIT(1350000/((val)*\ | 207 | #define FAN_TO_REG(val, div) ((val) <= 0 ? 0xff : \ |
| 205 | (div)),1,254)) | 208 | SENSORS_LIMIT(1350000/((val)*(div)), 1, 254)) |
| 206 | #define FAN_FROM_REG(val,div) ((val)==0?-1:(val)==0xff ? 0 : 1350000/((val)*\ | 209 | #define FAN_FROM_REG(val, div) ((val) == 0 ? -1:(val) == 0xff ? 0 : \ |
| 207 | (div))) | 210 | 1350000/((val)*(div))) |
| 208 | #define DIV_FROM_REG(val) (1<<(val)) | 211 | #define DIV_FROM_REG(val) (1<<(val)) |
| 209 | #define DIV_TO_REG(val) ((val)>=8 ? 3 : (val)>=4 ? 2 : (val)>=2 ? 1 : 0) | 212 | #define DIV_TO_REG(val) ((val) >= 8 ? 3 : (val) >= 4 ? 2 : (val) >= 2 ? 1 : 0) |
| 210 | 213 | ||
| 211 | /* Temperature is reported in 1 degC increments */ | 214 | /* Temperature is reported in 1 degC increments */ |
| 212 | #define TEMP_TO_REG(val) (SENSORS_LIMIT(((val)+((val)<0 ? -500 : 500))/1000,\ | 215 | #define TEMP_TO_REG(val) (SENSORS_LIMIT(((val)+((val)<0 ? -500 : 500))/1000,\ |
| 213 | -127,127)) | 216 | -127, 127)) |
| 214 | #define TEMP_FROM_REG(val) ((val) * 1000) | 217 | #define TEMP_FROM_REG(val) ((val) * 1000) |
| 215 | #define OFFSET_TO_REG(val) (SENSORS_LIMIT(((val)+((val)<0 ? -500 : 500))/1000,\ | 218 | #define OFFSET_TO_REG(val) (SENSORS_LIMIT(((val)+((val)<0 ? -500 : 500))/1000,\ |
| 216 | -127,127)) | 219 | -127, 127)) |
| 217 | #define OFFSET_FROM_REG(val) ((val) * 1000) | 220 | #define OFFSET_FROM_REG(val) ((val) * 1000) |
| 218 | 221 | ||
| 219 | #define PWM_TO_REG(val) (SENSORS_LIMIT(val,0,255)) | 222 | #define PWM_TO_REG(val) (SENSORS_LIMIT(val, 0, 255)) |
| 220 | #define PWM_FROM_REG(val) (val) | 223 | #define PWM_FROM_REG(val) (val) |
| 221 | 224 | ||
| 222 | #define PWM_MIN_TO_REG(val) ((val) & 0xf0) | 225 | #define PWM_MIN_TO_REG(val) ((val) & 0xf0) |
| 223 | #define PWM_MIN_FROM_REG(val) (((val) & 0xf0) + ((val) >> 4)) | 226 | #define PWM_MIN_FROM_REG(val) (((val) & 0xf0) + ((val) >> 4)) |
| 224 | 227 | ||
| 225 | /* Analog output is a voltage, and scaled to millivolts. The datasheet | 228 | /* Analog output is a voltage, and scaled to millivolts. The datasheet |
| 226 | * indicates that the DAC could be used to drive the fans, but in our | 229 | * indicates that the DAC could be used to drive the fans, but in our |
| 227 | * example board (Arima HDAMA) it isn't connected to the fans at all. | 230 | * example board (Arima HDAMA) it isn't connected to the fans at all. |
| 228 | */ | 231 | */ |
| 229 | #define DAC_TO_REG(val) (SENSORS_LIMIT(((((val)*255)+500)/2500),0,255)) | 232 | #define DAC_TO_REG(val) (SENSORS_LIMIT(((((val)*255)+500)/2500), 0, 255)) |
| 230 | #define DAC_FROM_REG(val) (((val)*2500)/255) | 233 | #define DAC_FROM_REG(val) (((val)*2500)/255) |
| 231 | 234 | ||
| 232 | /* Typically used with systems using a v9.1 VRM spec ? */ | ||
| 233 | #define ADM1026_INIT_VRM 91 | ||
| 234 | |||
| 235 | /* Chip sampling rates | 235 | /* Chip sampling rates |
| 236 | * | 236 | * |
| 237 | * Some sensors are not updated more frequently than once per second | 237 | * Some sensors are not updated more frequently than once per second |
| @@ -243,8 +243,8 @@ static int adm1026_scaling[] = { /* .001 Volts */ | |||
| 243 | * So, we keep the config data up to date in the cache | 243 | * So, we keep the config data up to date in the cache |
| 244 | * when it is written and only sample it once every 5 *minutes* | 244 | * when it is written and only sample it once every 5 *minutes* |
| 245 | */ | 245 | */ |
| 246 | #define ADM1026_DATA_INTERVAL (1 * HZ) | 246 | #define ADM1026_DATA_INTERVAL (1 * HZ) |
| 247 | #define ADM1026_CONFIG_INTERVAL (5 * 60 * HZ) | 247 | #define ADM1026_CONFIG_INTERVAL (5 * 60 * HZ) |
| 248 | 248 | ||
| 249 | /* We allow for multiple chips in a single system. | 249 | /* We allow for multiple chips in a single system. |
| 250 | * | 250 | * |
| @@ -261,37 +261,36 @@ struct pwm_data { | |||
| 261 | struct adm1026_data { | 261 | struct adm1026_data { |
| 262 | struct i2c_client client; | 262 | struct i2c_client client; |
| 263 | struct device *hwmon_dev; | 263 | struct device *hwmon_dev; |
| 264 | enum chips type; | ||
| 265 | 264 | ||
| 266 | struct mutex update_lock; | 265 | struct mutex update_lock; |
| 267 | int valid; /* !=0 if following fields are valid */ | 266 | int valid; /* !=0 if following fields are valid */ |
| 268 | unsigned long last_reading; /* In jiffies */ | 267 | unsigned long last_reading; /* In jiffies */ |
| 269 | unsigned long last_config; /* In jiffies */ | 268 | unsigned long last_config; /* In jiffies */ |
| 270 | 269 | ||
| 271 | u8 in[17]; /* Register value */ | 270 | u8 in[17]; /* Register value */ |
| 272 | u8 in_max[17]; /* Register value */ | 271 | u8 in_max[17]; /* Register value */ |
| 273 | u8 in_min[17]; /* Register value */ | 272 | u8 in_min[17]; /* Register value */ |
| 274 | s8 temp[3]; /* Register value */ | 273 | s8 temp[3]; /* Register value */ |
| 275 | s8 temp_min[3]; /* Register value */ | 274 | s8 temp_min[3]; /* Register value */ |
| 276 | s8 temp_max[3]; /* Register value */ | 275 | s8 temp_max[3]; /* Register value */ |
| 277 | s8 temp_tmin[3]; /* Register value */ | 276 | s8 temp_tmin[3]; /* Register value */ |
| 278 | s8 temp_crit[3]; /* Register value */ | 277 | s8 temp_crit[3]; /* Register value */ |
| 279 | s8 temp_offset[3]; /* Register value */ | 278 | s8 temp_offset[3]; /* Register value */ |
| 280 | u8 fan[8]; /* Register value */ | 279 | u8 fan[8]; /* Register value */ |
| 281 | u8 fan_min[8]; /* Register value */ | 280 | u8 fan_min[8]; /* Register value */ |
| 282 | u8 fan_div[8]; /* Decoded value */ | 281 | u8 fan_div[8]; /* Decoded value */ |
| 283 | struct pwm_data pwm1; /* Pwm control values */ | 282 | struct pwm_data pwm1; /* Pwm control values */ |
| 284 | int vid; /* Decoded value */ | 283 | int vid; /* Decoded value */ |
| 285 | u8 vrm; /* VRM version */ | 284 | u8 vrm; /* VRM version */ |
| 286 | u8 analog_out; /* Register value (DAC) */ | 285 | u8 analog_out; /* Register value (DAC) */ |
| 287 | long alarms; /* Register encoding, combined */ | 286 | long alarms; /* Register encoding, combined */ |
| 288 | long alarm_mask; /* Register encoding, combined */ | 287 | long alarm_mask; /* Register encoding, combined */ |
| 289 | long gpio; /* Register encoding, combined */ | 288 | long gpio; /* Register encoding, combined */ |
| 290 | long gpio_mask; /* Register encoding, combined */ | 289 | long gpio_mask; /* Register encoding, combined */ |
| 291 | u8 gpio_config[17]; /* Decoded value */ | 290 | u8 gpio_config[17]; /* Decoded value */ |
| 292 | u8 config1; /* Register value */ | 291 | u8 config1; /* Register value */ |
| 293 | u8 config2; /* Register value */ | 292 | u8 config2; /* Register value */ |
| 294 | u8 config3; /* Register value */ | 293 | u8 config3; /* Register value */ |
| 295 | }; | 294 | }; |
| 296 | 295 | ||
| 297 | static int adm1026_attach_adapter(struct i2c_adapter *adapter); | 296 | static int adm1026_attach_adapter(struct i2c_adapter *adapter); |
| @@ -301,7 +300,7 @@ static int adm1026_detach_client(struct i2c_client *client); | |||
| 301 | static int adm1026_read_value(struct i2c_client *client, u8 reg); | 300 | static int adm1026_read_value(struct i2c_client *client, u8 reg); |
| 302 | static int adm1026_write_value(struct i2c_client *client, u8 reg, int value); | 301 | static int adm1026_write_value(struct i2c_client *client, u8 reg, int value); |
| 303 | static void adm1026_print_gpio(struct i2c_client *client); | 302 | static void adm1026_print_gpio(struct i2c_client *client); |
| 304 | static void adm1026_fixup_gpio(struct i2c_client *client); | 303 | static void adm1026_fixup_gpio(struct i2c_client *client); |
| 305 | static struct adm1026_data *adm1026_update_device(struct device *dev); | 304 | static struct adm1026_data *adm1026_update_device(struct device *dev); |
| 306 | static void adm1026_init_client(struct i2c_client *client); | 305 | static void adm1026_init_client(struct i2c_client *client); |
| 307 | 306 | ||
| @@ -311,7 +310,7 @@ static struct i2c_driver adm1026_driver = { | |||
| 311 | .name = "adm1026", | 310 | .name = "adm1026", |
| 312 | }, | 311 | }, |
| 313 | .attach_adapter = adm1026_attach_adapter, | 312 | .attach_adapter = adm1026_attach_adapter, |
| 314 | .detach_client = adm1026_detach_client, | 313 | .detach_client = adm1026_detach_client, |
| 315 | }; | 314 | }; |
| 316 | 315 | ||
| 317 | static int adm1026_attach_adapter(struct i2c_adapter *adapter) | 316 | static int adm1026_attach_adapter(struct i2c_adapter *adapter) |
| @@ -355,7 +354,7 @@ static void adm1026_init_client(struct i2c_client *client) | |||
| 355 | int value, i; | 354 | int value, i; |
| 356 | struct adm1026_data *data = i2c_get_clientdata(client); | 355 | struct adm1026_data *data = i2c_get_clientdata(client); |
| 357 | 356 | ||
| 358 | dev_dbg(&client->dev, "Initializing device\n"); | 357 | dev_dbg(&client->dev, "Initializing device\n"); |
| 359 | /* Read chip config */ | 358 | /* Read chip config */ |
| 360 | data->config1 = adm1026_read_value(client, ADM1026_REG_CONFIG1); | 359 | data->config1 = adm1026_read_value(client, ADM1026_REG_CONFIG1); |
| 361 | data->config2 = adm1026_read_value(client, ADM1026_REG_CONFIG2); | 360 | data->config2 = adm1026_read_value(client, ADM1026_REG_CONFIG2); |
| @@ -384,7 +383,6 @@ static void adm1026_init_client(struct i2c_client *client) | |||
| 384 | "and temp limits enabled.\n"); | 383 | "and temp limits enabled.\n"); |
| 385 | } | 384 | } |
| 386 | 385 | ||
| 387 | value = data->config3; | ||
| 388 | if (data->config3 & CFG3_GPIO16_ENABLE) { | 386 | if (data->config3 & CFG3_GPIO16_ENABLE) { |
| 389 | dev_dbg(&client->dev, "GPIO16 enabled. THERM " | 387 | dev_dbg(&client->dev, "GPIO16 enabled. THERM " |
| 390 | "pin disabled.\n"); | 388 | "pin disabled.\n"); |
| @@ -426,10 +424,10 @@ static void adm1026_init_client(struct i2c_client *client) | |||
| 426 | * configured, we don't want to mess with them. | 424 | * configured, we don't want to mess with them. |
| 427 | * If they weren't, the default is 100% PWM, no | 425 | * If they weren't, the default is 100% PWM, no |
| 428 | * control and will suffice until 'sensors -s' | 426 | * control and will suffice until 'sensors -s' |
| 429 | * can be run by the user. We DO set the default | 427 | * can be run by the user. We DO set the default |
| 430 | * value for pwm1.auto_pwm_min to its maximum | 428 | * value for pwm1.auto_pwm_min to its maximum |
| 431 | * so that enabling automatic pwm fan control | 429 | * so that enabling automatic pwm fan control |
| 432 | * without first setting a value for pwm1.auto_pwm_min | 430 | * without first setting a value for pwm1.auto_pwm_min |
| 433 | * will not result in potentially dangerous fan speed decrease. | 431 | * will not result in potentially dangerous fan speed decrease. |
| 434 | */ | 432 | */ |
| 435 | data->pwm1.auto_pwm_min=255; | 433 | data->pwm1.auto_pwm_min=255; |
| @@ -453,7 +451,7 @@ static void adm1026_init_client(struct i2c_client *client) | |||
| 453 | static void adm1026_print_gpio(struct i2c_client *client) | 451 | static void adm1026_print_gpio(struct i2c_client *client) |
| 454 | { | 452 | { |
| 455 | struct adm1026_data *data = i2c_get_clientdata(client); | 453 | struct adm1026_data *data = i2c_get_clientdata(client); |
| 456 | int i; | 454 | int i; |
| 457 | 455 | ||
| 458 | dev_dbg(&client->dev, "GPIO config is:"); | 456 | dev_dbg(&client->dev, "GPIO config is:"); |
| 459 | for (i = 0;i <= 7;++i) { | 457 | for (i = 0;i <= 7;++i) { |
| @@ -477,7 +475,7 @@ static void adm1026_print_gpio(struct i2c_client *client) | |||
| 477 | data->gpio_config[16] & 0x02 ? "" : "!", | 475 | data->gpio_config[16] & 0x02 ? "" : "!", |
| 478 | data->gpio_config[16] & 0x01 ? "OUT" : "IN"); | 476 | data->gpio_config[16] & 0x01 ? "OUT" : "IN"); |
| 479 | } else { | 477 | } else { |
| 480 | /* GPIO16 is THERM */ | 478 | /* GPIO16 is THERM */ |
| 481 | dev_dbg(&client->dev, "\tTHERM\n"); | 479 | dev_dbg(&client->dev, "\tTHERM\n"); |
| 482 | } | 480 | } |
| 483 | } | 481 | } |
| @@ -485,8 +483,8 @@ static void adm1026_print_gpio(struct i2c_client *client) | |||
| 485 | static void adm1026_fixup_gpio(struct i2c_client *client) | 483 | static void adm1026_fixup_gpio(struct i2c_client *client) |
| 486 | { | 484 | { |
| 487 | struct adm1026_data *data = i2c_get_clientdata(client); | 485 | struct adm1026_data *data = i2c_get_clientdata(client); |
| 488 | int i; | 486 | int i; |
| 489 | int value; | 487 | int value; |
| 490 | 488 | ||
| 491 | /* Make the changes requested. */ | 489 | /* Make the changes requested. */ |
| 492 | /* We may need to unlock/stop monitoring or soft-reset the | 490 | /* We may need to unlock/stop monitoring or soft-reset the |
| @@ -516,14 +514,14 @@ static void adm1026_fixup_gpio(struct i2c_client *client) | |||
| 516 | } | 514 | } |
| 517 | } | 515 | } |
| 518 | 516 | ||
| 519 | /* Inverted */ | 517 | /* Inverted */ |
| 520 | for (i = 0;i <= 16;++i) { | 518 | for (i = 0;i <= 16;++i) { |
| 521 | if (gpio_inverted[i] >= 0 && gpio_inverted[i] <= 16) { | 519 | if (gpio_inverted[i] >= 0 && gpio_inverted[i] <= 16) { |
| 522 | data->gpio_config[gpio_inverted[i]] &= ~ 0x02; | 520 | data->gpio_config[gpio_inverted[i]] &= ~ 0x02; |
| 523 | } | 521 | } |
| 524 | } | 522 | } |
| 525 | 523 | ||
| 526 | /* Normal overrides inverted */ | 524 | /* Normal overrides inverted */ |
| 527 | for (i = 0;i <= 16;++i) { | 525 | for (i = 0;i <= 16;++i) { |
| 528 | if (gpio_normal[i] >= 0 && gpio_normal[i] <= 16) { | 526 | if (gpio_normal[i] >= 0 && gpio_normal[i] <= 16) { |
| 529 | data->gpio_config[gpio_normal[i]] |= 0x02; | 527 | data->gpio_config[gpio_normal[i]] |= 0x02; |
| @@ -569,7 +567,7 @@ static struct adm1026_data *adm1026_update_device(struct device *dev) | |||
| 569 | if (!data->valid | 567 | if (!data->valid |
| 570 | || time_after(jiffies, data->last_reading + ADM1026_DATA_INTERVAL)) { | 568 | || time_after(jiffies, data->last_reading + ADM1026_DATA_INTERVAL)) { |
| 571 | /* Things that change quickly */ | 569 | /* Things that change quickly */ |
| 572 | dev_dbg(&client->dev,"Reading sensor values\n"); | 570 | dev_dbg(&client->dev, "Reading sensor values\n"); |
| 573 | for (i = 0;i <= 16;++i) { | 571 | for (i = 0;i <= 16;++i) { |
| 574 | data->in[i] = | 572 | data->in[i] = |
| 575 | adm1026_read_value(client, ADM1026_REG_IN[i]); | 573 | adm1026_read_value(client, ADM1026_REG_IN[i]); |
| @@ -582,18 +580,18 @@ static struct adm1026_data *adm1026_update_device(struct device *dev) | |||
| 582 | 580 | ||
| 583 | for (i = 0;i <= 2;++i) { | 581 | for (i = 0;i <= 2;++i) { |
| 584 | /* NOTE: temp[] is s8 and we assume 2's complement | 582 | /* NOTE: temp[] is s8 and we assume 2's complement |
| 585 | * "conversion" in the assignment */ | 583 | * "conversion" in the assignment */ |
| 586 | data->temp[i] = | 584 | data->temp[i] = |
| 587 | adm1026_read_value(client, ADM1026_REG_TEMP[i]); | 585 | adm1026_read_value(client, ADM1026_REG_TEMP[i]); |
| 588 | } | 586 | } |
| 589 | 587 | ||
| 590 | data->pwm1.pwm = adm1026_read_value(client, | 588 | data->pwm1.pwm = adm1026_read_value(client, |
| 591 | ADM1026_REG_PWM); | 589 | ADM1026_REG_PWM); |
| 592 | data->analog_out = adm1026_read_value(client, | 590 | data->analog_out = adm1026_read_value(client, |
| 593 | ADM1026_REG_DAC); | 591 | ADM1026_REG_DAC); |
| 594 | /* GPIO16 is MSbit of alarms, move it to gpio */ | 592 | /* GPIO16 is MSbit of alarms, move it to gpio */ |
| 595 | alarms = adm1026_read_value(client, ADM1026_REG_STATUS4); | 593 | alarms = adm1026_read_value(client, ADM1026_REG_STATUS4); |
| 596 | gpio = alarms & 0x80 ? 0x0100 : 0; /* GPIO16 */ | 594 | gpio = alarms & 0x80 ? 0x0100 : 0; /* GPIO16 */ |
| 597 | alarms &= 0x7f; | 595 | alarms &= 0x7f; |
| 598 | alarms <<= 8; | 596 | alarms <<= 8; |
| 599 | alarms |= adm1026_read_value(client, ADM1026_REG_STATUS3); | 597 | alarms |= adm1026_read_value(client, ADM1026_REG_STATUS3); |
| @@ -604,24 +602,24 @@ static struct adm1026_data *adm1026_update_device(struct device *dev) | |||
| 604 | data->alarms = alarms; | 602 | data->alarms = alarms; |
| 605 | 603 | ||
| 606 | /* Read the GPIO values */ | 604 | /* Read the GPIO values */ |
| 607 | gpio |= adm1026_read_value(client, | 605 | gpio |= adm1026_read_value(client, |
| 608 | ADM1026_REG_GPIO_STATUS_8_15); | 606 | ADM1026_REG_GPIO_STATUS_8_15); |
| 609 | gpio <<= 8; | 607 | gpio <<= 8; |
| 610 | gpio |= adm1026_read_value(client, | 608 | gpio |= adm1026_read_value(client, |
| 611 | ADM1026_REG_GPIO_STATUS_0_7); | 609 | ADM1026_REG_GPIO_STATUS_0_7); |
| 612 | data->gpio = gpio; | 610 | data->gpio = gpio; |
| 613 | 611 | ||
| 614 | data->last_reading = jiffies; | 612 | data->last_reading = jiffies; |
| 615 | }; /* last_reading */ | 613 | }; /* last_reading */ |
| 616 | 614 | ||
| 617 | if (!data->valid || | 615 | if (!data->valid || |
| 618 | time_after(jiffies, data->last_config + ADM1026_CONFIG_INTERVAL)) { | 616 | time_after(jiffies, data->last_config + ADM1026_CONFIG_INTERVAL)) { |
| 619 | /* Things that don't change often */ | 617 | /* Things that don't change often */ |
| 620 | dev_dbg(&client->dev, "Reading config values\n"); | 618 | dev_dbg(&client->dev, "Reading config values\n"); |
| 621 | for (i = 0;i <= 16;++i) { | 619 | for (i = 0;i <= 16;++i) { |
| 622 | data->in_min[i] = adm1026_read_value(client, | 620 | data->in_min[i] = adm1026_read_value(client, |
| 623 | ADM1026_REG_IN_MIN[i]); | 621 | ADM1026_REG_IN_MIN[i]); |
| 624 | data->in_max[i] = adm1026_read_value(client, | 622 | data->in_max[i] = adm1026_read_value(client, |
| 625 | ADM1026_REG_IN_MAX[i]); | 623 | ADM1026_REG_IN_MAX[i]); |
| 626 | } | 624 | } |
| 627 | 625 | ||
| @@ -629,32 +627,32 @@ static struct adm1026_data *adm1026_update_device(struct device *dev) | |||
| 629 | | (adm1026_read_value(client, ADM1026_REG_FAN_DIV_4_7) | 627 | | (adm1026_read_value(client, ADM1026_REG_FAN_DIV_4_7) |
| 630 | << 8); | 628 | << 8); |
| 631 | for (i = 0;i <= 7;++i) { | 629 | for (i = 0;i <= 7;++i) { |
| 632 | data->fan_min[i] = adm1026_read_value(client, | 630 | data->fan_min[i] = adm1026_read_value(client, |
| 633 | ADM1026_REG_FAN_MIN(i)); | 631 | ADM1026_REG_FAN_MIN(i)); |
| 634 | data->fan_div[i] = DIV_FROM_REG(value & 0x03); | 632 | data->fan_div[i] = DIV_FROM_REG(value & 0x03); |
| 635 | value >>= 2; | 633 | value >>= 2; |
| 636 | } | 634 | } |
| 637 | 635 | ||
| 638 | for (i = 0; i <= 2; ++i) { | 636 | for (i = 0; i <= 2; ++i) { |
| 639 | /* NOTE: temp_xxx[] are s8 and we assume 2's | 637 | /* NOTE: temp_xxx[] are s8 and we assume 2's |
| 640 | * complement "conversion" in the assignment | 638 | * complement "conversion" in the assignment |
| 641 | */ | 639 | */ |
| 642 | data->temp_min[i] = adm1026_read_value(client, | 640 | data->temp_min[i] = adm1026_read_value(client, |
| 643 | ADM1026_REG_TEMP_MIN[i]); | 641 | ADM1026_REG_TEMP_MIN[i]); |
| 644 | data->temp_max[i] = adm1026_read_value(client, | 642 | data->temp_max[i] = adm1026_read_value(client, |
| 645 | ADM1026_REG_TEMP_MAX[i]); | 643 | ADM1026_REG_TEMP_MAX[i]); |
| 646 | data->temp_tmin[i] = adm1026_read_value(client, | 644 | data->temp_tmin[i] = adm1026_read_value(client, |
| 647 | ADM1026_REG_TEMP_TMIN[i]); | 645 | ADM1026_REG_TEMP_TMIN[i]); |
| 648 | data->temp_crit[i] = adm1026_read_value(client, | 646 | data->temp_crit[i] = adm1026_read_value(client, |
| 649 | ADM1026_REG_TEMP_THERM[i]); | 647 | ADM1026_REG_TEMP_THERM[i]); |
| 650 | data->temp_offset[i] = adm1026_read_value(client, | 648 | data->temp_offset[i] = adm1026_read_value(client, |
| 651 | ADM1026_REG_TEMP_OFFSET[i]); | 649 | ADM1026_REG_TEMP_OFFSET[i]); |
| 652 | } | 650 | } |
| 653 | 651 | ||
| 654 | /* Read the STATUS/alarm masks */ | 652 | /* Read the STATUS/alarm masks */ |
| 655 | alarms = adm1026_read_value(client, ADM1026_REG_MASK4); | 653 | alarms = adm1026_read_value(client, ADM1026_REG_MASK4); |
| 656 | gpio = alarms & 0x80 ? 0x0100 : 0; /* GPIO16 */ | 654 | gpio = alarms & 0x80 ? 0x0100 : 0; /* GPIO16 */ |
| 657 | alarms = (alarms & 0x7f) << 8; | 655 | alarms = (alarms & 0x7f) << 8; |
| 658 | alarms |= adm1026_read_value(client, ADM1026_REG_MASK3); | 656 | alarms |= adm1026_read_value(client, ADM1026_REG_MASK3); |
| 659 | alarms <<= 8; | 657 | alarms <<= 8; |
| 660 | alarms |= adm1026_read_value(client, ADM1026_REG_MASK2); | 658 | alarms |= adm1026_read_value(client, ADM1026_REG_MASK2); |
| @@ -663,24 +661,24 @@ static struct adm1026_data *adm1026_update_device(struct device *dev) | |||
| 663 | data->alarm_mask = alarms; | 661 | data->alarm_mask = alarms; |
| 664 | 662 | ||
| 665 | /* Read the GPIO values */ | 663 | /* Read the GPIO values */ |
| 666 | gpio |= adm1026_read_value(client, | 664 | gpio |= adm1026_read_value(client, |
| 667 | ADM1026_REG_GPIO_MASK_8_15); | 665 | ADM1026_REG_GPIO_MASK_8_15); |
| 668 | gpio <<= 8; | 666 | gpio <<= 8; |
| 669 | gpio |= adm1026_read_value(client, ADM1026_REG_GPIO_MASK_0_7); | 667 | gpio |= adm1026_read_value(client, ADM1026_REG_GPIO_MASK_0_7); |
| 670 | data->gpio_mask = gpio; | 668 | data->gpio_mask = gpio; |
| 671 | 669 | ||
| 672 | /* Read various values from CONFIG1 */ | 670 | /* Read various values from CONFIG1 */ |
| 673 | data->config1 = adm1026_read_value(client, | 671 | data->config1 = adm1026_read_value(client, |
| 674 | ADM1026_REG_CONFIG1); | 672 | ADM1026_REG_CONFIG1); |
| 675 | if (data->config1 & CFG1_PWM_AFC) { | 673 | if (data->config1 & CFG1_PWM_AFC) { |
| 676 | data->pwm1.enable = 2; | 674 | data->pwm1.enable = 2; |
| 677 | data->pwm1.auto_pwm_min = | 675 | data->pwm1.auto_pwm_min = |
| 678 | PWM_MIN_FROM_REG(data->pwm1.pwm); | 676 | PWM_MIN_FROM_REG(data->pwm1.pwm); |
| 679 | } | 677 | } |
| 680 | /* Read the GPIO config */ | 678 | /* Read the GPIO config */ |
| 681 | data->config2 = adm1026_read_value(client, | 679 | data->config2 = adm1026_read_value(client, |
| 682 | ADM1026_REG_CONFIG2); | 680 | ADM1026_REG_CONFIG2); |
| 683 | data->config3 = adm1026_read_value(client, | 681 | data->config3 = adm1026_read_value(client, |
| 684 | ADM1026_REG_CONFIG3); | 682 | ADM1026_REG_CONFIG3); |
| 685 | data->gpio_config[16] = (data->config3 >> 6) & 0x03; | 683 | data->gpio_config[16] = (data->config3 >> 6) & 0x03; |
| 686 | 684 | ||
| @@ -695,7 +693,7 @@ static struct adm1026_data *adm1026_update_device(struct device *dev) | |||
| 695 | } | 693 | } |
| 696 | 694 | ||
| 697 | data->last_config = jiffies; | 695 | data->last_config = jiffies; |
| 698 | }; /* last_config */ | 696 | }; /* last_config */ |
| 699 | 697 | ||
| 700 | dev_dbg(&client->dev, "Setting VID from GPIO11-15.\n"); | 698 | dev_dbg(&client->dev, "Setting VID from GPIO11-15.\n"); |
| 701 | data->vid = (data->gpio >> 11) & 0x1f; | 699 | data->vid = (data->gpio >> 11) & 0x1f; |
| @@ -710,15 +708,15 @@ static ssize_t show_in(struct device *dev, struct device_attribute *attr, | |||
| 710 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 708 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 711 | int nr = sensor_attr->index; | 709 | int nr = sensor_attr->index; |
| 712 | struct adm1026_data *data = adm1026_update_device(dev); | 710 | struct adm1026_data *data = adm1026_update_device(dev); |
| 713 | return sprintf(buf,"%d\n", INS_FROM_REG(nr, data->in[nr])); | 711 | return sprintf(buf, "%d\n", INS_FROM_REG(nr, data->in[nr])); |
| 714 | } | 712 | } |
| 715 | static ssize_t show_in_min(struct device *dev, struct device_attribute *attr, | 713 | static ssize_t show_in_min(struct device *dev, struct device_attribute *attr, |
| 716 | char *buf) | 714 | char *buf) |
| 717 | { | 715 | { |
| 718 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 716 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 719 | int nr = sensor_attr->index; | 717 | int nr = sensor_attr->index; |
| 720 | struct adm1026_data *data = adm1026_update_device(dev); | 718 | struct adm1026_data *data = adm1026_update_device(dev); |
| 721 | return sprintf(buf,"%d\n", INS_FROM_REG(nr, data->in_min[nr])); | 719 | return sprintf(buf, "%d\n", INS_FROM_REG(nr, data->in_min[nr])); |
| 722 | } | 720 | } |
| 723 | static ssize_t set_in_min(struct device *dev, struct device_attribute *attr, | 721 | static ssize_t set_in_min(struct device *dev, struct device_attribute *attr, |
| 724 | const char *buf, size_t count) | 722 | const char *buf, size_t count) |
| @@ -733,7 +731,7 @@ static ssize_t set_in_min(struct device *dev, struct device_attribute *attr, | |||
| 733 | data->in_min[nr] = INS_TO_REG(nr, val); | 731 | data->in_min[nr] = INS_TO_REG(nr, val); |
| 734 | adm1026_write_value(client, ADM1026_REG_IN_MIN[nr], data->in_min[nr]); | 732 | adm1026_write_value(client, ADM1026_REG_IN_MIN[nr], data->in_min[nr]); |
| 735 | mutex_unlock(&data->update_lock); | 733 | mutex_unlock(&data->update_lock); |
| 736 | return count; | 734 | return count; |
| 737 | } | 735 | } |
| 738 | static ssize_t show_in_max(struct device *dev, struct device_attribute *attr, | 736 | static ssize_t show_in_max(struct device *dev, struct device_attribute *attr, |
| 739 | char *buf) | 737 | char *buf) |
| @@ -741,7 +739,7 @@ static ssize_t show_in_max(struct device *dev, struct device_attribute *attr, | |||
| 741 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 739 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 742 | int nr = sensor_attr->index; | 740 | int nr = sensor_attr->index; |
| 743 | struct adm1026_data *data = adm1026_update_device(dev); | 741 | struct adm1026_data *data = adm1026_update_device(dev); |
| 744 | return sprintf(buf,"%d\n", INS_FROM_REG(nr, data->in_max[nr])); | 742 | return sprintf(buf, "%d\n", INS_FROM_REG(nr, data->in_max[nr])); |
| 745 | } | 743 | } |
| 746 | static ssize_t set_in_max(struct device *dev, struct device_attribute *attr, | 744 | static ssize_t set_in_max(struct device *dev, struct device_attribute *attr, |
| 747 | const char *buf, size_t count) | 745 | const char *buf, size_t count) |
| @@ -788,13 +786,13 @@ in_reg(15); | |||
| 788 | static ssize_t show_in16(struct device *dev, struct device_attribute *attr, char *buf) | 786 | static ssize_t show_in16(struct device *dev, struct device_attribute *attr, char *buf) |
| 789 | { | 787 | { |
| 790 | struct adm1026_data *data = adm1026_update_device(dev); | 788 | struct adm1026_data *data = adm1026_update_device(dev); |
| 791 | return sprintf(buf,"%d\n", INS_FROM_REG(16, data->in[16]) - | 789 | return sprintf(buf, "%d\n", INS_FROM_REG(16, data->in[16]) - |
| 792 | NEG12_OFFSET); | 790 | NEG12_OFFSET); |
| 793 | } | 791 | } |
| 794 | static ssize_t show_in16_min(struct device *dev, struct device_attribute *attr, char *buf) | 792 | static ssize_t show_in16_min(struct device *dev, struct device_attribute *attr, char *buf) |
| 795 | { | 793 | { |
| 796 | struct adm1026_data *data = adm1026_update_device(dev); | 794 | struct adm1026_data *data = adm1026_update_device(dev); |
| 797 | return sprintf(buf,"%d\n", INS_FROM_REG(16, data->in_min[16]) | 795 | return sprintf(buf, "%d\n", INS_FROM_REG(16, data->in_min[16]) |
| 798 | - NEG12_OFFSET); | 796 | - NEG12_OFFSET); |
| 799 | } | 797 | } |
| 800 | static ssize_t set_in16_min(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | 798 | static ssize_t set_in16_min(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
| @@ -807,12 +805,12 @@ static ssize_t set_in16_min(struct device *dev, struct device_attribute *attr, c | |||
| 807 | data->in_min[16] = INS_TO_REG(16, val + NEG12_OFFSET); | 805 | data->in_min[16] = INS_TO_REG(16, val + NEG12_OFFSET); |
| 808 | adm1026_write_value(client, ADM1026_REG_IN_MIN[16], data->in_min[16]); | 806 | adm1026_write_value(client, ADM1026_REG_IN_MIN[16], data->in_min[16]); |
| 809 | mutex_unlock(&data->update_lock); | 807 | mutex_unlock(&data->update_lock); |
| 810 | return count; | 808 | return count; |
| 811 | } | 809 | } |
| 812 | static ssize_t show_in16_max(struct device *dev, struct device_attribute *attr, char *buf) | 810 | static ssize_t show_in16_max(struct device *dev, struct device_attribute *attr, char *buf) |
| 813 | { | 811 | { |
| 814 | struct adm1026_data *data = adm1026_update_device(dev); | 812 | struct adm1026_data *data = adm1026_update_device(dev); |
| 815 | return sprintf(buf,"%d\n", INS_FROM_REG(16, data->in_max[16]) | 813 | return sprintf(buf, "%d\n", INS_FROM_REG(16, data->in_max[16]) |
| 816 | - NEG12_OFFSET); | 814 | - NEG12_OFFSET); |
| 817 | } | 815 | } |
| 818 | static ssize_t set_in16_max(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | 816 | static ssize_t set_in16_max(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
| @@ -843,7 +841,7 @@ static ssize_t show_fan(struct device *dev, struct device_attribute *attr, | |||
| 843 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 841 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 844 | int nr = sensor_attr->index; | 842 | int nr = sensor_attr->index; |
| 845 | struct adm1026_data *data = adm1026_update_device(dev); | 843 | struct adm1026_data *data = adm1026_update_device(dev); |
| 846 | return sprintf(buf,"%d\n", FAN_FROM_REG(data->fan[nr], | 844 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr], |
| 847 | data->fan_div[nr])); | 845 | data->fan_div[nr])); |
| 848 | } | 846 | } |
| 849 | static ssize_t show_fan_min(struct device *dev, struct device_attribute *attr, | 847 | static ssize_t show_fan_min(struct device *dev, struct device_attribute *attr, |
| @@ -852,7 +850,7 @@ static ssize_t show_fan_min(struct device *dev, struct device_attribute *attr, | |||
| 852 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 850 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 853 | int nr = sensor_attr->index; | 851 | int nr = sensor_attr->index; |
| 854 | struct adm1026_data *data = adm1026_update_device(dev); | 852 | struct adm1026_data *data = adm1026_update_device(dev); |
| 855 | return sprintf(buf,"%d\n", FAN_FROM_REG(data->fan_min[nr], | 853 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[nr], |
| 856 | data->fan_div[nr])); | 854 | data->fan_div[nr])); |
| 857 | } | 855 | } |
| 858 | static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr, | 856 | static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr, |
| @@ -872,10 +870,10 @@ static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr, | |||
| 872 | return count; | 870 | return count; |
| 873 | } | 871 | } |
| 874 | 872 | ||
| 875 | #define fan_offset(offset) \ | 873 | #define fan_offset(offset) \ |
| 876 | static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan, NULL, \ | 874 | static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan, NULL, \ |
| 877 | offset - 1); \ | 875 | offset - 1); \ |
| 878 | static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \ | 876 | static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \ |
| 879 | show_fan_min, set_fan_min, offset - 1); | 877 | show_fan_min, set_fan_min, offset - 1); |
| 880 | 878 | ||
| 881 | fan_offset(1); | 879 | fan_offset(1); |
| @@ -892,8 +890,8 @@ static void fixup_fan_min(struct device *dev, int fan, int old_div) | |||
| 892 | { | 890 | { |
| 893 | struct i2c_client *client = to_i2c_client(dev); | 891 | struct i2c_client *client = to_i2c_client(dev); |
| 894 | struct adm1026_data *data = i2c_get_clientdata(client); | 892 | struct adm1026_data *data = i2c_get_clientdata(client); |
| 895 | int new_min; | 893 | int new_min; |
| 896 | int new_div = data->fan_div[fan]; | 894 | int new_div = data->fan_div[fan]; |
| 897 | 895 | ||
| 898 | /* 0 and 0xff are special. Don't adjust them */ | 896 | /* 0 and 0xff are special. Don't adjust them */ |
| 899 | if (data->fan_min[fan] == 0 || data->fan_min[fan] == 0xff) { | 897 | if (data->fan_min[fan] == 0 || data->fan_min[fan] == 0xff) { |
| @@ -913,7 +911,7 @@ static ssize_t show_fan_div(struct device *dev, struct device_attribute *attr, | |||
| 913 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 911 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 914 | int nr = sensor_attr->index; | 912 | int nr = sensor_attr->index; |
| 915 | struct adm1026_data *data = adm1026_update_device(dev); | 913 | struct adm1026_data *data = adm1026_update_device(dev); |
| 916 | return sprintf(buf,"%d\n", data->fan_div[nr]); | 914 | return sprintf(buf, "%d\n", data->fan_div[nr]); |
| 917 | } | 915 | } |
| 918 | static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, | 916 | static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, |
| 919 | const char *buf, size_t count) | 917 | const char *buf, size_t count) |
| @@ -922,10 +920,10 @@ static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, | |||
| 922 | int nr = sensor_attr->index; | 920 | int nr = sensor_attr->index; |
| 923 | struct i2c_client *client = to_i2c_client(dev); | 921 | struct i2c_client *client = to_i2c_client(dev); |
| 924 | struct adm1026_data *data = i2c_get_clientdata(client); | 922 | struct adm1026_data *data = i2c_get_clientdata(client); |
| 925 | int val,orig_div,new_div,shift; | 923 | int val, orig_div, new_div, shift; |
| 926 | 924 | ||
| 927 | val = simple_strtol(buf, NULL, 10); | 925 | val = simple_strtol(buf, NULL, 10); |
| 928 | new_div = DIV_TO_REG(val); | 926 | new_div = DIV_TO_REG(val); |
| 929 | if (new_div == 0) { | 927 | if (new_div == 0) { |
| 930 | return -EINVAL; | 928 | return -EINVAL; |
| 931 | } | 929 | } |
| @@ -946,14 +944,14 @@ static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, | |||
| 946 | } | 944 | } |
| 947 | 945 | ||
| 948 | if (data->fan_div[nr] != orig_div) { | 946 | if (data->fan_div[nr] != orig_div) { |
| 949 | fixup_fan_min(dev,nr,orig_div); | 947 | fixup_fan_min(dev, nr, orig_div); |
| 950 | } | 948 | } |
| 951 | mutex_unlock(&data->update_lock); | 949 | mutex_unlock(&data->update_lock); |
| 952 | return count; | 950 | return count; |
| 953 | } | 951 | } |
| 954 | 952 | ||
| 955 | #define fan_offset_div(offset) \ | 953 | #define fan_offset_div(offset) \ |
| 956 | static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \ | 954 | static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \ |
| 957 | show_fan_div, set_fan_div, offset - 1); | 955 | show_fan_div, set_fan_div, offset - 1); |
| 958 | 956 | ||
| 959 | fan_offset_div(1); | 957 | fan_offset_div(1); |
| @@ -972,7 +970,7 @@ static ssize_t show_temp(struct device *dev, struct device_attribute *attr, | |||
| 972 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 970 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 973 | int nr = sensor_attr->index; | 971 | int nr = sensor_attr->index; |
| 974 | struct adm1026_data *data = adm1026_update_device(dev); | 972 | struct adm1026_data *data = adm1026_update_device(dev); |
| 975 | return sprintf(buf,"%d\n", TEMP_FROM_REG(data->temp[nr])); | 973 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[nr])); |
| 976 | } | 974 | } |
| 977 | static ssize_t show_temp_min(struct device *dev, struct device_attribute *attr, | 975 | static ssize_t show_temp_min(struct device *dev, struct device_attribute *attr, |
| 978 | char *buf) | 976 | char *buf) |
| @@ -980,7 +978,7 @@ static ssize_t show_temp_min(struct device *dev, struct device_attribute *attr, | |||
| 980 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 978 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 981 | int nr = sensor_attr->index; | 979 | int nr = sensor_attr->index; |
| 982 | struct adm1026_data *data = adm1026_update_device(dev); | 980 | struct adm1026_data *data = adm1026_update_device(dev); |
| 983 | return sprintf(buf,"%d\n", TEMP_FROM_REG(data->temp_min[nr])); | 981 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr])); |
| 984 | } | 982 | } |
| 985 | static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr, | 983 | static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr, |
| 986 | const char *buf, size_t count) | 984 | const char *buf, size_t count) |
| @@ -1004,7 +1002,7 @@ static ssize_t show_temp_max(struct device *dev, struct device_attribute *attr, | |||
| 1004 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 1002 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 1005 | int nr = sensor_attr->index; | 1003 | int nr = sensor_attr->index; |
| 1006 | struct adm1026_data *data = adm1026_update_device(dev); | 1004 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1007 | return sprintf(buf,"%d\n", TEMP_FROM_REG(data->temp_max[nr])); | 1005 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr])); |
| 1008 | } | 1006 | } |
| 1009 | static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr, | 1007 | static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr, |
| 1010 | const char *buf, size_t count) | 1008 | const char *buf, size_t count) |
| @@ -1024,7 +1022,7 @@ static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr, | |||
| 1024 | } | 1022 | } |
| 1025 | 1023 | ||
| 1026 | #define temp_reg(offset) \ | 1024 | #define temp_reg(offset) \ |
| 1027 | static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp, \ | 1025 | static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp, \ |
| 1028 | NULL, offset - 1); \ | 1026 | NULL, offset - 1); \ |
| 1029 | static SENSOR_DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR, \ | 1027 | static SENSOR_DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR, \ |
| 1030 | show_temp_min, set_temp_min, offset - 1); \ | 1028 | show_temp_min, set_temp_min, offset - 1); \ |
| @@ -1042,7 +1040,7 @@ static ssize_t show_temp_offset(struct device *dev, | |||
| 1042 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 1040 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 1043 | int nr = sensor_attr->index; | 1041 | int nr = sensor_attr->index; |
| 1044 | struct adm1026_data *data = adm1026_update_device(dev); | 1042 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1045 | return sprintf(buf,"%d\n", TEMP_FROM_REG(data->temp_offset[nr])); | 1043 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_offset[nr])); |
| 1046 | } | 1044 | } |
| 1047 | static ssize_t set_temp_offset(struct device *dev, | 1045 | static ssize_t set_temp_offset(struct device *dev, |
| 1048 | struct device_attribute *attr, const char *buf, | 1046 | struct device_attribute *attr, const char *buf, |
| @@ -1076,7 +1074,7 @@ static ssize_t show_temp_auto_point1_temp_hyst(struct device *dev, | |||
| 1076 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 1074 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 1077 | int nr = sensor_attr->index; | 1075 | int nr = sensor_attr->index; |
| 1078 | struct adm1026_data *data = adm1026_update_device(dev); | 1076 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1079 | return sprintf(buf,"%d\n", TEMP_FROM_REG( | 1077 | return sprintf(buf, "%d\n", TEMP_FROM_REG( |
| 1080 | ADM1026_FAN_ACTIVATION_TEMP_HYST + data->temp_tmin[nr])); | 1078 | ADM1026_FAN_ACTIVATION_TEMP_HYST + data->temp_tmin[nr])); |
| 1081 | } | 1079 | } |
| 1082 | static ssize_t show_temp_auto_point2_temp(struct device *dev, | 1080 | static ssize_t show_temp_auto_point2_temp(struct device *dev, |
| @@ -1085,7 +1083,7 @@ static ssize_t show_temp_auto_point2_temp(struct device *dev, | |||
| 1085 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 1083 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 1086 | int nr = sensor_attr->index; | 1084 | int nr = sensor_attr->index; |
| 1087 | struct adm1026_data *data = adm1026_update_device(dev); | 1085 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1088 | return sprintf(buf,"%d\n", TEMP_FROM_REG(data->temp_tmin[nr] + | 1086 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_tmin[nr] + |
| 1089 | ADM1026_FAN_CONTROL_TEMP_RANGE)); | 1087 | ADM1026_FAN_CONTROL_TEMP_RANGE)); |
| 1090 | } | 1088 | } |
| 1091 | static ssize_t show_temp_auto_point1_temp(struct device *dev, | 1089 | static ssize_t show_temp_auto_point1_temp(struct device *dev, |
| @@ -1094,7 +1092,7 @@ static ssize_t show_temp_auto_point1_temp(struct device *dev, | |||
| 1094 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 1092 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 1095 | int nr = sensor_attr->index; | 1093 | int nr = sensor_attr->index; |
| 1096 | struct adm1026_data *data = adm1026_update_device(dev); | 1094 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1097 | return sprintf(buf,"%d\n", TEMP_FROM_REG(data->temp_tmin[nr])); | 1095 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_tmin[nr])); |
| 1098 | } | 1096 | } |
| 1099 | static ssize_t set_temp_auto_point1_temp(struct device *dev, | 1097 | static ssize_t set_temp_auto_point1_temp(struct device *dev, |
| 1100 | struct device_attribute *attr, const char *buf, size_t count) | 1098 | struct device_attribute *attr, const char *buf, size_t count) |
| @@ -1113,13 +1111,13 @@ static ssize_t set_temp_auto_point1_temp(struct device *dev, | |||
| 1113 | return count; | 1111 | return count; |
| 1114 | } | 1112 | } |
| 1115 | 1113 | ||
| 1116 | #define temp_auto_point(offset) \ | 1114 | #define temp_auto_point(offset) \ |
| 1117 | static SENSOR_DEVICE_ATTR(temp##offset##_auto_point1_temp, S_IRUGO | S_IWUSR, \ | 1115 | static SENSOR_DEVICE_ATTR(temp##offset##_auto_point1_temp, \ |
| 1118 | show_temp_auto_point1_temp, set_temp_auto_point1_temp, \ | 1116 | S_IRUGO | S_IWUSR, show_temp_auto_point1_temp, \ |
| 1119 | offset - 1); \ | 1117 | set_temp_auto_point1_temp, offset - 1); \ |
| 1120 | static SENSOR_DEVICE_ATTR(temp##offset##_auto_point1_temp_hyst, S_IRUGO, \ | 1118 | static SENSOR_DEVICE_ATTR(temp##offset##_auto_point1_temp_hyst, S_IRUGO,\ |
| 1121 | show_temp_auto_point1_temp_hyst, NULL, offset - 1); \ | 1119 | show_temp_auto_point1_temp_hyst, NULL, offset - 1); \ |
| 1122 | static SENSOR_DEVICE_ATTR(temp##offset##_auto_point2_temp, S_IRUGO, \ | 1120 | static SENSOR_DEVICE_ATTR(temp##offset##_auto_point2_temp, S_IRUGO, \ |
| 1123 | show_temp_auto_point2_temp, NULL, offset - 1); | 1121 | show_temp_auto_point2_temp, NULL, offset - 1); |
| 1124 | 1122 | ||
| 1125 | temp_auto_point(1); | 1123 | temp_auto_point(1); |
| @@ -1130,7 +1128,7 @@ static ssize_t show_temp_crit_enable(struct device *dev, | |||
| 1130 | struct device_attribute *attr, char *buf) | 1128 | struct device_attribute *attr, char *buf) |
| 1131 | { | 1129 | { |
| 1132 | struct adm1026_data *data = adm1026_update_device(dev); | 1130 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1133 | return sprintf(buf,"%d\n", (data->config1 & CFG1_THERM_HOT) >> 4); | 1131 | return sprintf(buf, "%d\n", (data->config1 & CFG1_THERM_HOT) >> 4); |
| 1134 | } | 1132 | } |
| 1135 | static ssize_t set_temp_crit_enable(struct device *dev, | 1133 | static ssize_t set_temp_crit_enable(struct device *dev, |
| 1136 | struct device_attribute *attr, const char *buf, size_t count) | 1134 | struct device_attribute *attr, const char *buf, size_t count) |
| @@ -1142,7 +1140,7 @@ static ssize_t set_temp_crit_enable(struct device *dev, | |||
| 1142 | if ((val == 1) || (val==0)) { | 1140 | if ((val == 1) || (val==0)) { |
| 1143 | mutex_lock(&data->update_lock); | 1141 | mutex_lock(&data->update_lock); |
| 1144 | data->config1 = (data->config1 & ~CFG1_THERM_HOT) | (val << 4); | 1142 | data->config1 = (data->config1 & ~CFG1_THERM_HOT) | (val << 4); |
| 1145 | adm1026_write_value(client, ADM1026_REG_CONFIG1, | 1143 | adm1026_write_value(client, ADM1026_REG_CONFIG1, |
| 1146 | data->config1); | 1144 | data->config1); |
| 1147 | mutex_unlock(&data->update_lock); | 1145 | mutex_unlock(&data->update_lock); |
| 1148 | } | 1146 | } |
| @@ -1163,7 +1161,7 @@ static ssize_t show_temp_crit(struct device *dev, | |||
| 1163 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); | 1161 | struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); |
| 1164 | int nr = sensor_attr->index; | 1162 | int nr = sensor_attr->index; |
| 1165 | struct adm1026_data *data = adm1026_update_device(dev); | 1163 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1166 | return sprintf(buf,"%d\n", TEMP_FROM_REG(data->temp_crit[nr])); | 1164 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[nr])); |
| 1167 | } | 1165 | } |
| 1168 | static ssize_t set_temp_crit(struct device *dev, struct device_attribute *attr, | 1166 | static ssize_t set_temp_crit(struct device *dev, struct device_attribute *attr, |
| 1169 | const char *buf, size_t count) | 1167 | const char *buf, size_t count) |
| @@ -1193,7 +1191,7 @@ temp_crit_reg(3); | |||
| 1193 | static ssize_t show_analog_out_reg(struct device *dev, struct device_attribute *attr, char *buf) | 1191 | static ssize_t show_analog_out_reg(struct device *dev, struct device_attribute *attr, char *buf) |
| 1194 | { | 1192 | { |
| 1195 | struct adm1026_data *data = adm1026_update_device(dev); | 1193 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1196 | return sprintf(buf,"%d\n", DAC_FROM_REG(data->analog_out)); | 1194 | return sprintf(buf, "%d\n", DAC_FROM_REG(data->analog_out)); |
| 1197 | } | 1195 | } |
| 1198 | static ssize_t set_analog_out_reg(struct device *dev, struct device_attribute *attr, const char *buf, | 1196 | static ssize_t set_analog_out_reg(struct device *dev, struct device_attribute *attr, const char *buf, |
| 1199 | size_t count) | 1197 | size_t count) |
| @@ -1209,26 +1207,25 @@ static ssize_t set_analog_out_reg(struct device *dev, struct device_attribute *a | |||
| 1209 | return count; | 1207 | return count; |
| 1210 | } | 1208 | } |
| 1211 | 1209 | ||
| 1212 | static DEVICE_ATTR(analog_out, S_IRUGO | S_IWUSR, show_analog_out_reg, | 1210 | static DEVICE_ATTR(analog_out, S_IRUGO | S_IWUSR, show_analog_out_reg, |
| 1213 | set_analog_out_reg); | 1211 | set_analog_out_reg); |
| 1214 | 1212 | ||
| 1215 | static ssize_t show_vid_reg(struct device *dev, struct device_attribute *attr, char *buf) | 1213 | static ssize_t show_vid_reg(struct device *dev, struct device_attribute *attr, char *buf) |
| 1216 | { | 1214 | { |
| 1217 | struct adm1026_data *data = adm1026_update_device(dev); | 1215 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1218 | return sprintf(buf,"%d\n", vid_from_reg(data->vid & 0x3f, data->vrm)); | 1216 | return sprintf(buf, "%d\n", vid_from_reg(data->vid & 0x3f, data->vrm)); |
| 1219 | } | 1217 | } |
| 1220 | static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL); | 1218 | static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid_reg, NULL); |
| 1221 | 1219 | ||
| 1222 | static ssize_t show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf) | 1220 | static ssize_t show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf) |
| 1223 | { | 1221 | { |
| 1224 | struct adm1026_data *data = dev_get_drvdata(dev); | 1222 | struct adm1026_data *data = dev_get_drvdata(dev); |
| 1225 | return sprintf(buf,"%d\n", data->vrm); | 1223 | return sprintf(buf, "%d\n", data->vrm); |
| 1226 | } | 1224 | } |
| 1227 | static ssize_t store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, | 1225 | static ssize_t store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, |
| 1228 | size_t count) | 1226 | size_t count) |
| 1229 | { | 1227 | { |
| 1230 | struct i2c_client *client = to_i2c_client(dev); | 1228 | struct adm1026_data *data = dev_get_drvdata(dev); |
| 1231 | struct adm1026_data *data = i2c_get_clientdata(client); | ||
| 1232 | 1229 | ||
| 1233 | data->vrm = simple_strtol(buf, NULL, 10); | 1230 | data->vrm = simple_strtol(buf, NULL, 10); |
| 1234 | return count; | 1231 | return count; |
| @@ -1239,15 +1236,52 @@ static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm_reg, store_vrm_reg); | |||
| 1239 | static ssize_t show_alarms_reg(struct device *dev, struct device_attribute *attr, char *buf) | 1236 | static ssize_t show_alarms_reg(struct device *dev, struct device_attribute *attr, char *buf) |
| 1240 | { | 1237 | { |
| 1241 | struct adm1026_data *data = adm1026_update_device(dev); | 1238 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1242 | return sprintf(buf, "%ld\n", (long) (data->alarms)); | 1239 | return sprintf(buf, "%ld\n", data->alarms); |
| 1243 | } | 1240 | } |
| 1244 | 1241 | ||
| 1245 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL); | 1242 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL); |
| 1246 | 1243 | ||
| 1244 | static ssize_t show_alarm(struct device *dev, struct device_attribute *attr, | ||
| 1245 | char *buf) | ||
| 1246 | { | ||
| 1247 | struct adm1026_data *data = adm1026_update_device(dev); | ||
| 1248 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 1249 | return sprintf(buf, "%ld\n", (data->alarms >> bitnr) & 1); | ||
| 1250 | } | ||
| 1251 | |||
| 1252 | static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 0); | ||
| 1253 | static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 1); | ||
| 1254 | static SENSOR_DEVICE_ATTR(in9_alarm, S_IRUGO, show_alarm, NULL, 1); | ||
| 1255 | static SENSOR_DEVICE_ATTR(in11_alarm, S_IRUGO, show_alarm, NULL, 2); | ||
| 1256 | static SENSOR_DEVICE_ATTR(in12_alarm, S_IRUGO, show_alarm, NULL, 3); | ||
| 1257 | static SENSOR_DEVICE_ATTR(in13_alarm, S_IRUGO, show_alarm, NULL, 4); | ||
| 1258 | static SENSOR_DEVICE_ATTR(in14_alarm, S_IRUGO, show_alarm, NULL, 5); | ||
| 1259 | static SENSOR_DEVICE_ATTR(in15_alarm, S_IRUGO, show_alarm, NULL, 6); | ||
| 1260 | static SENSOR_DEVICE_ATTR(in16_alarm, S_IRUGO, show_alarm, NULL, 7); | ||
| 1261 | static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 8); | ||
| 1262 | static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 9); | ||
| 1263 | static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 10); | ||
| 1264 | static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 11); | ||
| 1265 | static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 12); | ||
| 1266 | static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 13); | ||
| 1267 | static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 14); | ||
| 1268 | static SENSOR_DEVICE_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 15); | ||
| 1269 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 16); | ||
| 1270 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 17); | ||
| 1271 | static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 18); | ||
| 1272 | static SENSOR_DEVICE_ATTR(fan4_alarm, S_IRUGO, show_alarm, NULL, 19); | ||
| 1273 | static SENSOR_DEVICE_ATTR(fan5_alarm, S_IRUGO, show_alarm, NULL, 20); | ||
| 1274 | static SENSOR_DEVICE_ATTR(fan6_alarm, S_IRUGO, show_alarm, NULL, 21); | ||
| 1275 | static SENSOR_DEVICE_ATTR(fan7_alarm, S_IRUGO, show_alarm, NULL, 22); | ||
| 1276 | static SENSOR_DEVICE_ATTR(fan8_alarm, S_IRUGO, show_alarm, NULL, 23); | ||
| 1277 | static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 24); | ||
| 1278 | static SENSOR_DEVICE_ATTR(in10_alarm, S_IRUGO, show_alarm, NULL, 25); | ||
| 1279 | static SENSOR_DEVICE_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 26); | ||
| 1280 | |||
| 1247 | static ssize_t show_alarm_mask(struct device *dev, struct device_attribute *attr, char *buf) | 1281 | static ssize_t show_alarm_mask(struct device *dev, struct device_attribute *attr, char *buf) |
| 1248 | { | 1282 | { |
| 1249 | struct adm1026_data *data = adm1026_update_device(dev); | 1283 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1250 | return sprintf(buf,"%ld\n", data->alarm_mask); | 1284 | return sprintf(buf, "%ld\n", data->alarm_mask); |
| 1251 | } | 1285 | } |
| 1252 | static ssize_t set_alarm_mask(struct device *dev, struct device_attribute *attr, const char *buf, | 1286 | static ssize_t set_alarm_mask(struct device *dev, struct device_attribute *attr, const char *buf, |
| 1253 | size_t count) | 1287 | size_t count) |
| @@ -1283,7 +1317,7 @@ static DEVICE_ATTR(alarm_mask, S_IRUGO | S_IWUSR, show_alarm_mask, | |||
| 1283 | static ssize_t show_gpio(struct device *dev, struct device_attribute *attr, char *buf) | 1317 | static ssize_t show_gpio(struct device *dev, struct device_attribute *attr, char *buf) |
| 1284 | { | 1318 | { |
| 1285 | struct adm1026_data *data = adm1026_update_device(dev); | 1319 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1286 | return sprintf(buf,"%ld\n", data->gpio); | 1320 | return sprintf(buf, "%ld\n", data->gpio); |
| 1287 | } | 1321 | } |
| 1288 | static ssize_t set_gpio(struct device *dev, struct device_attribute *attr, const char *buf, | 1322 | static ssize_t set_gpio(struct device *dev, struct device_attribute *attr, const char *buf, |
| 1289 | size_t count) | 1323 | size_t count) |
| @@ -1291,16 +1325,16 @@ static ssize_t set_gpio(struct device *dev, struct device_attribute *attr, const | |||
| 1291 | struct i2c_client *client = to_i2c_client(dev); | 1325 | struct i2c_client *client = to_i2c_client(dev); |
| 1292 | struct adm1026_data *data = i2c_get_clientdata(client); | 1326 | struct adm1026_data *data = i2c_get_clientdata(client); |
| 1293 | int val = simple_strtol(buf, NULL, 10); | 1327 | int val = simple_strtol(buf, NULL, 10); |
| 1294 | long gpio; | 1328 | long gpio; |
| 1295 | 1329 | ||
| 1296 | mutex_lock(&data->update_lock); | 1330 | mutex_lock(&data->update_lock); |
| 1297 | data->gpio = val & 0x1ffff; | 1331 | data->gpio = val & 0x1ffff; |
| 1298 | gpio = data->gpio; | 1332 | gpio = data->gpio; |
| 1299 | adm1026_write_value(client, ADM1026_REG_GPIO_STATUS_0_7,gpio & 0xff); | 1333 | adm1026_write_value(client, ADM1026_REG_GPIO_STATUS_0_7, gpio & 0xff); |
| 1300 | gpio >>= 8; | 1334 | gpio >>= 8; |
| 1301 | adm1026_write_value(client, ADM1026_REG_GPIO_STATUS_8_15,gpio & 0xff); | 1335 | adm1026_write_value(client, ADM1026_REG_GPIO_STATUS_8_15, gpio & 0xff); |
| 1302 | gpio = ((gpio >> 1) & 0x80) | (data->alarms >> 24 & 0x7f); | 1336 | gpio = ((gpio >> 1) & 0x80) | (data->alarms >> 24 & 0x7f); |
| 1303 | adm1026_write_value(client, ADM1026_REG_STATUS4,gpio & 0xff); | 1337 | adm1026_write_value(client, ADM1026_REG_STATUS4, gpio & 0xff); |
| 1304 | mutex_unlock(&data->update_lock); | 1338 | mutex_unlock(&data->update_lock); |
| 1305 | return count; | 1339 | return count; |
| 1306 | } | 1340 | } |
| @@ -1311,7 +1345,7 @@ static DEVICE_ATTR(gpio, S_IRUGO | S_IWUSR, show_gpio, set_gpio); | |||
| 1311 | static ssize_t show_gpio_mask(struct device *dev, struct device_attribute *attr, char *buf) | 1345 | static ssize_t show_gpio_mask(struct device *dev, struct device_attribute *attr, char *buf) |
| 1312 | { | 1346 | { |
| 1313 | struct adm1026_data *data = adm1026_update_device(dev); | 1347 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1314 | return sprintf(buf,"%ld\n", data->gpio_mask); | 1348 | return sprintf(buf, "%ld\n", data->gpio_mask); |
| 1315 | } | 1349 | } |
| 1316 | static ssize_t set_gpio_mask(struct device *dev, struct device_attribute *attr, const char *buf, | 1350 | static ssize_t set_gpio_mask(struct device *dev, struct device_attribute *attr, const char *buf, |
| 1317 | size_t count) | 1351 | size_t count) |
| @@ -1319,16 +1353,16 @@ static ssize_t set_gpio_mask(struct device *dev, struct device_attribute *attr, | |||
| 1319 | struct i2c_client *client = to_i2c_client(dev); | 1353 | struct i2c_client *client = to_i2c_client(dev); |
| 1320 | struct adm1026_data *data = i2c_get_clientdata(client); | 1354 | struct adm1026_data *data = i2c_get_clientdata(client); |
| 1321 | int val = simple_strtol(buf, NULL, 10); | 1355 | int val = simple_strtol(buf, NULL, 10); |
| 1322 | long mask; | 1356 | long mask; |
| 1323 | 1357 | ||
| 1324 | mutex_lock(&data->update_lock); | 1358 | mutex_lock(&data->update_lock); |
| 1325 | data->gpio_mask = val & 0x1ffff; | 1359 | data->gpio_mask = val & 0x1ffff; |
| 1326 | mask = data->gpio_mask; | 1360 | mask = data->gpio_mask; |
| 1327 | adm1026_write_value(client, ADM1026_REG_GPIO_MASK_0_7,mask & 0xff); | 1361 | adm1026_write_value(client, ADM1026_REG_GPIO_MASK_0_7, mask & 0xff); |
| 1328 | mask >>= 8; | 1362 | mask >>= 8; |
| 1329 | adm1026_write_value(client, ADM1026_REG_GPIO_MASK_8_15,mask & 0xff); | 1363 | adm1026_write_value(client, ADM1026_REG_GPIO_MASK_8_15, mask & 0xff); |
| 1330 | mask = ((mask >> 1) & 0x80) | (data->alarm_mask >> 24 & 0x7f); | 1364 | mask = ((mask >> 1) & 0x80) | (data->alarm_mask >> 24 & 0x7f); |
| 1331 | adm1026_write_value(client, ADM1026_REG_MASK1,mask & 0xff); | 1365 | adm1026_write_value(client, ADM1026_REG_MASK1, mask & 0xff); |
| 1332 | mutex_unlock(&data->update_lock); | 1366 | mutex_unlock(&data->update_lock); |
| 1333 | return count; | 1367 | return count; |
| 1334 | } | 1368 | } |
| @@ -1338,7 +1372,7 @@ static DEVICE_ATTR(gpio_mask, S_IRUGO | S_IWUSR, show_gpio_mask, set_gpio_mask); | |||
| 1338 | static ssize_t show_pwm_reg(struct device *dev, struct device_attribute *attr, char *buf) | 1372 | static ssize_t show_pwm_reg(struct device *dev, struct device_attribute *attr, char *buf) |
| 1339 | { | 1373 | { |
| 1340 | struct adm1026_data *data = adm1026_update_device(dev); | 1374 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1341 | return sprintf(buf,"%d\n", PWM_FROM_REG(data->pwm1.pwm)); | 1375 | return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm1.pwm)); |
| 1342 | } | 1376 | } |
| 1343 | static ssize_t set_pwm_reg(struct device *dev, struct device_attribute *attr, const char *buf, | 1377 | static ssize_t set_pwm_reg(struct device *dev, struct device_attribute *attr, const char *buf, |
| 1344 | size_t count) | 1378 | size_t count) |
| @@ -1359,7 +1393,7 @@ static ssize_t set_pwm_reg(struct device *dev, struct device_attribute *attr, co | |||
| 1359 | static ssize_t show_auto_pwm_min(struct device *dev, struct device_attribute *attr, char *buf) | 1393 | static ssize_t show_auto_pwm_min(struct device *dev, struct device_attribute *attr, char *buf) |
| 1360 | { | 1394 | { |
| 1361 | struct adm1026_data *data = adm1026_update_device(dev); | 1395 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1362 | return sprintf(buf,"%d\n", data->pwm1.auto_pwm_min); | 1396 | return sprintf(buf, "%d\n", data->pwm1.auto_pwm_min); |
| 1363 | } | 1397 | } |
| 1364 | static ssize_t set_auto_pwm_min(struct device *dev, struct device_attribute *attr, const char *buf, | 1398 | static ssize_t set_auto_pwm_min(struct device *dev, struct device_attribute *attr, const char *buf, |
| 1365 | size_t count) | 1399 | size_t count) |
| @@ -1369,10 +1403,10 @@ static ssize_t set_auto_pwm_min(struct device *dev, struct device_attribute *att | |||
| 1369 | int val = simple_strtol(buf, NULL, 10); | 1403 | int val = simple_strtol(buf, NULL, 10); |
| 1370 | 1404 | ||
| 1371 | mutex_lock(&data->update_lock); | 1405 | mutex_lock(&data->update_lock); |
| 1372 | data->pwm1.auto_pwm_min = SENSORS_LIMIT(val,0,255); | 1406 | data->pwm1.auto_pwm_min = SENSORS_LIMIT(val, 0, 255); |
| 1373 | if (data->pwm1.enable == 2) { /* apply immediately */ | 1407 | if (data->pwm1.enable == 2) { /* apply immediately */ |
| 1374 | data->pwm1.pwm = PWM_TO_REG((data->pwm1.pwm & 0x0f) | | 1408 | data->pwm1.pwm = PWM_TO_REG((data->pwm1.pwm & 0x0f) | |
| 1375 | PWM_MIN_TO_REG(data->pwm1.auto_pwm_min)); | 1409 | PWM_MIN_TO_REG(data->pwm1.auto_pwm_min)); |
| 1376 | adm1026_write_value(client, ADM1026_REG_PWM, data->pwm1.pwm); | 1410 | adm1026_write_value(client, ADM1026_REG_PWM, data->pwm1.pwm); |
| 1377 | } | 1411 | } |
| 1378 | mutex_unlock(&data->update_lock); | 1412 | mutex_unlock(&data->update_lock); |
| @@ -1380,12 +1414,12 @@ static ssize_t set_auto_pwm_min(struct device *dev, struct device_attribute *att | |||
| 1380 | } | 1414 | } |
| 1381 | static ssize_t show_auto_pwm_max(struct device *dev, struct device_attribute *attr, char *buf) | 1415 | static ssize_t show_auto_pwm_max(struct device *dev, struct device_attribute *attr, char *buf) |
| 1382 | { | 1416 | { |
| 1383 | return sprintf(buf,"%d\n", ADM1026_PWM_MAX); | 1417 | return sprintf(buf, "%d\n", ADM1026_PWM_MAX); |
| 1384 | } | 1418 | } |
| 1385 | static ssize_t show_pwm_enable(struct device *dev, struct device_attribute *attr, char *buf) | 1419 | static ssize_t show_pwm_enable(struct device *dev, struct device_attribute *attr, char *buf) |
| 1386 | { | 1420 | { |
| 1387 | struct adm1026_data *data = adm1026_update_device(dev); | 1421 | struct adm1026_data *data = adm1026_update_device(dev); |
| 1388 | return sprintf(buf,"%d\n", data->pwm1.enable); | 1422 | return sprintf(buf, "%d\n", data->pwm1.enable); |
| 1389 | } | 1423 | } |
| 1390 | static ssize_t set_pwm_enable(struct device *dev, struct device_attribute *attr, const char *buf, | 1424 | static ssize_t set_pwm_enable(struct device *dev, struct device_attribute *attr, const char *buf, |
| 1391 | size_t count) | 1425 | size_t count) |
| @@ -1393,7 +1427,7 @@ static ssize_t set_pwm_enable(struct device *dev, struct device_attribute *attr, | |||
| 1393 | struct i2c_client *client = to_i2c_client(dev); | 1427 | struct i2c_client *client = to_i2c_client(dev); |
| 1394 | struct adm1026_data *data = i2c_get_clientdata(client); | 1428 | struct adm1026_data *data = i2c_get_clientdata(client); |
| 1395 | int val = simple_strtol(buf, NULL, 10); | 1429 | int val = simple_strtol(buf, NULL, 10); |
| 1396 | int old_enable; | 1430 | int old_enable; |
| 1397 | 1431 | ||
| 1398 | if ((val >= 0) && (val < 3)) { | 1432 | if ((val >= 0) && (val < 3)) { |
| 1399 | mutex_lock(&data->update_lock); | 1433 | mutex_lock(&data->update_lock); |
| @@ -1403,15 +1437,15 @@ static ssize_t set_pwm_enable(struct device *dev, struct device_attribute *attr, | |||
| 1403 | | ((val == 2) ? CFG1_PWM_AFC : 0); | 1437 | | ((val == 2) ? CFG1_PWM_AFC : 0); |
| 1404 | adm1026_write_value(client, ADM1026_REG_CONFIG1, | 1438 | adm1026_write_value(client, ADM1026_REG_CONFIG1, |
| 1405 | data->config1); | 1439 | data->config1); |
| 1406 | if (val == 2) { /* apply pwm1_auto_pwm_min to pwm1 */ | 1440 | if (val == 2) { /* apply pwm1_auto_pwm_min to pwm1 */ |
| 1407 | data->pwm1.pwm = PWM_TO_REG((data->pwm1.pwm & 0x0f) | | 1441 | data->pwm1.pwm = PWM_TO_REG((data->pwm1.pwm & 0x0f) | |
| 1408 | PWM_MIN_TO_REG(data->pwm1.auto_pwm_min)); | 1442 | PWM_MIN_TO_REG(data->pwm1.auto_pwm_min)); |
| 1409 | adm1026_write_value(client, ADM1026_REG_PWM, | 1443 | adm1026_write_value(client, ADM1026_REG_PWM, |
| 1410 | data->pwm1.pwm); | 1444 | data->pwm1.pwm); |
| 1411 | } else if (!((old_enable == 1) && (val == 1))) { | 1445 | } else if (!((old_enable == 1) && (val == 1))) { |
| 1412 | /* set pwm to safe value */ | 1446 | /* set pwm to safe value */ |
| 1413 | data->pwm1.pwm = 255; | 1447 | data->pwm1.pwm = 255; |
| 1414 | adm1026_write_value(client, ADM1026_REG_PWM, | 1448 | adm1026_write_value(client, ADM1026_REG_PWM, |
| 1415 | data->pwm1.pwm); | 1449 | data->pwm1.pwm); |
| 1416 | } | 1450 | } |
| 1417 | mutex_unlock(&data->update_lock); | 1451 | mutex_unlock(&data->update_lock); |
| @@ -1420,20 +1454,20 @@ static ssize_t set_pwm_enable(struct device *dev, struct device_attribute *attr, | |||
| 1420 | } | 1454 | } |
| 1421 | 1455 | ||
| 1422 | /* enable PWM fan control */ | 1456 | /* enable PWM fan control */ |
| 1423 | static DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_pwm_reg, set_pwm_reg); | 1457 | static DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_pwm_reg, set_pwm_reg); |
| 1424 | static DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR, show_pwm_reg, set_pwm_reg); | 1458 | static DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR, show_pwm_reg, set_pwm_reg); |
| 1425 | static DEVICE_ATTR(pwm3, S_IRUGO | S_IWUSR, show_pwm_reg, set_pwm_reg); | 1459 | static DEVICE_ATTR(pwm3, S_IRUGO | S_IWUSR, show_pwm_reg, set_pwm_reg); |
| 1426 | static DEVICE_ATTR(pwm1_enable, S_IRUGO | S_IWUSR, show_pwm_enable, | 1460 | static DEVICE_ATTR(pwm1_enable, S_IRUGO | S_IWUSR, show_pwm_enable, |
| 1427 | set_pwm_enable); | 1461 | set_pwm_enable); |
| 1428 | static DEVICE_ATTR(pwm2_enable, S_IRUGO | S_IWUSR, show_pwm_enable, | 1462 | static DEVICE_ATTR(pwm2_enable, S_IRUGO | S_IWUSR, show_pwm_enable, |
| 1429 | set_pwm_enable); | 1463 | set_pwm_enable); |
| 1430 | static DEVICE_ATTR(pwm3_enable, S_IRUGO | S_IWUSR, show_pwm_enable, | 1464 | static DEVICE_ATTR(pwm3_enable, S_IRUGO | S_IWUSR, show_pwm_enable, |
| 1431 | set_pwm_enable); | 1465 | set_pwm_enable); |
| 1432 | static DEVICE_ATTR(temp1_auto_point1_pwm, S_IRUGO | S_IWUSR, | 1466 | static DEVICE_ATTR(temp1_auto_point1_pwm, S_IRUGO | S_IWUSR, |
| 1433 | show_auto_pwm_min, set_auto_pwm_min); | 1467 | show_auto_pwm_min, set_auto_pwm_min); |
| 1434 | static DEVICE_ATTR(temp2_auto_point1_pwm, S_IRUGO | S_IWUSR, | 1468 | static DEVICE_ATTR(temp2_auto_point1_pwm, S_IRUGO | S_IWUSR, |
| 1435 | show_auto_pwm_min, set_auto_pwm_min); | 1469 | show_auto_pwm_min, set_auto_pwm_min); |
| 1436 | static DEVICE_ATTR(temp3_auto_point1_pwm, S_IRUGO | S_IWUSR, | 1470 | static DEVICE_ATTR(temp3_auto_point1_pwm, S_IRUGO | S_IWUSR, |
| 1437 | show_auto_pwm_min, set_auto_pwm_min); | 1471 | show_auto_pwm_min, set_auto_pwm_min); |
| 1438 | 1472 | ||
| 1439 | static DEVICE_ATTR(temp1_auto_point2_pwm, S_IRUGO, show_auto_pwm_max, NULL); | 1473 | static DEVICE_ATTR(temp1_auto_point2_pwm, S_IRUGO, show_auto_pwm_max, NULL); |
| @@ -1444,105 +1478,115 @@ static struct attribute *adm1026_attributes[] = { | |||
| 1444 | &sensor_dev_attr_in0_input.dev_attr.attr, | 1478 | &sensor_dev_attr_in0_input.dev_attr.attr, |
| 1445 | &sensor_dev_attr_in0_max.dev_attr.attr, | 1479 | &sensor_dev_attr_in0_max.dev_attr.attr, |
| 1446 | &sensor_dev_attr_in0_min.dev_attr.attr, | 1480 | &sensor_dev_attr_in0_min.dev_attr.attr, |
| 1481 | &sensor_dev_attr_in0_alarm.dev_attr.attr, | ||
| 1447 | &sensor_dev_attr_in1_input.dev_attr.attr, | 1482 | &sensor_dev_attr_in1_input.dev_attr.attr, |
| 1448 | &sensor_dev_attr_in1_max.dev_attr.attr, | 1483 | &sensor_dev_attr_in1_max.dev_attr.attr, |
| 1449 | &sensor_dev_attr_in1_min.dev_attr.attr, | 1484 | &sensor_dev_attr_in1_min.dev_attr.attr, |
| 1485 | &sensor_dev_attr_in1_alarm.dev_attr.attr, | ||
| 1450 | &sensor_dev_attr_in2_input.dev_attr.attr, | 1486 | &sensor_dev_attr_in2_input.dev_attr.attr, |
| 1451 | &sensor_dev_attr_in2_max.dev_attr.attr, | 1487 | &sensor_dev_attr_in2_max.dev_attr.attr, |
| 1452 | &sensor_dev_attr_in2_min.dev_attr.attr, | 1488 | &sensor_dev_attr_in2_min.dev_attr.attr, |
| 1489 | &sensor_dev_attr_in2_alarm.dev_attr.attr, | ||
| 1453 | &sensor_dev_attr_in3_input.dev_attr.attr, | 1490 | &sensor_dev_attr_in3_input.dev_attr.attr, |
| 1454 | &sensor_dev_attr_in3_max.dev_attr.attr, | 1491 | &sensor_dev_attr_in3_max.dev_attr.attr, |
| 1455 | &sensor_dev_attr_in3_min.dev_attr.attr, | 1492 | &sensor_dev_attr_in3_min.dev_attr.attr, |
| 1493 | &sensor_dev_attr_in3_alarm.dev_attr.attr, | ||
| 1456 | &sensor_dev_attr_in4_input.dev_attr.attr, | 1494 | &sensor_dev_attr_in4_input.dev_attr.attr, |
| 1457 | &sensor_dev_attr_in4_max.dev_attr.attr, | 1495 | &sensor_dev_attr_in4_max.dev_attr.attr, |
| 1458 | &sensor_dev_attr_in4_min.dev_attr.attr, | 1496 | &sensor_dev_attr_in4_min.dev_attr.attr, |
| 1497 | &sensor_dev_attr_in4_alarm.dev_attr.attr, | ||
| 1459 | &sensor_dev_attr_in5_input.dev_attr.attr, | 1498 | &sensor_dev_attr_in5_input.dev_attr.attr, |
| 1460 | &sensor_dev_attr_in5_max.dev_attr.attr, | 1499 | &sensor_dev_attr_in5_max.dev_attr.attr, |
| 1461 | &sensor_dev_attr_in5_min.dev_attr.attr, | 1500 | &sensor_dev_attr_in5_min.dev_attr.attr, |
| 1501 | &sensor_dev_attr_in5_alarm.dev_attr.attr, | ||
| 1462 | &sensor_dev_attr_in6_input.dev_attr.attr, | 1502 | &sensor_dev_attr_in6_input.dev_attr.attr, |
| 1463 | &sensor_dev_attr_in6_max.dev_attr.attr, | 1503 | &sensor_dev_attr_in6_max.dev_attr.attr, |
| 1464 | &sensor_dev_attr_in6_min.dev_attr.attr, | 1504 | &sensor_dev_attr_in6_min.dev_attr.attr, |
| 1505 | &sensor_dev_attr_in6_alarm.dev_attr.attr, | ||
| 1465 | &sensor_dev_attr_in7_input.dev_attr.attr, | 1506 | &sensor_dev_attr_in7_input.dev_attr.attr, |
| 1466 | &sensor_dev_attr_in7_max.dev_attr.attr, | 1507 | &sensor_dev_attr_in7_max.dev_attr.attr, |
| 1467 | &sensor_dev_attr_in7_min.dev_attr.attr, | 1508 | &sensor_dev_attr_in7_min.dev_attr.attr, |
| 1468 | &sensor_dev_attr_in8_input.dev_attr.attr, | 1509 | &sensor_dev_attr_in7_alarm.dev_attr.attr, |
| 1469 | &sensor_dev_attr_in8_max.dev_attr.attr, | ||
| 1470 | &sensor_dev_attr_in8_min.dev_attr.attr, | ||
| 1471 | &sensor_dev_attr_in9_input.dev_attr.attr, | ||
| 1472 | &sensor_dev_attr_in9_max.dev_attr.attr, | ||
| 1473 | &sensor_dev_attr_in9_min.dev_attr.attr, | ||
| 1474 | &sensor_dev_attr_in10_input.dev_attr.attr, | 1510 | &sensor_dev_attr_in10_input.dev_attr.attr, |
| 1475 | &sensor_dev_attr_in10_max.dev_attr.attr, | 1511 | &sensor_dev_attr_in10_max.dev_attr.attr, |
| 1476 | &sensor_dev_attr_in10_min.dev_attr.attr, | 1512 | &sensor_dev_attr_in10_min.dev_attr.attr, |
| 1513 | &sensor_dev_attr_in10_alarm.dev_attr.attr, | ||
| 1477 | &sensor_dev_attr_in11_input.dev_attr.attr, | 1514 | &sensor_dev_attr_in11_input.dev_attr.attr, |
| 1478 | &sensor_dev_attr_in11_max.dev_attr.attr, | 1515 | &sensor_dev_attr_in11_max.dev_attr.attr, |
| 1479 | &sensor_dev_attr_in11_min.dev_attr.attr, | 1516 | &sensor_dev_attr_in11_min.dev_attr.attr, |
| 1517 | &sensor_dev_attr_in11_alarm.dev_attr.attr, | ||
| 1480 | &sensor_dev_attr_in12_input.dev_attr.attr, | 1518 | &sensor_dev_attr_in12_input.dev_attr.attr, |
| 1481 | &sensor_dev_attr_in12_max.dev_attr.attr, | 1519 | &sensor_dev_attr_in12_max.dev_attr.attr, |
| 1482 | &sensor_dev_attr_in12_min.dev_attr.attr, | 1520 | &sensor_dev_attr_in12_min.dev_attr.attr, |
| 1521 | &sensor_dev_attr_in12_alarm.dev_attr.attr, | ||
| 1483 | &sensor_dev_attr_in13_input.dev_attr.attr, | 1522 | &sensor_dev_attr_in13_input.dev_attr.attr, |
| 1484 | &sensor_dev_attr_in13_max.dev_attr.attr, | 1523 | &sensor_dev_attr_in13_max.dev_attr.attr, |
| 1485 | &sensor_dev_attr_in13_min.dev_attr.attr, | 1524 | &sensor_dev_attr_in13_min.dev_attr.attr, |
| 1525 | &sensor_dev_attr_in13_alarm.dev_attr.attr, | ||
| 1486 | &sensor_dev_attr_in14_input.dev_attr.attr, | 1526 | &sensor_dev_attr_in14_input.dev_attr.attr, |
| 1487 | &sensor_dev_attr_in14_max.dev_attr.attr, | 1527 | &sensor_dev_attr_in14_max.dev_attr.attr, |
| 1488 | &sensor_dev_attr_in14_min.dev_attr.attr, | 1528 | &sensor_dev_attr_in14_min.dev_attr.attr, |
| 1529 | &sensor_dev_attr_in14_alarm.dev_attr.attr, | ||
| 1489 | &sensor_dev_attr_in15_input.dev_attr.attr, | 1530 | &sensor_dev_attr_in15_input.dev_attr.attr, |
| 1490 | &sensor_dev_attr_in15_max.dev_attr.attr, | 1531 | &sensor_dev_attr_in15_max.dev_attr.attr, |
| 1491 | &sensor_dev_attr_in15_min.dev_attr.attr, | 1532 | &sensor_dev_attr_in15_min.dev_attr.attr, |
| 1533 | &sensor_dev_attr_in15_alarm.dev_attr.attr, | ||
| 1492 | &sensor_dev_attr_in16_input.dev_attr.attr, | 1534 | &sensor_dev_attr_in16_input.dev_attr.attr, |
| 1493 | &sensor_dev_attr_in16_max.dev_attr.attr, | 1535 | &sensor_dev_attr_in16_max.dev_attr.attr, |
| 1494 | &sensor_dev_attr_in16_min.dev_attr.attr, | 1536 | &sensor_dev_attr_in16_min.dev_attr.attr, |
| 1537 | &sensor_dev_attr_in16_alarm.dev_attr.attr, | ||
| 1495 | &sensor_dev_attr_fan1_input.dev_attr.attr, | 1538 | &sensor_dev_attr_fan1_input.dev_attr.attr, |
| 1496 | &sensor_dev_attr_fan1_div.dev_attr.attr, | 1539 | &sensor_dev_attr_fan1_div.dev_attr.attr, |
| 1497 | &sensor_dev_attr_fan1_min.dev_attr.attr, | 1540 | &sensor_dev_attr_fan1_min.dev_attr.attr, |
| 1541 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, | ||
| 1498 | &sensor_dev_attr_fan2_input.dev_attr.attr, | 1542 | &sensor_dev_attr_fan2_input.dev_attr.attr, |
| 1499 | &sensor_dev_attr_fan2_div.dev_attr.attr, | 1543 | &sensor_dev_attr_fan2_div.dev_attr.attr, |
| 1500 | &sensor_dev_attr_fan2_min.dev_attr.attr, | 1544 | &sensor_dev_attr_fan2_min.dev_attr.attr, |
| 1545 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, | ||
| 1501 | &sensor_dev_attr_fan3_input.dev_attr.attr, | 1546 | &sensor_dev_attr_fan3_input.dev_attr.attr, |
| 1502 | &sensor_dev_attr_fan3_div.dev_attr.attr, | 1547 | &sensor_dev_attr_fan3_div.dev_attr.attr, |
| 1503 | &sensor_dev_attr_fan3_min.dev_attr.attr, | 1548 | &sensor_dev_attr_fan3_min.dev_attr.attr, |
| 1549 | &sensor_dev_attr_fan3_alarm.dev_attr.attr, | ||
| 1504 | &sensor_dev_attr_fan4_input.dev_attr.attr, | 1550 | &sensor_dev_attr_fan4_input.dev_attr.attr, |
| 1505 | &sensor_dev_attr_fan4_div.dev_attr.attr, | 1551 | &sensor_dev_attr_fan4_div.dev_attr.attr, |
| 1506 | &sensor_dev_attr_fan4_min.dev_attr.attr, | 1552 | &sensor_dev_attr_fan4_min.dev_attr.attr, |
| 1553 | &sensor_dev_attr_fan4_alarm.dev_attr.attr, | ||
| 1507 | &sensor_dev_attr_fan5_input.dev_attr.attr, | 1554 | &sensor_dev_attr_fan5_input.dev_attr.attr, |
| 1508 | &sensor_dev_attr_fan5_div.dev_attr.attr, | 1555 | &sensor_dev_attr_fan5_div.dev_attr.attr, |
| 1509 | &sensor_dev_attr_fan5_min.dev_attr.attr, | 1556 | &sensor_dev_attr_fan5_min.dev_attr.attr, |
| 1557 | &sensor_dev_attr_fan5_alarm.dev_attr.attr, | ||
| 1510 | &sensor_dev_attr_fan6_input.dev_attr.attr, | 1558 | &sensor_dev_attr_fan6_input.dev_attr.attr, |
| 1511 | &sensor_dev_attr_fan6_div.dev_attr.attr, | 1559 | &sensor_dev_attr_fan6_div.dev_attr.attr, |
| 1512 | &sensor_dev_attr_fan6_min.dev_attr.attr, | 1560 | &sensor_dev_attr_fan6_min.dev_attr.attr, |
| 1561 | &sensor_dev_attr_fan6_alarm.dev_attr.attr, | ||
| 1513 | &sensor_dev_attr_fan7_input.dev_attr.attr, | 1562 | &sensor_dev_attr_fan7_input.dev_attr.attr, |
| 1514 | &sensor_dev_attr_fan7_div.dev_attr.attr, | 1563 | &sensor_dev_attr_fan7_div.dev_attr.attr, |
| 1515 | &sensor_dev_attr_fan7_min.dev_attr.attr, | 1564 | &sensor_dev_attr_fan7_min.dev_attr.attr, |
| 1565 | &sensor_dev_attr_fan7_alarm.dev_attr.attr, | ||
| 1516 | &sensor_dev_attr_fan8_input.dev_attr.attr, | 1566 | &sensor_dev_attr_fan8_input.dev_attr.attr, |
| 1517 | &sensor_dev_attr_fan8_div.dev_attr.attr, | 1567 | &sensor_dev_attr_fan8_div.dev_attr.attr, |
| 1518 | &sensor_dev_attr_fan8_min.dev_attr.attr, | 1568 | &sensor_dev_attr_fan8_min.dev_attr.attr, |
| 1569 | &sensor_dev_attr_fan8_alarm.dev_attr.attr, | ||
| 1519 | &sensor_dev_attr_temp1_input.dev_attr.attr, | 1570 | &sensor_dev_attr_temp1_input.dev_attr.attr, |
| 1520 | &sensor_dev_attr_temp1_max.dev_attr.attr, | 1571 | &sensor_dev_attr_temp1_max.dev_attr.attr, |
| 1521 | &sensor_dev_attr_temp1_min.dev_attr.attr, | 1572 | &sensor_dev_attr_temp1_min.dev_attr.attr, |
| 1573 | &sensor_dev_attr_temp1_alarm.dev_attr.attr, | ||
| 1522 | &sensor_dev_attr_temp2_input.dev_attr.attr, | 1574 | &sensor_dev_attr_temp2_input.dev_attr.attr, |
| 1523 | &sensor_dev_attr_temp2_max.dev_attr.attr, | 1575 | &sensor_dev_attr_temp2_max.dev_attr.attr, |
| 1524 | &sensor_dev_attr_temp2_min.dev_attr.attr, | 1576 | &sensor_dev_attr_temp2_min.dev_attr.attr, |
| 1525 | &sensor_dev_attr_temp3_input.dev_attr.attr, | 1577 | &sensor_dev_attr_temp2_alarm.dev_attr.attr, |
| 1526 | &sensor_dev_attr_temp3_max.dev_attr.attr, | ||
| 1527 | &sensor_dev_attr_temp3_min.dev_attr.attr, | ||
| 1528 | &sensor_dev_attr_temp1_offset.dev_attr.attr, | 1578 | &sensor_dev_attr_temp1_offset.dev_attr.attr, |
| 1529 | &sensor_dev_attr_temp2_offset.dev_attr.attr, | 1579 | &sensor_dev_attr_temp2_offset.dev_attr.attr, |
| 1530 | &sensor_dev_attr_temp3_offset.dev_attr.attr, | ||
| 1531 | &sensor_dev_attr_temp1_auto_point1_temp.dev_attr.attr, | 1580 | &sensor_dev_attr_temp1_auto_point1_temp.dev_attr.attr, |
| 1532 | &sensor_dev_attr_temp2_auto_point1_temp.dev_attr.attr, | 1581 | &sensor_dev_attr_temp2_auto_point1_temp.dev_attr.attr, |
| 1533 | &sensor_dev_attr_temp3_auto_point1_temp.dev_attr.attr, | ||
| 1534 | &sensor_dev_attr_temp1_auto_point1_temp_hyst.dev_attr.attr, | 1582 | &sensor_dev_attr_temp1_auto_point1_temp_hyst.dev_attr.attr, |
| 1535 | &sensor_dev_attr_temp2_auto_point1_temp_hyst.dev_attr.attr, | 1583 | &sensor_dev_attr_temp2_auto_point1_temp_hyst.dev_attr.attr, |
| 1536 | &sensor_dev_attr_temp3_auto_point1_temp_hyst.dev_attr.attr, | ||
| 1537 | &sensor_dev_attr_temp1_auto_point2_temp.dev_attr.attr, | 1584 | &sensor_dev_attr_temp1_auto_point2_temp.dev_attr.attr, |
| 1538 | &sensor_dev_attr_temp2_auto_point2_temp.dev_attr.attr, | 1585 | &sensor_dev_attr_temp2_auto_point2_temp.dev_attr.attr, |
| 1539 | &sensor_dev_attr_temp3_auto_point2_temp.dev_attr.attr, | ||
| 1540 | &sensor_dev_attr_temp1_crit.dev_attr.attr, | 1586 | &sensor_dev_attr_temp1_crit.dev_attr.attr, |
| 1541 | &sensor_dev_attr_temp2_crit.dev_attr.attr, | 1587 | &sensor_dev_attr_temp2_crit.dev_attr.attr, |
| 1542 | &sensor_dev_attr_temp3_crit.dev_attr.attr, | ||
| 1543 | &dev_attr_temp1_crit_enable.attr, | 1588 | &dev_attr_temp1_crit_enable.attr, |
| 1544 | &dev_attr_temp2_crit_enable.attr, | 1589 | &dev_attr_temp2_crit_enable.attr, |
| 1545 | &dev_attr_temp3_crit_enable.attr, | ||
| 1546 | &dev_attr_cpu0_vid.attr, | 1590 | &dev_attr_cpu0_vid.attr, |
| 1547 | &dev_attr_vrm.attr, | 1591 | &dev_attr_vrm.attr, |
| 1548 | &dev_attr_alarms.attr, | 1592 | &dev_attr_alarms.attr, |
| @@ -1557,10 +1601,8 @@ static struct attribute *adm1026_attributes[] = { | |||
| 1557 | &dev_attr_pwm3_enable.attr, | 1601 | &dev_attr_pwm3_enable.attr, |
| 1558 | &dev_attr_temp1_auto_point1_pwm.attr, | 1602 | &dev_attr_temp1_auto_point1_pwm.attr, |
| 1559 | &dev_attr_temp2_auto_point1_pwm.attr, | 1603 | &dev_attr_temp2_auto_point1_pwm.attr, |
| 1560 | &dev_attr_temp3_auto_point1_pwm.attr, | ||
| 1561 | &dev_attr_temp1_auto_point2_pwm.attr, | 1604 | &dev_attr_temp1_auto_point2_pwm.attr, |
| 1562 | &dev_attr_temp2_auto_point2_pwm.attr, | 1605 | &dev_attr_temp2_auto_point2_pwm.attr, |
| 1563 | &dev_attr_temp3_auto_point2_pwm.attr, | ||
| 1564 | &dev_attr_analog_out.attr, | 1606 | &dev_attr_analog_out.attr, |
| 1565 | NULL | 1607 | NULL |
| 1566 | }; | 1608 | }; |
| @@ -1569,11 +1611,45 @@ static const struct attribute_group adm1026_group = { | |||
| 1569 | .attrs = adm1026_attributes, | 1611 | .attrs = adm1026_attributes, |
| 1570 | }; | 1612 | }; |
| 1571 | 1613 | ||
| 1614 | static struct attribute *adm1026_attributes_temp3[] = { | ||
| 1615 | &sensor_dev_attr_temp3_input.dev_attr.attr, | ||
| 1616 | &sensor_dev_attr_temp3_max.dev_attr.attr, | ||
| 1617 | &sensor_dev_attr_temp3_min.dev_attr.attr, | ||
| 1618 | &sensor_dev_attr_temp3_alarm.dev_attr.attr, | ||
| 1619 | &sensor_dev_attr_temp3_offset.dev_attr.attr, | ||
| 1620 | &sensor_dev_attr_temp3_auto_point1_temp.dev_attr.attr, | ||
| 1621 | &sensor_dev_attr_temp3_auto_point1_temp_hyst.dev_attr.attr, | ||
| 1622 | &sensor_dev_attr_temp3_auto_point2_temp.dev_attr.attr, | ||
| 1623 | &sensor_dev_attr_temp3_crit.dev_attr.attr, | ||
| 1624 | &dev_attr_temp3_crit_enable.attr, | ||
| 1625 | &dev_attr_temp3_auto_point1_pwm.attr, | ||
| 1626 | &dev_attr_temp3_auto_point2_pwm.attr, | ||
| 1627 | }; | ||
| 1628 | |||
| 1629 | static const struct attribute_group adm1026_group_temp3 = { | ||
| 1630 | .attrs = adm1026_attributes_temp3, | ||
| 1631 | }; | ||
| 1632 | |||
| 1633 | static struct attribute *adm1026_attributes_in8_9[] = { | ||
| 1634 | &sensor_dev_attr_in8_input.dev_attr.attr, | ||
| 1635 | &sensor_dev_attr_in8_max.dev_attr.attr, | ||
| 1636 | &sensor_dev_attr_in8_min.dev_attr.attr, | ||
| 1637 | &sensor_dev_attr_in8_alarm.dev_attr.attr, | ||
| 1638 | &sensor_dev_attr_in9_input.dev_attr.attr, | ||
| 1639 | &sensor_dev_attr_in9_max.dev_attr.attr, | ||
| 1640 | &sensor_dev_attr_in9_min.dev_attr.attr, | ||
| 1641 | &sensor_dev_attr_in9_alarm.dev_attr.attr, | ||
| 1642 | }; | ||
| 1643 | |||
| 1644 | static const struct attribute_group adm1026_group_in8_9 = { | ||
| 1645 | .attrs = adm1026_attributes_in8_9, | ||
| 1646 | }; | ||
| 1647 | |||
| 1572 | static int adm1026_detect(struct i2c_adapter *adapter, int address, | 1648 | static int adm1026_detect(struct i2c_adapter *adapter, int address, |
| 1573 | int kind) | 1649 | int kind) |
| 1574 | { | 1650 | { |
| 1575 | int company, verstep; | 1651 | int company, verstep; |
| 1576 | struct i2c_client *new_client; | 1652 | struct i2c_client *client; |
| 1577 | struct adm1026_data *data; | 1653 | struct adm1026_data *data; |
| 1578 | int err = 0; | 1654 | int err = 0; |
| 1579 | const char *type_name = ""; | 1655 | const char *type_name = ""; |
| @@ -1592,26 +1668,25 @@ static int adm1026_detect(struct i2c_adapter *adapter, int address, | |||
| 1592 | goto exit; | 1668 | goto exit; |
| 1593 | } | 1669 | } |
| 1594 | 1670 | ||
| 1595 | new_client = &data->client; | 1671 | client = &data->client; |
| 1596 | i2c_set_clientdata(new_client, data); | 1672 | i2c_set_clientdata(client, data); |
| 1597 | new_client->addr = address; | 1673 | client->addr = address; |
| 1598 | new_client->adapter = adapter; | 1674 | client->adapter = adapter; |
| 1599 | new_client->driver = &adm1026_driver; | 1675 | client->driver = &adm1026_driver; |
| 1600 | new_client->flags = 0; | ||
| 1601 | 1676 | ||
| 1602 | /* Now, we do the remaining detection. */ | 1677 | /* Now, we do the remaining detection. */ |
| 1603 | 1678 | ||
| 1604 | company = adm1026_read_value(new_client, ADM1026_REG_COMPANY); | 1679 | company = adm1026_read_value(client, ADM1026_REG_COMPANY); |
| 1605 | verstep = adm1026_read_value(new_client, ADM1026_REG_VERSTEP); | 1680 | verstep = adm1026_read_value(client, ADM1026_REG_VERSTEP); |
| 1606 | 1681 | ||
| 1607 | dev_dbg(&new_client->dev, "Detecting device at %d,0x%02x with" | 1682 | dev_dbg(&client->dev, "Detecting device at %d,0x%02x with" |
| 1608 | " COMPANY: 0x%02x and VERSTEP: 0x%02x\n", | 1683 | " COMPANY: 0x%02x and VERSTEP: 0x%02x\n", |
| 1609 | i2c_adapter_id(new_client->adapter), new_client->addr, | 1684 | i2c_adapter_id(client->adapter), client->addr, |
| 1610 | company, verstep); | 1685 | company, verstep); |
| 1611 | 1686 | ||
| 1612 | /* If auto-detecting, Determine the chip type. */ | 1687 | /* If auto-detecting, Determine the chip type. */ |
| 1613 | if (kind <= 0) { | 1688 | if (kind <= 0) { |
| 1614 | dev_dbg(&new_client->dev, "Autodetecting device at %d,0x%02x " | 1689 | dev_dbg(&client->dev, "Autodetecting device at %d,0x%02x " |
| 1615 | "...\n", i2c_adapter_id(adapter), address); | 1690 | "...\n", i2c_adapter_id(adapter), address); |
| 1616 | if (company == ADM1026_COMPANY_ANALOG_DEV | 1691 | if (company == ADM1026_COMPANY_ANALOG_DEV |
| 1617 | && verstep == ADM1026_VERSTEP_ADM1026) { | 1692 | && verstep == ADM1026_VERSTEP_ADM1026) { |
| @@ -1627,16 +1702,15 @@ static int adm1026_detect(struct i2c_adapter *adapter, int address, | |||
| 1627 | verstep); | 1702 | verstep); |
| 1628 | kind = any_chip; | 1703 | kind = any_chip; |
| 1629 | } else { | 1704 | } else { |
| 1630 | dev_dbg(&new_client->dev, ": Autodetection " | 1705 | dev_dbg(&client->dev, ": Autodetection " |
| 1631 | "failed\n"); | 1706 | "failed\n"); |
| 1632 | /* Not an ADM1026 ... */ | 1707 | /* Not an ADM1026 ... */ |
| 1633 | if (kind == 0) { /* User used force=x,y */ | 1708 | if (kind == 0) { /* User used force=x,y */ |
| 1634 | dev_err(&adapter->dev, "Generic ADM1026 not " | 1709 | dev_err(&adapter->dev, "Generic ADM1026 not " |
| 1635 | "found at %d,0x%02x. Try " | 1710 | "found at %d,0x%02x. Try " |
| 1636 | "force_adm1026.\n", | 1711 | "force_adm1026.\n", |
| 1637 | i2c_adapter_id(adapter), address); | 1712 | i2c_adapter_id(adapter), address); |
| 1638 | } | 1713 | } |
| 1639 | err = 0; | ||
| 1640 | goto exitfree; | 1714 | goto exitfree; |
| 1641 | } | 1715 | } |
| 1642 | } | 1716 | } |
| @@ -1655,28 +1729,34 @@ static int adm1026_detect(struct i2c_adapter *adapter, int address, | |||
| 1655 | err = -EFAULT; | 1729 | err = -EFAULT; |
| 1656 | goto exitfree; | 1730 | goto exitfree; |
| 1657 | } | 1731 | } |
| 1658 | strlcpy(new_client->name, type_name, I2C_NAME_SIZE); | 1732 | strlcpy(client->name, type_name, I2C_NAME_SIZE); |
| 1659 | 1733 | ||
| 1660 | /* Fill in the remaining client fields */ | 1734 | /* Fill in the remaining client fields */ |
| 1661 | data->type = kind; | ||
| 1662 | data->valid = 0; | ||
| 1663 | mutex_init(&data->update_lock); | 1735 | mutex_init(&data->update_lock); |
| 1664 | 1736 | ||
| 1665 | /* Tell the I2C layer a new client has arrived */ | 1737 | /* Tell the I2C layer a new client has arrived */ |
| 1666 | if ((err = i2c_attach_client(new_client))) | 1738 | if ((err = i2c_attach_client(client))) |
| 1667 | goto exitfree; | 1739 | goto exitfree; |
| 1668 | 1740 | ||
| 1669 | /* Set the VRM version */ | 1741 | /* Set the VRM version */ |
| 1670 | data->vrm = vid_which_vrm(); | 1742 | data->vrm = vid_which_vrm(); |
| 1671 | 1743 | ||
| 1672 | /* Initialize the ADM1026 chip */ | 1744 | /* Initialize the ADM1026 chip */ |
| 1673 | adm1026_init_client(new_client); | 1745 | adm1026_init_client(client); |
| 1674 | 1746 | ||
| 1675 | /* Register sysfs hooks */ | 1747 | /* Register sysfs hooks */ |
| 1676 | if ((err = sysfs_create_group(&new_client->dev.kobj, &adm1026_group))) | 1748 | if ((err = sysfs_create_group(&client->dev.kobj, &adm1026_group))) |
| 1677 | goto exitdetach; | 1749 | goto exitdetach; |
| 1750 | if (data->config1 & CFG1_AIN8_9) | ||
| 1751 | err = sysfs_create_group(&client->dev.kobj, | ||
| 1752 | &adm1026_group_in8_9); | ||
| 1753 | else | ||
| 1754 | err = sysfs_create_group(&client->dev.kobj, | ||
| 1755 | &adm1026_group_temp3); | ||
| 1756 | if (err) | ||
| 1757 | goto exitremove; | ||
| 1678 | 1758 | ||
| 1679 | data->hwmon_dev = hwmon_device_register(&new_client->dev); | 1759 | data->hwmon_dev = hwmon_device_register(&client->dev); |
| 1680 | if (IS_ERR(data->hwmon_dev)) { | 1760 | if (IS_ERR(data->hwmon_dev)) { |
| 1681 | err = PTR_ERR(data->hwmon_dev); | 1761 | err = PTR_ERR(data->hwmon_dev); |
| 1682 | goto exitremove; | 1762 | goto exitremove; |
| @@ -1686,9 +1766,13 @@ static int adm1026_detect(struct i2c_adapter *adapter, int address, | |||
| 1686 | 1766 | ||
| 1687 | /* Error out and cleanup code */ | 1767 | /* Error out and cleanup code */ |
| 1688 | exitremove: | 1768 | exitremove: |
| 1689 | sysfs_remove_group(&new_client->dev.kobj, &adm1026_group); | 1769 | sysfs_remove_group(&client->dev.kobj, &adm1026_group); |
| 1770 | if (data->config1 & CFG1_AIN8_9) | ||
| 1771 | sysfs_remove_group(&client->dev.kobj, &adm1026_group_in8_9); | ||
| 1772 | else | ||
| 1773 | sysfs_remove_group(&client->dev.kobj, &adm1026_group_temp3); | ||
| 1690 | exitdetach: | 1774 | exitdetach: |
| 1691 | i2c_detach_client(new_client); | 1775 | i2c_detach_client(client); |
| 1692 | exitfree: | 1776 | exitfree: |
| 1693 | kfree(data); | 1777 | kfree(data); |
| 1694 | exit: | 1778 | exit: |
| @@ -1700,6 +1784,10 @@ static int adm1026_detach_client(struct i2c_client *client) | |||
| 1700 | struct adm1026_data *data = i2c_get_clientdata(client); | 1784 | struct adm1026_data *data = i2c_get_clientdata(client); |
| 1701 | hwmon_device_unregister(data->hwmon_dev); | 1785 | hwmon_device_unregister(data->hwmon_dev); |
| 1702 | sysfs_remove_group(&client->dev.kobj, &adm1026_group); | 1786 | sysfs_remove_group(&client->dev.kobj, &adm1026_group); |
| 1787 | if (data->config1 & CFG1_AIN8_9) | ||
| 1788 | sysfs_remove_group(&client->dev.kobj, &adm1026_group_in8_9); | ||
| 1789 | else | ||
| 1790 | sysfs_remove_group(&client->dev.kobj, &adm1026_group_temp3); | ||
| 1703 | i2c_detach_client(client); | 1791 | i2c_detach_client(client); |
| 1704 | kfree(data); | 1792 | kfree(data); |
| 1705 | return 0; | 1793 | return 0; |
| @@ -1710,14 +1798,14 @@ static int __init sm_adm1026_init(void) | |||
| 1710 | return i2c_add_driver(&adm1026_driver); | 1798 | return i2c_add_driver(&adm1026_driver); |
| 1711 | } | 1799 | } |
| 1712 | 1800 | ||
| 1713 | static void __exit sm_adm1026_exit(void) | 1801 | static void __exit sm_adm1026_exit(void) |
| 1714 | { | 1802 | { |
| 1715 | i2c_del_driver(&adm1026_driver); | 1803 | i2c_del_driver(&adm1026_driver); |
| 1716 | } | 1804 | } |
| 1717 | 1805 | ||
| 1718 | MODULE_LICENSE("GPL"); | 1806 | MODULE_LICENSE("GPL"); |
| 1719 | MODULE_AUTHOR("Philip Pokorny <ppokorny@penguincomputing.com>, " | 1807 | MODULE_AUTHOR("Philip Pokorny <ppokorny@penguincomputing.com>, " |
| 1720 | "Justin Thiessen <jthiessen@penguincomputing.com>"); | 1808 | "Justin Thiessen <jthiessen@penguincomputing.com>"); |
| 1721 | MODULE_DESCRIPTION("ADM1026 driver"); | 1809 | MODULE_DESCRIPTION("ADM1026 driver"); |
| 1722 | 1810 | ||
| 1723 | module_init(sm_adm1026_init); | 1811 | module_init(sm_adm1026_init); |
diff --git a/drivers/hwmon/adm1031.c b/drivers/hwmon/adm1031.c index 37cfc101da5e..5aaad3636c98 100644 --- a/drivers/hwmon/adm1031.c +++ b/drivers/hwmon/adm1031.c | |||
| @@ -5,7 +5,7 @@ | |||
| 5 | Supports adm1030 / adm1031 | 5 | Supports adm1030 / adm1031 |
| 6 | Copyright (C) 2004 Alexandre d'Alton <alex@alexdalton.org> | 6 | Copyright (C) 2004 Alexandre d'Alton <alex@alexdalton.org> |
| 7 | Reworked by Jean Delvare <khali@linux-fr.org> | 7 | Reworked by Jean Delvare <khali@linux-fr.org> |
| 8 | 8 | ||
| 9 | This program is free software; you can redistribute it and/or modify | 9 | This program is free software; you can redistribute it and/or modify |
| 10 | it under the terms of the GNU General Public License as published by | 10 | it under the terms of the GNU General Public License as published by |
| 11 | the Free Software Foundation; either version 2 of the License, or | 11 | the Free Software Foundation; either version 2 of the License, or |
| @@ -27,27 +27,28 @@ | |||
| 27 | #include <linux/jiffies.h> | 27 | #include <linux/jiffies.h> |
| 28 | #include <linux/i2c.h> | 28 | #include <linux/i2c.h> |
| 29 | #include <linux/hwmon.h> | 29 | #include <linux/hwmon.h> |
| 30 | #include <linux/hwmon-sysfs.h> | ||
| 30 | #include <linux/err.h> | 31 | #include <linux/err.h> |
| 31 | #include <linux/mutex.h> | 32 | #include <linux/mutex.h> |
| 32 | 33 | ||
| 33 | /* Following macros takes channel parameter starting from 0 to 2 */ | 34 | /* Following macros takes channel parameter starting from 0 to 2 */ |
| 34 | #define ADM1031_REG_FAN_SPEED(nr) (0x08 + (nr)) | 35 | #define ADM1031_REG_FAN_SPEED(nr) (0x08 + (nr)) |
| 35 | #define ADM1031_REG_FAN_DIV(nr) (0x20 + (nr)) | 36 | #define ADM1031_REG_FAN_DIV(nr) (0x20 + (nr)) |
| 36 | #define ADM1031_REG_PWM (0x22) | 37 | #define ADM1031_REG_PWM (0x22) |
| 37 | #define ADM1031_REG_FAN_MIN(nr) (0x10 + (nr)) | 38 | #define ADM1031_REG_FAN_MIN(nr) (0x10 + (nr)) |
| 38 | 39 | ||
| 39 | #define ADM1031_REG_TEMP_MAX(nr) (0x14 + 4*(nr)) | 40 | #define ADM1031_REG_TEMP_MAX(nr) (0x14 + 4 * (nr)) |
| 40 | #define ADM1031_REG_TEMP_MIN(nr) (0x15 + 4*(nr)) | 41 | #define ADM1031_REG_TEMP_MIN(nr) (0x15 + 4 * (nr)) |
| 41 | #define ADM1031_REG_TEMP_CRIT(nr) (0x16 + 4*(nr)) | 42 | #define ADM1031_REG_TEMP_CRIT(nr) (0x16 + 4 * (nr)) |
| 42 | 43 | ||
| 43 | #define ADM1031_REG_TEMP(nr) (0xa + (nr)) | 44 | #define ADM1031_REG_TEMP(nr) (0x0a + (nr)) |
| 44 | #define ADM1031_REG_AUTO_TEMP(nr) (0x24 + (nr)) | 45 | #define ADM1031_REG_AUTO_TEMP(nr) (0x24 + (nr)) |
| 45 | 46 | ||
| 46 | #define ADM1031_REG_STATUS(nr) (0x2 + (nr)) | 47 | #define ADM1031_REG_STATUS(nr) (0x2 + (nr)) |
| 47 | 48 | ||
| 48 | #define ADM1031_REG_CONF1 0x0 | 49 | #define ADM1031_REG_CONF1 0x00 |
| 49 | #define ADM1031_REG_CONF2 0x1 | 50 | #define ADM1031_REG_CONF2 0x01 |
| 50 | #define ADM1031_REG_EXT_TEMP 0x6 | 51 | #define ADM1031_REG_EXT_TEMP 0x06 |
| 51 | 52 | ||
| 52 | #define ADM1031_CONF1_MONITOR_ENABLE 0x01 /* Monitoring enable */ | 53 | #define ADM1031_CONF1_MONITOR_ENABLE 0x01 /* Monitoring enable */ |
| 53 | #define ADM1031_CONF1_PWM_INVERT 0x08 /* PWM Invert */ | 54 | #define ADM1031_CONF1_PWM_INVERT 0x08 /* PWM Invert */ |
| @@ -78,7 +79,7 @@ struct adm1031_data { | |||
| 78 | /* The chan_select_table contains the possible configurations for | 79 | /* The chan_select_table contains the possible configurations for |
| 79 | * auto fan control. | 80 | * auto fan control. |
| 80 | */ | 81 | */ |
| 81 | auto_chan_table_t *chan_select_table; | 82 | const auto_chan_table_t *chan_select_table; |
| 82 | u16 alarm; | 83 | u16 alarm; |
| 83 | u8 conf1; | 84 | u8 conf1; |
| 84 | u8 conf2; | 85 | u8 conf2; |
| @@ -181,25 +182,25 @@ static int AUTO_TEMP_MAX_TO_REG(int val, int reg, int pwm) | |||
| 181 | #define GET_FAN_AUTO_BITFIELD(data, idx) \ | 182 | #define GET_FAN_AUTO_BITFIELD(data, idx) \ |
| 182 | (*(data)->chan_select_table)[FAN_CHAN_FROM_REG((data)->conf1)][idx%2] | 183 | (*(data)->chan_select_table)[FAN_CHAN_FROM_REG((data)->conf1)][idx%2] |
| 183 | 184 | ||
| 184 | /* The tables below contains the possible values for the auto fan | 185 | /* The tables below contains the possible values for the auto fan |
| 185 | * control bitfields. the index in the table is the register value. | 186 | * control bitfields. the index in the table is the register value. |
| 186 | * MSb is the auto fan control enable bit, so the four first entries | 187 | * MSb is the auto fan control enable bit, so the four first entries |
| 187 | * in the table disables auto fan control when both bitfields are zero. | 188 | * in the table disables auto fan control when both bitfields are zero. |
| 188 | */ | 189 | */ |
| 189 | static auto_chan_table_t auto_channel_select_table_adm1031 = { | 190 | static const auto_chan_table_t auto_channel_select_table_adm1031 = { |
| 190 | {0, 0}, {0, 0}, {0, 0}, {0, 0}, | 191 | { 0, 0 }, { 0, 0 }, { 0, 0 }, { 0, 0 }, |
| 191 | {2 /*0b010 */ , 4 /*0b100 */ }, | 192 | { 2 /* 0b010 */ , 4 /* 0b100 */ }, |
| 192 | {2 /*0b010 */ , 2 /*0b010 */ }, | 193 | { 2 /* 0b010 */ , 2 /* 0b010 */ }, |
| 193 | {4 /*0b100 */ , 4 /*0b100 */ }, | 194 | { 4 /* 0b100 */ , 4 /* 0b100 */ }, |
| 194 | {7 /*0b111 */ , 7 /*0b111 */ }, | 195 | { 7 /* 0b111 */ , 7 /* 0b111 */ }, |
| 195 | }; | 196 | }; |
| 196 | 197 | ||
| 197 | static auto_chan_table_t auto_channel_select_table_adm1030 = { | 198 | static const auto_chan_table_t auto_channel_select_table_adm1030 = { |
| 198 | {0, 0}, {0, 0}, {0, 0}, {0, 0}, | 199 | { 0, 0 }, { 0, 0 }, { 0, 0 }, { 0, 0 }, |
| 199 | {2 /*0b10 */ , 0}, | 200 | { 2 /* 0b10 */ , 0 }, |
| 200 | {0xff /*invalid */ , 0}, | 201 | { 0xff /* invalid */ , 0 }, |
| 201 | {0xff /*invalid */ , 0}, | 202 | { 0xff /* invalid */ , 0 }, |
| 202 | {3 /*0b11 */ , 0}, | 203 | { 3 /* 0b11 */ , 0 }, |
| 203 | }; | 204 | }; |
| 204 | 205 | ||
| 205 | /* That function checks if a bitfield is valid and returns the other bitfield | 206 | /* That function checks if a bitfield is valid and returns the other bitfield |
| @@ -228,8 +229,8 @@ get_fan_auto_nearest(struct adm1031_data *data, | |||
| 228 | break; | 229 | break; |
| 229 | } else if (val == (*data->chan_select_table)[i][chan] && | 230 | } else if (val == (*data->chan_select_table)[i][chan] && |
| 230 | first_match == -1) { | 231 | first_match == -1) { |
| 231 | /* Save the first match in case of an exact match has not been | 232 | /* Save the first match in case of an exact match has |
| 232 | * found | 233 | * not been found |
| 233 | */ | 234 | */ |
| 234 | first_match = i; | 235 | first_match = i; |
| 235 | } | 236 | } |
| @@ -245,17 +246,21 @@ get_fan_auto_nearest(struct adm1031_data *data, | |||
| 245 | return 0; | 246 | return 0; |
| 246 | } | 247 | } |
| 247 | 248 | ||
| 248 | static ssize_t show_fan_auto_channel(struct device *dev, char *buf, int nr) | 249 | static ssize_t show_fan_auto_channel(struct device *dev, |
| 250 | struct device_attribute *attr, char *buf) | ||
| 249 | { | 251 | { |
| 252 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 250 | struct adm1031_data *data = adm1031_update_device(dev); | 253 | struct adm1031_data *data = adm1031_update_device(dev); |
| 251 | return sprintf(buf, "%d\n", GET_FAN_AUTO_BITFIELD(data, nr)); | 254 | return sprintf(buf, "%d\n", GET_FAN_AUTO_BITFIELD(data, nr)); |
| 252 | } | 255 | } |
| 253 | 256 | ||
| 254 | static ssize_t | 257 | static ssize_t |
| 255 | set_fan_auto_channel(struct device *dev, const char *buf, size_t count, int nr) | 258 | set_fan_auto_channel(struct device *dev, struct device_attribute *attr, |
| 259 | const char *buf, size_t count) | ||
| 256 | { | 260 | { |
| 257 | struct i2c_client *client = to_i2c_client(dev); | 261 | struct i2c_client *client = to_i2c_client(dev); |
| 258 | struct adm1031_data *data = i2c_get_clientdata(client); | 262 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 263 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 259 | int val = simple_strtol(buf, NULL, 10); | 264 | int val = simple_strtol(buf, NULL, 10); |
| 260 | u8 reg; | 265 | u8 reg; |
| 261 | int ret; | 266 | int ret; |
| @@ -264,16 +269,17 @@ set_fan_auto_channel(struct device *dev, const char *buf, size_t count, int nr) | |||
| 264 | old_fan_mode = data->conf1; | 269 | old_fan_mode = data->conf1; |
| 265 | 270 | ||
| 266 | mutex_lock(&data->update_lock); | 271 | mutex_lock(&data->update_lock); |
| 267 | 272 | ||
| 268 | if ((ret = get_fan_auto_nearest(data, nr, val, data->conf1, ®))) { | 273 | if ((ret = get_fan_auto_nearest(data, nr, val, data->conf1, ®))) { |
| 269 | mutex_unlock(&data->update_lock); | 274 | mutex_unlock(&data->update_lock); |
| 270 | return ret; | 275 | return ret; |
| 271 | } | 276 | } |
| 272 | if (((data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1)) & ADM1031_CONF1_AUTO_MODE) ^ | 277 | data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1); |
| 278 | if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) ^ | ||
| 273 | (old_fan_mode & ADM1031_CONF1_AUTO_MODE)) { | 279 | (old_fan_mode & ADM1031_CONF1_AUTO_MODE)) { |
| 274 | if (data->conf1 & ADM1031_CONF1_AUTO_MODE){ | 280 | if (data->conf1 & ADM1031_CONF1_AUTO_MODE){ |
| 275 | /* Switch to Auto Fan Mode | 281 | /* Switch to Auto Fan Mode |
| 276 | * Save PWM registers | 282 | * Save PWM registers |
| 277 | * Set PWM registers to 33% Both */ | 283 | * Set PWM registers to 33% Both */ |
| 278 | data->old_pwm[0] = data->pwm[0]; | 284 | data->old_pwm[0] = data->pwm[0]; |
| 279 | data->old_pwm[1] = data->pwm[1]; | 285 | data->old_pwm[1] = data->pwm[1]; |
| @@ -283,7 +289,7 @@ set_fan_auto_channel(struct device *dev, const char *buf, size_t count, int nr) | |||
| 283 | data->pwm[0] = data->old_pwm[0]; | 289 | data->pwm[0] = data->old_pwm[0]; |
| 284 | data->pwm[1] = data->old_pwm[1]; | 290 | data->pwm[1] = data->old_pwm[1]; |
| 285 | /* Restore PWM registers */ | 291 | /* Restore PWM registers */ |
| 286 | adm1031_write_value(client, ADM1031_REG_PWM, | 292 | adm1031_write_value(client, ADM1031_REG_PWM, |
| 287 | data->pwm[0] | (data->pwm[1] << 4)); | 293 | data->pwm[0] | (data->pwm[1] << 4)); |
| 288 | } | 294 | } |
| 289 | } | 295 | } |
| @@ -293,41 +299,35 @@ set_fan_auto_channel(struct device *dev, const char *buf, size_t count, int nr) | |||
| 293 | return count; | 299 | return count; |
| 294 | } | 300 | } |
| 295 | 301 | ||
| 296 | #define fan_auto_channel_offset(offset) \ | 302 | static SENSOR_DEVICE_ATTR(auto_fan1_channel, S_IRUGO | S_IWUSR, |
| 297 | static ssize_t show_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ | 303 | show_fan_auto_channel, set_fan_auto_channel, 0); |
| 298 | { \ | 304 | static SENSOR_DEVICE_ATTR(auto_fan2_channel, S_IRUGO | S_IWUSR, |
| 299 | return show_fan_auto_channel(dev, buf, offset - 1); \ | 305 | show_fan_auto_channel, set_fan_auto_channel, 1); |
| 300 | } \ | ||
| 301 | static ssize_t set_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr, \ | ||
| 302 | const char *buf, size_t count) \ | ||
| 303 | { \ | ||
| 304 | return set_fan_auto_channel(dev, buf, count, offset - 1); \ | ||
| 305 | } \ | ||
| 306 | static DEVICE_ATTR(auto_fan##offset##_channel, S_IRUGO | S_IWUSR, \ | ||
| 307 | show_fan_auto_channel_##offset, \ | ||
| 308 | set_fan_auto_channel_##offset) | ||
| 309 | |||
| 310 | fan_auto_channel_offset(1); | ||
| 311 | fan_auto_channel_offset(2); | ||
| 312 | 306 | ||
| 313 | /* Auto Temps */ | 307 | /* Auto Temps */ |
| 314 | static ssize_t show_auto_temp_off(struct device *dev, char *buf, int nr) | 308 | static ssize_t show_auto_temp_off(struct device *dev, |
| 309 | struct device_attribute *attr, char *buf) | ||
| 315 | { | 310 | { |
| 311 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 316 | struct adm1031_data *data = adm1031_update_device(dev); | 312 | struct adm1031_data *data = adm1031_update_device(dev); |
| 317 | return sprintf(buf, "%d\n", | 313 | return sprintf(buf, "%d\n", |
| 318 | AUTO_TEMP_OFF_FROM_REG(data->auto_temp[nr])); | 314 | AUTO_TEMP_OFF_FROM_REG(data->auto_temp[nr])); |
| 319 | } | 315 | } |
| 320 | static ssize_t show_auto_temp_min(struct device *dev, char *buf, int nr) | 316 | static ssize_t show_auto_temp_min(struct device *dev, |
| 317 | struct device_attribute *attr, char *buf) | ||
| 321 | { | 318 | { |
| 319 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 322 | struct adm1031_data *data = adm1031_update_device(dev); | 320 | struct adm1031_data *data = adm1031_update_device(dev); |
| 323 | return sprintf(buf, "%d\n", | 321 | return sprintf(buf, "%d\n", |
| 324 | AUTO_TEMP_MIN_FROM_REG(data->auto_temp[nr])); | 322 | AUTO_TEMP_MIN_FROM_REG(data->auto_temp[nr])); |
| 325 | } | 323 | } |
| 326 | static ssize_t | 324 | static ssize_t |
| 327 | set_auto_temp_min(struct device *dev, const char *buf, size_t count, int nr) | 325 | set_auto_temp_min(struct device *dev, struct device_attribute *attr, |
| 326 | const char *buf, size_t count) | ||
| 328 | { | 327 | { |
| 329 | struct i2c_client *client = to_i2c_client(dev); | 328 | struct i2c_client *client = to_i2c_client(dev); |
| 330 | struct adm1031_data *data = i2c_get_clientdata(client); | 329 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 330 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 331 | int val = simple_strtol(buf, NULL, 10); | 331 | int val = simple_strtol(buf, NULL, 10); |
| 332 | 332 | ||
| 333 | mutex_lock(&data->update_lock); | 333 | mutex_lock(&data->update_lock); |
| @@ -337,17 +337,21 @@ set_auto_temp_min(struct device *dev, const char *buf, size_t count, int nr) | |||
| 337 | mutex_unlock(&data->update_lock); | 337 | mutex_unlock(&data->update_lock); |
| 338 | return count; | 338 | return count; |
| 339 | } | 339 | } |
| 340 | static ssize_t show_auto_temp_max(struct device *dev, char *buf, int nr) | 340 | static ssize_t show_auto_temp_max(struct device *dev, |
| 341 | struct device_attribute *attr, char *buf) | ||
| 341 | { | 342 | { |
| 343 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 342 | struct adm1031_data *data = adm1031_update_device(dev); | 344 | struct adm1031_data *data = adm1031_update_device(dev); |
| 343 | return sprintf(buf, "%d\n", | 345 | return sprintf(buf, "%d\n", |
| 344 | AUTO_TEMP_MAX_FROM_REG(data->auto_temp[nr])); | 346 | AUTO_TEMP_MAX_FROM_REG(data->auto_temp[nr])); |
| 345 | } | 347 | } |
| 346 | static ssize_t | 348 | static ssize_t |
| 347 | set_auto_temp_max(struct device *dev, const char *buf, size_t count, int nr) | 349 | set_auto_temp_max(struct device *dev, struct device_attribute *attr, |
| 350 | const char *buf, size_t count) | ||
| 348 | { | 351 | { |
| 349 | struct i2c_client *client = to_i2c_client(dev); | 352 | struct i2c_client *client = to_i2c_client(dev); |
| 350 | struct adm1031_data *data = i2c_get_clientdata(client); | 353 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 354 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 351 | int val = simple_strtol(buf, NULL, 10); | 355 | int val = simple_strtol(buf, NULL, 10); |
| 352 | 356 | ||
| 353 | mutex_lock(&data->update_lock); | 357 | mutex_lock(&data->update_lock); |
| @@ -358,56 +362,37 @@ set_auto_temp_max(struct device *dev, const char *buf, size_t count, int nr) | |||
| 358 | return count; | 362 | return count; |
| 359 | } | 363 | } |
| 360 | 364 | ||
| 361 | #define auto_temp_reg(offset) \ | 365 | #define auto_temp_reg(offset) \ |
| 362 | static ssize_t show_auto_temp_##offset##_off (struct device *dev, struct device_attribute *attr, char *buf) \ | 366 | static SENSOR_DEVICE_ATTR(auto_temp##offset##_off, S_IRUGO, \ |
| 363 | { \ | 367 | show_auto_temp_off, NULL, offset - 1); \ |
| 364 | return show_auto_temp_off(dev, buf, offset - 1); \ | 368 | static SENSOR_DEVICE_ATTR(auto_temp##offset##_min, S_IRUGO | S_IWUSR, \ |
| 365 | } \ | 369 | show_auto_temp_min, set_auto_temp_min, offset - 1); \ |
| 366 | static ssize_t show_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \ | 370 | static SENSOR_DEVICE_ATTR(auto_temp##offset##_max, S_IRUGO | S_IWUSR, \ |
| 367 | { \ | 371 | show_auto_temp_max, set_auto_temp_max, offset - 1) |
| 368 | return show_auto_temp_min(dev, buf, offset - 1); \ | ||
| 369 | } \ | ||
| 370 | static ssize_t show_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf) \ | ||
| 371 | { \ | ||
| 372 | return show_auto_temp_max(dev, buf, offset - 1); \ | ||
| 373 | } \ | ||
| 374 | static ssize_t set_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr, \ | ||
| 375 | const char *buf, size_t count) \ | ||
| 376 | { \ | ||
| 377 | return set_auto_temp_min(dev, buf, count, offset - 1); \ | ||
| 378 | } \ | ||
| 379 | static ssize_t set_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr, \ | ||
| 380 | const char *buf, size_t count) \ | ||
| 381 | { \ | ||
| 382 | return set_auto_temp_max(dev, buf, count, offset - 1); \ | ||
| 383 | } \ | ||
| 384 | static DEVICE_ATTR(auto_temp##offset##_off, S_IRUGO, \ | ||
| 385 | show_auto_temp_##offset##_off, NULL); \ | ||
| 386 | static DEVICE_ATTR(auto_temp##offset##_min, S_IRUGO | S_IWUSR, \ | ||
| 387 | show_auto_temp_##offset##_min, set_auto_temp_##offset##_min);\ | ||
| 388 | static DEVICE_ATTR(auto_temp##offset##_max, S_IRUGO | S_IWUSR, \ | ||
| 389 | show_auto_temp_##offset##_max, set_auto_temp_##offset##_max) | ||
| 390 | 372 | ||
| 391 | auto_temp_reg(1); | 373 | auto_temp_reg(1); |
| 392 | auto_temp_reg(2); | 374 | auto_temp_reg(2); |
| 393 | auto_temp_reg(3); | 375 | auto_temp_reg(3); |
| 394 | 376 | ||
| 395 | /* pwm */ | 377 | /* pwm */ |
| 396 | static ssize_t show_pwm(struct device *dev, char *buf, int nr) | 378 | static ssize_t show_pwm(struct device *dev, |
| 379 | struct device_attribute *attr, char *buf) | ||
| 397 | { | 380 | { |
| 381 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 398 | struct adm1031_data *data = adm1031_update_device(dev); | 382 | struct adm1031_data *data = adm1031_update_device(dev); |
| 399 | return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr])); | 383 | return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr])); |
| 400 | } | 384 | } |
| 401 | static ssize_t | 385 | static ssize_t set_pwm(struct device *dev, struct device_attribute *attr, |
| 402 | set_pwm(struct device *dev, const char *buf, size_t count, int nr) | 386 | const char *buf, size_t count) |
| 403 | { | 387 | { |
| 404 | struct i2c_client *client = to_i2c_client(dev); | 388 | struct i2c_client *client = to_i2c_client(dev); |
| 405 | struct adm1031_data *data = i2c_get_clientdata(client); | 389 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 390 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 406 | int val = simple_strtol(buf, NULL, 10); | 391 | int val = simple_strtol(buf, NULL, 10); |
| 407 | int reg; | 392 | int reg; |
| 408 | 393 | ||
| 409 | mutex_lock(&data->update_lock); | 394 | mutex_lock(&data->update_lock); |
| 410 | if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) && | 395 | if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) && |
| 411 | (((val>>4) & 0xf) != 5)) { | 396 | (((val>>4) & 0xf) != 5)) { |
| 412 | /* In automatic mode, the only PWM accepted is 33% */ | 397 | /* In automatic mode, the only PWM accepted is 33% */ |
| 413 | mutex_unlock(&data->update_lock); | 398 | mutex_unlock(&data->update_lock); |
| @@ -422,21 +407,12 @@ set_pwm(struct device *dev, const char *buf, size_t count, int nr) | |||
| 422 | return count; | 407 | return count; |
| 423 | } | 408 | } |
| 424 | 409 | ||
| 425 | #define pwm_reg(offset) \ | 410 | static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_pwm, set_pwm, 0); |
| 426 | static ssize_t show_pwm_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ | 411 | static SENSOR_DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR, show_pwm, set_pwm, 1); |
| 427 | { \ | 412 | static SENSOR_DEVICE_ATTR(auto_fan1_min_pwm, S_IRUGO | S_IWUSR, |
| 428 | return show_pwm(dev, buf, offset - 1); \ | 413 | show_pwm, set_pwm, 0); |
| 429 | } \ | 414 | static SENSOR_DEVICE_ATTR(auto_fan2_min_pwm, S_IRUGO | S_IWUSR, |
| 430 | static ssize_t set_pwm_##offset (struct device *dev, struct device_attribute *attr, \ | 415 | show_pwm, set_pwm, 1); |
| 431 | const char *buf, size_t count) \ | ||
| 432 | { \ | ||
| 433 | return set_pwm(dev, buf, count, offset - 1); \ | ||
| 434 | } \ | ||
| 435 | static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR, \ | ||
| 436 | show_pwm_##offset, set_pwm_##offset) | ||
| 437 | |||
| 438 | pwm_reg(1); | ||
| 439 | pwm_reg(2); | ||
| 440 | 416 | ||
| 441 | /* Fans */ | 417 | /* Fans */ |
| 442 | 418 | ||
| @@ -471,7 +447,7 @@ static int trust_fan_readings(struct adm1031_data *data, int chan) | |||
| 471 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[0]) | 447 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[0]) |
| 472 | || data->temp[1] >= | 448 | || data->temp[1] >= |
| 473 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]) | 449 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]) |
| 474 | || (data->chip_type == adm1031 | 450 | || (data->chip_type == adm1031 |
| 475 | && data->temp[2] >= | 451 | && data->temp[2] >= |
| 476 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2])); | 452 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2])); |
| 477 | break; | 453 | break; |
| @@ -483,8 +459,10 @@ static int trust_fan_readings(struct adm1031_data *data, int chan) | |||
| 483 | } | 459 | } |
| 484 | 460 | ||
| 485 | 461 | ||
| 486 | static ssize_t show_fan(struct device *dev, char *buf, int nr) | 462 | static ssize_t show_fan(struct device *dev, |
| 463 | struct device_attribute *attr, char *buf) | ||
| 487 | { | 464 | { |
| 465 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 488 | struct adm1031_data *data = adm1031_update_device(dev); | 466 | struct adm1031_data *data = adm1031_update_device(dev); |
| 489 | int value; | 467 | int value; |
| 490 | 468 | ||
| @@ -493,28 +471,33 @@ static ssize_t show_fan(struct device *dev, char *buf, int nr) | |||
| 493 | return sprintf(buf, "%d\n", value); | 471 | return sprintf(buf, "%d\n", value); |
| 494 | } | 472 | } |
| 495 | 473 | ||
| 496 | static ssize_t show_fan_div(struct device *dev, char *buf, int nr) | 474 | static ssize_t show_fan_div(struct device *dev, |
| 475 | struct device_attribute *attr, char *buf) | ||
| 497 | { | 476 | { |
| 477 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 498 | struct adm1031_data *data = adm1031_update_device(dev); | 478 | struct adm1031_data *data = adm1031_update_device(dev); |
| 499 | return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[nr])); | 479 | return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[nr])); |
| 500 | } | 480 | } |
| 501 | static ssize_t show_fan_min(struct device *dev, char *buf, int nr) | 481 | static ssize_t show_fan_min(struct device *dev, |
| 482 | struct device_attribute *attr, char *buf) | ||
| 502 | { | 483 | { |
| 484 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 503 | struct adm1031_data *data = adm1031_update_device(dev); | 485 | struct adm1031_data *data = adm1031_update_device(dev); |
| 504 | return sprintf(buf, "%d\n", | 486 | return sprintf(buf, "%d\n", |
| 505 | FAN_FROM_REG(data->fan_min[nr], | 487 | FAN_FROM_REG(data->fan_min[nr], |
| 506 | FAN_DIV_FROM_REG(data->fan_div[nr]))); | 488 | FAN_DIV_FROM_REG(data->fan_div[nr]))); |
| 507 | } | 489 | } |
| 508 | static ssize_t | 490 | static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr, |
| 509 | set_fan_min(struct device *dev, const char *buf, size_t count, int nr) | 491 | const char *buf, size_t count) |
| 510 | { | 492 | { |
| 511 | struct i2c_client *client = to_i2c_client(dev); | 493 | struct i2c_client *client = to_i2c_client(dev); |
| 512 | struct adm1031_data *data = i2c_get_clientdata(client); | 494 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 495 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 513 | int val = simple_strtol(buf, NULL, 10); | 496 | int val = simple_strtol(buf, NULL, 10); |
| 514 | 497 | ||
| 515 | mutex_lock(&data->update_lock); | 498 | mutex_lock(&data->update_lock); |
| 516 | if (val) { | 499 | if (val) { |
| 517 | data->fan_min[nr] = | 500 | data->fan_min[nr] = |
| 518 | FAN_TO_REG(val, FAN_DIV_FROM_REG(data->fan_div[nr])); | 501 | FAN_TO_REG(val, FAN_DIV_FROM_REG(data->fan_div[nr])); |
| 519 | } else { | 502 | } else { |
| 520 | data->fan_min[nr] = 0xff; | 503 | data->fan_min[nr] = 0xff; |
| @@ -523,11 +506,12 @@ set_fan_min(struct device *dev, const char *buf, size_t count, int nr) | |||
| 523 | mutex_unlock(&data->update_lock); | 506 | mutex_unlock(&data->update_lock); |
| 524 | return count; | 507 | return count; |
| 525 | } | 508 | } |
| 526 | static ssize_t | 509 | static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, |
| 527 | set_fan_div(struct device *dev, const char *buf, size_t count, int nr) | 510 | const char *buf, size_t count) |
| 528 | { | 511 | { |
| 529 | struct i2c_client *client = to_i2c_client(dev); | 512 | struct i2c_client *client = to_i2c_client(dev); |
| 530 | struct adm1031_data *data = i2c_get_clientdata(client); | 513 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 514 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 531 | int val = simple_strtol(buf, NULL, 10); | 515 | int val = simple_strtol(buf, NULL, 10); |
| 532 | u8 tmp; | 516 | u8 tmp; |
| 533 | int old_div; | 517 | int old_div; |
| @@ -535,68 +519,53 @@ set_fan_div(struct device *dev, const char *buf, size_t count, int nr) | |||
| 535 | 519 | ||
| 536 | tmp = val == 8 ? 0xc0 : | 520 | tmp = val == 8 ? 0xc0 : |
| 537 | val == 4 ? 0x80 : | 521 | val == 4 ? 0x80 : |
| 538 | val == 2 ? 0x40 : | 522 | val == 2 ? 0x40 : |
| 539 | val == 1 ? 0x00 : | 523 | val == 1 ? 0x00 : |
| 540 | 0xff; | 524 | 0xff; |
| 541 | if (tmp == 0xff) | 525 | if (tmp == 0xff) |
| 542 | return -EINVAL; | 526 | return -EINVAL; |
| 543 | 527 | ||
| 544 | mutex_lock(&data->update_lock); | 528 | mutex_lock(&data->update_lock); |
| 529 | /* Get fresh readings */ | ||
| 530 | data->fan_div[nr] = adm1031_read_value(client, | ||
| 531 | ADM1031_REG_FAN_DIV(nr)); | ||
| 532 | data->fan_min[nr] = adm1031_read_value(client, | ||
| 533 | ADM1031_REG_FAN_MIN(nr)); | ||
| 534 | |||
| 535 | /* Write the new clock divider and fan min */ | ||
| 545 | old_div = FAN_DIV_FROM_REG(data->fan_div[nr]); | 536 | old_div = FAN_DIV_FROM_REG(data->fan_div[nr]); |
| 546 | data->fan_div[nr] = (tmp & 0xC0) | (0x3f & data->fan_div[nr]); | 537 | data->fan_div[nr] = tmp | (0x3f & data->fan_div[nr]); |
| 547 | new_min = data->fan_min[nr] * old_div / | 538 | new_min = data->fan_min[nr] * old_div / val; |
| 548 | FAN_DIV_FROM_REG(data->fan_div[nr]); | ||
| 549 | data->fan_min[nr] = new_min > 0xff ? 0xff : new_min; | 539 | data->fan_min[nr] = new_min > 0xff ? 0xff : new_min; |
| 550 | data->fan[nr] = data->fan[nr] * old_div / | ||
| 551 | FAN_DIV_FROM_REG(data->fan_div[nr]); | ||
| 552 | 540 | ||
| 553 | adm1031_write_value(client, ADM1031_REG_FAN_DIV(nr), | 541 | adm1031_write_value(client, ADM1031_REG_FAN_DIV(nr), |
| 554 | data->fan_div[nr]); | 542 | data->fan_div[nr]); |
| 555 | adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), | 543 | adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), |
| 556 | data->fan_min[nr]); | 544 | data->fan_min[nr]); |
| 545 | |||
| 546 | /* Invalidate the cache: fan speed is no longer valid */ | ||
| 547 | data->valid = 0; | ||
| 557 | mutex_unlock(&data->update_lock); | 548 | mutex_unlock(&data->update_lock); |
| 558 | return count; | 549 | return count; |
| 559 | } | 550 | } |
| 560 | 551 | ||
| 561 | #define fan_offset(offset) \ | 552 | #define fan_offset(offset) \ |
| 562 | static ssize_t show_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ | 553 | static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, \ |
| 563 | { \ | 554 | show_fan, NULL, offset - 1); \ |
| 564 | return show_fan(dev, buf, offset - 1); \ | 555 | static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \ |
| 565 | } \ | 556 | show_fan_min, set_fan_min, offset - 1); \ |
| 566 | static ssize_t show_fan_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \ | 557 | static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \ |
| 567 | { \ | 558 | show_fan_div, set_fan_div, offset - 1) |
| 568 | return show_fan_min(dev, buf, offset - 1); \ | ||
| 569 | } \ | ||
| 570 | static ssize_t show_fan_##offset##_div (struct device *dev, struct device_attribute *attr, char *buf) \ | ||
| 571 | { \ | ||
| 572 | return show_fan_div(dev, buf, offset - 1); \ | ||
| 573 | } \ | ||
| 574 | static ssize_t set_fan_##offset##_min (struct device *dev, struct device_attribute *attr, \ | ||
| 575 | const char *buf, size_t count) \ | ||
| 576 | { \ | ||
| 577 | return set_fan_min(dev, buf, count, offset - 1); \ | ||
| 578 | } \ | ||
| 579 | static ssize_t set_fan_##offset##_div (struct device *dev, struct device_attribute *attr, \ | ||
| 580 | const char *buf, size_t count) \ | ||
| 581 | { \ | ||
| 582 | return set_fan_div(dev, buf, count, offset - 1); \ | ||
| 583 | } \ | ||
| 584 | static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan_##offset, \ | ||
| 585 | NULL); \ | ||
| 586 | static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \ | ||
| 587 | show_fan_##offset##_min, set_fan_##offset##_min); \ | ||
| 588 | static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \ | ||
| 589 | show_fan_##offset##_div, set_fan_##offset##_div); \ | ||
| 590 | static DEVICE_ATTR(auto_fan##offset##_min_pwm, S_IRUGO | S_IWUSR, \ | ||
| 591 | show_pwm_##offset, set_pwm_##offset) | ||
| 592 | 559 | ||
| 593 | fan_offset(1); | 560 | fan_offset(1); |
| 594 | fan_offset(2); | 561 | fan_offset(2); |
| 595 | 562 | ||
| 596 | 563 | ||
| 597 | /* Temps */ | 564 | /* Temps */ |
| 598 | static ssize_t show_temp(struct device *dev, char *buf, int nr) | 565 | static ssize_t show_temp(struct device *dev, |
| 566 | struct device_attribute *attr, char *buf) | ||
| 599 | { | 567 | { |
| 568 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 600 | struct adm1031_data *data = adm1031_update_device(dev); | 569 | struct adm1031_data *data = adm1031_update_device(dev); |
| 601 | int ext; | 570 | int ext; |
| 602 | ext = nr == 0 ? | 571 | ext = nr == 0 ? |
| @@ -604,26 +573,33 @@ static ssize_t show_temp(struct device *dev, char *buf, int nr) | |||
| 604 | (((data->ext_temp[nr] >> ((nr - 1) * 3)) & 7)); | 573 | (((data->ext_temp[nr] >> ((nr - 1) * 3)) & 7)); |
| 605 | return sprintf(buf, "%d\n", TEMP_FROM_REG_EXT(data->temp[nr], ext)); | 574 | return sprintf(buf, "%d\n", TEMP_FROM_REG_EXT(data->temp[nr], ext)); |
| 606 | } | 575 | } |
| 607 | static ssize_t show_temp_min(struct device *dev, char *buf, int nr) | 576 | static ssize_t show_temp_min(struct device *dev, |
| 577 | struct device_attribute *attr, char *buf) | ||
| 608 | { | 578 | { |
| 579 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 609 | struct adm1031_data *data = adm1031_update_device(dev); | 580 | struct adm1031_data *data = adm1031_update_device(dev); |
| 610 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr])); | 581 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr])); |
| 611 | } | 582 | } |
| 612 | static ssize_t show_temp_max(struct device *dev, char *buf, int nr) | 583 | static ssize_t show_temp_max(struct device *dev, |
| 584 | struct device_attribute *attr, char *buf) | ||
| 613 | { | 585 | { |
| 586 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 614 | struct adm1031_data *data = adm1031_update_device(dev); | 587 | struct adm1031_data *data = adm1031_update_device(dev); |
| 615 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr])); | 588 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr])); |
| 616 | } | 589 | } |
| 617 | static ssize_t show_temp_crit(struct device *dev, char *buf, int nr) | 590 | static ssize_t show_temp_crit(struct device *dev, |
| 591 | struct device_attribute *attr, char *buf) | ||
| 618 | { | 592 | { |
| 593 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 619 | struct adm1031_data *data = adm1031_update_device(dev); | 594 | struct adm1031_data *data = adm1031_update_device(dev); |
| 620 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[nr])); | 595 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[nr])); |
| 621 | } | 596 | } |
| 622 | static ssize_t | 597 | static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr, |
| 623 | set_temp_min(struct device *dev, const char *buf, size_t count, int nr) | 598 | const char *buf, size_t count) |
| 624 | { | 599 | { |
| 625 | struct i2c_client *client = to_i2c_client(dev); | 600 | struct i2c_client *client = to_i2c_client(dev); |
| 626 | struct adm1031_data *data = i2c_get_clientdata(client); | 601 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 602 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 627 | int val; | 603 | int val; |
| 628 | 604 | ||
| 629 | val = simple_strtol(buf, NULL, 10); | 605 | val = simple_strtol(buf, NULL, 10); |
| @@ -635,11 +611,12 @@ set_temp_min(struct device *dev, const char *buf, size_t count, int nr) | |||
| 635 | mutex_unlock(&data->update_lock); | 611 | mutex_unlock(&data->update_lock); |
| 636 | return count; | 612 | return count; |
| 637 | } | 613 | } |
| 638 | static ssize_t | 614 | static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr, |
| 639 | set_temp_max(struct device *dev, const char *buf, size_t count, int nr) | 615 | const char *buf, size_t count) |
| 640 | { | 616 | { |
| 641 | struct i2c_client *client = to_i2c_client(dev); | 617 | struct i2c_client *client = to_i2c_client(dev); |
| 642 | struct adm1031_data *data = i2c_get_clientdata(client); | 618 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 619 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 643 | int val; | 620 | int val; |
| 644 | 621 | ||
| 645 | val = simple_strtol(buf, NULL, 10); | 622 | val = simple_strtol(buf, NULL, 10); |
| @@ -651,11 +628,12 @@ set_temp_max(struct device *dev, const char *buf, size_t count, int nr) | |||
| 651 | mutex_unlock(&data->update_lock); | 628 | mutex_unlock(&data->update_lock); |
| 652 | return count; | 629 | return count; |
| 653 | } | 630 | } |
| 654 | static ssize_t | 631 | static ssize_t set_temp_crit(struct device *dev, struct device_attribute *attr, |
| 655 | set_temp_crit(struct device *dev, const char *buf, size_t count, int nr) | 632 | const char *buf, size_t count) |
| 656 | { | 633 | { |
| 657 | struct i2c_client *client = to_i2c_client(dev); | 634 | struct i2c_client *client = to_i2c_client(dev); |
| 658 | struct adm1031_data *data = i2c_get_clientdata(client); | 635 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 636 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 659 | int val; | 637 | int val; |
| 660 | 638 | ||
| 661 | val = simple_strtol(buf, NULL, 10); | 639 | val = simple_strtol(buf, NULL, 10); |
| @@ -668,46 +646,15 @@ set_temp_crit(struct device *dev, const char *buf, size_t count, int nr) | |||
| 668 | return count; | 646 | return count; |
| 669 | } | 647 | } |
| 670 | 648 | ||
| 671 | #define temp_reg(offset) \ | 649 | #define temp_reg(offset) \ |
| 672 | static ssize_t show_temp_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ | 650 | static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, \ |
| 673 | { \ | 651 | show_temp, NULL, offset - 1); \ |
| 674 | return show_temp(dev, buf, offset - 1); \ | 652 | static SENSOR_DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR, \ |
| 675 | } \ | 653 | show_temp_min, set_temp_min, offset - 1); \ |
| 676 | static ssize_t show_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \ | 654 | static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \ |
| 677 | { \ | 655 | show_temp_max, set_temp_max, offset - 1); \ |
| 678 | return show_temp_min(dev, buf, offset - 1); \ | 656 | static SENSOR_DEVICE_ATTR(temp##offset##_crit, S_IRUGO | S_IWUSR, \ |
| 679 | } \ | 657 | show_temp_crit, set_temp_crit, offset - 1) |
| 680 | static ssize_t show_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf) \ | ||
| 681 | { \ | ||
| 682 | return show_temp_max(dev, buf, offset - 1); \ | ||
| 683 | } \ | ||
| 684 | static ssize_t show_temp_##offset##_crit (struct device *dev, struct device_attribute *attr, char *buf) \ | ||
| 685 | { \ | ||
| 686 | return show_temp_crit(dev, buf, offset - 1); \ | ||
| 687 | } \ | ||
| 688 | static ssize_t set_temp_##offset##_min (struct device *dev, struct device_attribute *attr, \ | ||
| 689 | const char *buf, size_t count) \ | ||
| 690 | { \ | ||
| 691 | return set_temp_min(dev, buf, count, offset - 1); \ | ||
| 692 | } \ | ||
| 693 | static ssize_t set_temp_##offset##_max (struct device *dev, struct device_attribute *attr, \ | ||
| 694 | const char *buf, size_t count) \ | ||
| 695 | { \ | ||
| 696 | return set_temp_max(dev, buf, count, offset - 1); \ | ||
| 697 | } \ | ||
| 698 | static ssize_t set_temp_##offset##_crit (struct device *dev, struct device_attribute *attr, \ | ||
| 699 | const char *buf, size_t count) \ | ||
| 700 | { \ | ||
| 701 | return set_temp_crit(dev, buf, count, offset - 1); \ | ||
| 702 | } \ | ||
| 703 | static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp_##offset, \ | ||
| 704 | NULL); \ | ||
| 705 | static DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR, \ | ||
| 706 | show_temp_##offset##_min, set_temp_##offset##_min); \ | ||
| 707 | static DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \ | ||
| 708 | show_temp_##offset##_max, set_temp_##offset##_max); \ | ||
| 709 | static DEVICE_ATTR(temp##offset##_crit, S_IRUGO | S_IWUSR, \ | ||
| 710 | show_temp_##offset##_crit, set_temp_##offset##_crit) | ||
| 711 | 658 | ||
| 712 | temp_reg(1); | 659 | temp_reg(1); |
| 713 | temp_reg(2); | 660 | temp_reg(2); |
| @@ -722,6 +669,29 @@ static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, ch | |||
| 722 | 669 | ||
| 723 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); | 670 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); |
| 724 | 671 | ||
| 672 | static ssize_t show_alarm(struct device *dev, | ||
| 673 | struct device_attribute *attr, char *buf) | ||
| 674 | { | ||
| 675 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 676 | struct adm1031_data *data = adm1031_update_device(dev); | ||
| 677 | return sprintf(buf, "%d\n", (data->alarm >> bitnr) & 1); | ||
| 678 | } | ||
| 679 | |||
| 680 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 0); | ||
| 681 | static SENSOR_DEVICE_ATTR(fan1_fault, S_IRUGO, show_alarm, NULL, 1); | ||
| 682 | static SENSOR_DEVICE_ATTR(temp2_max_alarm, S_IRUGO, show_alarm, NULL, 2); | ||
| 683 | static SENSOR_DEVICE_ATTR(temp2_min_alarm, S_IRUGO, show_alarm, NULL, 3); | ||
| 684 | static SENSOR_DEVICE_ATTR(temp2_crit_alarm, S_IRUGO, show_alarm, NULL, 4); | ||
| 685 | static SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_alarm, NULL, 5); | ||
| 686 | static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL, 6); | ||
| 687 | static SENSOR_DEVICE_ATTR(temp1_min_alarm, S_IRUGO, show_alarm, NULL, 7); | ||
| 688 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 8); | ||
| 689 | static SENSOR_DEVICE_ATTR(fan2_fault, S_IRUGO, show_alarm, NULL, 9); | ||
| 690 | static SENSOR_DEVICE_ATTR(temp3_max_alarm, S_IRUGO, show_alarm, NULL, 10); | ||
| 691 | static SENSOR_DEVICE_ATTR(temp3_min_alarm, S_IRUGO, show_alarm, NULL, 11); | ||
| 692 | static SENSOR_DEVICE_ATTR(temp3_crit_alarm, S_IRUGO, show_alarm, NULL, 12); | ||
| 693 | static SENSOR_DEVICE_ATTR(temp3_fault, S_IRUGO, show_alarm, NULL, 13); | ||
| 694 | static SENSOR_DEVICE_ATTR(temp1_crit_alarm, S_IRUGO, show_alarm, NULL, 14); | ||
| 725 | 695 | ||
| 726 | static int adm1031_attach_adapter(struct i2c_adapter *adapter) | 696 | static int adm1031_attach_adapter(struct i2c_adapter *adapter) |
| 727 | { | 697 | { |
| @@ -731,29 +701,38 @@ static int adm1031_attach_adapter(struct i2c_adapter *adapter) | |||
| 731 | } | 701 | } |
| 732 | 702 | ||
| 733 | static struct attribute *adm1031_attributes[] = { | 703 | static struct attribute *adm1031_attributes[] = { |
| 734 | &dev_attr_fan1_input.attr, | 704 | &sensor_dev_attr_fan1_input.dev_attr.attr, |
| 735 | &dev_attr_fan1_div.attr, | 705 | &sensor_dev_attr_fan1_div.dev_attr.attr, |
| 736 | &dev_attr_fan1_min.attr, | 706 | &sensor_dev_attr_fan1_min.dev_attr.attr, |
| 737 | &dev_attr_pwm1.attr, | 707 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, |
| 738 | &dev_attr_auto_fan1_channel.attr, | 708 | &sensor_dev_attr_fan1_fault.dev_attr.attr, |
| 739 | &dev_attr_temp1_input.attr, | 709 | &sensor_dev_attr_pwm1.dev_attr.attr, |
| 740 | &dev_attr_temp1_min.attr, | 710 | &sensor_dev_attr_auto_fan1_channel.dev_attr.attr, |
| 741 | &dev_attr_temp1_max.attr, | 711 | &sensor_dev_attr_temp1_input.dev_attr.attr, |
| 742 | &dev_attr_temp1_crit.attr, | 712 | &sensor_dev_attr_temp1_min.dev_attr.attr, |
| 743 | &dev_attr_temp2_input.attr, | 713 | &sensor_dev_attr_temp1_min_alarm.dev_attr.attr, |
| 744 | &dev_attr_temp2_min.attr, | 714 | &sensor_dev_attr_temp1_max.dev_attr.attr, |
| 745 | &dev_attr_temp2_max.attr, | 715 | &sensor_dev_attr_temp1_max_alarm.dev_attr.attr, |
| 746 | &dev_attr_temp2_crit.attr, | 716 | &sensor_dev_attr_temp1_crit.dev_attr.attr, |
| 747 | 717 | &sensor_dev_attr_temp1_crit_alarm.dev_attr.attr, | |
| 748 | &dev_attr_auto_temp1_off.attr, | 718 | &sensor_dev_attr_temp2_input.dev_attr.attr, |
| 749 | &dev_attr_auto_temp1_min.attr, | 719 | &sensor_dev_attr_temp2_min.dev_attr.attr, |
| 750 | &dev_attr_auto_temp1_max.attr, | 720 | &sensor_dev_attr_temp2_min_alarm.dev_attr.attr, |
| 751 | 721 | &sensor_dev_attr_temp2_max.dev_attr.attr, | |
| 752 | &dev_attr_auto_temp2_off.attr, | 722 | &sensor_dev_attr_temp2_max_alarm.dev_attr.attr, |
| 753 | &dev_attr_auto_temp2_min.attr, | 723 | &sensor_dev_attr_temp2_crit.dev_attr.attr, |
| 754 | &dev_attr_auto_temp2_max.attr, | 724 | &sensor_dev_attr_temp2_crit_alarm.dev_attr.attr, |
| 755 | 725 | &sensor_dev_attr_temp2_fault.dev_attr.attr, | |
| 756 | &dev_attr_auto_fan1_min_pwm.attr, | 726 | |
| 727 | &sensor_dev_attr_auto_temp1_off.dev_attr.attr, | ||
| 728 | &sensor_dev_attr_auto_temp1_min.dev_attr.attr, | ||
| 729 | &sensor_dev_attr_auto_temp1_max.dev_attr.attr, | ||
| 730 | |||
| 731 | &sensor_dev_attr_auto_temp2_off.dev_attr.attr, | ||
| 732 | &sensor_dev_attr_auto_temp2_min.dev_attr.attr, | ||
| 733 | &sensor_dev_attr_auto_temp2_max.dev_attr.attr, | ||
| 734 | |||
| 735 | &sensor_dev_attr_auto_fan1_min_pwm.dev_attr.attr, | ||
| 757 | 736 | ||
| 758 | &dev_attr_alarms.attr, | 737 | &dev_attr_alarms.attr, |
| 759 | 738 | ||
| @@ -765,19 +744,25 @@ static const struct attribute_group adm1031_group = { | |||
| 765 | }; | 744 | }; |
| 766 | 745 | ||
| 767 | static struct attribute *adm1031_attributes_opt[] = { | 746 | static struct attribute *adm1031_attributes_opt[] = { |
| 768 | &dev_attr_fan2_input.attr, | 747 | &sensor_dev_attr_fan2_input.dev_attr.attr, |
| 769 | &dev_attr_fan2_div.attr, | 748 | &sensor_dev_attr_fan2_div.dev_attr.attr, |
| 770 | &dev_attr_fan2_min.attr, | 749 | &sensor_dev_attr_fan2_min.dev_attr.attr, |
| 771 | &dev_attr_pwm2.attr, | 750 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, |
| 772 | &dev_attr_auto_fan2_channel.attr, | 751 | &sensor_dev_attr_fan2_fault.dev_attr.attr, |
| 773 | &dev_attr_temp3_input.attr, | 752 | &sensor_dev_attr_pwm2.dev_attr.attr, |
| 774 | &dev_attr_temp3_min.attr, | 753 | &sensor_dev_attr_auto_fan2_channel.dev_attr.attr, |
| 775 | &dev_attr_temp3_max.attr, | 754 | &sensor_dev_attr_temp3_input.dev_attr.attr, |
| 776 | &dev_attr_temp3_crit.attr, | 755 | &sensor_dev_attr_temp3_min.dev_attr.attr, |
| 777 | &dev_attr_auto_temp3_off.attr, | 756 | &sensor_dev_attr_temp3_min_alarm.dev_attr.attr, |
| 778 | &dev_attr_auto_temp3_min.attr, | 757 | &sensor_dev_attr_temp3_max.dev_attr.attr, |
| 779 | &dev_attr_auto_temp3_max.attr, | 758 | &sensor_dev_attr_temp3_max_alarm.dev_attr.attr, |
| 780 | &dev_attr_auto_fan2_min_pwm.attr, | 759 | &sensor_dev_attr_temp3_crit.dev_attr.attr, |
| 760 | &sensor_dev_attr_temp3_crit_alarm.dev_attr.attr, | ||
| 761 | &sensor_dev_attr_temp3_fault.dev_attr.attr, | ||
| 762 | &sensor_dev_attr_auto_temp3_off.dev_attr.attr, | ||
| 763 | &sensor_dev_attr_auto_temp3_min.dev_attr.attr, | ||
| 764 | &sensor_dev_attr_auto_temp3_max.dev_attr.attr, | ||
| 765 | &sensor_dev_attr_auto_fan2_min_pwm.dev_attr.attr, | ||
| 781 | NULL | 766 | NULL |
| 782 | }; | 767 | }; |
| 783 | 768 | ||
| @@ -788,7 +773,7 @@ static const struct attribute_group adm1031_group_opt = { | |||
| 788 | /* This function is called by i2c_probe */ | 773 | /* This function is called by i2c_probe */ |
| 789 | static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind) | 774 | static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind) |
| 790 | { | 775 | { |
| 791 | struct i2c_client *new_client; | 776 | struct i2c_client *client; |
| 792 | struct adm1031_data *data; | 777 | struct adm1031_data *data; |
| 793 | int err = 0; | 778 | int err = 0; |
| 794 | const char *name = ""; | 779 | const char *name = ""; |
| @@ -801,17 +786,16 @@ static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 801 | goto exit; | 786 | goto exit; |
| 802 | } | 787 | } |
| 803 | 788 | ||
| 804 | new_client = &data->client; | 789 | client = &data->client; |
| 805 | i2c_set_clientdata(new_client, data); | 790 | i2c_set_clientdata(client, data); |
| 806 | new_client->addr = address; | 791 | client->addr = address; |
| 807 | new_client->adapter = adapter; | 792 | client->adapter = adapter; |
| 808 | new_client->driver = &adm1031_driver; | 793 | client->driver = &adm1031_driver; |
| 809 | new_client->flags = 0; | ||
| 810 | 794 | ||
| 811 | if (kind < 0) { | 795 | if (kind < 0) { |
| 812 | int id, co; | 796 | int id, co; |
| 813 | id = i2c_smbus_read_byte_data(new_client, 0x3d); | 797 | id = i2c_smbus_read_byte_data(client, 0x3d); |
| 814 | co = i2c_smbus_read_byte_data(new_client, 0x3e); | 798 | co = i2c_smbus_read_byte_data(client, 0x3e); |
| 815 | 799 | ||
| 816 | if (!((id == 0x31 || id == 0x30) && co == 0x41)) | 800 | if (!((id == 0x31 || id == 0x30) && co == 0x41)) |
| 817 | goto exit_free; | 801 | goto exit_free; |
| @@ -832,28 +816,27 @@ static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 832 | } | 816 | } |
| 833 | data->chip_type = kind; | 817 | data->chip_type = kind; |
| 834 | 818 | ||
| 835 | strlcpy(new_client->name, name, I2C_NAME_SIZE); | 819 | strlcpy(client->name, name, I2C_NAME_SIZE); |
| 836 | data->valid = 0; | ||
| 837 | mutex_init(&data->update_lock); | 820 | mutex_init(&data->update_lock); |
| 838 | 821 | ||
| 839 | /* Tell the I2C layer a new client has arrived */ | 822 | /* Tell the I2C layer a new client has arrived */ |
| 840 | if ((err = i2c_attach_client(new_client))) | 823 | if ((err = i2c_attach_client(client))) |
| 841 | goto exit_free; | 824 | goto exit_free; |
| 842 | 825 | ||
| 843 | /* Initialize the ADM1031 chip */ | 826 | /* Initialize the ADM1031 chip */ |
| 844 | adm1031_init_client(new_client); | 827 | adm1031_init_client(client); |
| 845 | 828 | ||
| 846 | /* Register sysfs hooks */ | 829 | /* Register sysfs hooks */ |
| 847 | if ((err = sysfs_create_group(&new_client->dev.kobj, &adm1031_group))) | 830 | if ((err = sysfs_create_group(&client->dev.kobj, &adm1031_group))) |
| 848 | goto exit_detach; | 831 | goto exit_detach; |
| 849 | 832 | ||
| 850 | if (kind == adm1031) { | 833 | if (kind == adm1031) { |
| 851 | if ((err = sysfs_create_group(&new_client->dev.kobj, | 834 | if ((err = sysfs_create_group(&client->dev.kobj, |
| 852 | &adm1031_group_opt))) | 835 | &adm1031_group_opt))) |
| 853 | goto exit_remove; | 836 | goto exit_remove; |
| 854 | } | 837 | } |
| 855 | 838 | ||
| 856 | data->hwmon_dev = hwmon_device_register(&new_client->dev); | 839 | data->hwmon_dev = hwmon_device_register(&client->dev); |
| 857 | if (IS_ERR(data->hwmon_dev)) { | 840 | if (IS_ERR(data->hwmon_dev)) { |
| 858 | err = PTR_ERR(data->hwmon_dev); | 841 | err = PTR_ERR(data->hwmon_dev); |
| 859 | goto exit_remove; | 842 | goto exit_remove; |
| @@ -862,10 +845,10 @@ static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 862 | return 0; | 845 | return 0; |
| 863 | 846 | ||
| 864 | exit_remove: | 847 | exit_remove: |
| 865 | sysfs_remove_group(&new_client->dev.kobj, &adm1031_group); | 848 | sysfs_remove_group(&client->dev.kobj, &adm1031_group); |
| 866 | sysfs_remove_group(&new_client->dev.kobj, &adm1031_group_opt); | 849 | sysfs_remove_group(&client->dev.kobj, &adm1031_group_opt); |
| 867 | exit_detach: | 850 | exit_detach: |
| 868 | i2c_detach_client(new_client); | 851 | i2c_detach_client(client); |
| 869 | exit_free: | 852 | exit_free: |
| 870 | kfree(data); | 853 | kfree(data); |
| 871 | exit: | 854 | exit: |
| @@ -897,7 +880,7 @@ static void adm1031_init_client(struct i2c_client *client) | |||
| 897 | if (data->chip_type == adm1031) { | 880 | if (data->chip_type == adm1031) { |
| 898 | mask |= (ADM1031_CONF2_PWM2_ENABLE | | 881 | mask |= (ADM1031_CONF2_PWM2_ENABLE | |
| 899 | ADM1031_CONF2_TACH2_ENABLE); | 882 | ADM1031_CONF2_TACH2_ENABLE); |
| 900 | } | 883 | } |
| 901 | /* Initialize the ADM1031 chip (enables fan speed reading ) */ | 884 | /* Initialize the ADM1031 chip (enables fan speed reading ) */ |
| 902 | read_val = adm1031_read_value(client, ADM1031_REG_CONF2); | 885 | read_val = adm1031_read_value(client, ADM1031_REG_CONF2); |
| 903 | if ((read_val | mask) != read_val) { | 886 | if ((read_val | mask) != read_val) { |
| @@ -976,7 +959,7 @@ static struct adm1031_data *adm1031_update_device(struct device *dev) | |||
| 976 | if (data->chip_type == adm1030) { | 959 | if (data->chip_type == adm1030) { |
| 977 | data->alarm &= 0xc0ff; | 960 | data->alarm &= 0xc0ff; |
| 978 | } | 961 | } |
| 979 | 962 | ||
| 980 | for (chan=0; chan<(data->chip_type == adm1030 ? 1 : 2); chan++) { | 963 | for (chan=0; chan<(data->chip_type == adm1030 ? 1 : 2); chan++) { |
| 981 | data->fan_div[chan] = | 964 | data->fan_div[chan] = |
| 982 | adm1031_read_value(client, ADM1031_REG_FAN_DIV(chan)); | 965 | adm1031_read_value(client, ADM1031_REG_FAN_DIV(chan)); |
| @@ -985,7 +968,7 @@ static struct adm1031_data *adm1031_update_device(struct device *dev) | |||
| 985 | data->fan[chan] = | 968 | data->fan[chan] = |
| 986 | adm1031_read_value(client, ADM1031_REG_FAN_SPEED(chan)); | 969 | adm1031_read_value(client, ADM1031_REG_FAN_SPEED(chan)); |
| 987 | data->pwm[chan] = | 970 | data->pwm[chan] = |
| 988 | 0xf & (adm1031_read_value(client, ADM1031_REG_PWM) >> | 971 | 0xf & (adm1031_read_value(client, ADM1031_REG_PWM) >> |
| 989 | (4*chan)); | 972 | (4*chan)); |
| 990 | } | 973 | } |
| 991 | data->last_updated = jiffies; | 974 | data->last_updated = jiffies; |
diff --git a/drivers/hwmon/adm9240.c b/drivers/hwmon/adm9240.c index c17d0b6b3283..7671d2bf7800 100644 --- a/drivers/hwmon/adm9240.c +++ b/drivers/hwmon/adm9240.c | |||
| @@ -141,7 +141,6 @@ static struct i2c_driver adm9240_driver = { | |||
| 141 | .driver = { | 141 | .driver = { |
| 142 | .name = "adm9240", | 142 | .name = "adm9240", |
| 143 | }, | 143 | }, |
| 144 | .id = I2C_DRIVERID_ADM9240, | ||
| 145 | .attach_adapter = adm9240_attach_adapter, | 144 | .attach_adapter = adm9240_attach_adapter, |
| 146 | .detach_client = adm9240_detach_client, | 145 | .detach_client = adm9240_detach_client, |
| 147 | }; | 146 | }; |
| @@ -415,6 +414,23 @@ static ssize_t show_alarms(struct device *dev, | |||
| 415 | } | 414 | } |
| 416 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); | 415 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); |
| 417 | 416 | ||
| 417 | static ssize_t show_alarm(struct device *dev, | ||
| 418 | struct device_attribute *attr, char *buf) | ||
| 419 | { | ||
| 420 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 421 | struct adm9240_data *data = adm9240_update_device(dev); | ||
| 422 | return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); | ||
| 423 | } | ||
| 424 | static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0); | ||
| 425 | static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1); | ||
| 426 | static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2); | ||
| 427 | static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3); | ||
| 428 | static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8); | ||
| 429 | static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9); | ||
| 430 | static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4); | ||
| 431 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6); | ||
| 432 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7); | ||
| 433 | |||
| 418 | /* vid */ | 434 | /* vid */ |
| 419 | static ssize_t show_vid(struct device *dev, | 435 | static ssize_t show_vid(struct device *dev, |
| 420 | struct device_attribute *attr, char *buf) | 436 | struct device_attribute *attr, char *buf) |
| @@ -469,30 +485,39 @@ static struct attribute *adm9240_attributes[] = { | |||
| 469 | &sensor_dev_attr_in0_input.dev_attr.attr, | 485 | &sensor_dev_attr_in0_input.dev_attr.attr, |
| 470 | &sensor_dev_attr_in0_min.dev_attr.attr, | 486 | &sensor_dev_attr_in0_min.dev_attr.attr, |
| 471 | &sensor_dev_attr_in0_max.dev_attr.attr, | 487 | &sensor_dev_attr_in0_max.dev_attr.attr, |
| 488 | &sensor_dev_attr_in0_alarm.dev_attr.attr, | ||
| 472 | &sensor_dev_attr_in1_input.dev_attr.attr, | 489 | &sensor_dev_attr_in1_input.dev_attr.attr, |
| 473 | &sensor_dev_attr_in1_min.dev_attr.attr, | 490 | &sensor_dev_attr_in1_min.dev_attr.attr, |
| 474 | &sensor_dev_attr_in1_max.dev_attr.attr, | 491 | &sensor_dev_attr_in1_max.dev_attr.attr, |
| 492 | &sensor_dev_attr_in1_alarm.dev_attr.attr, | ||
| 475 | &sensor_dev_attr_in2_input.dev_attr.attr, | 493 | &sensor_dev_attr_in2_input.dev_attr.attr, |
| 476 | &sensor_dev_attr_in2_min.dev_attr.attr, | 494 | &sensor_dev_attr_in2_min.dev_attr.attr, |
| 477 | &sensor_dev_attr_in2_max.dev_attr.attr, | 495 | &sensor_dev_attr_in2_max.dev_attr.attr, |
| 496 | &sensor_dev_attr_in2_alarm.dev_attr.attr, | ||
| 478 | &sensor_dev_attr_in3_input.dev_attr.attr, | 497 | &sensor_dev_attr_in3_input.dev_attr.attr, |
| 479 | &sensor_dev_attr_in3_min.dev_attr.attr, | 498 | &sensor_dev_attr_in3_min.dev_attr.attr, |
| 480 | &sensor_dev_attr_in3_max.dev_attr.attr, | 499 | &sensor_dev_attr_in3_max.dev_attr.attr, |
| 500 | &sensor_dev_attr_in3_alarm.dev_attr.attr, | ||
| 481 | &sensor_dev_attr_in4_input.dev_attr.attr, | 501 | &sensor_dev_attr_in4_input.dev_attr.attr, |
| 482 | &sensor_dev_attr_in4_min.dev_attr.attr, | 502 | &sensor_dev_attr_in4_min.dev_attr.attr, |
| 483 | &sensor_dev_attr_in4_max.dev_attr.attr, | 503 | &sensor_dev_attr_in4_max.dev_attr.attr, |
| 504 | &sensor_dev_attr_in4_alarm.dev_attr.attr, | ||
| 484 | &sensor_dev_attr_in5_input.dev_attr.attr, | 505 | &sensor_dev_attr_in5_input.dev_attr.attr, |
| 485 | &sensor_dev_attr_in5_min.dev_attr.attr, | 506 | &sensor_dev_attr_in5_min.dev_attr.attr, |
| 486 | &sensor_dev_attr_in5_max.dev_attr.attr, | 507 | &sensor_dev_attr_in5_max.dev_attr.attr, |
| 508 | &sensor_dev_attr_in5_alarm.dev_attr.attr, | ||
| 487 | &dev_attr_temp1_input.attr, | 509 | &dev_attr_temp1_input.attr, |
| 488 | &sensor_dev_attr_temp1_max.dev_attr.attr, | 510 | &sensor_dev_attr_temp1_max.dev_attr.attr, |
| 489 | &sensor_dev_attr_temp1_max_hyst.dev_attr.attr, | 511 | &sensor_dev_attr_temp1_max_hyst.dev_attr.attr, |
| 512 | &sensor_dev_attr_temp1_alarm.dev_attr.attr, | ||
| 490 | &sensor_dev_attr_fan1_input.dev_attr.attr, | 513 | &sensor_dev_attr_fan1_input.dev_attr.attr, |
| 491 | &sensor_dev_attr_fan1_div.dev_attr.attr, | 514 | &sensor_dev_attr_fan1_div.dev_attr.attr, |
| 492 | &sensor_dev_attr_fan1_min.dev_attr.attr, | 515 | &sensor_dev_attr_fan1_min.dev_attr.attr, |
| 516 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, | ||
| 493 | &sensor_dev_attr_fan2_input.dev_attr.attr, | 517 | &sensor_dev_attr_fan2_input.dev_attr.attr, |
| 494 | &sensor_dev_attr_fan2_div.dev_attr.attr, | 518 | &sensor_dev_attr_fan2_div.dev_attr.attr, |
| 495 | &sensor_dev_attr_fan2_min.dev_attr.attr, | 519 | &sensor_dev_attr_fan2_min.dev_attr.attr, |
| 520 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, | ||
| 496 | &dev_attr_alarms.attr, | 521 | &dev_attr_alarms.attr, |
| 497 | &dev_attr_aout_output.attr, | 522 | &dev_attr_aout_output.attr, |
| 498 | &dev_attr_chassis_clear.attr, | 523 | &dev_attr_chassis_clear.attr, |
diff --git a/drivers/hwmon/ads7828.c b/drivers/hwmon/ads7828.c new file mode 100644 index 000000000000..6b8a73ef404c --- /dev/null +++ b/drivers/hwmon/ads7828.c | |||
| @@ -0,0 +1,297 @@ | |||
| 1 | /* | ||
| 2 | ads7828.c - lm_sensors driver for ads7828 12-bit 8-channel ADC | ||
| 3 | (C) 2007 EADS Astrium | ||
| 4 | |||
| 5 | This driver is based on the lm75 and other lm_sensors/hwmon drivers | ||
| 6 | |||
| 7 | Written by Steve Hardy <steve@linuxrealtime.co.uk> | ||
| 8 | |||
| 9 | Datasheet available at: http://focus.ti.com/lit/ds/symlink/ads7828.pdf | ||
| 10 | |||
| 11 | This program is free software; you can redistribute it and/or modify | ||
| 12 | it under the terms of the GNU General Public License as published by | ||
| 13 | the Free Software Foundation; either version 2 of the License, or | ||
| 14 | (at your option) any later version. | ||
| 15 | |||
| 16 | This program is distributed in the hope that it will be useful, | ||
| 17 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 18 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 19 | GNU General Public License for more details. | ||
| 20 | |||
| 21 | You should have received a copy of the GNU General Public License | ||
| 22 | along with this program; if not, write to the Free Software | ||
| 23 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
| 24 | */ | ||
| 25 | |||
| 26 | #include <linux/module.h> | ||
| 27 | #include <linux/init.h> | ||
| 28 | #include <linux/slab.h> | ||
| 29 | #include <linux/jiffies.h> | ||
| 30 | #include <linux/i2c.h> | ||
| 31 | #include <linux/hwmon.h> | ||
| 32 | #include <linux/hwmon-sysfs.h> | ||
| 33 | #include <linux/err.h> | ||
| 34 | #include <linux/mutex.h> | ||
| 35 | |||
| 36 | /* The ADS7828 registers */ | ||
| 37 | #define ADS7828_NCH 8 /* 8 channels of 12-bit A-D supported */ | ||
| 38 | #define ADS7828_CMD_SD_SE 0x80 /* Single ended inputs */ | ||
| 39 | #define ADS7828_CMD_SD_DIFF 0x00 /* Differential inputs */ | ||
| 40 | #define ADS7828_CMD_PD0 0x0 /* Power Down between A-D conversions */ | ||
| 41 | #define ADS7828_CMD_PD1 0x04 /* Internal ref OFF && A-D ON */ | ||
| 42 | #define ADS7828_CMD_PD2 0x08 /* Internal ref ON && A-D OFF */ | ||
| 43 | #define ADS7828_CMD_PD3 0x0C /* Internal ref ON && A-D ON */ | ||
| 44 | #define ADS7828_INT_VREF_MV 2500 /* Internal vref is 2.5V, 2500mV */ | ||
| 45 | |||
| 46 | /* Addresses to scan */ | ||
| 47 | static unsigned short normal_i2c[] = { 0x48, 0x49, 0x4a, 0x4b, | ||
| 48 | I2C_CLIENT_END }; | ||
| 49 | |||
| 50 | /* Insmod parameters */ | ||
| 51 | I2C_CLIENT_INSMOD_1(ads7828); | ||
| 52 | |||
| 53 | /* Other module parameters */ | ||
| 54 | static int se_input = 1; /* Default is SE, 0 == diff */ | ||
| 55 | static int int_vref = 1; /* Default is internal ref ON */ | ||
| 56 | static int vref_mv = ADS7828_INT_VREF_MV; /* set if vref != 2.5V */ | ||
| 57 | module_param(se_input, bool, S_IRUGO); | ||
| 58 | module_param(int_vref, bool, S_IRUGO); | ||
| 59 | module_param(vref_mv, int, S_IRUGO); | ||
| 60 | |||
| 61 | /* Global Variables */ | ||
| 62 | static u8 ads7828_cmd_byte; /* cmd byte without channel bits */ | ||
| 63 | static unsigned int ads7828_lsb_resol; /* resolution of the ADC sample lsb */ | ||
| 64 | |||
| 65 | /* Each client has this additional data */ | ||
| 66 | struct ads7828_data { | ||
| 67 | struct i2c_client client; | ||
| 68 | struct device *hwmon_dev; | ||
| 69 | struct mutex update_lock; /* mutex protect updates */ | ||
| 70 | char valid; /* !=0 if following fields are valid */ | ||
| 71 | unsigned long last_updated; /* In jiffies */ | ||
| 72 | u16 adc_input[ADS7828_NCH]; /* ADS7828_NCH 12-bit samples */ | ||
| 73 | }; | ||
| 74 | |||
| 75 | /* Function declaration - necessary due to function dependencies */ | ||
| 76 | static int ads7828_detect(struct i2c_adapter *adapter, int address, int kind); | ||
| 77 | |||
| 78 | /* The ADS7828 returns the 12-bit sample in two bytes, | ||
| 79 | these are read as a word then byte-swapped */ | ||
| 80 | static u16 ads7828_read_value(struct i2c_client *client, u8 reg) | ||
| 81 | { | ||
| 82 | return swab16(i2c_smbus_read_word_data(client, reg)); | ||
| 83 | } | ||
| 84 | |||
| 85 | static inline u8 channel_cmd_byte(int ch) | ||
| 86 | { | ||
| 87 | /* cmd byte C2,C1,C0 - see datasheet */ | ||
| 88 | u8 cmd = (((ch>>1) | (ch&0x01)<<2)<<4); | ||
| 89 | cmd |= ads7828_cmd_byte; | ||
| 90 | return cmd; | ||
| 91 | } | ||
| 92 | |||
| 93 | /* Update data for the device (all 8 channels) */ | ||
| 94 | static struct ads7828_data *ads7828_update_device(struct device *dev) | ||
| 95 | { | ||
| 96 | struct i2c_client *client = to_i2c_client(dev); | ||
| 97 | struct ads7828_data *data = i2c_get_clientdata(client); | ||
| 98 | |||
| 99 | mutex_lock(&data->update_lock); | ||
| 100 | |||
| 101 | if (time_after(jiffies, data->last_updated + HZ + HZ / 2) | ||
| 102 | || !data->valid) { | ||
| 103 | unsigned int ch; | ||
| 104 | dev_dbg(&client->dev, "Starting ads7828 update\n"); | ||
| 105 | |||
| 106 | for (ch = 0; ch < ADS7828_NCH; ch++) { | ||
| 107 | u8 cmd = channel_cmd_byte(ch); | ||
| 108 | data->adc_input[ch] = ads7828_read_value(client, cmd); | ||
| 109 | } | ||
| 110 | data->last_updated = jiffies; | ||
| 111 | data->valid = 1; | ||
| 112 | } | ||
| 113 | |||
| 114 | mutex_unlock(&data->update_lock); | ||
| 115 | |||
| 116 | return data; | ||
| 117 | } | ||
| 118 | |||
| 119 | /* sysfs callback function */ | ||
| 120 | static ssize_t show_in(struct device *dev, struct device_attribute *da, | ||
| 121 | char *buf) | ||
| 122 | { | ||
| 123 | struct sensor_device_attribute *attr = to_sensor_dev_attr(da); | ||
| 124 | struct ads7828_data *data = ads7828_update_device(dev); | ||
| 125 | /* Print value (in mV as specified in sysfs-interface documentation) */ | ||
| 126 | return sprintf(buf, "%d\n", (data->adc_input[attr->index] * | ||
| 127 | ads7828_lsb_resol)/1000); | ||
| 128 | } | ||
| 129 | |||
| 130 | #define in_reg(offset)\ | ||
| 131 | static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, show_in,\ | ||
| 132 | NULL, offset) | ||
| 133 | |||
| 134 | in_reg(0); | ||
| 135 | in_reg(1); | ||
| 136 | in_reg(2); | ||
| 137 | in_reg(3); | ||
| 138 | in_reg(4); | ||
| 139 | in_reg(5); | ||
| 140 | in_reg(6); | ||
| 141 | in_reg(7); | ||
| 142 | |||
| 143 | static struct attribute *ads7828_attributes[] = { | ||
| 144 | &sensor_dev_attr_in0_input.dev_attr.attr, | ||
| 145 | &sensor_dev_attr_in1_input.dev_attr.attr, | ||
| 146 | &sensor_dev_attr_in2_input.dev_attr.attr, | ||
| 147 | &sensor_dev_attr_in3_input.dev_attr.attr, | ||
| 148 | &sensor_dev_attr_in4_input.dev_attr.attr, | ||
| 149 | &sensor_dev_attr_in5_input.dev_attr.attr, | ||
| 150 | &sensor_dev_attr_in6_input.dev_attr.attr, | ||
| 151 | &sensor_dev_attr_in7_input.dev_attr.attr, | ||
| 152 | NULL | ||
| 153 | }; | ||
| 154 | |||
| 155 | static const struct attribute_group ads7828_group = { | ||
| 156 | .attrs = ads7828_attributes, | ||
| 157 | }; | ||
| 158 | |||
| 159 | static int ads7828_attach_adapter(struct i2c_adapter *adapter) | ||
| 160 | { | ||
| 161 | if (!(adapter->class & I2C_CLASS_HWMON)) | ||
| 162 | return 0; | ||
| 163 | return i2c_probe(adapter, &addr_data, ads7828_detect); | ||
| 164 | } | ||
| 165 | |||
| 166 | static int ads7828_detach_client(struct i2c_client *client) | ||
| 167 | { | ||
| 168 | struct ads7828_data *data = i2c_get_clientdata(client); | ||
| 169 | hwmon_device_unregister(data->hwmon_dev); | ||
| 170 | sysfs_remove_group(&client->dev.kobj, &ads7828_group); | ||
| 171 | i2c_detach_client(client); | ||
| 172 | kfree(i2c_get_clientdata(client)); | ||
| 173 | return 0; | ||
| 174 | } | ||
| 175 | |||
| 176 | /* This is the driver that will be inserted */ | ||
| 177 | static struct i2c_driver ads7828_driver = { | ||
| 178 | .driver = { | ||
| 179 | .name = "ads7828", | ||
| 180 | }, | ||
| 181 | .attach_adapter = ads7828_attach_adapter, | ||
| 182 | .detach_client = ads7828_detach_client, | ||
| 183 | }; | ||
| 184 | |||
| 185 | /* This function is called by i2c_probe */ | ||
| 186 | static int ads7828_detect(struct i2c_adapter *adapter, int address, int kind) | ||
| 187 | { | ||
| 188 | struct i2c_client *client; | ||
| 189 | struct ads7828_data *data; | ||
| 190 | int err = 0; | ||
| 191 | const char *name = ""; | ||
| 192 | |||
| 193 | /* Check we have a valid client */ | ||
| 194 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_READ_WORD_DATA)) | ||
| 195 | goto exit; | ||
| 196 | |||
| 197 | /* OK. For now, we presume we have a valid client. We now create the | ||
| 198 | client structure, even though we cannot fill it completely yet. | ||
| 199 | But it allows us to access ads7828_read_value. */ | ||
| 200 | data = kzalloc(sizeof(struct ads7828_data), GFP_KERNEL); | ||
| 201 | if (!data) { | ||
| 202 | err = -ENOMEM; | ||
| 203 | goto exit; | ||
| 204 | } | ||
| 205 | |||
| 206 | client = &data->client; | ||
| 207 | i2c_set_clientdata(client, data); | ||
| 208 | client->addr = address; | ||
| 209 | client->adapter = adapter; | ||
| 210 | client->driver = &ads7828_driver; | ||
| 211 | |||
| 212 | /* Now, we do the remaining detection. There is no identification | ||
| 213 | dedicated register so attempt to sanity check using knowledge of | ||
| 214 | the chip | ||
| 215 | - Read from the 8 channel addresses | ||
| 216 | - Check the top 4 bits of each result are not set (12 data bits) | ||
| 217 | */ | ||
| 218 | if (kind < 0) { | ||
| 219 | int ch; | ||
| 220 | for (ch = 0; ch < ADS7828_NCH; ch++) { | ||
| 221 | u16 in_data; | ||
| 222 | u8 cmd = channel_cmd_byte(ch); | ||
| 223 | in_data = ads7828_read_value(client, cmd); | ||
| 224 | if (in_data & 0xF000) { | ||
| 225 | printk(KERN_DEBUG | ||
| 226 | "%s : Doesn't look like an ads7828 device\n", | ||
| 227 | __FUNCTION__); | ||
| 228 | goto exit_free; | ||
| 229 | } | ||
| 230 | } | ||
| 231 | } | ||
| 232 | |||
| 233 | /* Determine the chip type - only one kind supported! */ | ||
| 234 | if (kind <= 0) | ||
| 235 | kind = ads7828; | ||
| 236 | |||
| 237 | if (kind == ads7828) | ||
| 238 | name = "ads7828"; | ||
| 239 | |||
| 240 | /* Fill in the remaining client fields, put it into the global list */ | ||
| 241 | strlcpy(client->name, name, I2C_NAME_SIZE); | ||
| 242 | |||
| 243 | mutex_init(&data->update_lock); | ||
| 244 | |||
| 245 | /* Tell the I2C layer a new client has arrived */ | ||
| 246 | err = i2c_attach_client(client); | ||
| 247 | if (err) | ||
| 248 | goto exit_free; | ||
| 249 | |||
| 250 | /* Register sysfs hooks */ | ||
| 251 | err = sysfs_create_group(&client->dev.kobj, &ads7828_group); | ||
| 252 | if (err) | ||
| 253 | goto exit_detach; | ||
| 254 | |||
| 255 | data->hwmon_dev = hwmon_device_register(&client->dev); | ||
| 256 | if (IS_ERR(data->hwmon_dev)) { | ||
| 257 | err = PTR_ERR(data->hwmon_dev); | ||
| 258 | goto exit_remove; | ||
| 259 | } | ||
| 260 | |||
| 261 | return 0; | ||
| 262 | |||
| 263 | exit_remove: | ||
| 264 | sysfs_remove_group(&client->dev.kobj, &ads7828_group); | ||
| 265 | exit_detach: | ||
| 266 | i2c_detach_client(client); | ||
| 267 | exit_free: | ||
| 268 | kfree(data); | ||
| 269 | exit: | ||
| 270 | return err; | ||
| 271 | } | ||
| 272 | |||
| 273 | static int __init sensors_ads7828_init(void) | ||
| 274 | { | ||
| 275 | /* Initialize the command byte according to module parameters */ | ||
| 276 | ads7828_cmd_byte = se_input ? | ||
| 277 | ADS7828_CMD_SD_SE : ADS7828_CMD_SD_DIFF; | ||
| 278 | ads7828_cmd_byte |= int_vref ? | ||
| 279 | ADS7828_CMD_PD3 : ADS7828_CMD_PD1; | ||
| 280 | |||
| 281 | /* Calculate the LSB resolution */ | ||
| 282 | ads7828_lsb_resol = (vref_mv*1000)/4096; | ||
| 283 | |||
| 284 | return i2c_add_driver(&ads7828_driver); | ||
| 285 | } | ||
| 286 | |||
| 287 | static void __exit sensors_ads7828_exit(void) | ||
| 288 | { | ||
| 289 | i2c_del_driver(&ads7828_driver); | ||
| 290 | } | ||
| 291 | |||
| 292 | MODULE_AUTHOR("Steve Hardy <steve@linuxrealtime.co.uk>"); | ||
| 293 | MODULE_DESCRIPTION("ADS7828 driver"); | ||
| 294 | MODULE_LICENSE("GPL"); | ||
| 295 | |||
| 296 | module_init(sensors_ads7828_init); | ||
| 297 | module_exit(sensors_ads7828_exit); | ||
diff --git a/drivers/hwmon/adt7470.c b/drivers/hwmon/adt7470.c index 9810aaa0489d..747693ab2ff1 100644 --- a/drivers/hwmon/adt7470.c +++ b/drivers/hwmon/adt7470.c | |||
| @@ -48,7 +48,22 @@ I2C_CLIENT_INSMOD_1(adt7470); | |||
| 48 | #define ADT7470_REG_CFG 0x40 | 48 | #define ADT7470_REG_CFG 0x40 |
| 49 | #define ADT7470_FSPD_MASK 0x04 | 49 | #define ADT7470_FSPD_MASK 0x04 |
| 50 | #define ADT7470_REG_ALARM1 0x41 | 50 | #define ADT7470_REG_ALARM1 0x41 |
| 51 | #define ADT7470_R1T_ALARM 0x01 | ||
| 52 | #define ADT7470_R2T_ALARM 0x02 | ||
| 53 | #define ADT7470_R3T_ALARM 0x04 | ||
| 54 | #define ADT7470_R4T_ALARM 0x08 | ||
| 55 | #define ADT7470_R5T_ALARM 0x10 | ||
| 56 | #define ADT7470_R6T_ALARM 0x20 | ||
| 57 | #define ADT7470_R7T_ALARM 0x40 | ||
| 58 | #define ADT7470_OOL_ALARM 0x80 | ||
| 51 | #define ADT7470_REG_ALARM2 0x42 | 59 | #define ADT7470_REG_ALARM2 0x42 |
| 60 | #define ADT7470_R8T_ALARM 0x01 | ||
| 61 | #define ADT7470_R9T_ALARM 0x02 | ||
| 62 | #define ADT7470_R10T_ALARM 0x04 | ||
| 63 | #define ADT7470_FAN1_ALARM 0x10 | ||
| 64 | #define ADT7470_FAN2_ALARM 0x20 | ||
| 65 | #define ADT7470_FAN3_ALARM 0x40 | ||
| 66 | #define ADT7470_FAN4_ALARM 0x80 | ||
| 52 | #define ADT7470_REG_TEMP_LIMITS_BASE_ADDR 0x44 | 67 | #define ADT7470_REG_TEMP_LIMITS_BASE_ADDR 0x44 |
| 53 | #define ADT7470_REG_TEMP_LIMITS_MAX_ADDR 0x57 | 68 | #define ADT7470_REG_TEMP_LIMITS_MAX_ADDR 0x57 |
| 54 | #define ADT7470_REG_FAN_MIN_BASE_ADDR 0x58 | 69 | #define ADT7470_REG_FAN_MIN_BASE_ADDR 0x58 |
| @@ -97,6 +112,8 @@ I2C_CLIENT_INSMOD_1(adt7470); | |||
| 97 | #define ADT7470_REG_PWM_AUTO_TEMP(x) (ADT7470_REG_PWM_AUTO_TEMP_BASE_ADDR + \ | 112 | #define ADT7470_REG_PWM_AUTO_TEMP(x) (ADT7470_REG_PWM_AUTO_TEMP_BASE_ADDR + \ |
| 98 | ((x) / 2)) | 113 | ((x) / 2)) |
| 99 | 114 | ||
| 115 | #define ALARM2(x) ((x) << 8) | ||
| 116 | |||
| 100 | #define ADT7470_VENDOR 0x41 | 117 | #define ADT7470_VENDOR 0x41 |
| 101 | #define ADT7470_DEVICE 0x70 | 118 | #define ADT7470_DEVICE 0x70 |
| 102 | /* datasheet only mentions a revision 2 */ | 119 | /* datasheet only mentions a revision 2 */ |
| @@ -114,8 +131,6 @@ I2C_CLIENT_INSMOD_1(adt7470); | |||
| 114 | /* sleep 1s while gathering temperature data */ | 131 | /* sleep 1s while gathering temperature data */ |
| 115 | #define TEMP_COLLECTION_TIME 1000 | 132 | #define TEMP_COLLECTION_TIME 1000 |
| 116 | 133 | ||
| 117 | #define power_of_2(x) (((x) & ((x) - 1)) == 0) | ||
| 118 | |||
| 119 | /* datasheet says to divide this number by the fan reading to get fan rpm */ | 134 | /* datasheet says to divide this number by the fan reading to get fan rpm */ |
| 120 | #define FAN_PERIOD_TO_RPM(x) ((90000 * 60) / (x)) | 135 | #define FAN_PERIOD_TO_RPM(x) ((90000 * 60) / (x)) |
| 121 | #define FAN_RPM_TO_PERIOD FAN_PERIOD_TO_RPM | 136 | #define FAN_RPM_TO_PERIOD FAN_PERIOD_TO_RPM |
| @@ -138,7 +153,8 @@ struct adt7470_data { | |||
| 138 | u16 fan[ADT7470_FAN_COUNT]; | 153 | u16 fan[ADT7470_FAN_COUNT]; |
| 139 | u16 fan_min[ADT7470_FAN_COUNT]; | 154 | u16 fan_min[ADT7470_FAN_COUNT]; |
| 140 | u16 fan_max[ADT7470_FAN_COUNT]; | 155 | u16 fan_max[ADT7470_FAN_COUNT]; |
| 141 | u16 alarms, alarms_mask; | 156 | u16 alarm; |
| 157 | u16 alarms_mask; | ||
| 142 | u8 force_pwm_max; | 158 | u8 force_pwm_max; |
| 143 | u8 pwm[ADT7470_PWM_COUNT]; | 159 | u8 pwm[ADT7470_PWM_COUNT]; |
| 144 | u8 pwm_max[ADT7470_PWM_COUNT]; | 160 | u8 pwm_max[ADT7470_PWM_COUNT]; |
| @@ -262,7 +278,10 @@ static struct adt7470_data *adt7470_update_device(struct device *dev) | |||
| 262 | else | 278 | else |
| 263 | data->force_pwm_max = 0; | 279 | data->force_pwm_max = 0; |
| 264 | 280 | ||
| 265 | data->alarms = adt7470_read_word_data(client, ADT7470_REG_ALARM1); | 281 | data->alarm = i2c_smbus_read_byte_data(client, ADT7470_REG_ALARM1); |
| 282 | if (data->alarm & ADT7470_OOL_ALARM) | ||
| 283 | data->alarm |= ALARM2(i2c_smbus_read_byte_data(client, | ||
| 284 | ADT7470_REG_ALARM2)); | ||
| 266 | data->alarms_mask = adt7470_read_word_data(client, | 285 | data->alarms_mask = adt7470_read_word_data(client, |
| 267 | ADT7470_REG_ALARM1_MASK); | 286 | ADT7470_REG_ALARM1_MASK); |
| 268 | 287 | ||
| @@ -370,17 +389,13 @@ static ssize_t show_temp(struct device *dev, struct device_attribute *devattr, | |||
| 370 | return sprintf(buf, "%d\n", 1000 * data->temp[attr->index]); | 389 | return sprintf(buf, "%d\n", 1000 * data->temp[attr->index]); |
| 371 | } | 390 | } |
| 372 | 391 | ||
| 373 | static ssize_t show_alarms(struct device *dev, | 392 | static ssize_t show_alarm_mask(struct device *dev, |
| 374 | struct device_attribute *devattr, | 393 | struct device_attribute *devattr, |
| 375 | char *buf) | 394 | char *buf) |
| 376 | { | 395 | { |
| 377 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | ||
| 378 | struct adt7470_data *data = adt7470_update_device(dev); | 396 | struct adt7470_data *data = adt7470_update_device(dev); |
| 379 | 397 | ||
| 380 | if (attr->index) | 398 | return sprintf(buf, "%x\n", data->alarms_mask); |
| 381 | return sprintf(buf, "%x\n", data->alarms); | ||
| 382 | else | ||
| 383 | return sprintf(buf, "%x\n", data->alarms_mask); | ||
| 384 | } | 399 | } |
| 385 | 400 | ||
| 386 | static ssize_t show_fan_max(struct device *dev, | 401 | static ssize_t show_fan_max(struct device *dev, |
| @@ -677,7 +692,7 @@ static int cvt_auto_temp(int input) | |||
| 677 | { | 692 | { |
| 678 | if (input == ADT7470_PWM_ALL_TEMPS) | 693 | if (input == ADT7470_PWM_ALL_TEMPS) |
| 679 | return 0; | 694 | return 0; |
| 680 | if (input < 1 || !power_of_2(input)) | 695 | if (input < 1 || !is_power_of_2(input)) |
| 681 | return -EINVAL; | 696 | return -EINVAL; |
| 682 | return ilog2(input) + 1; | 697 | return ilog2(input) + 1; |
| 683 | } | 698 | } |
| @@ -715,8 +730,20 @@ static ssize_t set_pwm_auto_temp(struct device *dev, | |||
| 715 | return count; | 730 | return count; |
| 716 | } | 731 | } |
| 717 | 732 | ||
| 718 | static SENSOR_DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL, 0); | 733 | static ssize_t show_alarm(struct device *dev, |
| 719 | static SENSOR_DEVICE_ATTR(alarm_mask, S_IRUGO, show_alarms, NULL, 1); | 734 | struct device_attribute *devattr, |
| 735 | char *buf) | ||
| 736 | { | ||
| 737 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | ||
| 738 | struct adt7470_data *data = adt7470_update_device(dev); | ||
| 739 | |||
| 740 | if (data->alarm & attr->index) | ||
| 741 | return sprintf(buf, "1\n"); | ||
| 742 | else | ||
| 743 | return sprintf(buf, "0\n"); | ||
| 744 | } | ||
| 745 | |||
| 746 | static DEVICE_ATTR(alarm_mask, S_IRUGO, show_alarm_mask, NULL); | ||
| 720 | 747 | ||
| 721 | static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp_max, | 748 | static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp_max, |
| 722 | set_temp_max, 0); | 749 | set_temp_max, 0); |
| @@ -771,6 +798,27 @@ static SENSOR_DEVICE_ATTR(temp8_input, S_IRUGO, show_temp, NULL, 7); | |||
| 771 | static SENSOR_DEVICE_ATTR(temp9_input, S_IRUGO, show_temp, NULL, 8); | 798 | static SENSOR_DEVICE_ATTR(temp9_input, S_IRUGO, show_temp, NULL, 8); |
| 772 | static SENSOR_DEVICE_ATTR(temp10_input, S_IRUGO, show_temp, NULL, 9); | 799 | static SENSOR_DEVICE_ATTR(temp10_input, S_IRUGO, show_temp, NULL, 9); |
| 773 | 800 | ||
| 801 | static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, | ||
| 802 | ADT7470_R1T_ALARM); | ||
| 803 | static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, | ||
| 804 | ADT7470_R2T_ALARM); | ||
| 805 | static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, | ||
| 806 | ADT7470_R3T_ALARM); | ||
| 807 | static SENSOR_DEVICE_ATTR(temp4_alarm, S_IRUGO, show_alarm, NULL, | ||
| 808 | ADT7470_R4T_ALARM); | ||
| 809 | static SENSOR_DEVICE_ATTR(temp5_alarm, S_IRUGO, show_alarm, NULL, | ||
| 810 | ADT7470_R5T_ALARM); | ||
| 811 | static SENSOR_DEVICE_ATTR(temp6_alarm, S_IRUGO, show_alarm, NULL, | ||
| 812 | ADT7470_R6T_ALARM); | ||
| 813 | static SENSOR_DEVICE_ATTR(temp7_alarm, S_IRUGO, show_alarm, NULL, | ||
| 814 | ADT7470_R7T_ALARM); | ||
| 815 | static SENSOR_DEVICE_ATTR(temp8_alarm, S_IRUGO, show_alarm, NULL, | ||
| 816 | ALARM2(ADT7470_R8T_ALARM)); | ||
| 817 | static SENSOR_DEVICE_ATTR(temp9_alarm, S_IRUGO, show_alarm, NULL, | ||
| 818 | ALARM2(ADT7470_R9T_ALARM)); | ||
| 819 | static SENSOR_DEVICE_ATTR(temp10_alarm, S_IRUGO, show_alarm, NULL, | ||
| 820 | ALARM2(ADT7470_R10T_ALARM)); | ||
| 821 | |||
| 774 | static SENSOR_DEVICE_ATTR(fan1_max, S_IWUSR | S_IRUGO, show_fan_max, | 822 | static SENSOR_DEVICE_ATTR(fan1_max, S_IWUSR | S_IRUGO, show_fan_max, |
| 775 | set_fan_max, 0); | 823 | set_fan_max, 0); |
| 776 | static SENSOR_DEVICE_ATTR(fan2_max, S_IWUSR | S_IRUGO, show_fan_max, | 824 | static SENSOR_DEVICE_ATTR(fan2_max, S_IWUSR | S_IRUGO, show_fan_max, |
| @@ -794,6 +842,15 @@ static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1); | |||
| 794 | static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2); | 842 | static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2); |
| 795 | static SENSOR_DEVICE_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3); | 843 | static SENSOR_DEVICE_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3); |
| 796 | 844 | ||
| 845 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, | ||
| 846 | ALARM2(ADT7470_FAN1_ALARM)); | ||
| 847 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, | ||
| 848 | ALARM2(ADT7470_FAN2_ALARM)); | ||
| 849 | static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, | ||
| 850 | ALARM2(ADT7470_FAN3_ALARM)); | ||
| 851 | static SENSOR_DEVICE_ATTR(fan4_alarm, S_IRUGO, show_alarm, NULL, | ||
| 852 | ALARM2(ADT7470_FAN4_ALARM)); | ||
| 853 | |||
| 797 | static SENSOR_DEVICE_ATTR(force_pwm_max, S_IWUSR | S_IRUGO, | 854 | static SENSOR_DEVICE_ATTR(force_pwm_max, S_IWUSR | S_IRUGO, |
| 798 | show_force_pwm_max, set_force_pwm_max, 0); | 855 | show_force_pwm_max, set_force_pwm_max, 0); |
| 799 | 856 | ||
| @@ -858,8 +915,7 @@ static SENSOR_DEVICE_ATTR(pwm4_auto_channels_temp, S_IWUSR | S_IRUGO, | |||
| 858 | 915 | ||
| 859 | static struct attribute *adt7470_attr[] = | 916 | static struct attribute *adt7470_attr[] = |
| 860 | { | 917 | { |
| 861 | &sensor_dev_attr_alarms.dev_attr.attr, | 918 | &dev_attr_alarm_mask.attr, |
| 862 | &sensor_dev_attr_alarm_mask.dev_attr.attr, | ||
| 863 | &sensor_dev_attr_temp1_max.dev_attr.attr, | 919 | &sensor_dev_attr_temp1_max.dev_attr.attr, |
| 864 | &sensor_dev_attr_temp2_max.dev_attr.attr, | 920 | &sensor_dev_attr_temp2_max.dev_attr.attr, |
| 865 | &sensor_dev_attr_temp3_max.dev_attr.attr, | 921 | &sensor_dev_attr_temp3_max.dev_attr.attr, |
| @@ -890,6 +946,16 @@ static struct attribute *adt7470_attr[] = | |||
| 890 | &sensor_dev_attr_temp8_input.dev_attr.attr, | 946 | &sensor_dev_attr_temp8_input.dev_attr.attr, |
| 891 | &sensor_dev_attr_temp9_input.dev_attr.attr, | 947 | &sensor_dev_attr_temp9_input.dev_attr.attr, |
| 892 | &sensor_dev_attr_temp10_input.dev_attr.attr, | 948 | &sensor_dev_attr_temp10_input.dev_attr.attr, |
| 949 | &sensor_dev_attr_temp1_alarm.dev_attr.attr, | ||
| 950 | &sensor_dev_attr_temp2_alarm.dev_attr.attr, | ||
| 951 | &sensor_dev_attr_temp3_alarm.dev_attr.attr, | ||
| 952 | &sensor_dev_attr_temp4_alarm.dev_attr.attr, | ||
| 953 | &sensor_dev_attr_temp5_alarm.dev_attr.attr, | ||
| 954 | &sensor_dev_attr_temp6_alarm.dev_attr.attr, | ||
| 955 | &sensor_dev_attr_temp7_alarm.dev_attr.attr, | ||
| 956 | &sensor_dev_attr_temp8_alarm.dev_attr.attr, | ||
| 957 | &sensor_dev_attr_temp9_alarm.dev_attr.attr, | ||
| 958 | &sensor_dev_attr_temp10_alarm.dev_attr.attr, | ||
| 893 | &sensor_dev_attr_fan1_max.dev_attr.attr, | 959 | &sensor_dev_attr_fan1_max.dev_attr.attr, |
| 894 | &sensor_dev_attr_fan2_max.dev_attr.attr, | 960 | &sensor_dev_attr_fan2_max.dev_attr.attr, |
| 895 | &sensor_dev_attr_fan3_max.dev_attr.attr, | 961 | &sensor_dev_attr_fan3_max.dev_attr.attr, |
| @@ -902,6 +968,10 @@ static struct attribute *adt7470_attr[] = | |||
| 902 | &sensor_dev_attr_fan2_input.dev_attr.attr, | 968 | &sensor_dev_attr_fan2_input.dev_attr.attr, |
| 903 | &sensor_dev_attr_fan3_input.dev_attr.attr, | 969 | &sensor_dev_attr_fan3_input.dev_attr.attr, |
| 904 | &sensor_dev_attr_fan4_input.dev_attr.attr, | 970 | &sensor_dev_attr_fan4_input.dev_attr.attr, |
| 971 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, | ||
| 972 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, | ||
| 973 | &sensor_dev_attr_fan3_alarm.dev_attr.attr, | ||
| 974 | &sensor_dev_attr_fan4_alarm.dev_attr.attr, | ||
| 905 | &sensor_dev_attr_force_pwm_max.dev_attr.attr, | 975 | &sensor_dev_attr_force_pwm_max.dev_attr.attr, |
| 906 | &sensor_dev_attr_pwm1.dev_attr.attr, | 976 | &sensor_dev_attr_pwm1.dev_attr.attr, |
| 907 | &sensor_dev_attr_pwm2.dev_attr.attr, | 977 | &sensor_dev_attr_pwm2.dev_attr.attr, |
diff --git a/drivers/hwmon/asb100.c b/drivers/hwmon/asb100.c index 9460dba4cf74..950cea8d1d65 100644 --- a/drivers/hwmon/asb100.c +++ b/drivers/hwmon/asb100.c | |||
| @@ -40,6 +40,7 @@ | |||
| 40 | #include <linux/slab.h> | 40 | #include <linux/slab.h> |
| 41 | #include <linux/i2c.h> | 41 | #include <linux/i2c.h> |
| 42 | #include <linux/hwmon.h> | 42 | #include <linux/hwmon.h> |
| 43 | #include <linux/hwmon-sysfs.h> | ||
| 43 | #include <linux/hwmon-vid.h> | 44 | #include <linux/hwmon-vid.h> |
| 44 | #include <linux/err.h> | 45 | #include <linux/err.h> |
| 45 | #include <linux/init.h> | 46 | #include <linux/init.h> |
| @@ -47,12 +48,6 @@ | |||
| 47 | #include <linux/mutex.h> | 48 | #include <linux/mutex.h> |
| 48 | #include "lm75.h" | 49 | #include "lm75.h" |
| 49 | 50 | ||
| 50 | /* | ||
| 51 | HISTORY: | ||
| 52 | 2003-12-29 1.0.0 Ported from lm_sensors project for kernel 2.6 | ||
| 53 | */ | ||
| 54 | #define ASB100_VERSION "1.0.0" | ||
| 55 | |||
| 56 | /* I2C addresses to scan */ | 51 | /* I2C addresses to scan */ |
| 57 | static unsigned short normal_i2c[] = { 0x2d, I2C_CLIENT_END }; | 52 | static unsigned short normal_i2c[] = { 0x2d, I2C_CLIENT_END }; |
| 58 | 53 | ||
| @@ -221,15 +216,16 @@ static struct i2c_driver asb100_driver = { | |||
| 221 | .driver = { | 216 | .driver = { |
| 222 | .name = "asb100", | 217 | .name = "asb100", |
| 223 | }, | 218 | }, |
| 224 | .id = I2C_DRIVERID_ASB100, | ||
| 225 | .attach_adapter = asb100_attach_adapter, | 219 | .attach_adapter = asb100_attach_adapter, |
| 226 | .detach_client = asb100_detach_client, | 220 | .detach_client = asb100_detach_client, |
| 227 | }; | 221 | }; |
| 228 | 222 | ||
| 229 | /* 7 Voltages */ | 223 | /* 7 Voltages */ |
| 230 | #define show_in_reg(reg) \ | 224 | #define show_in_reg(reg) \ |
| 231 | static ssize_t show_##reg (struct device *dev, char *buf, int nr) \ | 225 | static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \ |
| 226 | char *buf) \ | ||
| 232 | { \ | 227 | { \ |
| 228 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 233 | struct asb100_data *data = asb100_update_device(dev); \ | 229 | struct asb100_data *data = asb100_update_device(dev); \ |
| 234 | return sprintf(buf, "%d\n", IN_FROM_REG(data->reg[nr])); \ | 230 | return sprintf(buf, "%d\n", IN_FROM_REG(data->reg[nr])); \ |
| 235 | } | 231 | } |
| @@ -239,9 +235,10 @@ show_in_reg(in_min) | |||
| 239 | show_in_reg(in_max) | 235 | show_in_reg(in_max) |
| 240 | 236 | ||
| 241 | #define set_in_reg(REG, reg) \ | 237 | #define set_in_reg(REG, reg) \ |
| 242 | static ssize_t set_in_##reg(struct device *dev, const char *buf, \ | 238 | static ssize_t set_in_##reg(struct device *dev, struct device_attribute *attr, \ |
| 243 | size_t count, int nr) \ | 239 | const char *buf, size_t count) \ |
| 244 | { \ | 240 | { \ |
| 241 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 245 | struct i2c_client *client = to_i2c_client(dev); \ | 242 | struct i2c_client *client = to_i2c_client(dev); \ |
| 246 | struct asb100_data *data = i2c_get_clientdata(client); \ | 243 | struct asb100_data *data = i2c_get_clientdata(client); \ |
| 247 | unsigned long val = simple_strtoul(buf, NULL, 10); \ | 244 | unsigned long val = simple_strtoul(buf, NULL, 10); \ |
| @@ -258,37 +255,12 @@ set_in_reg(MIN, min) | |||
| 258 | set_in_reg(MAX, max) | 255 | set_in_reg(MAX, max) |
| 259 | 256 | ||
| 260 | #define sysfs_in(offset) \ | 257 | #define sysfs_in(offset) \ |
| 261 | static ssize_t \ | 258 | static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \ |
| 262 | show_in##offset (struct device *dev, struct device_attribute *attr, char *buf) \ | 259 | show_in, NULL, offset); \ |
| 263 | { \ | 260 | static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \ |
| 264 | return show_in(dev, buf, offset); \ | 261 | show_in_min, set_in_min, offset); \ |
| 265 | } \ | 262 | static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \ |
| 266 | static DEVICE_ATTR(in##offset##_input, S_IRUGO, \ | 263 | show_in_max, set_in_max, offset) |
| 267 | show_in##offset, NULL); \ | ||
| 268 | static ssize_t \ | ||
| 269 | show_in##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \ | ||
| 270 | { \ | ||
| 271 | return show_in_min(dev, buf, offset); \ | ||
| 272 | } \ | ||
| 273 | static ssize_t \ | ||
| 274 | show_in##offset##_max (struct device *dev, struct device_attribute *attr, char *buf) \ | ||
| 275 | { \ | ||
| 276 | return show_in_max(dev, buf, offset); \ | ||
| 277 | } \ | ||
| 278 | static ssize_t set_in##offset##_min (struct device *dev, struct device_attribute *attr, \ | ||
| 279 | const char *buf, size_t count) \ | ||
| 280 | { \ | ||
| 281 | return set_in_min(dev, buf, count, offset); \ | ||
| 282 | } \ | ||
| 283 | static ssize_t set_in##offset##_max (struct device *dev, struct device_attribute *attr, \ | ||
| 284 | const char *buf, size_t count) \ | ||
| 285 | { \ | ||
| 286 | return set_in_max(dev, buf, count, offset); \ | ||
| 287 | } \ | ||
| 288 | static DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \ | ||
| 289 | show_in##offset##_min, set_in##offset##_min); \ | ||
| 290 | static DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \ | ||
| 291 | show_in##offset##_max, set_in##offset##_max); | ||
| 292 | 264 | ||
| 293 | sysfs_in(0); | 265 | sysfs_in(0); |
| 294 | sysfs_in(1); | 266 | sysfs_in(1); |
| @@ -299,29 +271,36 @@ sysfs_in(5); | |||
| 299 | sysfs_in(6); | 271 | sysfs_in(6); |
| 300 | 272 | ||
| 301 | /* 3 Fans */ | 273 | /* 3 Fans */ |
| 302 | static ssize_t show_fan(struct device *dev, char *buf, int nr) | 274 | static ssize_t show_fan(struct device *dev, struct device_attribute *attr, |
| 275 | char *buf) | ||
| 303 | { | 276 | { |
| 277 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 304 | struct asb100_data *data = asb100_update_device(dev); | 278 | struct asb100_data *data = asb100_update_device(dev); |
| 305 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr], | 279 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr], |
| 306 | DIV_FROM_REG(data->fan_div[nr]))); | 280 | DIV_FROM_REG(data->fan_div[nr]))); |
| 307 | } | 281 | } |
| 308 | 282 | ||
| 309 | static ssize_t show_fan_min(struct device *dev, char *buf, int nr) | 283 | static ssize_t show_fan_min(struct device *dev, struct device_attribute *attr, |
| 284 | char *buf) | ||
| 310 | { | 285 | { |
| 286 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 311 | struct asb100_data *data = asb100_update_device(dev); | 287 | struct asb100_data *data = asb100_update_device(dev); |
| 312 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[nr], | 288 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[nr], |
| 313 | DIV_FROM_REG(data->fan_div[nr]))); | 289 | DIV_FROM_REG(data->fan_div[nr]))); |
| 314 | } | 290 | } |
| 315 | 291 | ||
| 316 | static ssize_t show_fan_div(struct device *dev, char *buf, int nr) | 292 | static ssize_t show_fan_div(struct device *dev, struct device_attribute *attr, |
| 293 | char *buf) | ||
| 317 | { | 294 | { |
| 295 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 318 | struct asb100_data *data = asb100_update_device(dev); | 296 | struct asb100_data *data = asb100_update_device(dev); |
| 319 | return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr])); | 297 | return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr])); |
| 320 | } | 298 | } |
| 321 | 299 | ||
| 322 | static ssize_t set_fan_min(struct device *dev, const char *buf, | 300 | static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr, |
| 323 | size_t count, int nr) | 301 | const char *buf, size_t count) |
| 324 | { | 302 | { |
| 303 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 325 | struct i2c_client *client = to_i2c_client(dev); | 304 | struct i2c_client *client = to_i2c_client(dev); |
| 326 | struct asb100_data *data = i2c_get_clientdata(client); | 305 | struct asb100_data *data = i2c_get_clientdata(client); |
| 327 | u32 val = simple_strtoul(buf, NULL, 10); | 306 | u32 val = simple_strtoul(buf, NULL, 10); |
| @@ -337,22 +316,23 @@ static ssize_t set_fan_min(struct device *dev, const char *buf, | |||
| 337 | determined in part by the fan divisor. This follows the principle of | 316 | determined in part by the fan divisor. This follows the principle of |
| 338 | least surprise; the user doesn't expect the fan minimum to change just | 317 | least surprise; the user doesn't expect the fan minimum to change just |
| 339 | because the divisor changed. */ | 318 | because the divisor changed. */ |
| 340 | static ssize_t set_fan_div(struct device *dev, const char *buf, | 319 | static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, |
| 341 | size_t count, int nr) | 320 | const char *buf, size_t count) |
| 342 | { | 321 | { |
| 322 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 343 | struct i2c_client *client = to_i2c_client(dev); | 323 | struct i2c_client *client = to_i2c_client(dev); |
| 344 | struct asb100_data *data = i2c_get_clientdata(client); | 324 | struct asb100_data *data = i2c_get_clientdata(client); |
| 345 | unsigned long min; | 325 | unsigned long min; |
| 346 | unsigned long val = simple_strtoul(buf, NULL, 10); | 326 | unsigned long val = simple_strtoul(buf, NULL, 10); |
| 347 | int reg; | 327 | int reg; |
| 348 | 328 | ||
| 349 | mutex_lock(&data->update_lock); | 329 | mutex_lock(&data->update_lock); |
| 350 | 330 | ||
| 351 | min = FAN_FROM_REG(data->fan_min[nr], | 331 | min = FAN_FROM_REG(data->fan_min[nr], |
| 352 | DIV_FROM_REG(data->fan_div[nr])); | 332 | DIV_FROM_REG(data->fan_div[nr])); |
| 353 | data->fan_div[nr] = DIV_TO_REG(val); | 333 | data->fan_div[nr] = DIV_TO_REG(val); |
| 354 | 334 | ||
| 355 | switch(nr) { | 335 | switch (nr) { |
| 356 | case 0: /* fan 1 */ | 336 | case 0: /* fan 1 */ |
| 357 | reg = asb100_read_value(client, ASB100_REG_VID_FANDIV); | 337 | reg = asb100_read_value(client, ASB100_REG_VID_FANDIV); |
| 358 | reg = (reg & 0xcf) | (data->fan_div[0] << 4); | 338 | reg = (reg & 0xcf) | (data->fan_div[0] << 4); |
| @@ -382,34 +362,12 @@ static ssize_t set_fan_div(struct device *dev, const char *buf, | |||
| 382 | } | 362 | } |
| 383 | 363 | ||
| 384 | #define sysfs_fan(offset) \ | 364 | #define sysfs_fan(offset) \ |
| 385 | static ssize_t show_fan##offset(struct device *dev, struct device_attribute *attr, char *buf) \ | 365 | static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO, \ |
| 386 | { \ | 366 | show_fan, NULL, offset - 1); \ |
| 387 | return show_fan(dev, buf, offset - 1); \ | 367 | static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \ |
| 388 | } \ | 368 | show_fan_min, set_fan_min, offset - 1); \ |
| 389 | static ssize_t show_fan##offset##_min(struct device *dev, struct device_attribute *attr, char *buf) \ | 369 | static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \ |
| 390 | { \ | 370 | show_fan_div, set_fan_div, offset - 1) |
| 391 | return show_fan_min(dev, buf, offset - 1); \ | ||
| 392 | } \ | ||
| 393 | static ssize_t show_fan##offset##_div(struct device *dev, struct device_attribute *attr, char *buf) \ | ||
| 394 | { \ | ||
| 395 | return show_fan_div(dev, buf, offset - 1); \ | ||
| 396 | } \ | ||
| 397 | static ssize_t set_fan##offset##_min(struct device *dev, struct device_attribute *attr, const char *buf, \ | ||
| 398 | size_t count) \ | ||
| 399 | { \ | ||
| 400 | return set_fan_min(dev, buf, count, offset - 1); \ | ||
| 401 | } \ | ||
| 402 | static ssize_t set_fan##offset##_div(struct device *dev, struct device_attribute *attr, const char *buf, \ | ||
| 403 | size_t count) \ | ||
| 404 | { \ | ||
| 405 | return set_fan_div(dev, buf, count, offset - 1); \ | ||
| 406 | } \ | ||
| 407 | static DEVICE_ATTR(fan##offset##_input, S_IRUGO, \ | ||
| 408 | show_fan##offset, NULL); \ | ||
| 409 | static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \ | ||
| 410 | show_fan##offset##_min, set_fan##offset##_min); \ | ||
| 411 | static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \ | ||
| 412 | show_fan##offset##_div, set_fan##offset##_div); | ||
| 413 | 371 | ||
| 414 | sysfs_fan(1); | 372 | sysfs_fan(1); |
| 415 | sysfs_fan(2); | 373 | sysfs_fan(2); |
| @@ -430,10 +388,12 @@ static int sprintf_temp_from_reg(u16 reg, char *buf, int nr) | |||
| 430 | } | 388 | } |
| 431 | return ret; | 389 | return ret; |
| 432 | } | 390 | } |
| 433 | 391 | ||
| 434 | #define show_temp_reg(reg) \ | 392 | #define show_temp_reg(reg) \ |
| 435 | static ssize_t show_##reg(struct device *dev, char *buf, int nr) \ | 393 | static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \ |
| 394 | char *buf) \ | ||
| 436 | { \ | 395 | { \ |
| 396 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 437 | struct asb100_data *data = asb100_update_device(dev); \ | 397 | struct asb100_data *data = asb100_update_device(dev); \ |
| 438 | return sprintf_temp_from_reg(data->reg[nr], buf, nr); \ | 398 | return sprintf_temp_from_reg(data->reg[nr], buf, nr); \ |
| 439 | } | 399 | } |
| @@ -443,9 +403,10 @@ show_temp_reg(temp_max); | |||
| 443 | show_temp_reg(temp_hyst); | 403 | show_temp_reg(temp_hyst); |
| 444 | 404 | ||
| 445 | #define set_temp_reg(REG, reg) \ | 405 | #define set_temp_reg(REG, reg) \ |
| 446 | static ssize_t set_##reg(struct device *dev, const char *buf, \ | 406 | static ssize_t set_##reg(struct device *dev, struct device_attribute *attr, \ |
| 447 | size_t count, int nr) \ | 407 | const char *buf, size_t count) \ |
| 448 | { \ | 408 | { \ |
| 409 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 449 | struct i2c_client *client = to_i2c_client(dev); \ | 410 | struct i2c_client *client = to_i2c_client(dev); \ |
| 450 | struct asb100_data *data = i2c_get_clientdata(client); \ | 411 | struct asb100_data *data = i2c_get_clientdata(client); \ |
| 451 | long val = simple_strtol(buf, NULL, 10); \ | 412 | long val = simple_strtol(buf, NULL, 10); \ |
| @@ -469,33 +430,12 @@ set_temp_reg(MAX, temp_max); | |||
| 469 | set_temp_reg(HYST, temp_hyst); | 430 | set_temp_reg(HYST, temp_hyst); |
| 470 | 431 | ||
| 471 | #define sysfs_temp(num) \ | 432 | #define sysfs_temp(num) \ |
| 472 | static ssize_t show_temp##num(struct device *dev, struct device_attribute *attr, char *buf) \ | 433 | static SENSOR_DEVICE_ATTR(temp##num##_input, S_IRUGO, \ |
| 473 | { \ | 434 | show_temp, NULL, num - 1); \ |
| 474 | return show_temp(dev, buf, num-1); \ | 435 | static SENSOR_DEVICE_ATTR(temp##num##_max, S_IRUGO | S_IWUSR, \ |
| 475 | } \ | 436 | show_temp_max, set_temp_max, num - 1); \ |
| 476 | static DEVICE_ATTR(temp##num##_input, S_IRUGO, show_temp##num, NULL); \ | 437 | static SENSOR_DEVICE_ATTR(temp##num##_max_hyst, S_IRUGO | S_IWUSR, \ |
| 477 | static ssize_t show_temp_max##num(struct device *dev, struct device_attribute *attr, char *buf) \ | 438 | show_temp_hyst, set_temp_hyst, num - 1) |
| 478 | { \ | ||
| 479 | return show_temp_max(dev, buf, num-1); \ | ||
| 480 | } \ | ||
| 481 | static ssize_t set_temp_max##num(struct device *dev, struct device_attribute *attr, const char *buf, \ | ||
| 482 | size_t count) \ | ||
| 483 | { \ | ||
| 484 | return set_temp_max(dev, buf, count, num-1); \ | ||
| 485 | } \ | ||
| 486 | static DEVICE_ATTR(temp##num##_max, S_IRUGO | S_IWUSR, \ | ||
| 487 | show_temp_max##num, set_temp_max##num); \ | ||
| 488 | static ssize_t show_temp_hyst##num(struct device *dev, struct device_attribute *attr, char *buf) \ | ||
| 489 | { \ | ||
| 490 | return show_temp_hyst(dev, buf, num-1); \ | ||
| 491 | } \ | ||
| 492 | static ssize_t set_temp_hyst##num(struct device *dev, struct device_attribute *attr, const char *buf, \ | ||
| 493 | size_t count) \ | ||
| 494 | { \ | ||
| 495 | return set_temp_hyst(dev, buf, count, num-1); \ | ||
| 496 | } \ | ||
| 497 | static DEVICE_ATTR(temp##num##_max_hyst, S_IRUGO | S_IWUSR, \ | ||
| 498 | show_temp_hyst##num, set_temp_hyst##num); | ||
| 499 | 439 | ||
| 500 | sysfs_temp(1); | 440 | sysfs_temp(1); |
| 501 | sysfs_temp(2); | 441 | sysfs_temp(2); |
| @@ -503,7 +443,8 @@ sysfs_temp(3); | |||
| 503 | sysfs_temp(4); | 443 | sysfs_temp(4); |
| 504 | 444 | ||
| 505 | /* VID */ | 445 | /* VID */ |
| 506 | static ssize_t show_vid(struct device *dev, struct device_attribute *attr, char *buf) | 446 | static ssize_t show_vid(struct device *dev, struct device_attribute *attr, |
| 447 | char *buf) | ||
| 507 | { | 448 | { |
| 508 | struct asb100_data *data = asb100_update_device(dev); | 449 | struct asb100_data *data = asb100_update_device(dev); |
| 509 | return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm)); | 450 | return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm)); |
| @@ -512,25 +453,26 @@ static ssize_t show_vid(struct device *dev, struct device_attribute *attr, char | |||
| 512 | static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL); | 453 | static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL); |
| 513 | 454 | ||
| 514 | /* VRM */ | 455 | /* VRM */ |
| 515 | static ssize_t show_vrm(struct device *dev, struct device_attribute *attr, char *buf) | 456 | static ssize_t show_vrm(struct device *dev, struct device_attribute *attr, |
| 457 | char *buf) | ||
| 516 | { | 458 | { |
| 517 | struct asb100_data *data = dev_get_drvdata(dev); | 459 | struct asb100_data *data = dev_get_drvdata(dev); |
| 518 | return sprintf(buf, "%d\n", data->vrm); | 460 | return sprintf(buf, "%d\n", data->vrm); |
| 519 | } | 461 | } |
| 520 | 462 | ||
| 521 | static ssize_t set_vrm(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | 463 | static ssize_t set_vrm(struct device *dev, struct device_attribute *attr, |
| 464 | const char *buf, size_t count) | ||
| 522 | { | 465 | { |
| 523 | struct i2c_client *client = to_i2c_client(dev); | 466 | struct asb100_data *data = dev_get_drvdata(dev); |
| 524 | struct asb100_data *data = i2c_get_clientdata(client); | 467 | data->vrm = simple_strtoul(buf, NULL, 10); |
| 525 | unsigned long val = simple_strtoul(buf, NULL, 10); | ||
| 526 | data->vrm = val; | ||
| 527 | return count; | 468 | return count; |
| 528 | } | 469 | } |
| 529 | 470 | ||
| 530 | /* Alarms */ | 471 | /* Alarms */ |
| 531 | static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm, set_vrm); | 472 | static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm, set_vrm); |
| 532 | 473 | ||
| 533 | static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf) | 474 | static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, |
| 475 | char *buf) | ||
| 534 | { | 476 | { |
| 535 | struct asb100_data *data = asb100_update_device(dev); | 477 | struct asb100_data *data = asb100_update_device(dev); |
| 536 | return sprintf(buf, "%u\n", data->alarms); | 478 | return sprintf(buf, "%u\n", data->alarms); |
| @@ -538,14 +480,35 @@ static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, ch | |||
| 538 | 480 | ||
| 539 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); | 481 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); |
| 540 | 482 | ||
| 483 | static ssize_t show_alarm(struct device *dev, struct device_attribute *attr, | ||
| 484 | char *buf) | ||
| 485 | { | ||
| 486 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 487 | struct asb100_data *data = asb100_update_device(dev); | ||
| 488 | return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); | ||
| 489 | } | ||
| 490 | static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0); | ||
| 491 | static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1); | ||
| 492 | static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2); | ||
| 493 | static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3); | ||
| 494 | static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8); | ||
| 495 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6); | ||
| 496 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7); | ||
| 497 | static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11); | ||
| 498 | static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4); | ||
| 499 | static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5); | ||
| 500 | static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 13); | ||
| 501 | |||
| 541 | /* 1 PWM */ | 502 | /* 1 PWM */ |
| 542 | static ssize_t show_pwm1(struct device *dev, struct device_attribute *attr, char *buf) | 503 | static ssize_t show_pwm1(struct device *dev, struct device_attribute *attr, |
| 504 | char *buf) | ||
| 543 | { | 505 | { |
| 544 | struct asb100_data *data = asb100_update_device(dev); | 506 | struct asb100_data *data = asb100_update_device(dev); |
| 545 | return sprintf(buf, "%d\n", ASB100_PWM_FROM_REG(data->pwm & 0x0f)); | 507 | return sprintf(buf, "%d\n", ASB100_PWM_FROM_REG(data->pwm & 0x0f)); |
| 546 | } | 508 | } |
| 547 | 509 | ||
| 548 | static ssize_t set_pwm1(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | 510 | static ssize_t set_pwm1(struct device *dev, struct device_attribute *attr, |
| 511 | const char *buf, size_t count) | ||
| 549 | { | 512 | { |
| 550 | struct i2c_client *client = to_i2c_client(dev); | 513 | struct i2c_client *client = to_i2c_client(dev); |
| 551 | struct asb100_data *data = i2c_get_clientdata(client); | 514 | struct asb100_data *data = i2c_get_clientdata(client); |
| @@ -559,14 +522,15 @@ static ssize_t set_pwm1(struct device *dev, struct device_attribute *attr, const | |||
| 559 | return count; | 522 | return count; |
| 560 | } | 523 | } |
| 561 | 524 | ||
| 562 | static ssize_t show_pwm_enable1(struct device *dev, struct device_attribute *attr, char *buf) | 525 | static ssize_t show_pwm_enable1(struct device *dev, |
| 526 | struct device_attribute *attr, char *buf) | ||
| 563 | { | 527 | { |
| 564 | struct asb100_data *data = asb100_update_device(dev); | 528 | struct asb100_data *data = asb100_update_device(dev); |
| 565 | return sprintf(buf, "%d\n", (data->pwm & 0x80) ? 1 : 0); | 529 | return sprintf(buf, "%d\n", (data->pwm & 0x80) ? 1 : 0); |
| 566 | } | 530 | } |
| 567 | 531 | ||
| 568 | static ssize_t set_pwm_enable1(struct device *dev, struct device_attribute *attr, const char *buf, | 532 | static ssize_t set_pwm_enable1(struct device *dev, |
| 569 | size_t count) | 533 | struct device_attribute *attr, const char *buf, size_t count) |
| 570 | { | 534 | { |
| 571 | struct i2c_client *client = to_i2c_client(dev); | 535 | struct i2c_client *client = to_i2c_client(dev); |
| 572 | struct asb100_data *data = i2c_get_clientdata(client); | 536 | struct asb100_data *data = i2c_get_clientdata(client); |
| @@ -585,50 +549,62 @@ static DEVICE_ATTR(pwm1_enable, S_IRUGO | S_IWUSR, | |||
| 585 | show_pwm_enable1, set_pwm_enable1); | 549 | show_pwm_enable1, set_pwm_enable1); |
| 586 | 550 | ||
| 587 | static struct attribute *asb100_attributes[] = { | 551 | static struct attribute *asb100_attributes[] = { |
| 588 | &dev_attr_in0_input.attr, | 552 | &sensor_dev_attr_in0_input.dev_attr.attr, |
| 589 | &dev_attr_in0_min.attr, | 553 | &sensor_dev_attr_in0_min.dev_attr.attr, |
| 590 | &dev_attr_in0_max.attr, | 554 | &sensor_dev_attr_in0_max.dev_attr.attr, |
| 591 | &dev_attr_in1_input.attr, | 555 | &sensor_dev_attr_in1_input.dev_attr.attr, |
| 592 | &dev_attr_in1_min.attr, | 556 | &sensor_dev_attr_in1_min.dev_attr.attr, |
| 593 | &dev_attr_in1_max.attr, | 557 | &sensor_dev_attr_in1_max.dev_attr.attr, |
| 594 | &dev_attr_in2_input.attr, | 558 | &sensor_dev_attr_in2_input.dev_attr.attr, |
| 595 | &dev_attr_in2_min.attr, | 559 | &sensor_dev_attr_in2_min.dev_attr.attr, |
| 596 | &dev_attr_in2_max.attr, | 560 | &sensor_dev_attr_in2_max.dev_attr.attr, |
| 597 | &dev_attr_in3_input.attr, | 561 | &sensor_dev_attr_in3_input.dev_attr.attr, |
| 598 | &dev_attr_in3_min.attr, | 562 | &sensor_dev_attr_in3_min.dev_attr.attr, |
| 599 | &dev_attr_in3_max.attr, | 563 | &sensor_dev_attr_in3_max.dev_attr.attr, |
| 600 | &dev_attr_in4_input.attr, | 564 | &sensor_dev_attr_in4_input.dev_attr.attr, |
| 601 | &dev_attr_in4_min.attr, | 565 | &sensor_dev_attr_in4_min.dev_attr.attr, |
| 602 | &dev_attr_in4_max.attr, | 566 | &sensor_dev_attr_in4_max.dev_attr.attr, |
| 603 | &dev_attr_in5_input.attr, | 567 | &sensor_dev_attr_in5_input.dev_attr.attr, |
| 604 | &dev_attr_in5_min.attr, | 568 | &sensor_dev_attr_in5_min.dev_attr.attr, |
| 605 | &dev_attr_in5_max.attr, | 569 | &sensor_dev_attr_in5_max.dev_attr.attr, |
| 606 | &dev_attr_in6_input.attr, | 570 | &sensor_dev_attr_in6_input.dev_attr.attr, |
| 607 | &dev_attr_in6_min.attr, | 571 | &sensor_dev_attr_in6_min.dev_attr.attr, |
| 608 | &dev_attr_in6_max.attr, | 572 | &sensor_dev_attr_in6_max.dev_attr.attr, |
| 609 | 573 | ||
| 610 | &dev_attr_fan1_input.attr, | 574 | &sensor_dev_attr_fan1_input.dev_attr.attr, |
| 611 | &dev_attr_fan1_min.attr, | 575 | &sensor_dev_attr_fan1_min.dev_attr.attr, |
| 612 | &dev_attr_fan1_div.attr, | 576 | &sensor_dev_attr_fan1_div.dev_attr.attr, |
| 613 | &dev_attr_fan2_input.attr, | 577 | &sensor_dev_attr_fan2_input.dev_attr.attr, |
| 614 | &dev_attr_fan2_min.attr, | 578 | &sensor_dev_attr_fan2_min.dev_attr.attr, |
| 615 | &dev_attr_fan2_div.attr, | 579 | &sensor_dev_attr_fan2_div.dev_attr.attr, |
| 616 | &dev_attr_fan3_input.attr, | 580 | &sensor_dev_attr_fan3_input.dev_attr.attr, |
| 617 | &dev_attr_fan3_min.attr, | 581 | &sensor_dev_attr_fan3_min.dev_attr.attr, |
| 618 | &dev_attr_fan3_div.attr, | 582 | &sensor_dev_attr_fan3_div.dev_attr.attr, |
| 619 | 583 | ||
| 620 | &dev_attr_temp1_input.attr, | 584 | &sensor_dev_attr_temp1_input.dev_attr.attr, |
| 621 | &dev_attr_temp1_max.attr, | 585 | &sensor_dev_attr_temp1_max.dev_attr.attr, |
| 622 | &dev_attr_temp1_max_hyst.attr, | 586 | &sensor_dev_attr_temp1_max_hyst.dev_attr.attr, |
| 623 | &dev_attr_temp2_input.attr, | 587 | &sensor_dev_attr_temp2_input.dev_attr.attr, |
| 624 | &dev_attr_temp2_max.attr, | 588 | &sensor_dev_attr_temp2_max.dev_attr.attr, |
| 625 | &dev_attr_temp2_max_hyst.attr, | 589 | &sensor_dev_attr_temp2_max_hyst.dev_attr.attr, |
| 626 | &dev_attr_temp3_input.attr, | 590 | &sensor_dev_attr_temp3_input.dev_attr.attr, |
| 627 | &dev_attr_temp3_max.attr, | 591 | &sensor_dev_attr_temp3_max.dev_attr.attr, |
| 628 | &dev_attr_temp3_max_hyst.attr, | 592 | &sensor_dev_attr_temp3_max_hyst.dev_attr.attr, |
| 629 | &dev_attr_temp4_input.attr, | 593 | &sensor_dev_attr_temp4_input.dev_attr.attr, |
| 630 | &dev_attr_temp4_max.attr, | 594 | &sensor_dev_attr_temp4_max.dev_attr.attr, |
| 631 | &dev_attr_temp4_max_hyst.attr, | 595 | &sensor_dev_attr_temp4_max_hyst.dev_attr.attr, |
| 596 | |||
| 597 | &sensor_dev_attr_in0_alarm.dev_attr.attr, | ||
| 598 | &sensor_dev_attr_in1_alarm.dev_attr.attr, | ||
| 599 | &sensor_dev_attr_in2_alarm.dev_attr.attr, | ||
| 600 | &sensor_dev_attr_in3_alarm.dev_attr.attr, | ||
| 601 | &sensor_dev_attr_in4_alarm.dev_attr.attr, | ||
| 602 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, | ||
| 603 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, | ||
| 604 | &sensor_dev_attr_fan3_alarm.dev_attr.attr, | ||
| 605 | &sensor_dev_attr_temp1_alarm.dev_attr.attr, | ||
| 606 | &sensor_dev_attr_temp2_alarm.dev_attr.attr, | ||
| 607 | &sensor_dev_attr_temp3_alarm.dev_attr.attr, | ||
| 632 | 608 | ||
| 633 | &dev_attr_cpu0_vid.attr, | 609 | &dev_attr_cpu0_vid.attr, |
| 634 | &dev_attr_vrm.attr, | 610 | &dev_attr_vrm.attr, |
| @@ -656,10 +632,10 @@ static int asb100_attach_adapter(struct i2c_adapter *adapter) | |||
| 656 | } | 632 | } |
| 657 | 633 | ||
| 658 | static int asb100_detect_subclients(struct i2c_adapter *adapter, int address, | 634 | static int asb100_detect_subclients(struct i2c_adapter *adapter, int address, |
| 659 | int kind, struct i2c_client *new_client) | 635 | int kind, struct i2c_client *client) |
| 660 | { | 636 | { |
| 661 | int i, id, err; | 637 | int i, id, err; |
| 662 | struct asb100_data *data = i2c_get_clientdata(new_client); | 638 | struct asb100_data *data = i2c_get_clientdata(client); |
| 663 | 639 | ||
| 664 | data->lm75[0] = kzalloc(sizeof(struct i2c_client), GFP_KERNEL); | 640 | data->lm75[0] = kzalloc(sizeof(struct i2c_client), GFP_KERNEL); |
| 665 | if (!(data->lm75[0])) { | 641 | if (!(data->lm75[0])) { |
| @@ -679,26 +655,26 @@ static int asb100_detect_subclients(struct i2c_adapter *adapter, int address, | |||
| 679 | for (i = 2; i <= 3; i++) { | 655 | for (i = 2; i <= 3; i++) { |
| 680 | if (force_subclients[i] < 0x48 || | 656 | if (force_subclients[i] < 0x48 || |
| 681 | force_subclients[i] > 0x4f) { | 657 | force_subclients[i] > 0x4f) { |
| 682 | dev_err(&new_client->dev, "invalid subclient " | 658 | dev_err(&client->dev, "invalid subclient " |
| 683 | "address %d; must be 0x48-0x4f\n", | 659 | "address %d; must be 0x48-0x4f\n", |
| 684 | force_subclients[i]); | 660 | force_subclients[i]); |
| 685 | err = -ENODEV; | 661 | err = -ENODEV; |
| 686 | goto ERROR_SC_2; | 662 | goto ERROR_SC_2; |
| 687 | } | 663 | } |
| 688 | } | 664 | } |
| 689 | asb100_write_value(new_client, ASB100_REG_I2C_SUBADDR, | 665 | asb100_write_value(client, ASB100_REG_I2C_SUBADDR, |
| 690 | (force_subclients[2] & 0x07) | | 666 | (force_subclients[2] & 0x07) | |
| 691 | ((force_subclients[3] & 0x07) <<4)); | 667 | ((force_subclients[3] & 0x07) << 4)); |
| 692 | data->lm75[0]->addr = force_subclients[2]; | 668 | data->lm75[0]->addr = force_subclients[2]; |
| 693 | data->lm75[1]->addr = force_subclients[3]; | 669 | data->lm75[1]->addr = force_subclients[3]; |
| 694 | } else { | 670 | } else { |
| 695 | int val = asb100_read_value(new_client, ASB100_REG_I2C_SUBADDR); | 671 | int val = asb100_read_value(client, ASB100_REG_I2C_SUBADDR); |
| 696 | data->lm75[0]->addr = 0x48 + (val & 0x07); | 672 | data->lm75[0]->addr = 0x48 + (val & 0x07); |
| 697 | data->lm75[1]->addr = 0x48 + ((val >> 4) & 0x07); | 673 | data->lm75[1]->addr = 0x48 + ((val >> 4) & 0x07); |
| 698 | } | 674 | } |
| 699 | 675 | ||
| 700 | if(data->lm75[0]->addr == data->lm75[1]->addr) { | 676 | if (data->lm75[0]->addr == data->lm75[1]->addr) { |
| 701 | dev_err(&new_client->dev, "duplicate addresses 0x%x " | 677 | dev_err(&client->dev, "duplicate addresses 0x%x " |
| 702 | "for subclients\n", data->lm75[0]->addr); | 678 | "for subclients\n", data->lm75[0]->addr); |
| 703 | err = -ENODEV; | 679 | err = -ENODEV; |
| 704 | goto ERROR_SC_2; | 680 | goto ERROR_SC_2; |
| @@ -708,18 +684,17 @@ static int asb100_detect_subclients(struct i2c_adapter *adapter, int address, | |||
| 708 | i2c_set_clientdata(data->lm75[i], NULL); | 684 | i2c_set_clientdata(data->lm75[i], NULL); |
| 709 | data->lm75[i]->adapter = adapter; | 685 | data->lm75[i]->adapter = adapter; |
| 710 | data->lm75[i]->driver = &asb100_driver; | 686 | data->lm75[i]->driver = &asb100_driver; |
| 711 | data->lm75[i]->flags = 0; | ||
| 712 | strlcpy(data->lm75[i]->name, "asb100 subclient", I2C_NAME_SIZE); | 687 | strlcpy(data->lm75[i]->name, "asb100 subclient", I2C_NAME_SIZE); |
| 713 | } | 688 | } |
| 714 | 689 | ||
| 715 | if ((err = i2c_attach_client(data->lm75[0]))) { | 690 | if ((err = i2c_attach_client(data->lm75[0]))) { |
| 716 | dev_err(&new_client->dev, "subclient %d registration " | 691 | dev_err(&client->dev, "subclient %d registration " |
| 717 | "at address 0x%x failed.\n", i, data->lm75[0]->addr); | 692 | "at address 0x%x failed.\n", i, data->lm75[0]->addr); |
| 718 | goto ERROR_SC_2; | 693 | goto ERROR_SC_2; |
| 719 | } | 694 | } |
| 720 | 695 | ||
| 721 | if ((err = i2c_attach_client(data->lm75[1]))) { | 696 | if ((err = i2c_attach_client(data->lm75[1]))) { |
| 722 | dev_err(&new_client->dev, "subclient %d registration " | 697 | dev_err(&client->dev, "subclient %d registration " |
| 723 | "at address 0x%x failed.\n", i, data->lm75[1]->addr); | 698 | "at address 0x%x failed.\n", i, data->lm75[1]->addr); |
| 724 | goto ERROR_SC_3; | 699 | goto ERROR_SC_3; |
| 725 | } | 700 | } |
| @@ -740,7 +715,7 @@ ERROR_SC_0: | |||
| 740 | static int asb100_detect(struct i2c_adapter *adapter, int address, int kind) | 715 | static int asb100_detect(struct i2c_adapter *adapter, int address, int kind) |
| 741 | { | 716 | { |
| 742 | int err; | 717 | int err; |
| 743 | struct i2c_client *new_client; | 718 | struct i2c_client *client; |
| 744 | struct asb100_data *data; | 719 | struct asb100_data *data; |
| 745 | 720 | ||
| 746 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) { | 721 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) { |
| @@ -760,13 +735,12 @@ static int asb100_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 760 | goto ERROR0; | 735 | goto ERROR0; |
| 761 | } | 736 | } |
| 762 | 737 | ||
| 763 | new_client = &data->client; | 738 | client = &data->client; |
| 764 | mutex_init(&data->lock); | 739 | mutex_init(&data->lock); |
| 765 | i2c_set_clientdata(new_client, data); | 740 | i2c_set_clientdata(client, data); |
| 766 | new_client->addr = address; | 741 | client->addr = address; |
| 767 | new_client->adapter = adapter; | 742 | client->adapter = adapter; |
| 768 | new_client->driver = &asb100_driver; | 743 | client->driver = &asb100_driver; |
| 769 | new_client->flags = 0; | ||
| 770 | 744 | ||
| 771 | /* Now, we do the remaining detection. */ | 745 | /* Now, we do the remaining detection. */ |
| 772 | 746 | ||
| @@ -776,15 +750,15 @@ static int asb100_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 776 | bank. */ | 750 | bank. */ |
| 777 | if (kind < 0) { | 751 | if (kind < 0) { |
| 778 | 752 | ||
| 779 | int val1 = asb100_read_value(new_client, ASB100_REG_BANK); | 753 | int val1 = asb100_read_value(client, ASB100_REG_BANK); |
| 780 | int val2 = asb100_read_value(new_client, ASB100_REG_CHIPMAN); | 754 | int val2 = asb100_read_value(client, ASB100_REG_CHIPMAN); |
| 781 | 755 | ||
| 782 | /* If we're in bank 0 */ | 756 | /* If we're in bank 0 */ |
| 783 | if ( (!(val1 & 0x07)) && | 757 | if ((!(val1 & 0x07)) && |
| 784 | /* Check for ASB100 ID (low byte) */ | 758 | /* Check for ASB100 ID (low byte) */ |
| 785 | ( ((!(val1 & 0x80)) && (val2 != 0x94)) || | 759 | (((!(val1 & 0x80)) && (val2 != 0x94)) || |
| 786 | /* Check for ASB100 ID (high byte ) */ | 760 | /* Check for ASB100 ID (high byte ) */ |
| 787 | ((val1 & 0x80) && (val2 != 0x06)) ) ) { | 761 | ((val1 & 0x80) && (val2 != 0x06)))) { |
| 788 | pr_debug("asb100.o: detect failed, " | 762 | pr_debug("asb100.o: detect failed, " |
| 789 | "bad chip id 0x%02x!\n", val2); | 763 | "bad chip id 0x%02x!\n", val2); |
| 790 | err = -ENODEV; | 764 | err = -ENODEV; |
| @@ -795,19 +769,19 @@ static int asb100_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 795 | 769 | ||
| 796 | /* We have either had a force parameter, or we have already detected | 770 | /* We have either had a force parameter, or we have already detected |
| 797 | Winbond. Put it now into bank 0 and Vendor ID High Byte */ | 771 | Winbond. Put it now into bank 0 and Vendor ID High Byte */ |
| 798 | asb100_write_value(new_client, ASB100_REG_BANK, | 772 | asb100_write_value(client, ASB100_REG_BANK, |
| 799 | (asb100_read_value(new_client, ASB100_REG_BANK) & 0x78) | 0x80); | 773 | (asb100_read_value(client, ASB100_REG_BANK) & 0x78) | 0x80); |
| 800 | 774 | ||
| 801 | /* Determine the chip type. */ | 775 | /* Determine the chip type. */ |
| 802 | if (kind <= 0) { | 776 | if (kind <= 0) { |
| 803 | int val1 = asb100_read_value(new_client, ASB100_REG_WCHIPID); | 777 | int val1 = asb100_read_value(client, ASB100_REG_WCHIPID); |
| 804 | int val2 = asb100_read_value(new_client, ASB100_REG_CHIPMAN); | 778 | int val2 = asb100_read_value(client, ASB100_REG_CHIPMAN); |
| 805 | 779 | ||
| 806 | if ((val1 == 0x31) && (val2 == 0x06)) | 780 | if ((val1 == 0x31) && (val2 == 0x06)) |
| 807 | kind = asb100; | 781 | kind = asb100; |
| 808 | else { | 782 | else { |
| 809 | if (kind == 0) | 783 | if (kind == 0) |
| 810 | dev_warn(&new_client->dev, "ignoring " | 784 | dev_warn(&client->dev, "ignoring " |
| 811 | "'force' parameter for unknown chip " | 785 | "'force' parameter for unknown chip " |
| 812 | "at adapter %d, address 0x%02x.\n", | 786 | "at adapter %d, address 0x%02x.\n", |
| 813 | i2c_adapter_id(adapter), address); | 787 | i2c_adapter_id(adapter), address); |
| @@ -817,34 +791,32 @@ static int asb100_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 817 | } | 791 | } |
| 818 | 792 | ||
| 819 | /* Fill in remaining client fields and put it into the global list */ | 793 | /* Fill in remaining client fields and put it into the global list */ |
| 820 | strlcpy(new_client->name, "asb100", I2C_NAME_SIZE); | 794 | strlcpy(client->name, "asb100", I2C_NAME_SIZE); |
| 821 | data->type = kind; | 795 | data->type = kind; |
| 822 | |||
| 823 | data->valid = 0; | ||
| 824 | mutex_init(&data->update_lock); | 796 | mutex_init(&data->update_lock); |
| 825 | 797 | ||
| 826 | /* Tell the I2C layer a new client has arrived */ | 798 | /* Tell the I2C layer a new client has arrived */ |
| 827 | if ((err = i2c_attach_client(new_client))) | 799 | if ((err = i2c_attach_client(client))) |
| 828 | goto ERROR1; | 800 | goto ERROR1; |
| 829 | 801 | ||
| 830 | /* Attach secondary lm75 clients */ | 802 | /* Attach secondary lm75 clients */ |
| 831 | if ((err = asb100_detect_subclients(adapter, address, kind, | 803 | if ((err = asb100_detect_subclients(adapter, address, kind, |
| 832 | new_client))) | 804 | client))) |
| 833 | goto ERROR2; | 805 | goto ERROR2; |
| 834 | 806 | ||
| 835 | /* Initialize the chip */ | 807 | /* Initialize the chip */ |
| 836 | asb100_init_client(new_client); | 808 | asb100_init_client(client); |
| 837 | 809 | ||
| 838 | /* A few vars need to be filled upon startup */ | 810 | /* A few vars need to be filled upon startup */ |
| 839 | data->fan_min[0] = asb100_read_value(new_client, ASB100_REG_FAN_MIN(0)); | 811 | data->fan_min[0] = asb100_read_value(client, ASB100_REG_FAN_MIN(0)); |
| 840 | data->fan_min[1] = asb100_read_value(new_client, ASB100_REG_FAN_MIN(1)); | 812 | data->fan_min[1] = asb100_read_value(client, ASB100_REG_FAN_MIN(1)); |
| 841 | data->fan_min[2] = asb100_read_value(new_client, ASB100_REG_FAN_MIN(2)); | 813 | data->fan_min[2] = asb100_read_value(client, ASB100_REG_FAN_MIN(2)); |
| 842 | 814 | ||
| 843 | /* Register sysfs hooks */ | 815 | /* Register sysfs hooks */ |
| 844 | if ((err = sysfs_create_group(&new_client->dev.kobj, &asb100_group))) | 816 | if ((err = sysfs_create_group(&client->dev.kobj, &asb100_group))) |
| 845 | goto ERROR3; | 817 | goto ERROR3; |
| 846 | 818 | ||
| 847 | data->hwmon_dev = hwmon_device_register(&new_client->dev); | 819 | data->hwmon_dev = hwmon_device_register(&client->dev); |
| 848 | if (IS_ERR(data->hwmon_dev)) { | 820 | if (IS_ERR(data->hwmon_dev)) { |
| 849 | err = PTR_ERR(data->hwmon_dev); | 821 | err = PTR_ERR(data->hwmon_dev); |
| 850 | goto ERROR4; | 822 | goto ERROR4; |
| @@ -853,14 +825,14 @@ static int asb100_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 853 | return 0; | 825 | return 0; |
| 854 | 826 | ||
| 855 | ERROR4: | 827 | ERROR4: |
| 856 | sysfs_remove_group(&new_client->dev.kobj, &asb100_group); | 828 | sysfs_remove_group(&client->dev.kobj, &asb100_group); |
| 857 | ERROR3: | 829 | ERROR3: |
| 858 | i2c_detach_client(data->lm75[1]); | 830 | i2c_detach_client(data->lm75[1]); |
| 859 | i2c_detach_client(data->lm75[0]); | 831 | i2c_detach_client(data->lm75[0]); |
| 860 | kfree(data->lm75[1]); | 832 | kfree(data->lm75[1]); |
| 861 | kfree(data->lm75[0]); | 833 | kfree(data->lm75[0]); |
| 862 | ERROR2: | 834 | ERROR2: |
| 863 | i2c_detach_client(new_client); | 835 | i2c_detach_client(client); |
| 864 | ERROR1: | 836 | ERROR1: |
| 865 | kfree(data); | 837 | kfree(data); |
| 866 | ERROR0: | 838 | ERROR0: |
| @@ -916,17 +888,17 @@ static int asb100_read_value(struct i2c_client *client, u16 reg) | |||
| 916 | /* convert from ISA to LM75 I2C addresses */ | 888 | /* convert from ISA to LM75 I2C addresses */ |
| 917 | switch (reg & 0xff) { | 889 | switch (reg & 0xff) { |
| 918 | case 0x50: /* TEMP */ | 890 | case 0x50: /* TEMP */ |
| 919 | res = swab16(i2c_smbus_read_word_data (cl, 0)); | 891 | res = swab16(i2c_smbus_read_word_data(cl, 0)); |
| 920 | break; | 892 | break; |
| 921 | case 0x52: /* CONFIG */ | 893 | case 0x52: /* CONFIG */ |
| 922 | res = i2c_smbus_read_byte_data(cl, 1); | 894 | res = i2c_smbus_read_byte_data(cl, 1); |
| 923 | break; | 895 | break; |
| 924 | case 0x53: /* HYST */ | 896 | case 0x53: /* HYST */ |
| 925 | res = swab16(i2c_smbus_read_word_data (cl, 2)); | 897 | res = swab16(i2c_smbus_read_word_data(cl, 2)); |
| 926 | break; | 898 | break; |
| 927 | case 0x55: /* MAX */ | 899 | case 0x55: /* MAX */ |
| 928 | default: | 900 | default: |
| 929 | res = swab16(i2c_smbus_read_word_data (cl, 3)); | 901 | res = swab16(i2c_smbus_read_word_data(cl, 3)); |
| 930 | break; | 902 | break; |
| 931 | } | 903 | } |
| 932 | } | 904 | } |
| @@ -989,7 +961,7 @@ static void asb100_init_client(struct i2c_client *client) | |||
| 989 | vid = vid_from_reg(vid, data->vrm); | 961 | vid = vid_from_reg(vid, data->vrm); |
| 990 | 962 | ||
| 991 | /* Start monitoring */ | 963 | /* Start monitoring */ |
| 992 | asb100_write_value(client, ASB100_REG_CONFIG, | 964 | asb100_write_value(client, ASB100_REG_CONFIG, |
| 993 | (asb100_read_value(client, ASB100_REG_CONFIG) & 0xf7) | 0x01); | 965 | (asb100_read_value(client, ASB100_REG_CONFIG) & 0xf7) | 0x01); |
| 994 | } | 966 | } |
| 995 | 967 | ||
| @@ -1078,4 +1050,3 @@ MODULE_LICENSE("GPL"); | |||
| 1078 | 1050 | ||
| 1079 | module_init(asb100_init); | 1051 | module_init(asb100_init); |
| 1080 | module_exit(asb100_exit); | 1052 | module_exit(asb100_exit); |
| 1081 | |||
diff --git a/drivers/hwmon/dme1737.c b/drivers/hwmon/dme1737.c index a878c98e252e..ddddd9f34c19 100644 --- a/drivers/hwmon/dme1737.c +++ b/drivers/hwmon/dme1737.c | |||
| @@ -44,6 +44,10 @@ static int force_start; | |||
| 44 | module_param(force_start, bool, 0); | 44 | module_param(force_start, bool, 0); |
| 45 | MODULE_PARM_DESC(force_start, "Force the chip to start monitoring inputs"); | 45 | MODULE_PARM_DESC(force_start, "Force the chip to start monitoring inputs"); |
| 46 | 46 | ||
| 47 | static unsigned short force_id; | ||
| 48 | module_param(force_id, ushort, 0); | ||
| 49 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 50 | |||
| 47 | /* Addresses to scan */ | 51 | /* Addresses to scan */ |
| 48 | static unsigned short normal_i2c[] = {0x2c, 0x2d, 0x2e, I2C_CLIENT_END}; | 52 | static unsigned short normal_i2c[] = {0x2c, 0x2d, 0x2e, I2C_CLIENT_END}; |
| 49 | 53 | ||
| @@ -279,14 +283,21 @@ static inline int TEMP_HYST_TO_REG(int val, int ix, int reg) | |||
| 279 | /* Fan input RPM */ | 283 | /* Fan input RPM */ |
| 280 | static inline int FAN_FROM_REG(int reg, int tpc) | 284 | static inline int FAN_FROM_REG(int reg, int tpc) |
| 281 | { | 285 | { |
| 282 | return (reg == 0 || reg == 0xffff) ? 0 : | 286 | if (tpc) { |
| 283 | (tpc == 0) ? 90000 * 60 / reg : tpc * reg; | 287 | return tpc * reg; |
| 288 | } else { | ||
| 289 | return (reg == 0 || reg == 0xffff) ? 0 : 90000 * 60 / reg; | ||
| 290 | } | ||
| 284 | } | 291 | } |
| 285 | 292 | ||
| 286 | static inline int FAN_TO_REG(int val, int tpc) | 293 | static inline int FAN_TO_REG(int val, int tpc) |
| 287 | { | 294 | { |
| 288 | return SENSORS_LIMIT((tpc == 0) ? 90000 * 60 / val : val / tpc, | 295 | if (tpc) { |
| 289 | 0, 0xffff); | 296 | return SENSORS_LIMIT(val / tpc, 0, 0xffff); |
| 297 | } else { | ||
| 298 | return (val <= 0) ? 0xffff : | ||
| 299 | SENSORS_LIMIT(90000 * 60 / val, 0, 0xfffe); | ||
| 300 | } | ||
| 290 | } | 301 | } |
| 291 | 302 | ||
| 292 | /* Fan TPC (tach pulse count) | 303 | /* Fan TPC (tach pulse count) |
| @@ -2019,7 +2030,7 @@ static int dme1737_i2c_get_features(int sio_cip, struct dme1737_data *data) | |||
| 2019 | 2030 | ||
| 2020 | /* Check device ID | 2031 | /* Check device ID |
| 2021 | * The DME1737 can return either 0x78 or 0x77 as its device ID. */ | 2032 | * The DME1737 can return either 0x78 or 0x77 as its device ID. */ |
| 2022 | reg = dme1737_sio_inb(sio_cip, 0x20); | 2033 | reg = force_id ? force_id : dme1737_sio_inb(sio_cip, 0x20); |
| 2023 | if (!(reg == 0x77 || reg == 0x78)) { | 2034 | if (!(reg == 0x77 || reg == 0x78)) { |
| 2024 | err = -ENODEV; | 2035 | err = -ENODEV; |
| 2025 | goto exit; | 2036 | goto exit; |
| @@ -2191,7 +2202,7 @@ static int __init dme1737_isa_detect(int sio_cip, unsigned short *addr) | |||
| 2191 | /* Check device ID | 2202 | /* Check device ID |
| 2192 | * We currently know about SCH3112 (0x7c), SCH3114 (0x7d), and | 2203 | * We currently know about SCH3112 (0x7c), SCH3114 (0x7d), and |
| 2193 | * SCH3116 (0x7f). */ | 2204 | * SCH3116 (0x7f). */ |
| 2194 | reg = dme1737_sio_inb(sio_cip, 0x20); | 2205 | reg = force_id ? force_id : dme1737_sio_inb(sio_cip, 0x20); |
| 2195 | if (!(reg == 0x7c || reg == 0x7d || reg == 0x7f)) { | 2206 | if (!(reg == 0x7c || reg == 0x7d || reg == 0x7f)) { |
| 2196 | err = -ENODEV; | 2207 | err = -ENODEV; |
| 2197 | goto exit; | 2208 | goto exit; |
diff --git a/drivers/hwmon/ds1621.c b/drivers/hwmon/ds1621.c index b7bd000b130f..3f5163de13c1 100644 --- a/drivers/hwmon/ds1621.c +++ b/drivers/hwmon/ds1621.c | |||
| @@ -94,7 +94,6 @@ static struct i2c_driver ds1621_driver = { | |||
| 94 | .driver = { | 94 | .driver = { |
| 95 | .name = "ds1621", | 95 | .name = "ds1621", |
| 96 | }, | 96 | }, |
| 97 | .id = I2C_DRIVERID_DS1621, | ||
| 98 | .attach_adapter = ds1621_attach_adapter, | 97 | .attach_adapter = ds1621_attach_adapter, |
| 99 | .detach_client = ds1621_detach_client, | 98 | .detach_client = ds1621_detach_client, |
| 100 | }; | 99 | }; |
diff --git a/drivers/hwmon/f71805f.c b/drivers/hwmon/f71805f.c index 5d9d5cc816a2..7a14a2dbb752 100644 --- a/drivers/hwmon/f71805f.c +++ b/drivers/hwmon/f71805f.c | |||
| @@ -41,6 +41,10 @@ | |||
| 41 | #include <linux/ioport.h> | 41 | #include <linux/ioport.h> |
| 42 | #include <asm/io.h> | 42 | #include <asm/io.h> |
| 43 | 43 | ||
| 44 | static unsigned short force_id; | ||
| 45 | module_param(force_id, ushort, 0); | ||
| 46 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 47 | |||
| 44 | static struct platform_device *pdev; | 48 | static struct platform_device *pdev; |
| 45 | 49 | ||
| 46 | #define DRVNAME "f71805f" | 50 | #define DRVNAME "f71805f" |
| @@ -1497,7 +1501,7 @@ static int __init f71805f_find(int sioaddr, unsigned short *address, | |||
| 1497 | if (devid != SIO_FINTEK_ID) | 1501 | if (devid != SIO_FINTEK_ID) |
| 1498 | goto exit; | 1502 | goto exit; |
| 1499 | 1503 | ||
| 1500 | devid = superio_inw(sioaddr, SIO_REG_DEVID); | 1504 | devid = force_id ? force_id : superio_inw(sioaddr, SIO_REG_DEVID); |
| 1501 | switch (devid) { | 1505 | switch (devid) { |
| 1502 | case SIO_F71805F_ID: | 1506 | case SIO_F71805F_ID: |
| 1503 | sio_data->kind = f71805f; | 1507 | sio_data->kind = f71805f; |
diff --git a/drivers/hwmon/f71882fg.c b/drivers/hwmon/f71882fg.c index 6db74434a02e..cbeb4984b5c7 100644 --- a/drivers/hwmon/f71882fg.c +++ b/drivers/hwmon/f71882fg.c | |||
| @@ -74,6 +74,10 @@ | |||
| 74 | 74 | ||
| 75 | #define FAN_MIN_DETECT 366 /* Lowest detectable fanspeed */ | 75 | #define FAN_MIN_DETECT 366 /* Lowest detectable fanspeed */ |
| 76 | 76 | ||
| 77 | static unsigned short force_id; | ||
| 78 | module_param(force_id, ushort, 0); | ||
| 79 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 80 | |||
| 77 | static struct platform_device *f71882fg_pdev = NULL; | 81 | static struct platform_device *f71882fg_pdev = NULL; |
| 78 | 82 | ||
| 79 | /* Super-I/O Function prototypes */ | 83 | /* Super-I/O Function prototypes */ |
| @@ -843,7 +847,7 @@ static int __init f71882fg_find(int sioaddr, unsigned short *address) | |||
| 843 | goto exit; | 847 | goto exit; |
| 844 | } | 848 | } |
| 845 | 849 | ||
| 846 | devid = superio_inw(sioaddr, SIO_REG_DEVID); | 850 | devid = force_id ? force_id : superio_inw(sioaddr, SIO_REG_DEVID); |
| 847 | if (devid != SIO_F71882_ID) { | 851 | if (devid != SIO_F71882_ID) { |
| 848 | printk(KERN_INFO DRVNAME ": Unsupported Fintek device\n"); | 852 | printk(KERN_INFO DRVNAME ": Unsupported Fintek device\n"); |
| 849 | goto exit; | 853 | goto exit; |
diff --git a/drivers/hwmon/fscher.c b/drivers/hwmon/fscher.c index e67c36953b2d..721c70177b17 100644 --- a/drivers/hwmon/fscher.c +++ b/drivers/hwmon/fscher.c | |||
| @@ -123,7 +123,6 @@ static struct i2c_driver fscher_driver = { | |||
| 123 | .driver = { | 123 | .driver = { |
| 124 | .name = "fscher", | 124 | .name = "fscher", |
| 125 | }, | 125 | }, |
| 126 | .id = I2C_DRIVERID_FSCHER, | ||
| 127 | .attach_adapter = fscher_attach_adapter, | 126 | .attach_adapter = fscher_attach_adapter, |
| 128 | .detach_client = fscher_detach_client, | 127 | .detach_client = fscher_detach_client, |
| 129 | }; | 128 | }; |
diff --git a/drivers/hwmon/fschmd.c b/drivers/hwmon/fschmd.c index 63a4df0580db..b7c9eef0f928 100644 --- a/drivers/hwmon/fschmd.c +++ b/drivers/hwmon/fschmd.c | |||
| @@ -41,6 +41,7 @@ | |||
| 41 | #include <linux/err.h> | 41 | #include <linux/err.h> |
| 42 | #include <linux/mutex.h> | 42 | #include <linux/mutex.h> |
| 43 | #include <linux/sysfs.h> | 43 | #include <linux/sysfs.h> |
| 44 | #include <linux/dmi.h> | ||
| 44 | 45 | ||
| 45 | /* Addresses to scan */ | 46 | /* Addresses to scan */ |
| 46 | static unsigned short normal_i2c[] = { 0x73, I2C_CLIENT_END }; | 47 | static unsigned short normal_i2c[] = { 0x73, I2C_CLIENT_END }; |
| @@ -133,7 +134,7 @@ static const u8 FSCHMD_REG_TEMP_STATE[5][5] = { | |||
| 133 | { 0x71, 0x81, 0x91 }, /* her */ | 134 | { 0x71, 0x81, 0x91 }, /* her */ |
| 134 | { 0x71, 0xd1, 0x81, 0x91 }, /* scy */ | 135 | { 0x71, 0xd1, 0x81, 0x91 }, /* scy */ |
| 135 | { 0x71, 0x81, 0x91 }, /* hrc */ | 136 | { 0x71, 0x81, 0x91 }, /* hrc */ |
| 136 | { 0x71, 0x81, 0x91, 0xd1, 0xe1 }, /*Â hmd */ | 137 | { 0x71, 0x81, 0x91, 0xd1, 0xe1 }, /* hmd */ |
| 137 | }; | 138 | }; |
| 138 | 139 | ||
| 139 | /* temperature high limit registers, FSC does not document these. Proven to be | 140 | /* temperature high limit registers, FSC does not document these. Proven to be |
| @@ -146,7 +147,7 @@ static const u8 FSCHMD_REG_TEMP_LIMIT[5][5] = { | |||
| 146 | { 0x76, 0x86, 0x96 }, /* her */ | 147 | { 0x76, 0x86, 0x96 }, /* her */ |
| 147 | { 0x76, 0xd6, 0x86, 0x96 }, /* scy */ | 148 | { 0x76, 0xd6, 0x86, 0x96 }, /* scy */ |
| 148 | { 0x76, 0x86, 0x96 }, /* hrc */ | 149 | { 0x76, 0x86, 0x96 }, /* hrc */ |
| 149 | { 0x76, 0x86, 0x96, 0xd6, 0xe6 }, /*Â hmd */ | 150 | { 0x76, 0x86, 0x96, 0xd6, 0xe6 }, /* hmd */ |
| 150 | }; | 151 | }; |
| 151 | 152 | ||
| 152 | /* These were found through experimenting with an fscher, currently they are | 153 | /* These were found through experimenting with an fscher, currently they are |
| @@ -210,6 +211,13 @@ struct fschmd_data { | |||
| 210 | u8 fan_ripple[6]; /* divider for rps */ | 211 | u8 fan_ripple[6]; /* divider for rps */ |
| 211 | }; | 212 | }; |
| 212 | 213 | ||
| 214 | /* Global variables to hold information read from special DMI tables, which are | ||
| 215 | available on FSC machines with an fscher or later chip. */ | ||
| 216 | static int dmi_mult[3] = { 490, 200, 100 }; | ||
| 217 | static int dmi_offset[3] = { 0, 0, 0 }; | ||
| 218 | static int dmi_vref = -1; | ||
| 219 | |||
| 220 | |||
| 213 | /* | 221 | /* |
| 214 | * Sysfs attr show / store functions | 222 | * Sysfs attr show / store functions |
| 215 | */ | 223 | */ |
| @@ -221,8 +229,13 @@ static ssize_t show_in_value(struct device *dev, | |||
| 221 | int index = to_sensor_dev_attr(devattr)->index; | 229 | int index = to_sensor_dev_attr(devattr)->index; |
| 222 | struct fschmd_data *data = fschmd_update_device(dev); | 230 | struct fschmd_data *data = fschmd_update_device(dev); |
| 223 | 231 | ||
| 224 | return sprintf(buf, "%d\n", (data->volt[index] * | 232 | /* fscher / fschrc - 1 as data->kind is an array index, not a chips */ |
| 225 | max_reading[index] + 128) / 255); | 233 | if (data->kind == (fscher - 1) || data->kind >= (fschrc - 1)) |
| 234 | return sprintf(buf, "%d\n", (data->volt[index] * dmi_vref * | ||
| 235 | dmi_mult[index]) / 255 + dmi_offset[index]); | ||
| 236 | else | ||
| 237 | return sprintf(buf, "%d\n", (data->volt[index] * | ||
| 238 | max_reading[index] + 128) / 255); | ||
| 226 | } | 239 | } |
| 227 | 240 | ||
| 228 | 241 | ||
| @@ -525,6 +538,68 @@ static struct sensor_device_attribute fschmd_fan_attr[] = { | |||
| 525 | * Real code | 538 | * Real code |
| 526 | */ | 539 | */ |
| 527 | 540 | ||
| 541 | /* DMI decode routine to read voltage scaling factors from special DMI tables, | ||
| 542 | which are available on FSC machines with an fscher or later chip. */ | ||
| 543 | static void fschmd_dmi_decode(const struct dmi_header *header) | ||
| 544 | { | ||
| 545 | int i, mult[3] = { 0 }, offset[3] = { 0 }, vref = 0, found = 0; | ||
| 546 | |||
| 547 | /* dmi code ugliness, we get passed the address of the contents of | ||
| 548 | a complete DMI record, but in the form of a dmi_header pointer, in | ||
| 549 | reality this address holds header->length bytes of which the header | ||
| 550 | are the first 4 bytes */ | ||
| 551 | u8 *dmi_data = (u8 *)header; | ||
| 552 | |||
| 553 | /* We are looking for OEM-specific type 185 */ | ||
| 554 | if (header->type != 185) | ||
| 555 | return; | ||
| 556 | |||
| 557 | /* we are looking for what Siemens calls "subtype" 19, the subtype | ||
| 558 | is stored in byte 5 of the dmi block */ | ||
| 559 | if (header->length < 5 || dmi_data[4] != 19) | ||
| 560 | return; | ||
| 561 | |||
| 562 | /* After the subtype comes 1 unknown byte and then blocks of 5 bytes, | ||
| 563 | consisting of what Siemens calls an "Entity" number, followed by | ||
| 564 | 2 16-bit words in LSB first order */ | ||
| 565 | for (i = 6; (i + 4) < header->length; i += 5) { | ||
| 566 | /* entity 1 - 3: voltage multiplier and offset */ | ||
| 567 | if (dmi_data[i] >= 1 && dmi_data[i] <= 3) { | ||
| 568 | /* Our in sensors order and the DMI order differ */ | ||
| 569 | const int shuffle[3] = { 1, 0, 2 }; | ||
| 570 | int in = shuffle[dmi_data[i] - 1]; | ||
| 571 | |||
| 572 | /* Check for twice the same entity */ | ||
| 573 | if (found & (1 << in)) | ||
| 574 | return; | ||
| 575 | |||
| 576 | mult[in] = dmi_data[i + 1] | (dmi_data[i + 2] << 8); | ||
| 577 | offset[in] = dmi_data[i + 3] | (dmi_data[i + 4] << 8); | ||
| 578 | |||
| 579 | found |= 1 << in; | ||
| 580 | } | ||
| 581 | |||
| 582 | /* entity 7: reference voltage */ | ||
| 583 | if (dmi_data[i] == 7) { | ||
| 584 | /* Check for twice the same entity */ | ||
| 585 | if (found & 0x08) | ||
| 586 | return; | ||
| 587 | |||
| 588 | vref = dmi_data[i + 1] | (dmi_data[i + 2] << 8); | ||
| 589 | |||
| 590 | found |= 0x08; | ||
| 591 | } | ||
| 592 | } | ||
| 593 | |||
| 594 | if (found == 0x0F) { | ||
| 595 | for (i = 0; i < 3; i++) { | ||
| 596 | dmi_mult[i] = mult[i] * 10; | ||
| 597 | dmi_offset[i] = offset[i] * 10; | ||
| 598 | } | ||
| 599 | dmi_vref = vref; | ||
| 600 | } | ||
| 601 | } | ||
| 602 | |||
| 528 | static int fschmd_detect(struct i2c_adapter *adapter, int address, int kind) | 603 | static int fschmd_detect(struct i2c_adapter *adapter, int address, int kind) |
| 529 | { | 604 | { |
| 530 | struct i2c_client *client; | 605 | struct i2c_client *client; |
| @@ -586,6 +661,17 @@ static int fschmd_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 586 | data->temp_max[2] = 50 + 128; | 661 | data->temp_max[2] = 50 + 128; |
| 587 | } | 662 | } |
| 588 | 663 | ||
| 664 | /* Read the special DMI table for fscher and newer chips */ | ||
| 665 | if (kind == fscher || kind >= fschrc) { | ||
| 666 | dmi_walk(fschmd_dmi_decode); | ||
| 667 | if (dmi_vref == -1) { | ||
| 668 | printk(KERN_WARNING FSCHMD_NAME | ||
| 669 | ": Couldn't get voltage scaling factors from " | ||
| 670 | "BIOS DMI table, using builtin defaults\n"); | ||
| 671 | dmi_vref = 33; | ||
| 672 | } | ||
| 673 | } | ||
| 674 | |||
| 589 | /* i2c kind goes from 1-5, we want from 0-4 to address arrays */ | 675 | /* i2c kind goes from 1-5, we want from 0-4 to address arrays */ |
| 590 | data->kind = kind - 1; | 676 | data->kind = kind - 1; |
| 591 | strlcpy(client->name, client_names[data->kind], I2C_NAME_SIZE); | 677 | strlcpy(client->name, client_names[data->kind], I2C_NAME_SIZE); |
diff --git a/drivers/hwmon/fscpos.c b/drivers/hwmon/fscpos.c index 92c9703d0ac0..2f1075323a1e 100644 --- a/drivers/hwmon/fscpos.c +++ b/drivers/hwmon/fscpos.c | |||
| @@ -105,7 +105,6 @@ static struct i2c_driver fscpos_driver = { | |||
| 105 | .driver = { | 105 | .driver = { |
| 106 | .name = "fscpos", | 106 | .name = "fscpos", |
| 107 | }, | 107 | }, |
| 108 | .id = I2C_DRIVERID_FSCPOS, | ||
| 109 | .attach_adapter = fscpos_attach_adapter, | 108 | .attach_adapter = fscpos_attach_adapter, |
| 110 | .detach_client = fscpos_detach_client, | 109 | .detach_client = fscpos_detach_client, |
| 111 | }; | 110 | }; |
diff --git a/drivers/hwmon/gl518sm.c b/drivers/hwmon/gl518sm.c index bb58d9866a37..3b1ac48fce23 100644 --- a/drivers/hwmon/gl518sm.c +++ b/drivers/hwmon/gl518sm.c | |||
| @@ -30,10 +30,6 @@ | |||
| 30 | * We did not keep that part of the original driver in the Linux 2.6 | 30 | * We did not keep that part of the original driver in the Linux 2.6 |
| 31 | * version, since it was making the driver significantly more complex | 31 | * version, since it was making the driver significantly more complex |
| 32 | * with no real benefit. | 32 | * with no real benefit. |
| 33 | * | ||
| 34 | * History: | ||
| 35 | * 2004-01-28 Original port. (Hong-Gunn Chew) | ||
| 36 | * 2004-01-31 Code review and approval. (Jean Delvare) | ||
| 37 | */ | 33 | */ |
| 38 | 34 | ||
| 39 | #include <linux/module.h> | 35 | #include <linux/module.h> |
| @@ -42,6 +38,7 @@ | |||
| 42 | #include <linux/jiffies.h> | 38 | #include <linux/jiffies.h> |
| 43 | #include <linux/i2c.h> | 39 | #include <linux/i2c.h> |
| 44 | #include <linux/hwmon.h> | 40 | #include <linux/hwmon.h> |
| 41 | #include <linux/hwmon-sysfs.h> | ||
| 45 | #include <linux/err.h> | 42 | #include <linux/err.h> |
| 46 | #include <linux/mutex.h> | 43 | #include <linux/mutex.h> |
| 47 | #include <linux/sysfs.h> | 44 | #include <linux/sysfs.h> |
| @@ -99,10 +96,10 @@ static inline u8 FAN_TO_REG(long rpm, int div) | |||
| 99 | long rpmdiv; | 96 | long rpmdiv; |
| 100 | if (rpm == 0) | 97 | if (rpm == 0) |
| 101 | return 0; | 98 | return 0; |
| 102 | rpmdiv = SENSORS_LIMIT(rpm, 1, 1920000) * div; | 99 | rpmdiv = SENSORS_LIMIT(rpm, 1, 960000) * div; |
| 103 | return SENSORS_LIMIT((960000 + rpmdiv / 2) / rpmdiv, 1, 255); | 100 | return SENSORS_LIMIT((480000 + rpmdiv / 2) / rpmdiv, 1, 255); |
| 104 | } | 101 | } |
| 105 | #define FAN_FROM_REG(val,div) ((val)==0 ? 0 : (960000/((val)*(div)))) | 102 | #define FAN_FROM_REG(val,div) ((val)==0 ? 0 : (480000/((val)*(div)))) |
| 106 | 103 | ||
| 107 | #define IN_TO_REG(val) (SENSORS_LIMIT((((val)+9)/19),0,255)) | 104 | #define IN_TO_REG(val) (SENSORS_LIMIT((((val)+9)/19),0,255)) |
| 108 | #define IN_FROM_REG(val) ((val)*19) | 105 | #define IN_FROM_REG(val) ((val)*19) |
| @@ -110,7 +107,6 @@ static inline u8 FAN_TO_REG(long rpm, int div) | |||
| 110 | #define VDD_TO_REG(val) (SENSORS_LIMIT((((val)*4+47)/95),0,255)) | 107 | #define VDD_TO_REG(val) (SENSORS_LIMIT((((val)*4+47)/95),0,255)) |
| 111 | #define VDD_FROM_REG(val) (((val)*95+2)/4) | 108 | #define VDD_FROM_REG(val) (((val)*95+2)/4) |
| 112 | 109 | ||
| 113 | #define DIV_TO_REG(val) ((val)==4?2:(val)==2?1:(val)==1?0:3) | ||
| 114 | #define DIV_FROM_REG(val) (1 << (val)) | 110 | #define DIV_FROM_REG(val) (1 << (val)) |
| 115 | 111 | ||
| 116 | #define BEEP_MASK_TO_REG(val) ((val) & 0x7f & data->alarm_mask) | 112 | #define BEEP_MASK_TO_REG(val) ((val) & 0x7f & data->alarm_mask) |
| @@ -129,7 +125,6 @@ struct gl518_data { | |||
| 129 | u8 voltage_in[4]; /* Register values; [0] = VDD */ | 125 | u8 voltage_in[4]; /* Register values; [0] = VDD */ |
| 130 | u8 voltage_min[4]; /* Register values; [0] = VDD */ | 126 | u8 voltage_min[4]; /* Register values; [0] = VDD */ |
| 131 | u8 voltage_max[4]; /* Register values; [0] = VDD */ | 127 | u8 voltage_max[4]; /* Register values; [0] = VDD */ |
| 132 | u8 iter_voltage_in[4]; /* Register values; [0] = VDD */ | ||
| 133 | u8 fan_in[2]; | 128 | u8 fan_in[2]; |
| 134 | u8 fan_min[2]; | 129 | u8 fan_min[2]; |
| 135 | u8 fan_div[2]; /* Register encoding, shifted right */ | 130 | u8 fan_div[2]; /* Register encoding, shifted right */ |
| @@ -138,7 +133,7 @@ struct gl518_data { | |||
| 138 | u8 temp_max; /* Register values */ | 133 | u8 temp_max; /* Register values */ |
| 139 | u8 temp_hyst; /* Register values */ | 134 | u8 temp_hyst; /* Register values */ |
| 140 | u8 alarms; /* Register value */ | 135 | u8 alarms; /* Register value */ |
| 141 | u8 alarm_mask; /* Register value */ | 136 | u8 alarm_mask; |
| 142 | u8 beep_mask; /* Register value */ | 137 | u8 beep_mask; /* Register value */ |
| 143 | u8 beep_enable; /* Boolean */ | 138 | u8 beep_enable; /* Boolean */ |
| 144 | }; | 139 | }; |
| @@ -156,7 +151,6 @@ static struct i2c_driver gl518_driver = { | |||
| 156 | .driver = { | 151 | .driver = { |
| 157 | .name = "gl518sm", | 152 | .name = "gl518sm", |
| 158 | }, | 153 | }, |
| 159 | .id = I2C_DRIVERID_GL518, | ||
| 160 | .attach_adapter = gl518_attach_adapter, | 154 | .attach_adapter = gl518_attach_adapter, |
| 161 | .detach_client = gl518_detach_client, | 155 | .detach_client = gl518_detach_client, |
| 162 | }; | 156 | }; |
| @@ -172,24 +166,10 @@ static ssize_t show_##suffix(struct device *dev, struct device_attribute *attr, | |||
| 172 | return sprintf(buf, "%d\n", type##_FROM_REG(data->value)); \ | 166 | return sprintf(buf, "%d\n", type##_FROM_REG(data->value)); \ |
| 173 | } | 167 | } |
| 174 | 168 | ||
| 175 | #define show_fan(suffix, value, index) \ | ||
| 176 | static ssize_t show_##suffix(struct device *dev, struct device_attribute *attr, char *buf) \ | ||
| 177 | { \ | ||
| 178 | struct gl518_data *data = gl518_update_device(dev); \ | ||
| 179 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->value[index], \ | ||
| 180 | DIV_FROM_REG(data->fan_div[index]))); \ | ||
| 181 | } | ||
| 182 | |||
| 183 | show(TEMP, temp_input1, temp_in); | 169 | show(TEMP, temp_input1, temp_in); |
| 184 | show(TEMP, temp_max1, temp_max); | 170 | show(TEMP, temp_max1, temp_max); |
| 185 | show(TEMP, temp_hyst1, temp_hyst); | 171 | show(TEMP, temp_hyst1, temp_hyst); |
| 186 | show(BOOL, fan_auto1, fan_auto1); | 172 | show(BOOL, fan_auto1, fan_auto1); |
| 187 | show_fan(fan_input1, fan_in, 0); | ||
| 188 | show_fan(fan_input2, fan_in, 1); | ||
| 189 | show_fan(fan_min1, fan_min, 0); | ||
| 190 | show_fan(fan_min2, fan_min, 1); | ||
| 191 | show(DIV, fan_div1, fan_div[0]); | ||
| 192 | show(DIV, fan_div2, fan_div[1]); | ||
| 193 | show(VDD, in_input0, voltage_in[0]); | 173 | show(VDD, in_input0, voltage_in[0]); |
| 194 | show(IN, in_input1, voltage_in[1]); | 174 | show(IN, in_input1, voltage_in[1]); |
| 195 | show(IN, in_input2, voltage_in[2]); | 175 | show(IN, in_input2, voltage_in[2]); |
| @@ -206,6 +186,32 @@ show(RAW, alarms, alarms); | |||
| 206 | show(BOOL, beep_enable, beep_enable); | 186 | show(BOOL, beep_enable, beep_enable); |
| 207 | show(BEEP_MASK, beep_mask, beep_mask); | 187 | show(BEEP_MASK, beep_mask, beep_mask); |
| 208 | 188 | ||
| 189 | static ssize_t show_fan_input(struct device *dev, | ||
| 190 | struct device_attribute *attr, char *buf) | ||
| 191 | { | ||
| 192 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 193 | struct gl518_data *data = gl518_update_device(dev); | ||
| 194 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_in[nr], | ||
| 195 | DIV_FROM_REG(data->fan_div[nr]))); | ||
| 196 | } | ||
| 197 | |||
| 198 | static ssize_t show_fan_min(struct device *dev, | ||
| 199 | struct device_attribute *attr, char *buf) | ||
| 200 | { | ||
| 201 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 202 | struct gl518_data *data = gl518_update_device(dev); | ||
| 203 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[nr], | ||
| 204 | DIV_FROM_REG(data->fan_div[nr]))); | ||
| 205 | } | ||
| 206 | |||
| 207 | static ssize_t show_fan_div(struct device *dev, | ||
| 208 | struct device_attribute *attr, char *buf) | ||
| 209 | { | ||
| 210 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 211 | struct gl518_data *data = gl518_update_device(dev); | ||
| 212 | return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr])); | ||
| 213 | } | ||
| 214 | |||
| 209 | #define set(type, suffix, value, reg) \ | 215 | #define set(type, suffix, value, reg) \ |
| 210 | static ssize_t set_##suffix(struct device *dev, struct device_attribute *attr, const char *buf, \ | 216 | static ssize_t set_##suffix(struct device *dev, struct device_attribute *attr, const char *buf, \ |
| 211 | size_t count) \ | 217 | size_t count) \ |
| @@ -247,8 +253,6 @@ static ssize_t set_##suffix(struct device *dev, struct device_attribute *attr, c | |||
| 247 | set(TEMP, temp_max1, temp_max, GL518_REG_TEMP_MAX); | 253 | set(TEMP, temp_max1, temp_max, GL518_REG_TEMP_MAX); |
| 248 | set(TEMP, temp_hyst1, temp_hyst, GL518_REG_TEMP_HYST); | 254 | set(TEMP, temp_hyst1, temp_hyst, GL518_REG_TEMP_HYST); |
| 249 | set_bits(BOOL, fan_auto1, fan_auto1, GL518_REG_MISC, 0x08, 3); | 255 | set_bits(BOOL, fan_auto1, fan_auto1, GL518_REG_MISC, 0x08, 3); |
| 250 | set_bits(DIV, fan_div1, fan_div[0], GL518_REG_MISC, 0xc0, 6); | ||
| 251 | set_bits(DIV, fan_div2, fan_div[1], GL518_REG_MISC, 0x30, 4); | ||
| 252 | set_low(VDD, in_min0, voltage_min[0], GL518_REG_VDD_LIMIT); | 256 | set_low(VDD, in_min0, voltage_min[0], GL518_REG_VDD_LIMIT); |
| 253 | set_low(IN, in_min1, voltage_min[1], GL518_REG_VIN1_LIMIT); | 257 | set_low(IN, in_min1, voltage_min[1], GL518_REG_VIN1_LIMIT); |
| 254 | set_low(IN, in_min2, voltage_min[2], GL518_REG_VIN2_LIMIT); | 258 | set_low(IN, in_min2, voltage_min[2], GL518_REG_VIN2_LIMIT); |
| @@ -260,25 +264,27 @@ set_high(IN, in_max3, voltage_max[3], GL518_REG_VIN3_LIMIT); | |||
| 260 | set_bits(BOOL, beep_enable, beep_enable, GL518_REG_CONF, 0x04, 2); | 264 | set_bits(BOOL, beep_enable, beep_enable, GL518_REG_CONF, 0x04, 2); |
| 261 | set(BEEP_MASK, beep_mask, beep_mask, GL518_REG_ALARM); | 265 | set(BEEP_MASK, beep_mask, beep_mask, GL518_REG_ALARM); |
| 262 | 266 | ||
| 263 | static ssize_t set_fan_min1(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | 267 | static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr, |
| 268 | const char *buf, size_t count) | ||
| 264 | { | 269 | { |
| 265 | struct i2c_client *client = to_i2c_client(dev); | 270 | struct i2c_client *client = to_i2c_client(dev); |
| 266 | struct gl518_data *data = i2c_get_clientdata(client); | 271 | struct gl518_data *data = i2c_get_clientdata(client); |
| 272 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 267 | int regvalue; | 273 | int regvalue; |
| 268 | unsigned long val = simple_strtoul(buf, NULL, 10); | 274 | unsigned long val = simple_strtoul(buf, NULL, 10); |
| 269 | 275 | ||
| 270 | mutex_lock(&data->update_lock); | 276 | mutex_lock(&data->update_lock); |
| 271 | regvalue = gl518_read_value(client, GL518_REG_FAN_LIMIT); | 277 | regvalue = gl518_read_value(client, GL518_REG_FAN_LIMIT); |
| 272 | data->fan_min[0] = FAN_TO_REG(val, | 278 | data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr])); |
| 273 | DIV_FROM_REG(data->fan_div[0])); | 279 | regvalue = (regvalue & (0xff << (8 * nr))) |
| 274 | regvalue = (regvalue & 0x00ff) | (data->fan_min[0] << 8); | 280 | | (data->fan_min[nr] << (8 * (1 - nr))); |
| 275 | gl518_write_value(client, GL518_REG_FAN_LIMIT, regvalue); | 281 | gl518_write_value(client, GL518_REG_FAN_LIMIT, regvalue); |
| 276 | 282 | ||
| 277 | data->beep_mask = gl518_read_value(client, GL518_REG_ALARM); | 283 | data->beep_mask = gl518_read_value(client, GL518_REG_ALARM); |
| 278 | if (data->fan_min[0] == 0) | 284 | if (data->fan_min[nr] == 0) |
| 279 | data->alarm_mask &= ~0x20; | 285 | data->alarm_mask &= ~(0x20 << nr); |
| 280 | else | 286 | else |
| 281 | data->alarm_mask |= 0x20; | 287 | data->alarm_mask |= (0x20 << nr); |
| 282 | data->beep_mask &= data->alarm_mask; | 288 | data->beep_mask &= data->alarm_mask; |
| 283 | gl518_write_value(client, GL518_REG_ALARM, data->beep_mask); | 289 | gl518_write_value(client, GL518_REG_ALARM, data->beep_mask); |
| 284 | 290 | ||
| @@ -286,28 +292,32 @@ static ssize_t set_fan_min1(struct device *dev, struct device_attribute *attr, c | |||
| 286 | return count; | 292 | return count; |
| 287 | } | 293 | } |
| 288 | 294 | ||
| 289 | static ssize_t set_fan_min2(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | 295 | static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, |
| 296 | const char *buf, size_t count) | ||
| 290 | { | 297 | { |
| 291 | struct i2c_client *client = to_i2c_client(dev); | 298 | struct i2c_client *client = to_i2c_client(dev); |
| 292 | struct gl518_data *data = i2c_get_clientdata(client); | 299 | struct gl518_data *data = i2c_get_clientdata(client); |
| 300 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 293 | int regvalue; | 301 | int regvalue; |
| 294 | unsigned long val = simple_strtoul(buf, NULL, 10); | 302 | unsigned long val = simple_strtoul(buf, NULL, 10); |
| 295 | 303 | ||
| 296 | mutex_lock(&data->update_lock); | 304 | switch (val) { |
| 297 | regvalue = gl518_read_value(client, GL518_REG_FAN_LIMIT); | 305 | case 1: val = 0; break; |
| 298 | data->fan_min[1] = FAN_TO_REG(val, | 306 | case 2: val = 1; break; |
| 299 | DIV_FROM_REG(data->fan_div[1])); | 307 | case 4: val = 2; break; |
| 300 | regvalue = (regvalue & 0xff00) | data->fan_min[1]; | 308 | case 8: val = 3; break; |
| 301 | gl518_write_value(client, GL518_REG_FAN_LIMIT, regvalue); | 309 | default: |
| 302 | 310 | dev_err(dev, "Invalid fan clock divider %lu, choose one " | |
| 303 | data->beep_mask = gl518_read_value(client, GL518_REG_ALARM); | 311 | "of 1, 2, 4 or 8\n", val); |
| 304 | if (data->fan_min[1] == 0) | 312 | return -EINVAL; |
| 305 | data->alarm_mask &= ~0x40; | 313 | } |
| 306 | else | ||
| 307 | data->alarm_mask |= 0x40; | ||
| 308 | data->beep_mask &= data->alarm_mask; | ||
| 309 | gl518_write_value(client, GL518_REG_ALARM, data->beep_mask); | ||
| 310 | 314 | ||
| 315 | mutex_lock(&data->update_lock); | ||
| 316 | regvalue = gl518_read_value(client, GL518_REG_MISC); | ||
| 317 | data->fan_div[nr] = val; | ||
| 318 | regvalue = (regvalue & ~(0xc0 >> (2 * nr))) | ||
| 319 | | (data->fan_div[nr] << (6 - 2 * nr)); | ||
| 320 | gl518_write_value(client, GL518_REG_MISC, regvalue); | ||
| 311 | mutex_unlock(&data->update_lock); | 321 | mutex_unlock(&data->update_lock); |
| 312 | return count; | 322 | return count; |
| 313 | } | 323 | } |
| @@ -317,12 +327,16 @@ static DEVICE_ATTR(temp1_max, S_IWUSR|S_IRUGO, show_temp_max1, set_temp_max1); | |||
| 317 | static DEVICE_ATTR(temp1_max_hyst, S_IWUSR|S_IRUGO, | 327 | static DEVICE_ATTR(temp1_max_hyst, S_IWUSR|S_IRUGO, |
| 318 | show_temp_hyst1, set_temp_hyst1); | 328 | show_temp_hyst1, set_temp_hyst1); |
| 319 | static DEVICE_ATTR(fan1_auto, S_IWUSR|S_IRUGO, show_fan_auto1, set_fan_auto1); | 329 | static DEVICE_ATTR(fan1_auto, S_IWUSR|S_IRUGO, show_fan_auto1, set_fan_auto1); |
| 320 | static DEVICE_ATTR(fan1_input, S_IRUGO, show_fan_input1, NULL); | 330 | static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan_input, NULL, 0); |
| 321 | static DEVICE_ATTR(fan2_input, S_IRUGO, show_fan_input2, NULL); | 331 | static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan_input, NULL, 1); |
| 322 | static DEVICE_ATTR(fan1_min, S_IWUSR|S_IRUGO, show_fan_min1, set_fan_min1); | 332 | static SENSOR_DEVICE_ATTR(fan1_min, S_IWUSR|S_IRUGO, |
| 323 | static DEVICE_ATTR(fan2_min, S_IWUSR|S_IRUGO, show_fan_min2, set_fan_min2); | 333 | show_fan_min, set_fan_min, 0); |
| 324 | static DEVICE_ATTR(fan1_div, S_IWUSR|S_IRUGO, show_fan_div1, set_fan_div1); | 334 | static SENSOR_DEVICE_ATTR(fan2_min, S_IWUSR|S_IRUGO, |
| 325 | static DEVICE_ATTR(fan2_div, S_IWUSR|S_IRUGO, show_fan_div2, set_fan_div2); | 335 | show_fan_min, set_fan_min, 1); |
| 336 | static SENSOR_DEVICE_ATTR(fan1_div, S_IWUSR|S_IRUGO, | ||
| 337 | show_fan_div, set_fan_div, 0); | ||
| 338 | static SENSOR_DEVICE_ATTR(fan2_div, S_IWUSR|S_IRUGO, | ||
| 339 | show_fan_div, set_fan_div, 1); | ||
| 326 | static DEVICE_ATTR(in0_input, S_IRUGO, show_in_input0, NULL); | 340 | static DEVICE_ATTR(in0_input, S_IRUGO, show_in_input0, NULL); |
| 327 | static DEVICE_ATTR(in1_input, S_IRUGO, show_in_input1, NULL); | 341 | static DEVICE_ATTR(in1_input, S_IRUGO, show_in_input1, NULL); |
| 328 | static DEVICE_ATTR(in2_input, S_IRUGO, show_in_input2, NULL); | 342 | static DEVICE_ATTR(in2_input, S_IRUGO, show_in_input2, NULL); |
| @@ -341,10 +355,62 @@ static DEVICE_ATTR(beep_enable, S_IWUSR|S_IRUGO, | |||
| 341 | static DEVICE_ATTR(beep_mask, S_IWUSR|S_IRUGO, | 355 | static DEVICE_ATTR(beep_mask, S_IWUSR|S_IRUGO, |
| 342 | show_beep_mask, set_beep_mask); | 356 | show_beep_mask, set_beep_mask); |
| 343 | 357 | ||
| 358 | static ssize_t show_alarm(struct device *dev, struct device_attribute *attr, | ||
| 359 | char *buf) | ||
| 360 | { | ||
| 361 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 362 | struct gl518_data *data = gl518_update_device(dev); | ||
| 363 | return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); | ||
| 364 | } | ||
| 365 | |||
| 366 | static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0); | ||
| 367 | static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1); | ||
| 368 | static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2); | ||
| 369 | static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3); | ||
| 370 | static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4); | ||
| 371 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 5); | ||
| 372 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 6); | ||
| 373 | |||
| 374 | static ssize_t show_beep(struct device *dev, struct device_attribute *attr, | ||
| 375 | char *buf) | ||
| 376 | { | ||
| 377 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 378 | struct gl518_data *data = gl518_update_device(dev); | ||
| 379 | return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1); | ||
| 380 | } | ||
| 381 | |||
| 382 | static ssize_t set_beep(struct device *dev, struct device_attribute *attr, | ||
| 383 | const char *buf, size_t count) | ||
| 384 | { | ||
| 385 | struct i2c_client *client = to_i2c_client(dev); | ||
| 386 | struct gl518_data *data = i2c_get_clientdata(client); | ||
| 387 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 388 | unsigned long bit; | ||
| 389 | |||
| 390 | bit = simple_strtoul(buf, NULL, 10); | ||
| 391 | if (bit & ~1) | ||
| 392 | return -EINVAL; | ||
| 393 | |||
| 394 | mutex_lock(&data->update_lock); | ||
| 395 | data->beep_mask = gl518_read_value(client, GL518_REG_ALARM); | ||
| 396 | if (bit) | ||
| 397 | data->beep_mask |= (1 << bitnr); | ||
| 398 | else | ||
| 399 | data->beep_mask &= ~(1 << bitnr); | ||
| 400 | gl518_write_value(client, GL518_REG_ALARM, data->beep_mask); | ||
| 401 | mutex_unlock(&data->update_lock); | ||
| 402 | return count; | ||
| 403 | } | ||
| 404 | |||
| 405 | static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 0); | ||
| 406 | static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 1); | ||
| 407 | static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 2); | ||
| 408 | static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 3); | ||
| 409 | static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 4); | ||
| 410 | static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 5); | ||
| 411 | static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO|S_IWUSR, show_beep, set_beep, 6); | ||
| 412 | |||
| 344 | static struct attribute *gl518_attributes[] = { | 413 | static struct attribute *gl518_attributes[] = { |
| 345 | &dev_attr_in0_input.attr, | ||
| 346 | &dev_attr_in1_input.attr, | ||
| 347 | &dev_attr_in2_input.attr, | ||
| 348 | &dev_attr_in3_input.attr, | 414 | &dev_attr_in3_input.attr, |
| 349 | &dev_attr_in0_min.attr, | 415 | &dev_attr_in0_min.attr, |
| 350 | &dev_attr_in1_min.attr, | 416 | &dev_attr_in1_min.attr, |
| @@ -354,18 +420,32 @@ static struct attribute *gl518_attributes[] = { | |||
| 354 | &dev_attr_in1_max.attr, | 420 | &dev_attr_in1_max.attr, |
| 355 | &dev_attr_in2_max.attr, | 421 | &dev_attr_in2_max.attr, |
| 356 | &dev_attr_in3_max.attr, | 422 | &dev_attr_in3_max.attr, |
| 423 | &sensor_dev_attr_in0_alarm.dev_attr.attr, | ||
| 424 | &sensor_dev_attr_in1_alarm.dev_attr.attr, | ||
| 425 | &sensor_dev_attr_in2_alarm.dev_attr.attr, | ||
| 426 | &sensor_dev_attr_in3_alarm.dev_attr.attr, | ||
| 427 | &sensor_dev_attr_in0_beep.dev_attr.attr, | ||
| 428 | &sensor_dev_attr_in1_beep.dev_attr.attr, | ||
| 429 | &sensor_dev_attr_in2_beep.dev_attr.attr, | ||
| 430 | &sensor_dev_attr_in3_beep.dev_attr.attr, | ||
| 357 | 431 | ||
| 358 | &dev_attr_fan1_auto.attr, | 432 | &dev_attr_fan1_auto.attr, |
| 359 | &dev_attr_fan1_input.attr, | 433 | &sensor_dev_attr_fan1_input.dev_attr.attr, |
| 360 | &dev_attr_fan2_input.attr, | 434 | &sensor_dev_attr_fan2_input.dev_attr.attr, |
| 361 | &dev_attr_fan1_min.attr, | 435 | &sensor_dev_attr_fan1_min.dev_attr.attr, |
| 362 | &dev_attr_fan2_min.attr, | 436 | &sensor_dev_attr_fan2_min.dev_attr.attr, |
| 363 | &dev_attr_fan1_div.attr, | 437 | &sensor_dev_attr_fan1_div.dev_attr.attr, |
| 364 | &dev_attr_fan2_div.attr, | 438 | &sensor_dev_attr_fan2_div.dev_attr.attr, |
| 439 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, | ||
| 440 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, | ||
| 441 | &sensor_dev_attr_fan1_beep.dev_attr.attr, | ||
| 442 | &sensor_dev_attr_fan2_beep.dev_attr.attr, | ||
| 365 | 443 | ||
| 366 | &dev_attr_temp1_input.attr, | 444 | &dev_attr_temp1_input.attr, |
| 367 | &dev_attr_temp1_max.attr, | 445 | &dev_attr_temp1_max.attr, |
| 368 | &dev_attr_temp1_max_hyst.attr, | 446 | &dev_attr_temp1_max_hyst.attr, |
| 447 | &sensor_dev_attr_temp1_alarm.dev_attr.attr, | ||
| 448 | &sensor_dev_attr_temp1_beep.dev_attr.attr, | ||
| 369 | 449 | ||
| 370 | &dev_attr_alarms.attr, | 450 | &dev_attr_alarms.attr, |
| 371 | &dev_attr_beep_enable.attr, | 451 | &dev_attr_beep_enable.attr, |
| @@ -377,6 +457,17 @@ static const struct attribute_group gl518_group = { | |||
| 377 | .attrs = gl518_attributes, | 457 | .attrs = gl518_attributes, |
| 378 | }; | 458 | }; |
| 379 | 459 | ||
| 460 | static struct attribute *gl518_attributes_r80[] = { | ||
| 461 | &dev_attr_in0_input.attr, | ||
| 462 | &dev_attr_in1_input.attr, | ||
| 463 | &dev_attr_in2_input.attr, | ||
| 464 | NULL | ||
| 465 | }; | ||
| 466 | |||
| 467 | static const struct attribute_group gl518_group_r80 = { | ||
| 468 | .attrs = gl518_attributes_r80, | ||
| 469 | }; | ||
| 470 | |||
| 380 | /* | 471 | /* |
| 381 | * Real code | 472 | * Real code |
| 382 | */ | 473 | */ |
| @@ -391,7 +482,7 @@ static int gl518_attach_adapter(struct i2c_adapter *adapter) | |||
| 391 | static int gl518_detect(struct i2c_adapter *adapter, int address, int kind) | 482 | static int gl518_detect(struct i2c_adapter *adapter, int address, int kind) |
| 392 | { | 483 | { |
| 393 | int i; | 484 | int i; |
| 394 | struct i2c_client *new_client; | 485 | struct i2c_client *client; |
| 395 | struct gl518_data *data; | 486 | struct gl518_data *data; |
| 396 | int err = 0; | 487 | int err = 0; |
| 397 | 488 | ||
| @@ -408,25 +499,24 @@ static int gl518_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 408 | goto exit; | 499 | goto exit; |
| 409 | } | 500 | } |
| 410 | 501 | ||
| 411 | new_client = &data->client; | 502 | client = &data->client; |
| 412 | i2c_set_clientdata(new_client, data); | 503 | i2c_set_clientdata(client, data); |
| 413 | 504 | ||
| 414 | new_client->addr = address; | 505 | client->addr = address; |
| 415 | new_client->adapter = adapter; | 506 | client->adapter = adapter; |
| 416 | new_client->driver = &gl518_driver; | 507 | client->driver = &gl518_driver; |
| 417 | new_client->flags = 0; | ||
| 418 | 508 | ||
| 419 | /* Now, we do the remaining detection. */ | 509 | /* Now, we do the remaining detection. */ |
| 420 | 510 | ||
| 421 | if (kind < 0) { | 511 | if (kind < 0) { |
| 422 | if ((gl518_read_value(new_client, GL518_REG_CHIP_ID) != 0x80) | 512 | if ((gl518_read_value(client, GL518_REG_CHIP_ID) != 0x80) |
| 423 | || (gl518_read_value(new_client, GL518_REG_CONF) & 0x80)) | 513 | || (gl518_read_value(client, GL518_REG_CONF) & 0x80)) |
| 424 | goto exit_free; | 514 | goto exit_free; |
| 425 | } | 515 | } |
| 426 | 516 | ||
| 427 | /* Determine the chip type. */ | 517 | /* Determine the chip type. */ |
| 428 | if (kind <= 0) { | 518 | if (kind <= 0) { |
| 429 | i = gl518_read_value(new_client, GL518_REG_REVISION); | 519 | i = gl518_read_value(client, GL518_REG_REVISION); |
| 430 | if (i == 0x00) { | 520 | if (i == 0x00) { |
| 431 | kind = gl518sm_r00; | 521 | kind = gl518sm_r00; |
| 432 | } else if (i == 0x80) { | 522 | } else if (i == 0x80) { |
| @@ -442,25 +532,27 @@ static int gl518_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 442 | } | 532 | } |
| 443 | 533 | ||
| 444 | /* Fill in the remaining client fields */ | 534 | /* Fill in the remaining client fields */ |
| 445 | strlcpy(new_client->name, "gl518sm", I2C_NAME_SIZE); | 535 | strlcpy(client->name, "gl518sm", I2C_NAME_SIZE); |
| 446 | data->type = kind; | 536 | data->type = kind; |
| 447 | data->valid = 0; | ||
| 448 | mutex_init(&data->update_lock); | 537 | mutex_init(&data->update_lock); |
| 449 | 538 | ||
| 450 | /* Tell the I2C layer a new client has arrived */ | 539 | /* Tell the I2C layer a new client has arrived */ |
| 451 | if ((err = i2c_attach_client(new_client))) | 540 | if ((err = i2c_attach_client(client))) |
| 452 | goto exit_free; | 541 | goto exit_free; |
| 453 | 542 | ||
| 454 | /* Initialize the GL518SM chip */ | 543 | /* Initialize the GL518SM chip */ |
| 455 | data->alarm_mask = 0xff; | 544 | data->alarm_mask = 0xff; |
| 456 | data->voltage_in[0]=data->voltage_in[1]=data->voltage_in[2]=0; | 545 | gl518_init_client(client); |
| 457 | gl518_init_client((struct i2c_client *) new_client); | ||
| 458 | 546 | ||
| 459 | /* Register sysfs hooks */ | 547 | /* Register sysfs hooks */ |
| 460 | if ((err = sysfs_create_group(&new_client->dev.kobj, &gl518_group))) | 548 | if ((err = sysfs_create_group(&client->dev.kobj, &gl518_group))) |
| 461 | goto exit_detach; | 549 | goto exit_detach; |
| 550 | if (data->type == gl518sm_r80) | ||
| 551 | if ((err = sysfs_create_group(&client->dev.kobj, | ||
| 552 | &gl518_group_r80))) | ||
| 553 | goto exit_remove_files; | ||
| 462 | 554 | ||
| 463 | data->hwmon_dev = hwmon_device_register(&new_client->dev); | 555 | data->hwmon_dev = hwmon_device_register(&client->dev); |
| 464 | if (IS_ERR(data->hwmon_dev)) { | 556 | if (IS_ERR(data->hwmon_dev)) { |
| 465 | err = PTR_ERR(data->hwmon_dev); | 557 | err = PTR_ERR(data->hwmon_dev); |
| 466 | goto exit_remove_files; | 558 | goto exit_remove_files; |
| @@ -469,9 +561,11 @@ static int gl518_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 469 | return 0; | 561 | return 0; |
| 470 | 562 | ||
| 471 | exit_remove_files: | 563 | exit_remove_files: |
| 472 | sysfs_remove_group(&new_client->dev.kobj, &gl518_group); | 564 | sysfs_remove_group(&client->dev.kobj, &gl518_group); |
| 565 | if (data->type == gl518sm_r80) | ||
| 566 | sysfs_remove_group(&client->dev.kobj, &gl518_group_r80); | ||
| 473 | exit_detach: | 567 | exit_detach: |
| 474 | i2c_detach_client(new_client); | 568 | i2c_detach_client(client); |
| 475 | exit_free: | 569 | exit_free: |
| 476 | kfree(data); | 570 | kfree(data); |
| 477 | exit: | 571 | exit: |
| @@ -504,6 +598,8 @@ static int gl518_detach_client(struct i2c_client *client) | |||
| 504 | 598 | ||
| 505 | hwmon_device_unregister(data->hwmon_dev); | 599 | hwmon_device_unregister(data->hwmon_dev); |
| 506 | sysfs_remove_group(&client->dev.kobj, &gl518_group); | 600 | sysfs_remove_group(&client->dev.kobj, &gl518_group); |
| 601 | if (data->type == gl518sm_r80) | ||
| 602 | sysfs_remove_group(&client->dev.kobj, &gl518_group_r80); | ||
| 507 | 603 | ||
| 508 | if ((err = i2c_detach_client(client))) | 604 | if ((err = i2c_detach_client(client))) |
| 509 | return err; | 605 | return err; |
| @@ -512,9 +608,9 @@ static int gl518_detach_client(struct i2c_client *client) | |||
| 512 | return 0; | 608 | return 0; |
| 513 | } | 609 | } |
| 514 | 610 | ||
| 515 | /* Registers 0x07 to 0x0c are word-sized, others are byte-sized | 611 | /* Registers 0x07 to 0x0c are word-sized, others are byte-sized |
| 516 | GL518 uses a high-byte first convention, which is exactly opposite to | 612 | GL518 uses a high-byte first convention, which is exactly opposite to |
| 517 | the usual practice. */ | 613 | the SMBus standard. */ |
| 518 | static int gl518_read_value(struct i2c_client *client, u8 reg) | 614 | static int gl518_read_value(struct i2c_client *client, u8 reg) |
| 519 | { | 615 | { |
| 520 | if ((reg >= 0x07) && (reg <= 0x0c)) | 616 | if ((reg >= 0x07) && (reg <= 0x0c)) |
| @@ -523,9 +619,6 @@ static int gl518_read_value(struct i2c_client *client, u8 reg) | |||
| 523 | return i2c_smbus_read_byte_data(client, reg); | 619 | return i2c_smbus_read_byte_data(client, reg); |
| 524 | } | 620 | } |
| 525 | 621 | ||
| 526 | /* Registers 0x07 to 0x0c are word-sized, others are byte-sized | ||
| 527 | GL518 uses a high-byte first convention, which is exactly opposite to | ||
| 528 | the usual practice. */ | ||
| 529 | static int gl518_write_value(struct i2c_client *client, u8 reg, u16 value) | 622 | static int gl518_write_value(struct i2c_client *client, u8 reg, u16 value) |
| 530 | { | 623 | { |
| 531 | if ((reg >= 0x07) && (reg <= 0x0c)) | 624 | if ((reg >= 0x07) && (reg <= 0x0c)) |
diff --git a/drivers/hwmon/gl520sm.c b/drivers/hwmon/gl520sm.c index 2d39d8fc2389..03ecdc334764 100644 --- a/drivers/hwmon/gl520sm.c +++ b/drivers/hwmon/gl520sm.c | |||
| @@ -27,6 +27,7 @@ | |||
| 27 | #include <linux/jiffies.h> | 27 | #include <linux/jiffies.h> |
| 28 | #include <linux/i2c.h> | 28 | #include <linux/i2c.h> |
| 29 | #include <linux/hwmon.h> | 29 | #include <linux/hwmon.h> |
| 30 | #include <linux/hwmon-sysfs.h> | ||
| 30 | #include <linux/hwmon-vid.h> | 31 | #include <linux/hwmon-vid.h> |
| 31 | #include <linux/err.h> | 32 | #include <linux/err.h> |
| 32 | #include <linux/mutex.h> | 33 | #include <linux/mutex.h> |
| @@ -43,9 +44,9 @@ static unsigned short normal_i2c[] = { 0x2c, 0x2d, I2C_CLIENT_END }; | |||
| 43 | /* Insmod parameters */ | 44 | /* Insmod parameters */ |
| 44 | I2C_CLIENT_INSMOD_1(gl520sm); | 45 | I2C_CLIENT_INSMOD_1(gl520sm); |
| 45 | 46 | ||
| 46 | /* Many GL520 constants specified below | 47 | /* Many GL520 constants specified below |
| 47 | One of the inputs can be configured as either temp or voltage. | 48 | One of the inputs can be configured as either temp or voltage. |
| 48 | That's why _TEMP2 and _IN4 access the same register | 49 | That's why _TEMP2 and _IN4 access the same register |
| 49 | */ | 50 | */ |
| 50 | 51 | ||
| 51 | /* The GL520 registers */ | 52 | /* The GL520 registers */ |
| @@ -56,37 +57,14 @@ That's why _TEMP2 and _IN4 access the same register | |||
| 56 | 57 | ||
| 57 | #define GL520_REG_VID_INPUT 0x02 | 58 | #define GL520_REG_VID_INPUT 0x02 |
| 58 | 59 | ||
| 59 | #define GL520_REG_IN0_INPUT 0x15 | 60 | static const u8 GL520_REG_IN_INPUT[] = { 0x15, 0x14, 0x13, 0x0d, 0x0e }; |
| 60 | #define GL520_REG_IN0_LIMIT 0x0c | 61 | static const u8 GL520_REG_IN_LIMIT[] = { 0x0c, 0x09, 0x0a, 0x0b }; |
| 61 | #define GL520_REG_IN0_MIN GL520_REG_IN0_LIMIT | 62 | static const u8 GL520_REG_IN_MIN[] = { 0x0c, 0x09, 0x0a, 0x0b, 0x18 }; |
| 62 | #define GL520_REG_IN0_MAX GL520_REG_IN0_LIMIT | 63 | static const u8 GL520_REG_IN_MAX[] = { 0x0c, 0x09, 0x0a, 0x0b, 0x17 }; |
| 63 | 64 | ||
| 64 | #define GL520_REG_IN1_INPUT 0x14 | 65 | static const u8 GL520_REG_TEMP_INPUT[] = { 0x04, 0x0e }; |
| 65 | #define GL520_REG_IN1_LIMIT 0x09 | 66 | static const u8 GL520_REG_TEMP_MAX[] = { 0x05, 0x17 }; |
| 66 | #define GL520_REG_IN1_MIN GL520_REG_IN1_LIMIT | 67 | static const u8 GL520_REG_TEMP_MAX_HYST[] = { 0x06, 0x18 }; |
| 67 | #define GL520_REG_IN1_MAX GL520_REG_IN1_LIMIT | ||
| 68 | |||
| 69 | #define GL520_REG_IN2_INPUT 0x13 | ||
| 70 | #define GL520_REG_IN2_LIMIT 0x0a | ||
| 71 | #define GL520_REG_IN2_MIN GL520_REG_IN2_LIMIT | ||
| 72 | #define GL520_REG_IN2_MAX GL520_REG_IN2_LIMIT | ||
| 73 | |||
| 74 | #define GL520_REG_IN3_INPUT 0x0d | ||
| 75 | #define GL520_REG_IN3_LIMIT 0x0b | ||
| 76 | #define GL520_REG_IN3_MIN GL520_REG_IN3_LIMIT | ||
| 77 | #define GL520_REG_IN3_MAX GL520_REG_IN3_LIMIT | ||
| 78 | |||
| 79 | #define GL520_REG_IN4_INPUT 0x0e | ||
| 80 | #define GL520_REG_IN4_MAX 0x17 | ||
| 81 | #define GL520_REG_IN4_MIN 0x18 | ||
| 82 | |||
| 83 | #define GL520_REG_TEMP1_INPUT 0x04 | ||
| 84 | #define GL520_REG_TEMP1_MAX 0x05 | ||
| 85 | #define GL520_REG_TEMP1_MAX_HYST 0x06 | ||
| 86 | |||
| 87 | #define GL520_REG_TEMP2_INPUT 0x0e | ||
| 88 | #define GL520_REG_TEMP2_MAX 0x17 | ||
| 89 | #define GL520_REG_TEMP2_MAX_HYST 0x18 | ||
| 90 | 68 | ||
| 91 | #define GL520_REG_FAN_INPUT 0x07 | 69 | #define GL520_REG_FAN_INPUT 0x07 |
| 92 | #define GL520_REG_FAN_MIN 0x08 | 70 | #define GL520_REG_FAN_MIN 0x08 |
| @@ -114,7 +92,6 @@ static struct i2c_driver gl520_driver = { | |||
| 114 | .driver = { | 92 | .driver = { |
| 115 | .name = "gl520sm", | 93 | .name = "gl520sm", |
| 116 | }, | 94 | }, |
| 117 | .id = I2C_DRIVERID_GL520, | ||
| 118 | .attach_adapter = gl520_attach_adapter, | 95 | .attach_adapter = gl520_attach_adapter, |
| 119 | .detach_client = gl520_detach_client, | 96 | .detach_client = gl520_detach_client, |
| 120 | }; | 97 | }; |
| @@ -150,93 +127,13 @@ struct gl520_data { | |||
| 150 | * Sysfs stuff | 127 | * Sysfs stuff |
| 151 | */ | 128 | */ |
| 152 | 129 | ||
| 153 | #define sysfs_r(type, n, item, reg) \ | 130 | static ssize_t get_cpu_vid(struct device *dev, struct device_attribute *attr, |
| 154 | static ssize_t get_##type##item (struct gl520_data *, char *, int); \ | 131 | char *buf) |
| 155 | static ssize_t get_##type##n##item (struct device *, struct device_attribute *attr, char *); \ | ||
| 156 | static ssize_t get_##type##n##item (struct device *dev, struct device_attribute *attr, char *buf) \ | ||
| 157 | { \ | ||
| 158 | struct gl520_data *data = gl520_update_device(dev); \ | ||
| 159 | return get_##type##item(data, buf, (n)); \ | ||
| 160 | } | ||
| 161 | |||
| 162 | #define sysfs_w(type, n, item, reg) \ | ||
| 163 | static ssize_t set_##type##item (struct i2c_client *, struct gl520_data *, const char *, size_t, int, int); \ | ||
| 164 | static ssize_t set_##type##n##item (struct device *, struct device_attribute *attr, const char *, size_t); \ | ||
| 165 | static ssize_t set_##type##n##item (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \ | ||
| 166 | { \ | ||
| 167 | struct i2c_client *client = to_i2c_client(dev); \ | ||
| 168 | struct gl520_data *data = i2c_get_clientdata(client); \ | ||
| 169 | return set_##type##item(client, data, buf, count, (n), reg); \ | ||
| 170 | } | ||
| 171 | |||
| 172 | #define sysfs_rw_n(type, n, item, reg) \ | ||
| 173 | sysfs_r(type, n, item, reg) \ | ||
| 174 | sysfs_w(type, n, item, reg) \ | ||
| 175 | static DEVICE_ATTR(type##n##item, S_IRUGO | S_IWUSR, get_##type##n##item, set_##type##n##item); | ||
| 176 | |||
| 177 | #define sysfs_ro_n(type, n, item, reg) \ | ||
| 178 | sysfs_r(type, n, item, reg) \ | ||
| 179 | static DEVICE_ATTR(type##n##item, S_IRUGO, get_##type##n##item, NULL); | ||
| 180 | |||
| 181 | #define sysfs_rw(type, item, reg) \ | ||
| 182 | sysfs_r(type, 0, item, reg) \ | ||
| 183 | sysfs_w(type, 0, item, reg) \ | ||
| 184 | static DEVICE_ATTR(type##item, S_IRUGO | S_IWUSR, get_##type##0##item, set_##type##0##item); | ||
| 185 | |||
| 186 | #define sysfs_ro(type, item, reg) \ | ||
| 187 | sysfs_r(type, 0, item, reg) \ | ||
| 188 | static DEVICE_ATTR(type##item, S_IRUGO, get_##type##0##item, NULL); | ||
| 189 | |||
| 190 | |||
| 191 | #define sysfs_vid(n) \ | ||
| 192 | sysfs_ro_n(cpu, n, _vid, GL520_REG_VID_INPUT) | ||
| 193 | |||
| 194 | #define sysfs_in(n) \ | ||
| 195 | sysfs_ro_n(in, n, _input, GL520_REG_IN##n##INPUT) \ | ||
| 196 | sysfs_rw_n(in, n, _min, GL520_REG_IN##n##_MIN) \ | ||
| 197 | sysfs_rw_n(in, n, _max, GL520_REG_IN##n##_MAX) \ | ||
| 198 | |||
| 199 | #define sysfs_fan(n) \ | ||
| 200 | sysfs_ro_n(fan, n, _input, GL520_REG_FAN_INPUT) \ | ||
| 201 | sysfs_rw_n(fan, n, _min, GL520_REG_FAN_MIN) \ | ||
| 202 | sysfs_rw_n(fan, n, _div, GL520_REG_FAN_DIV) | ||
| 203 | |||
| 204 | #define sysfs_fan_off(n) \ | ||
| 205 | sysfs_rw_n(fan, n, _off, GL520_REG_FAN_OFF) \ | ||
| 206 | |||
| 207 | #define sysfs_temp(n) \ | ||
| 208 | sysfs_ro_n(temp, n, _input, GL520_REG_TEMP##n##_INPUT) \ | ||
| 209 | sysfs_rw_n(temp, n, _max, GL520_REG_TEMP##n##_MAX) \ | ||
| 210 | sysfs_rw_n(temp, n, _max_hyst, GL520_REG_TEMP##n##_MAX_HYST) | ||
| 211 | |||
| 212 | #define sysfs_alarms() \ | ||
| 213 | sysfs_ro(alarms, , GL520_REG_ALARMS) \ | ||
| 214 | sysfs_rw(beep_enable, , GL520_REG_BEEP_ENABLE) \ | ||
| 215 | sysfs_rw(beep_mask, , GL520_REG_BEEP_MASK) | ||
| 216 | |||
| 217 | |||
| 218 | sysfs_vid(0) | ||
| 219 | |||
| 220 | sysfs_in(0) | ||
| 221 | sysfs_in(1) | ||
| 222 | sysfs_in(2) | ||
| 223 | sysfs_in(3) | ||
| 224 | sysfs_in(4) | ||
| 225 | |||
| 226 | sysfs_fan(1) | ||
| 227 | sysfs_fan(2) | ||
| 228 | sysfs_fan_off(1) | ||
| 229 | |||
| 230 | sysfs_temp(1) | ||
| 231 | sysfs_temp(2) | ||
| 232 | |||
| 233 | sysfs_alarms() | ||
| 234 | |||
| 235 | |||
| 236 | static ssize_t get_cpu_vid(struct gl520_data *data, char *buf, int n) | ||
| 237 | { | 132 | { |
| 133 | struct gl520_data *data = gl520_update_device(dev); | ||
| 238 | return sprintf(buf, "%u\n", vid_from_reg(data->vid, data->vrm)); | 134 | return sprintf(buf, "%u\n", vid_from_reg(data->vid, data->vrm)); |
| 239 | } | 135 | } |
| 136 | static DEVICE_ATTR(cpu0_vid, S_IRUGO, get_cpu_vid, NULL); | ||
| 240 | 137 | ||
| 241 | #define VDD_FROM_REG(val) (((val)*95+2)/4) | 138 | #define VDD_FROM_REG(val) (((val)*95+2)/4) |
| 242 | #define VDD_TO_REG(val) (SENSORS_LIMIT((((val)*4+47)/95),0,255)) | 139 | #define VDD_TO_REG(val) (SENSORS_LIMIT((((val)*4+47)/95),0,255)) |
| @@ -244,8 +141,11 @@ static ssize_t get_cpu_vid(struct gl520_data *data, char *buf, int n) | |||
| 244 | #define IN_FROM_REG(val) ((val)*19) | 141 | #define IN_FROM_REG(val) ((val)*19) |
| 245 | #define IN_TO_REG(val) (SENSORS_LIMIT((((val)+9)/19),0,255)) | 142 | #define IN_TO_REG(val) (SENSORS_LIMIT((((val)+9)/19),0,255)) |
| 246 | 143 | ||
| 247 | static ssize_t get_in_input(struct gl520_data *data, char *buf, int n) | 144 | static ssize_t get_in_input(struct device *dev, struct device_attribute *attr, |
| 145 | char *buf) | ||
| 248 | { | 146 | { |
| 147 | int n = to_sensor_dev_attr(attr)->index; | ||
| 148 | struct gl520_data *data = gl520_update_device(dev); | ||
| 249 | u8 r = data->in_input[n]; | 149 | u8 r = data->in_input[n]; |
| 250 | 150 | ||
| 251 | if (n == 0) | 151 | if (n == 0) |
| @@ -254,8 +154,11 @@ static ssize_t get_in_input(struct gl520_data *data, char *buf, int n) | |||
| 254 | return sprintf(buf, "%d\n", IN_FROM_REG(r)); | 154 | return sprintf(buf, "%d\n", IN_FROM_REG(r)); |
| 255 | } | 155 | } |
| 256 | 156 | ||
| 257 | static ssize_t get_in_min(struct gl520_data *data, char *buf, int n) | 157 | static ssize_t get_in_min(struct device *dev, struct device_attribute *attr, |
| 158 | char *buf) | ||
| 258 | { | 159 | { |
| 160 | int n = to_sensor_dev_attr(attr)->index; | ||
| 161 | struct gl520_data *data = gl520_update_device(dev); | ||
| 259 | u8 r = data->in_min[n]; | 162 | u8 r = data->in_min[n]; |
| 260 | 163 | ||
| 261 | if (n == 0) | 164 | if (n == 0) |
| @@ -264,8 +167,11 @@ static ssize_t get_in_min(struct gl520_data *data, char *buf, int n) | |||
| 264 | return sprintf(buf, "%d\n", IN_FROM_REG(r)); | 167 | return sprintf(buf, "%d\n", IN_FROM_REG(r)); |
| 265 | } | 168 | } |
| 266 | 169 | ||
| 267 | static ssize_t get_in_max(struct gl520_data *data, char *buf, int n) | 170 | static ssize_t get_in_max(struct device *dev, struct device_attribute *attr, |
| 171 | char *buf) | ||
| 268 | { | 172 | { |
| 173 | int n = to_sensor_dev_attr(attr)->index; | ||
| 174 | struct gl520_data *data = gl520_update_device(dev); | ||
| 269 | u8 r = data->in_max[n]; | 175 | u8 r = data->in_max[n]; |
| 270 | 176 | ||
| 271 | if (n == 0) | 177 | if (n == 0) |
| @@ -274,8 +180,12 @@ static ssize_t get_in_max(struct gl520_data *data, char *buf, int n) | |||
| 274 | return sprintf(buf, "%d\n", IN_FROM_REG(r)); | 180 | return sprintf(buf, "%d\n", IN_FROM_REG(r)); |
| 275 | } | 181 | } |
| 276 | 182 | ||
| 277 | static ssize_t set_in_min(struct i2c_client *client, struct gl520_data *data, const char *buf, size_t count, int n, int reg) | 183 | static ssize_t set_in_min(struct device *dev, struct device_attribute *attr, |
| 184 | const char *buf, size_t count) | ||
| 278 | { | 185 | { |
| 186 | struct i2c_client *client = to_i2c_client(dev); | ||
| 187 | struct gl520_data *data = i2c_get_clientdata(client); | ||
| 188 | int n = to_sensor_dev_attr(attr)->index; | ||
| 279 | long v = simple_strtol(buf, NULL, 10); | 189 | long v = simple_strtol(buf, NULL, 10); |
| 280 | u8 r; | 190 | u8 r; |
| 281 | 191 | ||
| @@ -289,16 +199,22 @@ static ssize_t set_in_min(struct i2c_client *client, struct gl520_data *data, co | |||
| 289 | data->in_min[n] = r; | 199 | data->in_min[n] = r; |
| 290 | 200 | ||
| 291 | if (n < 4) | 201 | if (n < 4) |
| 292 | gl520_write_value(client, reg, (gl520_read_value(client, reg) & ~0xff) | r); | 202 | gl520_write_value(client, GL520_REG_IN_MIN[n], |
| 203 | (gl520_read_value(client, GL520_REG_IN_MIN[n]) | ||
| 204 | & ~0xff) | r); | ||
| 293 | else | 205 | else |
| 294 | gl520_write_value(client, reg, r); | 206 | gl520_write_value(client, GL520_REG_IN_MIN[n], r); |
| 295 | 207 | ||
| 296 | mutex_unlock(&data->update_lock); | 208 | mutex_unlock(&data->update_lock); |
| 297 | return count; | 209 | return count; |
| 298 | } | 210 | } |
| 299 | 211 | ||
| 300 | static ssize_t set_in_max(struct i2c_client *client, struct gl520_data *data, const char *buf, size_t count, int n, int reg) | 212 | static ssize_t set_in_max(struct device *dev, struct device_attribute *attr, |
| 213 | const char *buf, size_t count) | ||
| 301 | { | 214 | { |
| 215 | struct i2c_client *client = to_i2c_client(dev); | ||
| 216 | struct gl520_data *data = i2c_get_clientdata(client); | ||
| 217 | int n = to_sensor_dev_attr(attr)->index; | ||
| 302 | long v = simple_strtol(buf, NULL, 10); | 218 | long v = simple_strtol(buf, NULL, 10); |
| 303 | u8 r; | 219 | u8 r; |
| 304 | 220 | ||
| @@ -312,57 +228,109 @@ static ssize_t set_in_max(struct i2c_client *client, struct gl520_data *data, co | |||
| 312 | data->in_max[n] = r; | 228 | data->in_max[n] = r; |
| 313 | 229 | ||
| 314 | if (n < 4) | 230 | if (n < 4) |
| 315 | gl520_write_value(client, reg, (gl520_read_value(client, reg) & ~0xff00) | (r << 8)); | 231 | gl520_write_value(client, GL520_REG_IN_MAX[n], |
| 232 | (gl520_read_value(client, GL520_REG_IN_MAX[n]) | ||
| 233 | & ~0xff00) | (r << 8)); | ||
| 316 | else | 234 | else |
| 317 | gl520_write_value(client, reg, r); | 235 | gl520_write_value(client, GL520_REG_IN_MAX[n], r); |
| 318 | 236 | ||
| 319 | mutex_unlock(&data->update_lock); | 237 | mutex_unlock(&data->update_lock); |
| 320 | return count; | 238 | return count; |
| 321 | } | 239 | } |
| 322 | 240 | ||
| 241 | static SENSOR_DEVICE_ATTR(in0_input, S_IRUGO, get_in_input, NULL, 0); | ||
| 242 | static SENSOR_DEVICE_ATTR(in1_input, S_IRUGO, get_in_input, NULL, 1); | ||
| 243 | static SENSOR_DEVICE_ATTR(in2_input, S_IRUGO, get_in_input, NULL, 2); | ||
| 244 | static SENSOR_DEVICE_ATTR(in3_input, S_IRUGO, get_in_input, NULL, 3); | ||
| 245 | static SENSOR_DEVICE_ATTR(in4_input, S_IRUGO, get_in_input, NULL, 4); | ||
| 246 | static SENSOR_DEVICE_ATTR(in0_min, S_IRUGO | S_IWUSR, | ||
| 247 | get_in_min, set_in_min, 0); | ||
| 248 | static SENSOR_DEVICE_ATTR(in1_min, S_IRUGO | S_IWUSR, | ||
| 249 | get_in_min, set_in_min, 1); | ||
| 250 | static SENSOR_DEVICE_ATTR(in2_min, S_IRUGO | S_IWUSR, | ||
| 251 | get_in_min, set_in_min, 2); | ||
| 252 | static SENSOR_DEVICE_ATTR(in3_min, S_IRUGO | S_IWUSR, | ||
| 253 | get_in_min, set_in_min, 3); | ||
| 254 | static SENSOR_DEVICE_ATTR(in4_min, S_IRUGO | S_IWUSR, | ||
| 255 | get_in_min, set_in_min, 4); | ||
| 256 | static SENSOR_DEVICE_ATTR(in0_max, S_IRUGO | S_IWUSR, | ||
| 257 | get_in_max, set_in_max, 0); | ||
| 258 | static SENSOR_DEVICE_ATTR(in1_max, S_IRUGO | S_IWUSR, | ||
| 259 | get_in_max, set_in_max, 1); | ||
| 260 | static SENSOR_DEVICE_ATTR(in2_max, S_IRUGO | S_IWUSR, | ||
| 261 | get_in_max, set_in_max, 2); | ||
| 262 | static SENSOR_DEVICE_ATTR(in3_max, S_IRUGO | S_IWUSR, | ||
| 263 | get_in_max, set_in_max, 3); | ||
| 264 | static SENSOR_DEVICE_ATTR(in4_max, S_IRUGO | S_IWUSR, | ||
| 265 | get_in_max, set_in_max, 4); | ||
| 266 | |||
| 323 | #define DIV_FROM_REG(val) (1 << (val)) | 267 | #define DIV_FROM_REG(val) (1 << (val)) |
| 324 | #define FAN_FROM_REG(val,div) ((val)==0 ? 0 : (480000/((val) << (div)))) | 268 | #define FAN_FROM_REG(val,div) ((val)==0 ? 0 : (480000/((val) << (div)))) |
| 325 | #define FAN_TO_REG(val,div) ((val)<=0?0:SENSORS_LIMIT((480000 + ((val) << ((div)-1))) / ((val) << (div)), 1, 255)); | 269 | #define FAN_TO_REG(val,div) ((val)<=0?0:SENSORS_LIMIT((480000 + ((val) << ((div)-1))) / ((val) << (div)), 1, 255)); |
| 326 | 270 | ||
| 327 | static ssize_t get_fan_input(struct gl520_data *data, char *buf, int n) | 271 | static ssize_t get_fan_input(struct device *dev, struct device_attribute *attr, |
| 272 | char *buf) | ||
| 328 | { | 273 | { |
| 329 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_input[n - 1], data->fan_div[n - 1])); | 274 | int n = to_sensor_dev_attr(attr)->index; |
| 275 | struct gl520_data *data = gl520_update_device(dev); | ||
| 276 | |||
| 277 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_input[n], | ||
| 278 | data->fan_div[n])); | ||
| 330 | } | 279 | } |
| 331 | 280 | ||
| 332 | static ssize_t get_fan_min(struct gl520_data *data, char *buf, int n) | 281 | static ssize_t get_fan_min(struct device *dev, struct device_attribute *attr, |
| 282 | char *buf) | ||
| 333 | { | 283 | { |
| 334 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[n - 1], data->fan_div[n - 1])); | 284 | int n = to_sensor_dev_attr(attr)->index; |
| 285 | struct gl520_data *data = gl520_update_device(dev); | ||
| 286 | |||
| 287 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[n], | ||
| 288 | data->fan_div[n])); | ||
| 335 | } | 289 | } |
| 336 | 290 | ||
| 337 | static ssize_t get_fan_div(struct gl520_data *data, char *buf, int n) | 291 | static ssize_t get_fan_div(struct device *dev, struct device_attribute *attr, |
| 292 | char *buf) | ||
| 338 | { | 293 | { |
| 339 | return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[n - 1])); | 294 | int n = to_sensor_dev_attr(attr)->index; |
| 295 | struct gl520_data *data = gl520_update_device(dev); | ||
| 296 | |||
| 297 | return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[n])); | ||
| 340 | } | 298 | } |
| 341 | 299 | ||
| 342 | static ssize_t get_fan_off(struct gl520_data *data, char *buf, int n) | 300 | static ssize_t get_fan_off(struct device *dev, struct device_attribute *attr, |
| 301 | char *buf) | ||
| 343 | { | 302 | { |
| 303 | struct gl520_data *data = gl520_update_device(dev); | ||
| 344 | return sprintf(buf, "%d\n", data->fan_off); | 304 | return sprintf(buf, "%d\n", data->fan_off); |
| 345 | } | 305 | } |
| 346 | 306 | ||
| 347 | static ssize_t set_fan_min(struct i2c_client *client, struct gl520_data *data, const char *buf, size_t count, int n, int reg) | 307 | static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr, |
| 308 | const char *buf, size_t count) | ||
| 348 | { | 309 | { |
| 310 | struct i2c_client *client = to_i2c_client(dev); | ||
| 311 | struct gl520_data *data = i2c_get_clientdata(client); | ||
| 312 | int n = to_sensor_dev_attr(attr)->index; | ||
| 349 | unsigned long v = simple_strtoul(buf, NULL, 10); | 313 | unsigned long v = simple_strtoul(buf, NULL, 10); |
| 350 | u8 r; | 314 | u8 r; |
| 351 | 315 | ||
| 352 | mutex_lock(&data->update_lock); | 316 | mutex_lock(&data->update_lock); |
| 353 | r = FAN_TO_REG(v, data->fan_div[n - 1]); | 317 | r = FAN_TO_REG(v, data->fan_div[n]); |
| 354 | data->fan_min[n - 1] = r; | 318 | data->fan_min[n] = r; |
| 355 | 319 | ||
| 356 | if (n == 1) | 320 | if (n == 0) |
| 357 | gl520_write_value(client, reg, (gl520_read_value(client, reg) & ~0xff00) | (r << 8)); | 321 | gl520_write_value(client, GL520_REG_FAN_MIN, |
| 322 | (gl520_read_value(client, GL520_REG_FAN_MIN) | ||
| 323 | & ~0xff00) | (r << 8)); | ||
| 358 | else | 324 | else |
| 359 | gl520_write_value(client, reg, (gl520_read_value(client, reg) & ~0xff) | r); | 325 | gl520_write_value(client, GL520_REG_FAN_MIN, |
| 326 | (gl520_read_value(client, GL520_REG_FAN_MIN) | ||
| 327 | & ~0xff) | r); | ||
| 360 | 328 | ||
| 361 | data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK); | 329 | data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK); |
| 362 | if (data->fan_min[n - 1] == 0) | 330 | if (data->fan_min[n] == 0) |
| 363 | data->alarm_mask &= (n == 1) ? ~0x20 : ~0x40; | 331 | data->alarm_mask &= (n == 0) ? ~0x20 : ~0x40; |
| 364 | else | 332 | else |
| 365 | data->alarm_mask |= (n == 1) ? 0x20 : 0x40; | 333 | data->alarm_mask |= (n == 0) ? 0x20 : 0x40; |
| 366 | data->beep_mask &= data->alarm_mask; | 334 | data->beep_mask &= data->alarm_mask; |
| 367 | gl520_write_value(client, GL520_REG_BEEP_MASK, data->beep_mask); | 335 | gl520_write_value(client, GL520_REG_BEEP_MASK, data->beep_mask); |
| 368 | 336 | ||
| @@ -370,8 +338,12 @@ static ssize_t set_fan_min(struct i2c_client *client, struct gl520_data *data, c | |||
| 370 | return count; | 338 | return count; |
| 371 | } | 339 | } |
| 372 | 340 | ||
| 373 | static ssize_t set_fan_div(struct i2c_client *client, struct gl520_data *data, const char *buf, size_t count, int n, int reg) | 341 | static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, |
| 342 | const char *buf, size_t count) | ||
| 374 | { | 343 | { |
| 344 | struct i2c_client *client = to_i2c_client(dev); | ||
| 345 | struct gl520_data *data = i2c_get_clientdata(client); | ||
| 346 | int n = to_sensor_dev_attr(attr)->index; | ||
| 375 | unsigned long v = simple_strtoul(buf, NULL, 10); | 347 | unsigned long v = simple_strtoul(buf, NULL, 10); |
| 376 | u8 r; | 348 | u8 r; |
| 377 | 349 | ||
| @@ -386,133 +358,282 @@ static ssize_t set_fan_div(struct i2c_client *client, struct gl520_data *data, c | |||
| 386 | } | 358 | } |
| 387 | 359 | ||
| 388 | mutex_lock(&data->update_lock); | 360 | mutex_lock(&data->update_lock); |
| 389 | data->fan_div[n - 1] = r; | 361 | data->fan_div[n] = r; |
| 390 | 362 | ||
| 391 | if (n == 1) | 363 | if (n == 0) |
| 392 | gl520_write_value(client, reg, (gl520_read_value(client, reg) & ~0xc0) | (r << 6)); | 364 | gl520_write_value(client, GL520_REG_FAN_DIV, |
| 365 | (gl520_read_value(client, GL520_REG_FAN_DIV) | ||
| 366 | & ~0xc0) | (r << 6)); | ||
| 393 | else | 367 | else |
| 394 | gl520_write_value(client, reg, (gl520_read_value(client, reg) & ~0x30) | (r << 4)); | 368 | gl520_write_value(client, GL520_REG_FAN_DIV, |
| 369 | (gl520_read_value(client, GL520_REG_FAN_DIV) | ||
| 370 | & ~0x30) | (r << 4)); | ||
| 395 | 371 | ||
| 396 | mutex_unlock(&data->update_lock); | 372 | mutex_unlock(&data->update_lock); |
| 397 | return count; | 373 | return count; |
| 398 | } | 374 | } |
| 399 | 375 | ||
| 400 | static ssize_t set_fan_off(struct i2c_client *client, struct gl520_data *data, const char *buf, size_t count, int n, int reg) | 376 | static ssize_t set_fan_off(struct device *dev, struct device_attribute *attr, |
| 377 | const char *buf, size_t count) | ||
| 401 | { | 378 | { |
| 379 | struct i2c_client *client = to_i2c_client(dev); | ||
| 380 | struct gl520_data *data = i2c_get_clientdata(client); | ||
| 402 | u8 r = simple_strtoul(buf, NULL, 10)?1:0; | 381 | u8 r = simple_strtoul(buf, NULL, 10)?1:0; |
| 403 | 382 | ||
| 404 | mutex_lock(&data->update_lock); | 383 | mutex_lock(&data->update_lock); |
| 405 | data->fan_off = r; | 384 | data->fan_off = r; |
| 406 | gl520_write_value(client, reg, (gl520_read_value(client, reg) & ~0x0c) | (r << 2)); | 385 | gl520_write_value(client, GL520_REG_FAN_OFF, |
| 386 | (gl520_read_value(client, GL520_REG_FAN_OFF) | ||
| 387 | & ~0x0c) | (r << 2)); | ||
| 407 | mutex_unlock(&data->update_lock); | 388 | mutex_unlock(&data->update_lock); |
| 408 | return count; | 389 | return count; |
| 409 | } | 390 | } |
| 410 | 391 | ||
| 392 | static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, get_fan_input, NULL, 0); | ||
| 393 | static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, get_fan_input, NULL, 1); | ||
| 394 | static SENSOR_DEVICE_ATTR(fan1_min, S_IRUGO | S_IWUSR, | ||
| 395 | get_fan_min, set_fan_min, 0); | ||
| 396 | static SENSOR_DEVICE_ATTR(fan2_min, S_IRUGO | S_IWUSR, | ||
| 397 | get_fan_min, set_fan_min, 1); | ||
| 398 | static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR, | ||
| 399 | get_fan_div, set_fan_div, 0); | ||
| 400 | static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR, | ||
| 401 | get_fan_div, set_fan_div, 1); | ||
| 402 | static DEVICE_ATTR(fan1_off, S_IRUGO | S_IWUSR, | ||
| 403 | get_fan_off, set_fan_off); | ||
| 404 | |||
| 411 | #define TEMP_FROM_REG(val) (((val) - 130) * 1000) | 405 | #define TEMP_FROM_REG(val) (((val) - 130) * 1000) |
| 412 | #define TEMP_TO_REG(val) (SENSORS_LIMIT(((((val)<0?(val)-500:(val)+500) / 1000)+130),0,255)) | 406 | #define TEMP_TO_REG(val) (SENSORS_LIMIT(((((val)<0?(val)-500:(val)+500) / 1000)+130),0,255)) |
| 413 | 407 | ||
| 414 | static ssize_t get_temp_input(struct gl520_data *data, char *buf, int n) | 408 | static ssize_t get_temp_input(struct device *dev, struct device_attribute *attr, |
| 409 | char *buf) | ||
| 415 | { | 410 | { |
| 416 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_input[n - 1])); | 411 | int n = to_sensor_dev_attr(attr)->index; |
| 412 | struct gl520_data *data = gl520_update_device(dev); | ||
| 413 | |||
| 414 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_input[n])); | ||
| 417 | } | 415 | } |
| 418 | 416 | ||
| 419 | static ssize_t get_temp_max(struct gl520_data *data, char *buf, int n) | 417 | static ssize_t get_temp_max(struct device *dev, struct device_attribute *attr, |
| 418 | char *buf) | ||
| 420 | { | 419 | { |
| 421 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[n - 1])); | 420 | int n = to_sensor_dev_attr(attr)->index; |
| 421 | struct gl520_data *data = gl520_update_device(dev); | ||
| 422 | |||
| 423 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[n])); | ||
| 422 | } | 424 | } |
| 423 | 425 | ||
| 424 | static ssize_t get_temp_max_hyst(struct gl520_data *data, char *buf, int n) | 426 | static ssize_t get_temp_max_hyst(struct device *dev, struct device_attribute |
| 427 | *attr, char *buf) | ||
| 425 | { | 428 | { |
| 426 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max_hyst[n - 1])); | 429 | int n = to_sensor_dev_attr(attr)->index; |
| 430 | struct gl520_data *data = gl520_update_device(dev); | ||
| 431 | |||
| 432 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max_hyst[n])); | ||
| 427 | } | 433 | } |
| 428 | 434 | ||
| 429 | static ssize_t set_temp_max(struct i2c_client *client, struct gl520_data *data, const char *buf, size_t count, int n, int reg) | 435 | static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr, |
| 436 | const char *buf, size_t count) | ||
| 430 | { | 437 | { |
| 438 | struct i2c_client *client = to_i2c_client(dev); | ||
| 439 | struct gl520_data *data = i2c_get_clientdata(client); | ||
| 440 | int n = to_sensor_dev_attr(attr)->index; | ||
| 431 | long v = simple_strtol(buf, NULL, 10); | 441 | long v = simple_strtol(buf, NULL, 10); |
| 432 | 442 | ||
| 433 | mutex_lock(&data->update_lock); | 443 | mutex_lock(&data->update_lock); |
| 434 | data->temp_max[n - 1] = TEMP_TO_REG(v); | 444 | data->temp_max[n] = TEMP_TO_REG(v); |
| 435 | gl520_write_value(client, reg, data->temp_max[n - 1]); | 445 | gl520_write_value(client, GL520_REG_TEMP_MAX[n], data->temp_max[n]); |
| 436 | mutex_unlock(&data->update_lock); | 446 | mutex_unlock(&data->update_lock); |
| 437 | return count; | 447 | return count; |
| 438 | } | 448 | } |
| 439 | 449 | ||
| 440 | static ssize_t set_temp_max_hyst(struct i2c_client *client, struct gl520_data *data, const char *buf, size_t count, int n, int reg) | 450 | static ssize_t set_temp_max_hyst(struct device *dev, struct device_attribute |
| 451 | *attr, const char *buf, size_t count) | ||
| 441 | { | 452 | { |
| 453 | struct i2c_client *client = to_i2c_client(dev); | ||
| 454 | struct gl520_data *data = i2c_get_clientdata(client); | ||
| 455 | int n = to_sensor_dev_attr(attr)->index; | ||
| 442 | long v = simple_strtol(buf, NULL, 10); | 456 | long v = simple_strtol(buf, NULL, 10); |
| 443 | 457 | ||
| 444 | mutex_lock(&data->update_lock); | 458 | mutex_lock(&data->update_lock); |
| 445 | data->temp_max_hyst[n - 1] = TEMP_TO_REG(v); | 459 | data->temp_max_hyst[n] = TEMP_TO_REG(v); |
| 446 | gl520_write_value(client, reg, data->temp_max_hyst[n - 1]); | 460 | gl520_write_value(client, GL520_REG_TEMP_MAX_HYST[n], |
| 461 | data->temp_max_hyst[n]); | ||
| 447 | mutex_unlock(&data->update_lock); | 462 | mutex_unlock(&data->update_lock); |
| 448 | return count; | 463 | return count; |
| 449 | } | 464 | } |
| 450 | 465 | ||
| 451 | static ssize_t get_alarms(struct gl520_data *data, char *buf, int n) | 466 | static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, get_temp_input, NULL, 0); |
| 467 | static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, get_temp_input, NULL, 1); | ||
| 468 | static SENSOR_DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR, | ||
| 469 | get_temp_max, set_temp_max, 0); | ||
| 470 | static SENSOR_DEVICE_ATTR(temp2_max, S_IRUGO | S_IWUSR, | ||
| 471 | get_temp_max, set_temp_max, 1); | ||
| 472 | static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR, | ||
| 473 | get_temp_max_hyst, set_temp_max_hyst, 0); | ||
| 474 | static SENSOR_DEVICE_ATTR(temp2_max_hyst, S_IRUGO | S_IWUSR, | ||
| 475 | get_temp_max_hyst, set_temp_max_hyst, 1); | ||
| 476 | |||
| 477 | static ssize_t get_alarms(struct device *dev, struct device_attribute *attr, | ||
| 478 | char *buf) | ||
| 452 | { | 479 | { |
| 480 | struct gl520_data *data = gl520_update_device(dev); | ||
| 453 | return sprintf(buf, "%d\n", data->alarms); | 481 | return sprintf(buf, "%d\n", data->alarms); |
| 454 | } | 482 | } |
| 455 | 483 | ||
| 456 | static ssize_t get_beep_enable(struct gl520_data *data, char *buf, int n) | 484 | static ssize_t get_beep_enable(struct device *dev, struct device_attribute |
| 485 | *attr, char *buf) | ||
| 457 | { | 486 | { |
| 487 | struct gl520_data *data = gl520_update_device(dev); | ||
| 458 | return sprintf(buf, "%d\n", data->beep_enable); | 488 | return sprintf(buf, "%d\n", data->beep_enable); |
| 459 | } | 489 | } |
| 460 | 490 | ||
| 461 | static ssize_t get_beep_mask(struct gl520_data *data, char *buf, int n) | 491 | static ssize_t get_beep_mask(struct device *dev, struct device_attribute *attr, |
| 492 | char *buf) | ||
| 462 | { | 493 | { |
| 494 | struct gl520_data *data = gl520_update_device(dev); | ||
| 463 | return sprintf(buf, "%d\n", data->beep_mask); | 495 | return sprintf(buf, "%d\n", data->beep_mask); |
| 464 | } | 496 | } |
| 465 | 497 | ||
| 466 | static ssize_t set_beep_enable(struct i2c_client *client, struct gl520_data *data, const char *buf, size_t count, int n, int reg) | 498 | static ssize_t set_beep_enable(struct device *dev, struct device_attribute |
| 499 | *attr, const char *buf, size_t count) | ||
| 467 | { | 500 | { |
| 501 | struct i2c_client *client = to_i2c_client(dev); | ||
| 502 | struct gl520_data *data = i2c_get_clientdata(client); | ||
| 468 | u8 r = simple_strtoul(buf, NULL, 10)?0:1; | 503 | u8 r = simple_strtoul(buf, NULL, 10)?0:1; |
| 469 | 504 | ||
| 470 | mutex_lock(&data->update_lock); | 505 | mutex_lock(&data->update_lock); |
| 471 | data->beep_enable = !r; | 506 | data->beep_enable = !r; |
| 472 | gl520_write_value(client, reg, (gl520_read_value(client, reg) & ~0x04) | (r << 2)); | 507 | gl520_write_value(client, GL520_REG_BEEP_ENABLE, |
| 508 | (gl520_read_value(client, GL520_REG_BEEP_ENABLE) | ||
| 509 | & ~0x04) | (r << 2)); | ||
| 473 | mutex_unlock(&data->update_lock); | 510 | mutex_unlock(&data->update_lock); |
| 474 | return count; | 511 | return count; |
| 475 | } | 512 | } |
| 476 | 513 | ||
| 477 | static ssize_t set_beep_mask(struct i2c_client *client, struct gl520_data *data, const char *buf, size_t count, int n, int reg) | 514 | static ssize_t set_beep_mask(struct device *dev, struct device_attribute *attr, |
| 515 | const char *buf, size_t count) | ||
| 478 | { | 516 | { |
| 517 | struct i2c_client *client = to_i2c_client(dev); | ||
| 518 | struct gl520_data *data = i2c_get_clientdata(client); | ||
| 479 | u8 r = simple_strtoul(buf, NULL, 10); | 519 | u8 r = simple_strtoul(buf, NULL, 10); |
| 480 | 520 | ||
| 481 | mutex_lock(&data->update_lock); | 521 | mutex_lock(&data->update_lock); |
| 482 | r &= data->alarm_mask; | 522 | r &= data->alarm_mask; |
| 483 | data->beep_mask = r; | 523 | data->beep_mask = r; |
| 484 | gl520_write_value(client, reg, r); | 524 | gl520_write_value(client, GL520_REG_BEEP_MASK, r); |
| 525 | mutex_unlock(&data->update_lock); | ||
| 526 | return count; | ||
| 527 | } | ||
| 528 | |||
| 529 | static DEVICE_ATTR(alarms, S_IRUGO, get_alarms, NULL); | ||
| 530 | static DEVICE_ATTR(beep_enable, S_IRUGO | S_IWUSR, | ||
| 531 | get_beep_enable, set_beep_enable); | ||
| 532 | static DEVICE_ATTR(beep_mask, S_IRUGO | S_IWUSR, | ||
| 533 | get_beep_mask, set_beep_mask); | ||
| 534 | |||
| 535 | static ssize_t get_alarm(struct device *dev, struct device_attribute *attr, | ||
| 536 | char *buf) | ||
| 537 | { | ||
| 538 | int bit_nr = to_sensor_dev_attr(attr)->index; | ||
| 539 | struct gl520_data *data = gl520_update_device(dev); | ||
| 540 | |||
| 541 | return sprintf(buf, "%d\n", (data->alarms >> bit_nr) & 1); | ||
| 542 | } | ||
| 543 | |||
| 544 | static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, get_alarm, NULL, 0); | ||
| 545 | static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, get_alarm, NULL, 1); | ||
| 546 | static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, get_alarm, NULL, 2); | ||
| 547 | static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, get_alarm, NULL, 3); | ||
| 548 | static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, get_alarm, NULL, 4); | ||
| 549 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, get_alarm, NULL, 5); | ||
| 550 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, get_alarm, NULL, 6); | ||
| 551 | static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, get_alarm, NULL, 7); | ||
| 552 | static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, get_alarm, NULL, 7); | ||
| 553 | |||
| 554 | static ssize_t get_beep(struct device *dev, struct device_attribute *attr, | ||
| 555 | char *buf) | ||
| 556 | { | ||
| 557 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 558 | struct gl520_data *data = gl520_update_device(dev); | ||
| 559 | |||
| 560 | return sprintf(buf, "%d\n", (data->beep_mask >> bitnr) & 1); | ||
| 561 | } | ||
| 562 | |||
| 563 | static ssize_t set_beep(struct device *dev, struct device_attribute *attr, | ||
| 564 | const char *buf, size_t count) | ||
| 565 | { | ||
| 566 | struct i2c_client *client = to_i2c_client(dev); | ||
| 567 | struct gl520_data *data = i2c_get_clientdata(client); | ||
| 568 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 569 | unsigned long bit; | ||
| 570 | |||
| 571 | bit = simple_strtoul(buf, NULL, 10); | ||
| 572 | if (bit & ~1) | ||
| 573 | return -EINVAL; | ||
| 574 | |||
| 575 | mutex_lock(&data->update_lock); | ||
| 576 | data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK); | ||
| 577 | if (bit) | ||
| 578 | data->beep_mask |= (1 << bitnr); | ||
| 579 | else | ||
| 580 | data->beep_mask &= ~(1 << bitnr); | ||
| 581 | gl520_write_value(client, GL520_REG_BEEP_MASK, data->beep_mask); | ||
| 485 | mutex_unlock(&data->update_lock); | 582 | mutex_unlock(&data->update_lock); |
| 486 | return count; | 583 | return count; |
| 487 | } | 584 | } |
| 488 | 585 | ||
| 586 | static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 0); | ||
| 587 | static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 1); | ||
| 588 | static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 2); | ||
| 589 | static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 3); | ||
| 590 | static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 4); | ||
| 591 | static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 5); | ||
| 592 | static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 6); | ||
| 593 | static SENSOR_DEVICE_ATTR(temp2_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 7); | ||
| 594 | static SENSOR_DEVICE_ATTR(in4_beep, S_IRUGO | S_IWUSR, get_beep, set_beep, 7); | ||
| 595 | |||
| 489 | static struct attribute *gl520_attributes[] = { | 596 | static struct attribute *gl520_attributes[] = { |
| 490 | &dev_attr_cpu0_vid.attr, | 597 | &dev_attr_cpu0_vid.attr, |
| 491 | 598 | ||
| 492 | &dev_attr_in0_input.attr, | 599 | &sensor_dev_attr_in0_input.dev_attr.attr, |
| 493 | &dev_attr_in0_min.attr, | 600 | &sensor_dev_attr_in0_min.dev_attr.attr, |
| 494 | &dev_attr_in0_max.attr, | 601 | &sensor_dev_attr_in0_max.dev_attr.attr, |
| 495 | &dev_attr_in1_input.attr, | 602 | &sensor_dev_attr_in0_alarm.dev_attr.attr, |
| 496 | &dev_attr_in1_min.attr, | 603 | &sensor_dev_attr_in0_beep.dev_attr.attr, |
| 497 | &dev_attr_in1_max.attr, | 604 | &sensor_dev_attr_in1_input.dev_attr.attr, |
| 498 | &dev_attr_in2_input.attr, | 605 | &sensor_dev_attr_in1_min.dev_attr.attr, |
| 499 | &dev_attr_in2_min.attr, | 606 | &sensor_dev_attr_in1_max.dev_attr.attr, |
| 500 | &dev_attr_in2_max.attr, | 607 | &sensor_dev_attr_in1_alarm.dev_attr.attr, |
| 501 | &dev_attr_in3_input.attr, | 608 | &sensor_dev_attr_in1_beep.dev_attr.attr, |
| 502 | &dev_attr_in3_min.attr, | 609 | &sensor_dev_attr_in2_input.dev_attr.attr, |
| 503 | &dev_attr_in3_max.attr, | 610 | &sensor_dev_attr_in2_min.dev_attr.attr, |
| 504 | 611 | &sensor_dev_attr_in2_max.dev_attr.attr, | |
| 505 | &dev_attr_fan1_input.attr, | 612 | &sensor_dev_attr_in2_alarm.dev_attr.attr, |
| 506 | &dev_attr_fan1_min.attr, | 613 | &sensor_dev_attr_in2_beep.dev_attr.attr, |
| 507 | &dev_attr_fan1_div.attr, | 614 | &sensor_dev_attr_in3_input.dev_attr.attr, |
| 615 | &sensor_dev_attr_in3_min.dev_attr.attr, | ||
| 616 | &sensor_dev_attr_in3_max.dev_attr.attr, | ||
| 617 | &sensor_dev_attr_in3_alarm.dev_attr.attr, | ||
| 618 | &sensor_dev_attr_in3_beep.dev_attr.attr, | ||
| 619 | |||
| 620 | &sensor_dev_attr_fan1_input.dev_attr.attr, | ||
| 621 | &sensor_dev_attr_fan1_min.dev_attr.attr, | ||
| 622 | &sensor_dev_attr_fan1_div.dev_attr.attr, | ||
| 623 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, | ||
| 624 | &sensor_dev_attr_fan1_beep.dev_attr.attr, | ||
| 508 | &dev_attr_fan1_off.attr, | 625 | &dev_attr_fan1_off.attr, |
| 509 | &dev_attr_fan2_input.attr, | 626 | &sensor_dev_attr_fan2_input.dev_attr.attr, |
| 510 | &dev_attr_fan2_min.attr, | 627 | &sensor_dev_attr_fan2_min.dev_attr.attr, |
| 511 | &dev_attr_fan2_div.attr, | 628 | &sensor_dev_attr_fan2_div.dev_attr.attr, |
| 512 | 629 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, | |
| 513 | &dev_attr_temp1_input.attr, | 630 | &sensor_dev_attr_fan2_beep.dev_attr.attr, |
| 514 | &dev_attr_temp1_max.attr, | 631 | |
| 515 | &dev_attr_temp1_max_hyst.attr, | 632 | &sensor_dev_attr_temp1_input.dev_attr.attr, |
| 633 | &sensor_dev_attr_temp1_max.dev_attr.attr, | ||
| 634 | &sensor_dev_attr_temp1_max_hyst.dev_attr.attr, | ||
| 635 | &sensor_dev_attr_temp1_alarm.dev_attr.attr, | ||
| 636 | &sensor_dev_attr_temp1_beep.dev_attr.attr, | ||
| 516 | 637 | ||
| 517 | &dev_attr_alarms.attr, | 638 | &dev_attr_alarms.attr, |
| 518 | &dev_attr_beep_enable.attr, | 639 | &dev_attr_beep_enable.attr, |
| @@ -525,13 +646,17 @@ static const struct attribute_group gl520_group = { | |||
| 525 | }; | 646 | }; |
| 526 | 647 | ||
| 527 | static struct attribute *gl520_attributes_opt[] = { | 648 | static struct attribute *gl520_attributes_opt[] = { |
| 528 | &dev_attr_in4_input.attr, | 649 | &sensor_dev_attr_in4_input.dev_attr.attr, |
| 529 | &dev_attr_in4_min.attr, | 650 | &sensor_dev_attr_in4_min.dev_attr.attr, |
| 530 | &dev_attr_in4_max.attr, | 651 | &sensor_dev_attr_in4_max.dev_attr.attr, |
| 531 | 652 | &sensor_dev_attr_in4_alarm.dev_attr.attr, | |
| 532 | &dev_attr_temp2_input.attr, | 653 | &sensor_dev_attr_in4_beep.dev_attr.attr, |
| 533 | &dev_attr_temp2_max.attr, | 654 | |
| 534 | &dev_attr_temp2_max_hyst.attr, | 655 | &sensor_dev_attr_temp2_input.dev_attr.attr, |
| 656 | &sensor_dev_attr_temp2_max.dev_attr.attr, | ||
| 657 | &sensor_dev_attr_temp2_max_hyst.dev_attr.attr, | ||
| 658 | &sensor_dev_attr_temp2_alarm.dev_attr.attr, | ||
| 659 | &sensor_dev_attr_temp2_beep.dev_attr.attr, | ||
| 535 | NULL | 660 | NULL |
| 536 | }; | 661 | }; |
| 537 | 662 | ||
| @@ -553,7 +678,7 @@ static int gl520_attach_adapter(struct i2c_adapter *adapter) | |||
| 553 | 678 | ||
| 554 | static int gl520_detect(struct i2c_adapter *adapter, int address, int kind) | 679 | static int gl520_detect(struct i2c_adapter *adapter, int address, int kind) |
| 555 | { | 680 | { |
| 556 | struct i2c_client *new_client; | 681 | struct i2c_client *client; |
| 557 | struct gl520_data *data; | 682 | struct gl520_data *data; |
| 558 | int err = 0; | 683 | int err = 0; |
| 559 | 684 | ||
| @@ -570,59 +695,65 @@ static int gl520_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 570 | goto exit; | 695 | goto exit; |
| 571 | } | 696 | } |
| 572 | 697 | ||
| 573 | new_client = &data->client; | 698 | client = &data->client; |
| 574 | i2c_set_clientdata(new_client, data); | 699 | i2c_set_clientdata(client, data); |
| 575 | new_client->addr = address; | 700 | client->addr = address; |
| 576 | new_client->adapter = adapter; | 701 | client->adapter = adapter; |
| 577 | new_client->driver = &gl520_driver; | 702 | client->driver = &gl520_driver; |
| 578 | new_client->flags = 0; | ||
| 579 | 703 | ||
| 580 | /* Determine the chip type. */ | 704 | /* Determine the chip type. */ |
| 581 | if (kind < 0) { | 705 | if (kind < 0) { |
| 582 | if ((gl520_read_value(new_client, GL520_REG_CHIP_ID) != 0x20) || | 706 | if ((gl520_read_value(client, GL520_REG_CHIP_ID) != 0x20) || |
| 583 | ((gl520_read_value(new_client, GL520_REG_REVISION) & 0x7f) != 0x00) || | 707 | ((gl520_read_value(client, GL520_REG_REVISION) & 0x7f) != 0x00) || |
| 584 | ((gl520_read_value(new_client, GL520_REG_CONF) & 0x80) != 0x00)) { | 708 | ((gl520_read_value(client, GL520_REG_CONF) & 0x80) != 0x00)) { |
| 585 | dev_dbg(&new_client->dev, "Unknown chip type, skipping\n"); | 709 | dev_dbg(&client->dev, "Unknown chip type, skipping\n"); |
| 586 | goto exit_free; | 710 | goto exit_free; |
| 587 | } | 711 | } |
| 588 | } | 712 | } |
| 589 | 713 | ||
| 590 | /* Fill in the remaining client fields */ | 714 | /* Fill in the remaining client fields */ |
| 591 | strlcpy(new_client->name, "gl520sm", I2C_NAME_SIZE); | 715 | strlcpy(client->name, "gl520sm", I2C_NAME_SIZE); |
| 592 | data->valid = 0; | ||
| 593 | mutex_init(&data->update_lock); | 716 | mutex_init(&data->update_lock); |
| 594 | 717 | ||
| 595 | /* Tell the I2C layer a new client has arrived */ | 718 | /* Tell the I2C layer a new client has arrived */ |
| 596 | if ((err = i2c_attach_client(new_client))) | 719 | if ((err = i2c_attach_client(client))) |
| 597 | goto exit_free; | 720 | goto exit_free; |
| 598 | 721 | ||
| 599 | /* Initialize the GL520SM chip */ | 722 | /* Initialize the GL520SM chip */ |
| 600 | gl520_init_client(new_client); | 723 | gl520_init_client(client); |
| 601 | 724 | ||
| 602 | /* Register sysfs hooks */ | 725 | /* Register sysfs hooks */ |
| 603 | if ((err = sysfs_create_group(&new_client->dev.kobj, &gl520_group))) | 726 | if ((err = sysfs_create_group(&client->dev.kobj, &gl520_group))) |
| 604 | goto exit_detach; | 727 | goto exit_detach; |
| 605 | 728 | ||
| 606 | if (data->two_temps) { | 729 | if (data->two_temps) { |
| 607 | if ((err = device_create_file(&new_client->dev, | 730 | if ((err = device_create_file(&client->dev, |
| 608 | &dev_attr_temp2_input)) | 731 | &sensor_dev_attr_temp2_input.dev_attr)) |
| 609 | || (err = device_create_file(&new_client->dev, | 732 | || (err = device_create_file(&client->dev, |
| 610 | &dev_attr_temp2_max)) | 733 | &sensor_dev_attr_temp2_max.dev_attr)) |
| 611 | || (err = device_create_file(&new_client->dev, | 734 | || (err = device_create_file(&client->dev, |
| 612 | &dev_attr_temp2_max_hyst))) | 735 | &sensor_dev_attr_temp2_max_hyst.dev_attr)) |
| 736 | || (err = device_create_file(&client->dev, | ||
| 737 | &sensor_dev_attr_temp2_alarm.dev_attr)) | ||
| 738 | || (err = device_create_file(&client->dev, | ||
| 739 | &sensor_dev_attr_temp2_beep.dev_attr))) | ||
| 613 | goto exit_remove_files; | 740 | goto exit_remove_files; |
| 614 | } else { | 741 | } else { |
| 615 | if ((err = device_create_file(&new_client->dev, | 742 | if ((err = device_create_file(&client->dev, |
| 616 | &dev_attr_in4_input)) | 743 | &sensor_dev_attr_in4_input.dev_attr)) |
| 617 | || (err = device_create_file(&new_client->dev, | 744 | || (err = device_create_file(&client->dev, |
| 618 | &dev_attr_in4_min)) | 745 | &sensor_dev_attr_in4_min.dev_attr)) |
| 619 | || (err = device_create_file(&new_client->dev, | 746 | || (err = device_create_file(&client->dev, |
| 620 | &dev_attr_in4_max))) | 747 | &sensor_dev_attr_in4_max.dev_attr)) |
| 748 | || (err = device_create_file(&client->dev, | ||
| 749 | &sensor_dev_attr_in4_alarm.dev_attr)) | ||
| 750 | || (err = device_create_file(&client->dev, | ||
| 751 | &sensor_dev_attr_in4_beep.dev_attr))) | ||
| 621 | goto exit_remove_files; | 752 | goto exit_remove_files; |
| 622 | } | 753 | } |
| 623 | 754 | ||
| 624 | 755 | ||
| 625 | data->hwmon_dev = hwmon_device_register(&new_client->dev); | 756 | data->hwmon_dev = hwmon_device_register(&client->dev); |
| 626 | if (IS_ERR(data->hwmon_dev)) { | 757 | if (IS_ERR(data->hwmon_dev)) { |
| 627 | err = PTR_ERR(data->hwmon_dev); | 758 | err = PTR_ERR(data->hwmon_dev); |
| 628 | goto exit_remove_files; | 759 | goto exit_remove_files; |
| @@ -631,10 +762,10 @@ static int gl520_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 631 | return 0; | 762 | return 0; |
| 632 | 763 | ||
| 633 | exit_remove_files: | 764 | exit_remove_files: |
| 634 | sysfs_remove_group(&new_client->dev.kobj, &gl520_group); | 765 | sysfs_remove_group(&client->dev.kobj, &gl520_group); |
| 635 | sysfs_remove_group(&new_client->dev.kobj, &gl520_group_opt); | 766 | sysfs_remove_group(&client->dev.kobj, &gl520_group_opt); |
| 636 | exit_detach: | 767 | exit_detach: |
| 637 | i2c_detach_client(new_client); | 768 | i2c_detach_client(client); |
| 638 | exit_free: | 769 | exit_free: |
| 639 | kfree(data); | 770 | kfree(data); |
| 640 | exit: | 771 | exit: |
| @@ -697,7 +828,7 @@ static int gl520_detach_client(struct i2c_client *client) | |||
| 697 | } | 828 | } |
| 698 | 829 | ||
| 699 | 830 | ||
| 700 | /* Registers 0x07 to 0x0c are word-sized, others are byte-sized | 831 | /* Registers 0x07 to 0x0c are word-sized, others are byte-sized |
| 701 | GL520 uses a high-byte first convention */ | 832 | GL520 uses a high-byte first convention */ |
| 702 | static int gl520_read_value(struct i2c_client *client, u8 reg) | 833 | static int gl520_read_value(struct i2c_client *client, u8 reg) |
| 703 | { | 834 | { |
| @@ -720,7 +851,7 @@ static struct gl520_data *gl520_update_device(struct device *dev) | |||
| 720 | { | 851 | { |
| 721 | struct i2c_client *client = to_i2c_client(dev); | 852 | struct i2c_client *client = to_i2c_client(dev); |
| 722 | struct gl520_data *data = i2c_get_clientdata(client); | 853 | struct gl520_data *data = i2c_get_clientdata(client); |
| 723 | int val; | 854 | int val, i; |
| 724 | 855 | ||
| 725 | mutex_lock(&data->update_lock); | 856 | mutex_lock(&data->update_lock); |
| 726 | 857 | ||
| @@ -732,18 +863,13 @@ static struct gl520_data *gl520_update_device(struct device *dev) | |||
| 732 | data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK); | 863 | data->beep_mask = gl520_read_value(client, GL520_REG_BEEP_MASK); |
| 733 | data->vid = gl520_read_value(client, GL520_REG_VID_INPUT) & 0x1f; | 864 | data->vid = gl520_read_value(client, GL520_REG_VID_INPUT) & 0x1f; |
| 734 | 865 | ||
| 735 | val = gl520_read_value(client, GL520_REG_IN0_LIMIT); | 866 | for (i = 0; i < 4; i++) { |
| 736 | data->in_min[0] = val & 0xff; | 867 | data->in_input[i] = gl520_read_value(client, |
| 737 | data->in_max[0] = (val >> 8) & 0xff; | 868 | GL520_REG_IN_INPUT[i]); |
| 738 | val = gl520_read_value(client, GL520_REG_IN1_LIMIT); | 869 | val = gl520_read_value(client, GL520_REG_IN_LIMIT[i]); |
| 739 | data->in_min[1] = val & 0xff; | 870 | data->in_min[i] = val & 0xff; |
| 740 | data->in_max[1] = (val >> 8) & 0xff; | 871 | data->in_max[i] = (val >> 8) & 0xff; |
| 741 | val = gl520_read_value(client, GL520_REG_IN2_LIMIT); | 872 | } |
| 742 | data->in_min[2] = val & 0xff; | ||
| 743 | data->in_max[2] = (val >> 8) & 0xff; | ||
| 744 | val = gl520_read_value(client, GL520_REG_IN3_LIMIT); | ||
| 745 | data->in_min[3] = val & 0xff; | ||
| 746 | data->in_max[3] = (val >> 8) & 0xff; | ||
| 747 | 873 | ||
| 748 | val = gl520_read_value(client, GL520_REG_FAN_INPUT); | 874 | val = gl520_read_value(client, GL520_REG_FAN_INPUT); |
| 749 | data->fan_input[0] = (val >> 8) & 0xff; | 875 | data->fan_input[0] = (val >> 8) & 0xff; |
| @@ -753,9 +879,12 @@ static struct gl520_data *gl520_update_device(struct device *dev) | |||
| 753 | data->fan_min[0] = (val >> 8) & 0xff; | 879 | data->fan_min[0] = (val >> 8) & 0xff; |
| 754 | data->fan_min[1] = val & 0xff; | 880 | data->fan_min[1] = val & 0xff; |
| 755 | 881 | ||
| 756 | data->temp_input[0] = gl520_read_value(client, GL520_REG_TEMP1_INPUT); | 882 | data->temp_input[0] = gl520_read_value(client, |
| 757 | data->temp_max[0] = gl520_read_value(client, GL520_REG_TEMP1_MAX); | 883 | GL520_REG_TEMP_INPUT[0]); |
| 758 | data->temp_max_hyst[0] = gl520_read_value(client, GL520_REG_TEMP1_MAX_HYST); | 884 | data->temp_max[0] = gl520_read_value(client, |
| 885 | GL520_REG_TEMP_MAX[0]); | ||
| 886 | data->temp_max_hyst[0] = gl520_read_value(client, | ||
| 887 | GL520_REG_TEMP_MAX_HYST[0]); | ||
| 759 | 888 | ||
| 760 | val = gl520_read_value(client, GL520_REG_FAN_DIV); | 889 | val = gl520_read_value(client, GL520_REG_FAN_DIV); |
| 761 | data->fan_div[0] = (val >> 6) & 0x03; | 890 | data->fan_div[0] = (val >> 6) & 0x03; |
| @@ -767,20 +896,21 @@ static struct gl520_data *gl520_update_device(struct device *dev) | |||
| 767 | val = gl520_read_value(client, GL520_REG_CONF); | 896 | val = gl520_read_value(client, GL520_REG_CONF); |
| 768 | data->beep_enable = !((val >> 2) & 1); | 897 | data->beep_enable = !((val >> 2) & 1); |
| 769 | 898 | ||
| 770 | data->in_input[0] = gl520_read_value(client, GL520_REG_IN0_INPUT); | ||
| 771 | data->in_input[1] = gl520_read_value(client, GL520_REG_IN1_INPUT); | ||
| 772 | data->in_input[2] = gl520_read_value(client, GL520_REG_IN2_INPUT); | ||
| 773 | data->in_input[3] = gl520_read_value(client, GL520_REG_IN3_INPUT); | ||
| 774 | |||
| 775 | /* Temp1 and Vin4 are the same input */ | 899 | /* Temp1 and Vin4 are the same input */ |
| 776 | if (data->two_temps) { | 900 | if (data->two_temps) { |
| 777 | data->temp_input[1] = gl520_read_value(client, GL520_REG_TEMP2_INPUT); | 901 | data->temp_input[1] = gl520_read_value(client, |
| 778 | data->temp_max[1] = gl520_read_value(client, GL520_REG_TEMP2_MAX); | 902 | GL520_REG_TEMP_INPUT[1]); |
| 779 | data->temp_max_hyst[1] = gl520_read_value(client, GL520_REG_TEMP2_MAX_HYST); | 903 | data->temp_max[1] = gl520_read_value(client, |
| 904 | GL520_REG_TEMP_MAX[1]); | ||
| 905 | data->temp_max_hyst[1] = gl520_read_value(client, | ||
| 906 | GL520_REG_TEMP_MAX_HYST[1]); | ||
| 780 | } else { | 907 | } else { |
| 781 | data->in_input[4] = gl520_read_value(client, GL520_REG_IN4_INPUT); | 908 | data->in_input[4] = gl520_read_value(client, |
| 782 | data->in_min[4] = gl520_read_value(client, GL520_REG_IN4_MIN); | 909 | GL520_REG_IN_INPUT[4]); |
| 783 | data->in_max[4] = gl520_read_value(client, GL520_REG_IN4_MAX); | 910 | data->in_min[4] = gl520_read_value(client, |
| 911 | GL520_REG_IN_MIN[4]); | ||
| 912 | data->in_max[4] = gl520_read_value(client, | ||
| 913 | GL520_REG_IN_MAX[4]); | ||
| 784 | } | 914 | } |
| 785 | 915 | ||
| 786 | data->last_updated = jiffies; | 916 | data->last_updated = jiffies; |
diff --git a/drivers/hwmon/it87.c b/drivers/hwmon/it87.c index ad6c8a319903..e12c132ff83a 100644 --- a/drivers/hwmon/it87.c +++ b/drivers/hwmon/it87.c | |||
| @@ -17,8 +17,8 @@ | |||
| 17 | IT8726F Super I/O chip w/LPC interface | 17 | IT8726F Super I/O chip w/LPC interface |
| 18 | Sis950 A clone of the IT8705F | 18 | Sis950 A clone of the IT8705F |
| 19 | 19 | ||
| 20 | Copyright (C) 2001 Chris Gauthron <chrisg@0-in.com> | 20 | Copyright (C) 2001 Chris Gauthron |
| 21 | Copyright (C) 2005-2006 Jean Delvare <khali@linux-fr.org> | 21 | Copyright (C) 2005-2007 Jean Delvare <khali@linux-fr.org> |
| 22 | 22 | ||
| 23 | This program is free software; you can redistribute it and/or modify | 23 | This program is free software; you can redistribute it and/or modify |
| 24 | it under the terms of the GNU General Public License as published by | 24 | it under the terms of the GNU General Public License as published by |
| @@ -52,6 +52,10 @@ | |||
| 52 | 52 | ||
| 53 | enum chips { it87, it8712, it8716, it8718 }; | 53 | enum chips { it87, it8712, it8716, it8718 }; |
| 54 | 54 | ||
| 55 | static unsigned short force_id; | ||
| 56 | module_param(force_id, ushort, 0); | ||
| 57 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 58 | |||
| 55 | static struct platform_device *pdev; | 59 | static struct platform_device *pdev; |
| 56 | 60 | ||
| 57 | #define REG 0x2e /* The register to read/write */ | 61 | #define REG 0x2e /* The register to read/write */ |
| @@ -776,6 +780,30 @@ static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, ch | |||
| 776 | } | 780 | } |
| 777 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); | 781 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); |
| 778 | 782 | ||
| 783 | static ssize_t show_alarm(struct device *dev, struct device_attribute *attr, | ||
| 784 | char *buf) | ||
| 785 | { | ||
| 786 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 787 | struct it87_data *data = it87_update_device(dev); | ||
| 788 | return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); | ||
| 789 | } | ||
| 790 | static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 8); | ||
| 791 | static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 9); | ||
| 792 | static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 10); | ||
| 793 | static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 11); | ||
| 794 | static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 12); | ||
| 795 | static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 13); | ||
| 796 | static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 14); | ||
| 797 | static SENSOR_DEVICE_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 15); | ||
| 798 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 0); | ||
| 799 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 1); | ||
| 800 | static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 2); | ||
| 801 | static SENSOR_DEVICE_ATTR(fan4_alarm, S_IRUGO, show_alarm, NULL, 3); | ||
| 802 | static SENSOR_DEVICE_ATTR(fan5_alarm, S_IRUGO, show_alarm, NULL, 6); | ||
| 803 | static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 16); | ||
| 804 | static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 17); | ||
| 805 | static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 18); | ||
| 806 | |||
| 779 | static ssize_t | 807 | static ssize_t |
| 780 | show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf) | 808 | show_vrm_reg(struct device *dev, struct device_attribute *attr, char *buf) |
| 781 | { | 809 | { |
| @@ -837,6 +865,14 @@ static struct attribute *it87_attributes[] = { | |||
| 837 | &sensor_dev_attr_in5_max.dev_attr.attr, | 865 | &sensor_dev_attr_in5_max.dev_attr.attr, |
| 838 | &sensor_dev_attr_in6_max.dev_attr.attr, | 866 | &sensor_dev_attr_in6_max.dev_attr.attr, |
| 839 | &sensor_dev_attr_in7_max.dev_attr.attr, | 867 | &sensor_dev_attr_in7_max.dev_attr.attr, |
| 868 | &sensor_dev_attr_in0_alarm.dev_attr.attr, | ||
| 869 | &sensor_dev_attr_in1_alarm.dev_attr.attr, | ||
| 870 | &sensor_dev_attr_in2_alarm.dev_attr.attr, | ||
| 871 | &sensor_dev_attr_in3_alarm.dev_attr.attr, | ||
| 872 | &sensor_dev_attr_in4_alarm.dev_attr.attr, | ||
| 873 | &sensor_dev_attr_in5_alarm.dev_attr.attr, | ||
| 874 | &sensor_dev_attr_in6_alarm.dev_attr.attr, | ||
| 875 | &sensor_dev_attr_in7_alarm.dev_attr.attr, | ||
| 840 | 876 | ||
| 841 | &sensor_dev_attr_temp1_input.dev_attr.attr, | 877 | &sensor_dev_attr_temp1_input.dev_attr.attr, |
| 842 | &sensor_dev_attr_temp2_input.dev_attr.attr, | 878 | &sensor_dev_attr_temp2_input.dev_attr.attr, |
| @@ -850,6 +886,9 @@ static struct attribute *it87_attributes[] = { | |||
| 850 | &sensor_dev_attr_temp1_type.dev_attr.attr, | 886 | &sensor_dev_attr_temp1_type.dev_attr.attr, |
| 851 | &sensor_dev_attr_temp2_type.dev_attr.attr, | 887 | &sensor_dev_attr_temp2_type.dev_attr.attr, |
| 852 | &sensor_dev_attr_temp3_type.dev_attr.attr, | 888 | &sensor_dev_attr_temp3_type.dev_attr.attr, |
| 889 | &sensor_dev_attr_temp1_alarm.dev_attr.attr, | ||
| 890 | &sensor_dev_attr_temp2_alarm.dev_attr.attr, | ||
| 891 | &sensor_dev_attr_temp3_alarm.dev_attr.attr, | ||
| 853 | 892 | ||
| 854 | &dev_attr_alarms.attr, | 893 | &dev_attr_alarms.attr, |
| 855 | &dev_attr_name.attr, | 894 | &dev_attr_name.attr, |
| @@ -882,12 +921,21 @@ static struct attribute *it87_attributes_opt[] = { | |||
| 882 | &sensor_dev_attr_fan3_min.dev_attr.attr, | 921 | &sensor_dev_attr_fan3_min.dev_attr.attr, |
| 883 | &sensor_dev_attr_fan3_div.dev_attr.attr, | 922 | &sensor_dev_attr_fan3_div.dev_attr.attr, |
| 884 | 923 | ||
| 924 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, | ||
| 925 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, | ||
| 926 | &sensor_dev_attr_fan3_alarm.dev_attr.attr, | ||
| 927 | &sensor_dev_attr_fan4_alarm.dev_attr.attr, | ||
| 928 | &sensor_dev_attr_fan5_alarm.dev_attr.attr, | ||
| 929 | |||
| 885 | &sensor_dev_attr_pwm1_enable.dev_attr.attr, | 930 | &sensor_dev_attr_pwm1_enable.dev_attr.attr, |
| 886 | &sensor_dev_attr_pwm2_enable.dev_attr.attr, | 931 | &sensor_dev_attr_pwm2_enable.dev_attr.attr, |
| 887 | &sensor_dev_attr_pwm3_enable.dev_attr.attr, | 932 | &sensor_dev_attr_pwm3_enable.dev_attr.attr, |
| 888 | &sensor_dev_attr_pwm1.dev_attr.attr, | 933 | &sensor_dev_attr_pwm1.dev_attr.attr, |
| 889 | &sensor_dev_attr_pwm2.dev_attr.attr, | 934 | &sensor_dev_attr_pwm2.dev_attr.attr, |
| 890 | &sensor_dev_attr_pwm3.dev_attr.attr, | 935 | &sensor_dev_attr_pwm3.dev_attr.attr, |
| 936 | &dev_attr_pwm1_freq.attr, | ||
| 937 | &dev_attr_pwm2_freq.attr, | ||
| 938 | &dev_attr_pwm3_freq.attr, | ||
| 891 | 939 | ||
| 892 | &dev_attr_vrm.attr, | 940 | &dev_attr_vrm.attr, |
| 893 | &dev_attr_cpu0_vid.attr, | 941 | &dev_attr_cpu0_vid.attr, |
| @@ -906,7 +954,7 @@ static int __init it87_find(unsigned short *address, | |||
| 906 | u16 chip_type; | 954 | u16 chip_type; |
| 907 | 955 | ||
| 908 | superio_enter(); | 956 | superio_enter(); |
| 909 | chip_type = superio_inw(DEVID); | 957 | chip_type = force_id ? force_id : superio_inw(DEVID); |
| 910 | 958 | ||
| 911 | switch (chip_type) { | 959 | switch (chip_type) { |
| 912 | case IT8705F_DEVID: | 960 | case IT8705F_DEVID: |
| @@ -1027,35 +1075,45 @@ static int __devinit it87_probe(struct platform_device *pdev) | |||
| 1027 | if ((err = device_create_file(dev, | 1075 | if ((err = device_create_file(dev, |
| 1028 | &sensor_dev_attr_fan1_input16.dev_attr)) | 1076 | &sensor_dev_attr_fan1_input16.dev_attr)) |
| 1029 | || (err = device_create_file(dev, | 1077 | || (err = device_create_file(dev, |
| 1030 | &sensor_dev_attr_fan1_min16.dev_attr))) | 1078 | &sensor_dev_attr_fan1_min16.dev_attr)) |
| 1079 | || (err = device_create_file(dev, | ||
| 1080 | &sensor_dev_attr_fan1_alarm.dev_attr))) | ||
| 1031 | goto ERROR4; | 1081 | goto ERROR4; |
| 1032 | } | 1082 | } |
| 1033 | if (data->has_fan & (1 << 1)) { | 1083 | if (data->has_fan & (1 << 1)) { |
| 1034 | if ((err = device_create_file(dev, | 1084 | if ((err = device_create_file(dev, |
| 1035 | &sensor_dev_attr_fan2_input16.dev_attr)) | 1085 | &sensor_dev_attr_fan2_input16.dev_attr)) |
| 1036 | || (err = device_create_file(dev, | 1086 | || (err = device_create_file(dev, |
| 1037 | &sensor_dev_attr_fan2_min16.dev_attr))) | 1087 | &sensor_dev_attr_fan2_min16.dev_attr)) |
| 1088 | || (err = device_create_file(dev, | ||
| 1089 | &sensor_dev_attr_fan2_alarm.dev_attr))) | ||
| 1038 | goto ERROR4; | 1090 | goto ERROR4; |
| 1039 | } | 1091 | } |
| 1040 | if (data->has_fan & (1 << 2)) { | 1092 | if (data->has_fan & (1 << 2)) { |
| 1041 | if ((err = device_create_file(dev, | 1093 | if ((err = device_create_file(dev, |
| 1042 | &sensor_dev_attr_fan3_input16.dev_attr)) | 1094 | &sensor_dev_attr_fan3_input16.dev_attr)) |
| 1043 | || (err = device_create_file(dev, | 1095 | || (err = device_create_file(dev, |
| 1044 | &sensor_dev_attr_fan3_min16.dev_attr))) | 1096 | &sensor_dev_attr_fan3_min16.dev_attr)) |
| 1097 | || (err = device_create_file(dev, | ||
| 1098 | &sensor_dev_attr_fan3_alarm.dev_attr))) | ||
| 1045 | goto ERROR4; | 1099 | goto ERROR4; |
| 1046 | } | 1100 | } |
| 1047 | if (data->has_fan & (1 << 3)) { | 1101 | if (data->has_fan & (1 << 3)) { |
| 1048 | if ((err = device_create_file(dev, | 1102 | if ((err = device_create_file(dev, |
| 1049 | &sensor_dev_attr_fan4_input16.dev_attr)) | 1103 | &sensor_dev_attr_fan4_input16.dev_attr)) |
| 1050 | || (err = device_create_file(dev, | 1104 | || (err = device_create_file(dev, |
| 1051 | &sensor_dev_attr_fan4_min16.dev_attr))) | 1105 | &sensor_dev_attr_fan4_min16.dev_attr)) |
| 1106 | || (err = device_create_file(dev, | ||
| 1107 | &sensor_dev_attr_fan4_alarm.dev_attr))) | ||
| 1052 | goto ERROR4; | 1108 | goto ERROR4; |
| 1053 | } | 1109 | } |
| 1054 | if (data->has_fan & (1 << 4)) { | 1110 | if (data->has_fan & (1 << 4)) { |
| 1055 | if ((err = device_create_file(dev, | 1111 | if ((err = device_create_file(dev, |
| 1056 | &sensor_dev_attr_fan5_input16.dev_attr)) | 1112 | &sensor_dev_attr_fan5_input16.dev_attr)) |
| 1057 | || (err = device_create_file(dev, | 1113 | || (err = device_create_file(dev, |
| 1058 | &sensor_dev_attr_fan5_min16.dev_attr))) | 1114 | &sensor_dev_attr_fan5_min16.dev_attr)) |
| 1115 | || (err = device_create_file(dev, | ||
| 1116 | &sensor_dev_attr_fan5_alarm.dev_attr))) | ||
| 1059 | goto ERROR4; | 1117 | goto ERROR4; |
| 1060 | } | 1118 | } |
| 1061 | } else { | 1119 | } else { |
| @@ -1066,7 +1124,9 @@ static int __devinit it87_probe(struct platform_device *pdev) | |||
| 1066 | || (err = device_create_file(dev, | 1124 | || (err = device_create_file(dev, |
| 1067 | &sensor_dev_attr_fan1_min.dev_attr)) | 1125 | &sensor_dev_attr_fan1_min.dev_attr)) |
| 1068 | || (err = device_create_file(dev, | 1126 | || (err = device_create_file(dev, |
| 1069 | &sensor_dev_attr_fan1_div.dev_attr))) | 1127 | &sensor_dev_attr_fan1_div.dev_attr)) |
| 1128 | || (err = device_create_file(dev, | ||
| 1129 | &sensor_dev_attr_fan1_alarm.dev_attr))) | ||
| 1070 | goto ERROR4; | 1130 | goto ERROR4; |
| 1071 | } | 1131 | } |
| 1072 | if (data->has_fan & (1 << 1)) { | 1132 | if (data->has_fan & (1 << 1)) { |
| @@ -1075,7 +1135,9 @@ static int __devinit it87_probe(struct platform_device *pdev) | |||
| 1075 | || (err = device_create_file(dev, | 1135 | || (err = device_create_file(dev, |
| 1076 | &sensor_dev_attr_fan2_min.dev_attr)) | 1136 | &sensor_dev_attr_fan2_min.dev_attr)) |
| 1077 | || (err = device_create_file(dev, | 1137 | || (err = device_create_file(dev, |
| 1078 | &sensor_dev_attr_fan2_div.dev_attr))) | 1138 | &sensor_dev_attr_fan2_div.dev_attr)) |
| 1139 | || (err = device_create_file(dev, | ||
| 1140 | &sensor_dev_attr_fan2_alarm.dev_attr))) | ||
| 1079 | goto ERROR4; | 1141 | goto ERROR4; |
| 1080 | } | 1142 | } |
| 1081 | if (data->has_fan & (1 << 2)) { | 1143 | if (data->has_fan & (1 << 2)) { |
| @@ -1084,7 +1146,9 @@ static int __devinit it87_probe(struct platform_device *pdev) | |||
| 1084 | || (err = device_create_file(dev, | 1146 | || (err = device_create_file(dev, |
| 1085 | &sensor_dev_attr_fan3_min.dev_attr)) | 1147 | &sensor_dev_attr_fan3_min.dev_attr)) |
| 1086 | || (err = device_create_file(dev, | 1148 | || (err = device_create_file(dev, |
| 1087 | &sensor_dev_attr_fan3_div.dev_attr))) | 1149 | &sensor_dev_attr_fan3_div.dev_attr)) |
| 1150 | || (err = device_create_file(dev, | ||
| 1151 | &sensor_dev_attr_fan3_alarm.dev_attr))) | ||
| 1088 | goto ERROR4; | 1152 | goto ERROR4; |
| 1089 | } | 1153 | } |
| 1090 | } | 1154 | } |
| @@ -1488,7 +1552,7 @@ static void __exit sm_it87_exit(void) | |||
| 1488 | } | 1552 | } |
| 1489 | 1553 | ||
| 1490 | 1554 | ||
| 1491 | MODULE_AUTHOR("Chris Gauthron <chrisg@0-in.com>, " | 1555 | MODULE_AUTHOR("Chris Gauthron, " |
| 1492 | "Jean Delvare <khali@linux-fr.org>"); | 1556 | "Jean Delvare <khali@linux-fr.org>"); |
| 1493 | MODULE_DESCRIPTION("IT8705F/8712F/8716F/8718F/8726F, SiS950 driver"); | 1557 | MODULE_DESCRIPTION("IT8705F/8712F/8716F/8718F/8726F, SiS950 driver"); |
| 1494 | module_param(update_vbat, bool, 0); | 1558 | module_param(update_vbat, bool, 0); |
diff --git a/drivers/hwmon/lm75.c b/drivers/hwmon/lm75.c index 37a8cc032ffa..e5c35a355a57 100644 --- a/drivers/hwmon/lm75.c +++ b/drivers/hwmon/lm75.c | |||
| @@ -74,7 +74,6 @@ static struct i2c_driver lm75_driver = { | |||
| 74 | .driver = { | 74 | .driver = { |
| 75 | .name = "lm75", | 75 | .name = "lm75", |
| 76 | }, | 76 | }, |
| 77 | .id = I2C_DRIVERID_LM75, | ||
| 78 | .attach_adapter = lm75_attach_adapter, | 77 | .attach_adapter = lm75_attach_adapter, |
| 79 | .detach_client = lm75_detach_client, | 78 | .detach_client = lm75_detach_client, |
| 80 | }; | 79 | }; |
diff --git a/drivers/hwmon/lm77.c b/drivers/hwmon/lm77.c index cee5c2e8cfad..459b70ad6bee 100644 --- a/drivers/hwmon/lm77.c +++ b/drivers/hwmon/lm77.c | |||
| @@ -31,6 +31,7 @@ | |||
| 31 | #include <linux/jiffies.h> | 31 | #include <linux/jiffies.h> |
| 32 | #include <linux/i2c.h> | 32 | #include <linux/i2c.h> |
| 33 | #include <linux/hwmon.h> | 33 | #include <linux/hwmon.h> |
| 34 | #include <linux/hwmon-sysfs.h> | ||
| 34 | #include <linux/err.h> | 35 | #include <linux/err.h> |
| 35 | #include <linux/mutex.h> | 36 | #include <linux/mutex.h> |
| 36 | 37 | ||
| @@ -113,7 +114,6 @@ show(temp_input); | |||
| 113 | show(temp_crit); | 114 | show(temp_crit); |
| 114 | show(temp_min); | 115 | show(temp_min); |
| 115 | show(temp_max); | 116 | show(temp_max); |
| 116 | show(alarms); | ||
| 117 | 117 | ||
| 118 | /* read routines for hysteresis values */ | 118 | /* read routines for hysteresis values */ |
| 119 | static ssize_t show_temp_crit_hyst(struct device *dev, struct device_attribute *attr, char *buf) | 119 | static ssize_t show_temp_crit_hyst(struct device *dev, struct device_attribute *attr, char *buf) |
| @@ -186,6 +186,14 @@ static ssize_t set_temp_crit(struct device *dev, struct device_attribute *attr, | |||
| 186 | return count; | 186 | return count; |
| 187 | } | 187 | } |
| 188 | 188 | ||
| 189 | static ssize_t show_alarm(struct device *dev, struct device_attribute *attr, | ||
| 190 | char *buf) | ||
| 191 | { | ||
| 192 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 193 | struct lm77_data *data = lm77_update_device(dev); | ||
| 194 | return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); | ||
| 195 | } | ||
| 196 | |||
| 189 | static DEVICE_ATTR(temp1_input, S_IRUGO, | 197 | static DEVICE_ATTR(temp1_input, S_IRUGO, |
| 190 | show_temp_input, NULL); | 198 | show_temp_input, NULL); |
| 191 | static DEVICE_ATTR(temp1_crit, S_IWUSR | S_IRUGO, | 199 | static DEVICE_ATTR(temp1_crit, S_IWUSR | S_IRUGO, |
| @@ -202,8 +210,9 @@ static DEVICE_ATTR(temp1_min_hyst, S_IRUGO, | |||
| 202 | static DEVICE_ATTR(temp1_max_hyst, S_IRUGO, | 210 | static DEVICE_ATTR(temp1_max_hyst, S_IRUGO, |
| 203 | show_temp_max_hyst, NULL); | 211 | show_temp_max_hyst, NULL); |
| 204 | 212 | ||
| 205 | static DEVICE_ATTR(alarms, S_IRUGO, | 213 | static SENSOR_DEVICE_ATTR(temp1_crit_alarm, S_IRUGO, show_alarm, NULL, 2); |
| 206 | show_alarms, NULL); | 214 | static SENSOR_DEVICE_ATTR(temp1_min_alarm, S_IRUGO, show_alarm, NULL, 0); |
| 215 | static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL, 1); | ||
| 207 | 216 | ||
| 208 | static int lm77_attach_adapter(struct i2c_adapter *adapter) | 217 | static int lm77_attach_adapter(struct i2c_adapter *adapter) |
| 209 | { | 218 | { |
| @@ -220,8 +229,9 @@ static struct attribute *lm77_attributes[] = { | |||
| 220 | &dev_attr_temp1_crit_hyst.attr, | 229 | &dev_attr_temp1_crit_hyst.attr, |
| 221 | &dev_attr_temp1_min_hyst.attr, | 230 | &dev_attr_temp1_min_hyst.attr, |
| 222 | &dev_attr_temp1_max_hyst.attr, | 231 | &dev_attr_temp1_max_hyst.attr, |
| 223 | &dev_attr_alarms.attr, | 232 | &sensor_dev_attr_temp1_crit_alarm.dev_attr.attr, |
| 224 | 233 | &sensor_dev_attr_temp1_min_alarm.dev_attr.attr, | |
| 234 | &sensor_dev_attr_temp1_max_alarm.dev_attr.attr, | ||
| 225 | NULL | 235 | NULL |
| 226 | }; | 236 | }; |
| 227 | 237 | ||
diff --git a/drivers/hwmon/lm78.c b/drivers/hwmon/lm78.c index 3f7055ee679f..0a9eb1f6f4e4 100644 --- a/drivers/hwmon/lm78.c +++ b/drivers/hwmon/lm78.c | |||
| @@ -37,10 +37,8 @@ | |||
| 37 | static struct platform_device *pdev; | 37 | static struct platform_device *pdev; |
| 38 | 38 | ||
| 39 | /* Addresses to scan */ | 39 | /* Addresses to scan */ |
| 40 | static unsigned short normal_i2c[] = { 0x20, 0x21, 0x22, 0x23, 0x24, | 40 | static unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, |
| 41 | 0x25, 0x26, 0x27, 0x28, 0x29, | 41 | 0x2e, 0x2f, I2C_CLIENT_END }; |
| 42 | 0x2a, 0x2b, 0x2c, 0x2d, 0x2e, | ||
| 43 | 0x2f, I2C_CLIENT_END }; | ||
| 44 | static unsigned short isa_address = 0x290; | 42 | static unsigned short isa_address = 0x290; |
| 45 | 43 | ||
| 46 | /* Insmod parameters */ | 44 | /* Insmod parameters */ |
| @@ -170,7 +168,6 @@ static struct i2c_driver lm78_driver = { | |||
| 170 | .driver = { | 168 | .driver = { |
| 171 | .name = "lm78", | 169 | .name = "lm78", |
| 172 | }, | 170 | }, |
| 173 | .id = I2C_DRIVERID_LM78, | ||
| 174 | .attach_adapter = lm78_attach_adapter, | 171 | .attach_adapter = lm78_attach_adapter, |
| 175 | .detach_client = lm78_detach_client, | 172 | .detach_client = lm78_detach_client, |
| 176 | }; | 173 | }; |
diff --git a/drivers/hwmon/lm80.c b/drivers/hwmon/lm80.c index 063cdba00a88..a2ca055f3922 100644 --- a/drivers/hwmon/lm80.c +++ b/drivers/hwmon/lm80.c | |||
| @@ -27,6 +27,7 @@ | |||
| 27 | #include <linux/jiffies.h> | 27 | #include <linux/jiffies.h> |
| 28 | #include <linux/i2c.h> | 28 | #include <linux/i2c.h> |
| 29 | #include <linux/hwmon.h> | 29 | #include <linux/hwmon.h> |
| 30 | #include <linux/hwmon-sysfs.h> | ||
| 30 | #include <linux/err.h> | 31 | #include <linux/err.h> |
| 31 | #include <linux/mutex.h> | 32 | #include <linux/mutex.h> |
| 32 | 33 | ||
| @@ -127,7 +128,7 @@ struct lm80_data { | |||
| 127 | u16 alarms; /* Register encoding, combined */ | 128 | u16 alarms; /* Register encoding, combined */ |
| 128 | }; | 129 | }; |
| 129 | 130 | ||
| 130 | /* | 131 | /* |
| 131 | * Functions declaration | 132 | * Functions declaration |
| 132 | */ | 133 | */ |
| 133 | 134 | ||
| @@ -147,7 +148,6 @@ static struct i2c_driver lm80_driver = { | |||
| 147 | .driver = { | 148 | .driver = { |
| 148 | .name = "lm80", | 149 | .name = "lm80", |
| 149 | }, | 150 | }, |
| 150 | .id = I2C_DRIVERID_LM80, | ||
| 151 | .attach_adapter = lm80_attach_adapter, | 151 | .attach_adapter = lm80_attach_adapter, |
| 152 | .detach_client = lm80_detach_client, | 152 | .detach_client = lm80_detach_client, |
| 153 | }; | 153 | }; |
| @@ -159,105 +159,74 @@ static struct i2c_driver lm80_driver = { | |||
| 159 | #define show_in(suffix, value) \ | 159 | #define show_in(suffix, value) \ |
| 160 | static ssize_t show_in_##suffix(struct device *dev, struct device_attribute *attr, char *buf) \ | 160 | static ssize_t show_in_##suffix(struct device *dev, struct device_attribute *attr, char *buf) \ |
| 161 | { \ | 161 | { \ |
| 162 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 162 | struct lm80_data *data = lm80_update_device(dev); \ | 163 | struct lm80_data *data = lm80_update_device(dev); \ |
| 163 | return sprintf(buf, "%d\n", IN_FROM_REG(data->value)); \ | 164 | return sprintf(buf, "%d\n", IN_FROM_REG(data->value[nr])); \ |
| 164 | } | 165 | } |
| 165 | show_in(min0, in_min[0]); | 166 | show_in(min, in_min) |
| 166 | show_in(min1, in_min[1]); | 167 | show_in(max, in_max) |
| 167 | show_in(min2, in_min[2]); | 168 | show_in(input, in) |
| 168 | show_in(min3, in_min[3]); | ||
| 169 | show_in(min4, in_min[4]); | ||
| 170 | show_in(min5, in_min[5]); | ||
| 171 | show_in(min6, in_min[6]); | ||
| 172 | show_in(max0, in_max[0]); | ||
| 173 | show_in(max1, in_max[1]); | ||
| 174 | show_in(max2, in_max[2]); | ||
| 175 | show_in(max3, in_max[3]); | ||
| 176 | show_in(max4, in_max[4]); | ||
| 177 | show_in(max5, in_max[5]); | ||
| 178 | show_in(max6, in_max[6]); | ||
| 179 | show_in(input0, in[0]); | ||
| 180 | show_in(input1, in[1]); | ||
| 181 | show_in(input2, in[2]); | ||
| 182 | show_in(input3, in[3]); | ||
| 183 | show_in(input4, in[4]); | ||
| 184 | show_in(input5, in[5]); | ||
| 185 | show_in(input6, in[6]); | ||
| 186 | 169 | ||
| 187 | #define set_in(suffix, value, reg) \ | 170 | #define set_in(suffix, value, reg) \ |
| 188 | static ssize_t set_in_##suffix(struct device *dev, struct device_attribute *attr, const char *buf, \ | 171 | static ssize_t set_in_##suffix(struct device *dev, struct device_attribute *attr, const char *buf, \ |
| 189 | size_t count) \ | 172 | size_t count) \ |
| 190 | { \ | 173 | { \ |
| 174 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 191 | struct i2c_client *client = to_i2c_client(dev); \ | 175 | struct i2c_client *client = to_i2c_client(dev); \ |
| 192 | struct lm80_data *data = i2c_get_clientdata(client); \ | 176 | struct lm80_data *data = i2c_get_clientdata(client); \ |
| 193 | long val = simple_strtol(buf, NULL, 10); \ | 177 | long val = simple_strtol(buf, NULL, 10); \ |
| 194 | \ | 178 | \ |
| 195 | mutex_lock(&data->update_lock);\ | 179 | mutex_lock(&data->update_lock);\ |
| 196 | data->value = IN_TO_REG(val); \ | 180 | data->value[nr] = IN_TO_REG(val); \ |
| 197 | lm80_write_value(client, reg, data->value); \ | 181 | lm80_write_value(client, reg(nr), data->value[nr]); \ |
| 198 | mutex_unlock(&data->update_lock);\ | 182 | mutex_unlock(&data->update_lock);\ |
| 199 | return count; \ | 183 | return count; \ |
| 200 | } | 184 | } |
| 201 | set_in(min0, in_min[0], LM80_REG_IN_MIN(0)); | 185 | set_in(min, in_min, LM80_REG_IN_MIN) |
| 202 | set_in(min1, in_min[1], LM80_REG_IN_MIN(1)); | 186 | set_in(max, in_max, LM80_REG_IN_MAX) |
| 203 | set_in(min2, in_min[2], LM80_REG_IN_MIN(2)); | 187 | |
| 204 | set_in(min3, in_min[3], LM80_REG_IN_MIN(3)); | 188 | #define show_fan(suffix, value) \ |
| 205 | set_in(min4, in_min[4], LM80_REG_IN_MIN(4)); | ||
| 206 | set_in(min5, in_min[5], LM80_REG_IN_MIN(5)); | ||
| 207 | set_in(min6, in_min[6], LM80_REG_IN_MIN(6)); | ||
| 208 | set_in(max0, in_max[0], LM80_REG_IN_MAX(0)); | ||
| 209 | set_in(max1, in_max[1], LM80_REG_IN_MAX(1)); | ||
| 210 | set_in(max2, in_max[2], LM80_REG_IN_MAX(2)); | ||
| 211 | set_in(max3, in_max[3], LM80_REG_IN_MAX(3)); | ||
| 212 | set_in(max4, in_max[4], LM80_REG_IN_MAX(4)); | ||
| 213 | set_in(max5, in_max[5], LM80_REG_IN_MAX(5)); | ||
| 214 | set_in(max6, in_max[6], LM80_REG_IN_MAX(6)); | ||
| 215 | |||
| 216 | #define show_fan(suffix, value, div) \ | ||
| 217 | static ssize_t show_fan_##suffix(struct device *dev, struct device_attribute *attr, char *buf) \ | 189 | static ssize_t show_fan_##suffix(struct device *dev, struct device_attribute *attr, char *buf) \ |
| 218 | { \ | 190 | { \ |
| 191 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 219 | struct lm80_data *data = lm80_update_device(dev); \ | 192 | struct lm80_data *data = lm80_update_device(dev); \ |
| 220 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->value, \ | 193 | return sprintf(buf, "%d\n", FAN_FROM_REG(data->value[nr], \ |
| 221 | DIV_FROM_REG(data->div))); \ | 194 | DIV_FROM_REG(data->fan_div[nr]))); \ |
| 222 | } | 195 | } |
| 223 | show_fan(min1, fan_min[0], fan_div[0]); | 196 | show_fan(min, fan_min) |
| 224 | show_fan(min2, fan_min[1], fan_div[1]); | 197 | show_fan(input, fan) |
| 225 | show_fan(input1, fan[0], fan_div[0]); | ||
| 226 | show_fan(input2, fan[1], fan_div[1]); | ||
| 227 | 198 | ||
| 228 | #define show_fan_div(suffix, value) \ | 199 | static ssize_t show_fan_div(struct device *dev, struct device_attribute *attr, |
| 229 | static ssize_t show_fan_div##suffix(struct device *dev, struct device_attribute *attr, char *buf) \ | 200 | char *buf) |
| 230 | { \ | 201 | { |
| 231 | struct lm80_data *data = lm80_update_device(dev); \ | 202 | int nr = to_sensor_dev_attr(attr)->index; |
| 232 | return sprintf(buf, "%d\n", DIV_FROM_REG(data->value)); \ | 203 | struct lm80_data *data = lm80_update_device(dev); |
| 204 | return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr])); | ||
| 233 | } | 205 | } |
| 234 | show_fan_div(1, fan_div[0]); | ||
| 235 | show_fan_div(2, fan_div[1]); | ||
| 236 | 206 | ||
| 237 | #define set_fan(suffix, value, reg, div) \ | 207 | static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr, |
| 238 | static ssize_t set_fan_##suffix(struct device *dev, struct device_attribute *attr, const char *buf, \ | 208 | const char *buf, size_t count) |
| 239 | size_t count) \ | 209 | { |
| 240 | { \ | 210 | int nr = to_sensor_dev_attr(attr)->index; |
| 241 | struct i2c_client *client = to_i2c_client(dev); \ | 211 | struct i2c_client *client = to_i2c_client(dev); |
| 242 | struct lm80_data *data = i2c_get_clientdata(client); \ | 212 | struct lm80_data *data = i2c_get_clientdata(client); |
| 243 | long val = simple_strtoul(buf, NULL, 10); \ | 213 | long val = simple_strtoul(buf, NULL, 10); |
| 244 | \ | 214 | |
| 245 | mutex_lock(&data->update_lock);\ | 215 | mutex_lock(&data->update_lock); |
| 246 | data->value = FAN_TO_REG(val, DIV_FROM_REG(data->div)); \ | 216 | data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr])); |
| 247 | lm80_write_value(client, reg, data->value); \ | 217 | lm80_write_value(client, LM80_REG_FAN_MIN(nr + 1), data->fan_min[nr]); |
| 248 | mutex_unlock(&data->update_lock);\ | 218 | mutex_unlock(&data->update_lock); |
| 249 | return count; \ | 219 | return count; |
| 250 | } | 220 | } |
| 251 | set_fan(min1, fan_min[0], LM80_REG_FAN_MIN(1), fan_div[0]); | ||
| 252 | set_fan(min2, fan_min[1], LM80_REG_FAN_MIN(2), fan_div[1]); | ||
| 253 | 221 | ||
| 254 | /* Note: we save and restore the fan minimum here, because its value is | 222 | /* Note: we save and restore the fan minimum here, because its value is |
| 255 | determined in part by the fan divisor. This follows the principle of | 223 | determined in part by the fan divisor. This follows the principle of |
| 256 | least surprise; the user doesn't expect the fan minimum to change just | 224 | least surprise; the user doesn't expect the fan minimum to change just |
| 257 | because the divisor changed. */ | 225 | because the divisor changed. */ |
| 258 | static ssize_t set_fan_div(struct device *dev, const char *buf, | 226 | static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, |
| 259 | size_t count, int nr) | 227 | const char *buf, size_t count) |
| 260 | { | 228 | { |
| 229 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 261 | struct i2c_client *client = to_i2c_client(dev); | 230 | struct i2c_client *client = to_i2c_client(dev); |
| 262 | struct lm80_data *data = i2c_get_clientdata(client); | 231 | struct lm80_data *data = i2c_get_clientdata(client); |
| 263 | unsigned long min, val = simple_strtoul(buf, NULL, 10); | 232 | unsigned long min, val = simple_strtoul(buf, NULL, 10); |
| @@ -292,15 +261,6 @@ static ssize_t set_fan_div(struct device *dev, const char *buf, | |||
| 292 | return count; | 261 | return count; |
| 293 | } | 262 | } |
| 294 | 263 | ||
| 295 | #define set_fan_div(number) \ | ||
| 296 | static ssize_t set_fan_div##number(struct device *dev, struct device_attribute *attr, const char *buf, \ | ||
| 297 | size_t count) \ | ||
| 298 | { \ | ||
| 299 | return set_fan_div(dev, buf, count, number - 1); \ | ||
| 300 | } | ||
| 301 | set_fan_div(1); | ||
| 302 | set_fan_div(2); | ||
| 303 | |||
| 304 | static ssize_t show_temp_input1(struct device *dev, struct device_attribute *attr, char *buf) | 264 | static ssize_t show_temp_input1(struct device *dev, struct device_attribute *attr, char *buf) |
| 305 | { | 265 | { |
| 306 | struct lm80_data *data = lm80_update_device(dev); | 266 | struct lm80_data *data = lm80_update_device(dev); |
| @@ -337,41 +297,66 @@ set_temp(hot_hyst, temp_hot_hyst, LM80_REG_TEMP_HOT_HYST); | |||
| 337 | set_temp(os_max, temp_os_max, LM80_REG_TEMP_OS_MAX); | 297 | set_temp(os_max, temp_os_max, LM80_REG_TEMP_OS_MAX); |
| 338 | set_temp(os_hyst, temp_os_hyst, LM80_REG_TEMP_OS_HYST); | 298 | set_temp(os_hyst, temp_os_hyst, LM80_REG_TEMP_OS_HYST); |
| 339 | 299 | ||
| 340 | static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf) | 300 | static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, |
| 301 | char *buf) | ||
| 341 | { | 302 | { |
| 342 | struct lm80_data *data = lm80_update_device(dev); | 303 | struct lm80_data *data = lm80_update_device(dev); |
| 343 | return sprintf(buf, "%u\n", data->alarms); | 304 | return sprintf(buf, "%u\n", data->alarms); |
| 344 | } | 305 | } |
| 345 | 306 | ||
| 346 | static DEVICE_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min0, set_in_min0); | 307 | static ssize_t show_alarm(struct device *dev, struct device_attribute *attr, |
| 347 | static DEVICE_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min1, set_in_min1); | 308 | char *buf) |
| 348 | static DEVICE_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min2, set_in_min2); | 309 | { |
| 349 | static DEVICE_ATTR(in3_min, S_IWUSR | S_IRUGO, show_in_min3, set_in_min3); | 310 | int bitnr = to_sensor_dev_attr(attr)->index; |
| 350 | static DEVICE_ATTR(in4_min, S_IWUSR | S_IRUGO, show_in_min4, set_in_min4); | 311 | struct lm80_data *data = lm80_update_device(dev); |
| 351 | static DEVICE_ATTR(in5_min, S_IWUSR | S_IRUGO, show_in_min5, set_in_min5); | 312 | return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); |
| 352 | static DEVICE_ATTR(in6_min, S_IWUSR | S_IRUGO, show_in_min6, set_in_min6); | 313 | } |
| 353 | static DEVICE_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max0, set_in_max0); | 314 | |
| 354 | static DEVICE_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max1, set_in_max1); | 315 | static SENSOR_DEVICE_ATTR(in0_min, S_IWUSR | S_IRUGO, |
| 355 | static DEVICE_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max2, set_in_max2); | 316 | show_in_min, set_in_min, 0); |
| 356 | static DEVICE_ATTR(in3_max, S_IWUSR | S_IRUGO, show_in_max3, set_in_max3); | 317 | static SENSOR_DEVICE_ATTR(in1_min, S_IWUSR | S_IRUGO, |
| 357 | static DEVICE_ATTR(in4_max, S_IWUSR | S_IRUGO, show_in_max4, set_in_max4); | 318 | show_in_min, set_in_min, 1); |
| 358 | static DEVICE_ATTR(in5_max, S_IWUSR | S_IRUGO, show_in_max5, set_in_max5); | 319 | static SENSOR_DEVICE_ATTR(in2_min, S_IWUSR | S_IRUGO, |
| 359 | static DEVICE_ATTR(in6_max, S_IWUSR | S_IRUGO, show_in_max6, set_in_max6); | 320 | show_in_min, set_in_min, 2); |
| 360 | static DEVICE_ATTR(in0_input, S_IRUGO, show_in_input0, NULL); | 321 | static SENSOR_DEVICE_ATTR(in3_min, S_IWUSR | S_IRUGO, |
| 361 | static DEVICE_ATTR(in1_input, S_IRUGO, show_in_input1, NULL); | 322 | show_in_min, set_in_min, 3); |
| 362 | static DEVICE_ATTR(in2_input, S_IRUGO, show_in_input2, NULL); | 323 | static SENSOR_DEVICE_ATTR(in4_min, S_IWUSR | S_IRUGO, |
| 363 | static DEVICE_ATTR(in3_input, S_IRUGO, show_in_input3, NULL); | 324 | show_in_min, set_in_min, 4); |
| 364 | static DEVICE_ATTR(in4_input, S_IRUGO, show_in_input4, NULL); | 325 | static SENSOR_DEVICE_ATTR(in5_min, S_IWUSR | S_IRUGO, |
| 365 | static DEVICE_ATTR(in5_input, S_IRUGO, show_in_input5, NULL); | 326 | show_in_min, set_in_min, 5); |
| 366 | static DEVICE_ATTR(in6_input, S_IRUGO, show_in_input6, NULL); | 327 | static SENSOR_DEVICE_ATTR(in6_min, S_IWUSR | S_IRUGO, |
| 367 | static DEVICE_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min1, | 328 | show_in_min, set_in_min, 6); |
| 368 | set_fan_min1); | 329 | static SENSOR_DEVICE_ATTR(in0_max, S_IWUSR | S_IRUGO, |
| 369 | static DEVICE_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min2, | 330 | show_in_max, set_in_max, 0); |
| 370 | set_fan_min2); | 331 | static SENSOR_DEVICE_ATTR(in1_max, S_IWUSR | S_IRUGO, |
| 371 | static DEVICE_ATTR(fan1_input, S_IRUGO, show_fan_input1, NULL); | 332 | show_in_max, set_in_max, 1); |
| 372 | static DEVICE_ATTR(fan2_input, S_IRUGO, show_fan_input2, NULL); | 333 | static SENSOR_DEVICE_ATTR(in2_max, S_IWUSR | S_IRUGO, |
| 373 | static DEVICE_ATTR(fan1_div, S_IWUSR | S_IRUGO, show_fan_div1, set_fan_div1); | 334 | show_in_max, set_in_max, 2); |
| 374 | static DEVICE_ATTR(fan2_div, S_IWUSR | S_IRUGO, show_fan_div2, set_fan_div2); | 335 | static SENSOR_DEVICE_ATTR(in3_max, S_IWUSR | S_IRUGO, |
| 336 | show_in_max, set_in_max, 3); | ||
| 337 | static SENSOR_DEVICE_ATTR(in4_max, S_IWUSR | S_IRUGO, | ||
| 338 | show_in_max, set_in_max, 4); | ||
| 339 | static SENSOR_DEVICE_ATTR(in5_max, S_IWUSR | S_IRUGO, | ||
| 340 | show_in_max, set_in_max, 5); | ||
| 341 | static SENSOR_DEVICE_ATTR(in6_max, S_IWUSR | S_IRUGO, | ||
| 342 | show_in_max, set_in_max, 6); | ||
| 343 | static SENSOR_DEVICE_ATTR(in0_input, S_IRUGO, show_in_input, NULL, 0); | ||
| 344 | static SENSOR_DEVICE_ATTR(in1_input, S_IRUGO, show_in_input, NULL, 1); | ||
| 345 | static SENSOR_DEVICE_ATTR(in2_input, S_IRUGO, show_in_input, NULL, 2); | ||
| 346 | static SENSOR_DEVICE_ATTR(in3_input, S_IRUGO, show_in_input, NULL, 3); | ||
| 347 | static SENSOR_DEVICE_ATTR(in4_input, S_IRUGO, show_in_input, NULL, 4); | ||
| 348 | static SENSOR_DEVICE_ATTR(in5_input, S_IRUGO, show_in_input, NULL, 5); | ||
| 349 | static SENSOR_DEVICE_ATTR(in6_input, S_IRUGO, show_in_input, NULL, 6); | ||
| 350 | static SENSOR_DEVICE_ATTR(fan1_min, S_IWUSR | S_IRUGO, | ||
| 351 | show_fan_min, set_fan_min, 0); | ||
| 352 | static SENSOR_DEVICE_ATTR(fan2_min, S_IWUSR | S_IRUGO, | ||
| 353 | show_fan_min, set_fan_min, 1); | ||
| 354 | static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan_input, NULL, 0); | ||
| 355 | static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan_input, NULL, 1); | ||
| 356 | static SENSOR_DEVICE_ATTR(fan1_div, S_IWUSR | S_IRUGO, | ||
| 357 | show_fan_div, set_fan_div, 0); | ||
| 358 | static SENSOR_DEVICE_ATTR(fan2_div, S_IWUSR | S_IRUGO, | ||
| 359 | show_fan_div, set_fan_div, 1); | ||
| 375 | static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp_input1, NULL); | 360 | static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp_input1, NULL); |
| 376 | static DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp_hot_max, | 361 | static DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp_hot_max, |
| 377 | set_temp_hot_max); | 362 | set_temp_hot_max); |
| @@ -382,6 +367,17 @@ static DEVICE_ATTR(temp1_crit, S_IWUSR | S_IRUGO, show_temp_os_max, | |||
| 382 | static DEVICE_ATTR(temp1_crit_hyst, S_IWUSR | S_IRUGO, show_temp_os_hyst, | 367 | static DEVICE_ATTR(temp1_crit_hyst, S_IWUSR | S_IRUGO, show_temp_os_hyst, |
| 383 | set_temp_os_hyst); | 368 | set_temp_os_hyst); |
| 384 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); | 369 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); |
| 370 | static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0); | ||
| 371 | static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1); | ||
| 372 | static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2); | ||
| 373 | static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3); | ||
| 374 | static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 4); | ||
| 375 | static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 5); | ||
| 376 | static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 6); | ||
| 377 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 10); | ||
| 378 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 11); | ||
| 379 | static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL, 8); | ||
| 380 | static SENSOR_DEVICE_ATTR(temp1_crit_alarm, S_IRUGO, show_alarm, NULL, 13); | ||
| 385 | 381 | ||
| 386 | /* | 382 | /* |
| 387 | * Real code | 383 | * Real code |
| @@ -395,40 +391,50 @@ static int lm80_attach_adapter(struct i2c_adapter *adapter) | |||
| 395 | } | 391 | } |
| 396 | 392 | ||
| 397 | static struct attribute *lm80_attributes[] = { | 393 | static struct attribute *lm80_attributes[] = { |
| 398 | &dev_attr_in0_min.attr, | 394 | &sensor_dev_attr_in0_min.dev_attr.attr, |
| 399 | &dev_attr_in1_min.attr, | 395 | &sensor_dev_attr_in1_min.dev_attr.attr, |
| 400 | &dev_attr_in2_min.attr, | 396 | &sensor_dev_attr_in2_min.dev_attr.attr, |
| 401 | &dev_attr_in3_min.attr, | 397 | &sensor_dev_attr_in3_min.dev_attr.attr, |
| 402 | &dev_attr_in4_min.attr, | 398 | &sensor_dev_attr_in4_min.dev_attr.attr, |
| 403 | &dev_attr_in5_min.attr, | 399 | &sensor_dev_attr_in5_min.dev_attr.attr, |
| 404 | &dev_attr_in6_min.attr, | 400 | &sensor_dev_attr_in6_min.dev_attr.attr, |
| 405 | &dev_attr_in0_max.attr, | 401 | &sensor_dev_attr_in0_max.dev_attr.attr, |
| 406 | &dev_attr_in1_max.attr, | 402 | &sensor_dev_attr_in1_max.dev_attr.attr, |
| 407 | &dev_attr_in2_max.attr, | 403 | &sensor_dev_attr_in2_max.dev_attr.attr, |
| 408 | &dev_attr_in3_max.attr, | 404 | &sensor_dev_attr_in3_max.dev_attr.attr, |
| 409 | &dev_attr_in4_max.attr, | 405 | &sensor_dev_attr_in4_max.dev_attr.attr, |
| 410 | &dev_attr_in5_max.attr, | 406 | &sensor_dev_attr_in5_max.dev_attr.attr, |
| 411 | &dev_attr_in6_max.attr, | 407 | &sensor_dev_attr_in6_max.dev_attr.attr, |
| 412 | &dev_attr_in0_input.attr, | 408 | &sensor_dev_attr_in0_input.dev_attr.attr, |
| 413 | &dev_attr_in1_input.attr, | 409 | &sensor_dev_attr_in1_input.dev_attr.attr, |
| 414 | &dev_attr_in2_input.attr, | 410 | &sensor_dev_attr_in2_input.dev_attr.attr, |
| 415 | &dev_attr_in3_input.attr, | 411 | &sensor_dev_attr_in3_input.dev_attr.attr, |
| 416 | &dev_attr_in4_input.attr, | 412 | &sensor_dev_attr_in4_input.dev_attr.attr, |
| 417 | &dev_attr_in5_input.attr, | 413 | &sensor_dev_attr_in5_input.dev_attr.attr, |
| 418 | &dev_attr_in6_input.attr, | 414 | &sensor_dev_attr_in6_input.dev_attr.attr, |
| 419 | &dev_attr_fan1_min.attr, | 415 | &sensor_dev_attr_fan1_min.dev_attr.attr, |
| 420 | &dev_attr_fan2_min.attr, | 416 | &sensor_dev_attr_fan2_min.dev_attr.attr, |
| 421 | &dev_attr_fan1_input.attr, | 417 | &sensor_dev_attr_fan1_input.dev_attr.attr, |
| 422 | &dev_attr_fan2_input.attr, | 418 | &sensor_dev_attr_fan2_input.dev_attr.attr, |
| 423 | &dev_attr_fan1_div.attr, | 419 | &sensor_dev_attr_fan1_div.dev_attr.attr, |
| 424 | &dev_attr_fan2_div.attr, | 420 | &sensor_dev_attr_fan2_div.dev_attr.attr, |
| 425 | &dev_attr_temp1_input.attr, | 421 | &dev_attr_temp1_input.attr, |
| 426 | &dev_attr_temp1_max.attr, | 422 | &dev_attr_temp1_max.attr, |
| 427 | &dev_attr_temp1_max_hyst.attr, | 423 | &dev_attr_temp1_max_hyst.attr, |
| 428 | &dev_attr_temp1_crit.attr, | 424 | &dev_attr_temp1_crit.attr, |
| 429 | &dev_attr_temp1_crit_hyst.attr, | 425 | &dev_attr_temp1_crit_hyst.attr, |
| 430 | &dev_attr_alarms.attr, | 426 | &dev_attr_alarms.attr, |
| 431 | 427 | &sensor_dev_attr_in0_alarm.dev_attr.attr, | |
| 428 | &sensor_dev_attr_in1_alarm.dev_attr.attr, | ||
| 429 | &sensor_dev_attr_in2_alarm.dev_attr.attr, | ||
| 430 | &sensor_dev_attr_in3_alarm.dev_attr.attr, | ||
| 431 | &sensor_dev_attr_in4_alarm.dev_attr.attr, | ||
| 432 | &sensor_dev_attr_in5_alarm.dev_attr.attr, | ||
| 433 | &sensor_dev_attr_in6_alarm.dev_attr.attr, | ||
| 434 | &sensor_dev_attr_fan1_alarm.dev_attr.attr, | ||
| 435 | &sensor_dev_attr_fan2_alarm.dev_attr.attr, | ||
| 436 | &sensor_dev_attr_temp1_max_alarm.dev_attr.attr, | ||
| 437 | &sensor_dev_attr_temp1_crit_alarm.dev_attr.attr, | ||
| 432 | NULL | 438 | NULL |
| 433 | }; | 439 | }; |
| 434 | 440 | ||
| @@ -439,7 +445,7 @@ static const struct attribute_group lm80_group = { | |||
| 439 | static int lm80_detect(struct i2c_adapter *adapter, int address, int kind) | 445 | static int lm80_detect(struct i2c_adapter *adapter, int address, int kind) |
| 440 | { | 446 | { |
| 441 | int i, cur; | 447 | int i, cur; |
| 442 | struct i2c_client *new_client; | 448 | struct i2c_client *client; |
| 443 | struct lm80_data *data; | 449 | struct lm80_data *data; |
| 444 | int err = 0; | 450 | int err = 0; |
| 445 | const char *name; | 451 | const char *name; |
| @@ -455,21 +461,20 @@ static int lm80_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 455 | goto exit; | 461 | goto exit; |
| 456 | } | 462 | } |
| 457 | 463 | ||
| 458 | new_client = &data->client; | 464 | client = &data->client; |
| 459 | i2c_set_clientdata(new_client, data); | 465 | i2c_set_clientdata(client, data); |
| 460 | new_client->addr = address; | 466 | client->addr = address; |
| 461 | new_client->adapter = adapter; | 467 | client->adapter = adapter; |
| 462 | new_client->driver = &lm80_driver; | 468 | client->driver = &lm80_driver; |
| 463 | new_client->flags = 0; | ||
| 464 | 469 | ||
| 465 | /* Now, we do the remaining detection. It is lousy. */ | 470 | /* Now, we do the remaining detection. It is lousy. */ |
| 466 | if (lm80_read_value(new_client, LM80_REG_ALARM2) & 0xc0) | 471 | if (lm80_read_value(client, LM80_REG_ALARM2) & 0xc0) |
| 467 | goto error_free; | 472 | goto error_free; |
| 468 | for (i = 0x2a; i <= 0x3d; i++) { | 473 | for (i = 0x2a; i <= 0x3d; i++) { |
| 469 | cur = i2c_smbus_read_byte_data(new_client, i); | 474 | cur = i2c_smbus_read_byte_data(client, i); |
| 470 | if ((i2c_smbus_read_byte_data(new_client, i + 0x40) != cur) | 475 | if ((i2c_smbus_read_byte_data(client, i + 0x40) != cur) |
| 471 | || (i2c_smbus_read_byte_data(new_client, i + 0x80) != cur) | 476 | || (i2c_smbus_read_byte_data(client, i + 0x80) != cur) |
| 472 | || (i2c_smbus_read_byte_data(new_client, i + 0xc0) != cur)) | 477 | || (i2c_smbus_read_byte_data(client, i + 0xc0) != cur)) |
| 473 | goto error_free; | 478 | goto error_free; |
| 474 | } | 479 | } |
| 475 | 480 | ||
| @@ -477,27 +482,26 @@ static int lm80_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 477 | kind = lm80; | 482 | kind = lm80; |
| 478 | name = "lm80"; | 483 | name = "lm80"; |
| 479 | 484 | ||
| 480 | /* Fill in the remaining client fields and put it into the global list */ | 485 | /* Fill in the remaining client fields */ |
| 481 | strlcpy(new_client->name, name, I2C_NAME_SIZE); | 486 | strlcpy(client->name, name, I2C_NAME_SIZE); |
| 482 | data->valid = 0; | ||
| 483 | mutex_init(&data->update_lock); | 487 | mutex_init(&data->update_lock); |
| 484 | 488 | ||
| 485 | /* Tell the I2C layer a new client has arrived */ | 489 | /* Tell the I2C layer a new client has arrived */ |
| 486 | if ((err = i2c_attach_client(new_client))) | 490 | if ((err = i2c_attach_client(client))) |
| 487 | goto error_free; | 491 | goto error_free; |
| 488 | 492 | ||
| 489 | /* Initialize the LM80 chip */ | 493 | /* Initialize the LM80 chip */ |
| 490 | lm80_init_client(new_client); | 494 | lm80_init_client(client); |
| 491 | 495 | ||
| 492 | /* A few vars need to be filled upon startup */ | 496 | /* A few vars need to be filled upon startup */ |
| 493 | data->fan_min[0] = lm80_read_value(new_client, LM80_REG_FAN_MIN(1)); | 497 | data->fan_min[0] = lm80_read_value(client, LM80_REG_FAN_MIN(1)); |
| 494 | data->fan_min[1] = lm80_read_value(new_client, LM80_REG_FAN_MIN(2)); | 498 | data->fan_min[1] = lm80_read_value(client, LM80_REG_FAN_MIN(2)); |
| 495 | 499 | ||
| 496 | /* Register sysfs hooks */ | 500 | /* Register sysfs hooks */ |
| 497 | if ((err = sysfs_create_group(&new_client->dev.kobj, &lm80_group))) | 501 | if ((err = sysfs_create_group(&client->dev.kobj, &lm80_group))) |
| 498 | goto error_detach; | 502 | goto error_detach; |
| 499 | 503 | ||
| 500 | data->hwmon_dev = hwmon_device_register(&new_client->dev); | 504 | data->hwmon_dev = hwmon_device_register(&client->dev); |
| 501 | if (IS_ERR(data->hwmon_dev)) { | 505 | if (IS_ERR(data->hwmon_dev)) { |
| 502 | err = PTR_ERR(data->hwmon_dev); | 506 | err = PTR_ERR(data->hwmon_dev); |
| 503 | goto error_remove; | 507 | goto error_remove; |
| @@ -506,9 +510,9 @@ static int lm80_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 506 | return 0; | 510 | return 0; |
| 507 | 511 | ||
| 508 | error_remove: | 512 | error_remove: |
| 509 | sysfs_remove_group(&new_client->dev.kobj, &lm80_group); | 513 | sysfs_remove_group(&client->dev.kobj, &lm80_group); |
| 510 | error_detach: | 514 | error_detach: |
| 511 | i2c_detach_client(new_client); | 515 | i2c_detach_client(client); |
| 512 | error_free: | 516 | error_free: |
| 513 | kfree(data); | 517 | kfree(data); |
| 514 | exit: | 518 | exit: |
diff --git a/drivers/hwmon/lm83.c b/drivers/hwmon/lm83.c index 0336b4572a61..6e8903a6e902 100644 --- a/drivers/hwmon/lm83.c +++ b/drivers/hwmon/lm83.c | |||
| @@ -133,7 +133,6 @@ static struct i2c_driver lm83_driver = { | |||
| 133 | .driver = { | 133 | .driver = { |
| 134 | .name = "lm83", | 134 | .name = "lm83", |
| 135 | }, | 135 | }, |
| 136 | .id = I2C_DRIVERID_LM83, | ||
| 137 | .attach_adapter = lm83_attach_adapter, | 136 | .attach_adapter = lm83_attach_adapter, |
| 138 | .detach_client = lm83_detach_client, | 137 | .detach_client = lm83_detach_client, |
| 139 | }; | 138 | }; |
diff --git a/drivers/hwmon/lm85.c b/drivers/hwmon/lm85.c index a02480be65f2..4bb0f291a6b8 100644 --- a/drivers/hwmon/lm85.c +++ b/drivers/hwmon/lm85.c | |||
| @@ -367,7 +367,6 @@ static struct i2c_driver lm85_driver = { | |||
| 367 | .driver = { | 367 | .driver = { |
| 368 | .name = "lm85", | 368 | .name = "lm85", |
| 369 | }, | 369 | }, |
| 370 | .id = I2C_DRIVERID_LM85, | ||
| 371 | .attach_adapter = lm85_attach_adapter, | 370 | .attach_adapter = lm85_attach_adapter, |
| 372 | .detach_client = lm85_detach_client, | 371 | .detach_client = lm85_detach_client, |
| 373 | }; | 372 | }; |
| @@ -444,12 +443,8 @@ static ssize_t show_vrm_reg(struct device *dev, struct device_attribute *attr, c | |||
| 444 | 443 | ||
| 445 | static ssize_t store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | 444 | static ssize_t store_vrm_reg(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
| 446 | { | 445 | { |
| 447 | struct i2c_client *client = to_i2c_client(dev); | 446 | struct lm85_data *data = dev_get_drvdata(dev); |
| 448 | struct lm85_data *data = i2c_get_clientdata(client); | 447 | data->vrm = simple_strtoul(buf, NULL, 10); |
| 449 | u32 val; | ||
| 450 | |||
| 451 | val = simple_strtoul(buf, NULL, 10); | ||
| 452 | data->vrm = val; | ||
| 453 | return count; | 448 | return count; |
| 454 | } | 449 | } |
| 455 | 450 | ||
| @@ -519,17 +514,64 @@ static ssize_t show_pwm_enable(struct device *dev, struct device_attribute | |||
| 519 | { | 514 | { |
| 520 | int nr = to_sensor_dev_attr(attr)->index; | 515 | int nr = to_sensor_dev_attr(attr)->index; |
| 521 | struct lm85_data *data = lm85_update_device(dev); | 516 | struct lm85_data *data = lm85_update_device(dev); |
| 522 | int pwm_zone; | 517 | int pwm_zone, enable; |
| 523 | 518 | ||
| 524 | pwm_zone = ZONE_FROM_REG(data->autofan[nr].config); | 519 | pwm_zone = ZONE_FROM_REG(data->autofan[nr].config); |
| 525 | return sprintf(buf,"%d\n", (pwm_zone != 0 && pwm_zone != -1) ); | 520 | switch (pwm_zone) { |
| 521 | case -1: /* PWM is always at 100% */ | ||
| 522 | enable = 0; | ||
| 523 | break; | ||
| 524 | case 0: /* PWM is always at 0% */ | ||
| 525 | case -2: /* PWM responds to manual control */ | ||
| 526 | enable = 1; | ||
| 527 | break; | ||
| 528 | default: /* PWM in automatic mode */ | ||
| 529 | enable = 2; | ||
| 530 | } | ||
| 531 | return sprintf(buf, "%d\n", enable); | ||
| 532 | } | ||
| 533 | |||
| 534 | static ssize_t set_pwm_enable(struct device *dev, struct device_attribute | ||
| 535 | *attr, const char *buf, size_t count) | ||
| 536 | { | ||
| 537 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 538 | struct i2c_client *client = to_i2c_client(dev); | ||
| 539 | struct lm85_data *data = i2c_get_clientdata(client); | ||
| 540 | long val = simple_strtol(buf, NULL, 10); | ||
| 541 | u8 config; | ||
| 542 | |||
| 543 | switch (val) { | ||
| 544 | case 0: | ||
| 545 | config = 3; | ||
| 546 | break; | ||
| 547 | case 1: | ||
| 548 | config = 7; | ||
| 549 | break; | ||
| 550 | case 2: | ||
| 551 | /* Here we have to choose arbitrarily one of the 5 possible | ||
| 552 | configurations; I go for the safest */ | ||
| 553 | config = 6; | ||
| 554 | break; | ||
| 555 | default: | ||
| 556 | return -EINVAL; | ||
| 557 | } | ||
| 558 | |||
| 559 | mutex_lock(&data->update_lock); | ||
| 560 | data->autofan[nr].config = lm85_read_value(client, | ||
| 561 | LM85_REG_AFAN_CONFIG(nr)); | ||
| 562 | data->autofan[nr].config = (data->autofan[nr].config & ~0xe0) | ||
| 563 | | (config << 5); | ||
| 564 | lm85_write_value(client, LM85_REG_AFAN_CONFIG(nr), | ||
| 565 | data->autofan[nr].config); | ||
| 566 | mutex_unlock(&data->update_lock); | ||
| 567 | return count; | ||
| 526 | } | 568 | } |
| 527 | 569 | ||
| 528 | #define show_pwm_reg(offset) \ | 570 | #define show_pwm_reg(offset) \ |
| 529 | static SENSOR_DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR, \ | 571 | static SENSOR_DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR, \ |
| 530 | show_pwm, set_pwm, offset - 1); \ | 572 | show_pwm, set_pwm, offset - 1); \ |
| 531 | static SENSOR_DEVICE_ATTR(pwm##offset##_enable, S_IRUGO, \ | 573 | static SENSOR_DEVICE_ATTR(pwm##offset##_enable, S_IRUGO | S_IWUSR, \ |
| 532 | show_pwm_enable, NULL, offset - 1) | 574 | show_pwm_enable, set_pwm_enable, offset - 1) |
| 533 | 575 | ||
| 534 | show_pwm_reg(1); | 576 | show_pwm_reg(1); |
| 535 | show_pwm_reg(2); | 577 | show_pwm_reg(2); |
diff --git a/drivers/hwmon/lm87.c b/drivers/hwmon/lm87.c index 28cdff0c556b..8ee07c5c97a1 100644 --- a/drivers/hwmon/lm87.c +++ b/drivers/hwmon/lm87.c | |||
| @@ -5,7 +5,7 @@ | |||
| 5 | * Philip Edelbrock <phil@netroedge.com> | 5 | * Philip Edelbrock <phil@netroedge.com> |
| 6 | * Stephen Rousset <stephen.rousset@rocketlogix.com> | 6 | * Stephen Rousset <stephen.rousset@rocketlogix.com> |
| 7 | * Dan Eaton <dan.eaton@rocketlogix.com> | 7 | * Dan Eaton <dan.eaton@rocketlogix.com> |
| 8 | * Copyright (C) 2004 Jean Delvare <khali@linux-fr.org> | 8 | * Copyright (C) 2004,2007 Jean Delvare <khali@linux-fr.org> |
| 9 | * | 9 | * |
| 10 | * Original port to Linux 2.6 by Jeff Oliver. | 10 | * Original port to Linux 2.6 by Jeff Oliver. |
| 11 | * | 11 | * |
| @@ -37,6 +37,11 @@ | |||
| 37 | * instead. The LM87 is the only hardware monitoring chipset I know of | 37 | * instead. The LM87 is the only hardware monitoring chipset I know of |
| 38 | * which uses amplitude modulation. Be careful when using this feature. | 38 | * which uses amplitude modulation. Be careful when using this feature. |
| 39 | * | 39 | * |
| 40 | * This driver also supports the ADM1024, a sensor chip made by Analog | ||
| 41 | * Devices. That chip is fully compatible with the LM87. Complete | ||
| 42 | * datasheet can be obtained from Analog's website at: | ||
| 43 | * http://www.analog.com/en/prod/0,2877,ADM1024,00.html | ||
| 44 | * | ||
| 40 | * This program is free software; you can redistribute it and/or modify | 45 | * This program is free software; you can redistribute it and/or modify |
| 41 | * it under the terms of the GNU General Public License as published by | 46 | * it under the terms of the GNU General Public License as published by |
| 42 | * the Free Software Foundation; either version 2 of the License, or | 47 | * the Free Software Foundation; either version 2 of the License, or |
| @@ -74,7 +79,7 @@ static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END }; | |||
| 74 | * Insmod parameters | 79 | * Insmod parameters |
| 75 | */ | 80 | */ |
| 76 | 81 | ||
| 77 | I2C_CLIENT_INSMOD_1(lm87); | 82 | I2C_CLIENT_INSMOD_2(lm87, adm1024); |
| 78 | 83 | ||
| 79 | /* | 84 | /* |
| 80 | * The LM87 registers | 85 | * The LM87 registers |
| @@ -166,7 +171,6 @@ static struct i2c_driver lm87_driver = { | |||
| 166 | .driver = { | 171 | .driver = { |
| 167 | .name = "lm87", | 172 | .name = "lm87", |
| 168 | }, | 173 | }, |
| 169 | .id = I2C_DRIVERID_LM87, | ||
| 170 | .attach_adapter = lm87_attach_adapter, | 174 | .attach_adapter = lm87_attach_adapter, |
| 171 | .detach_client = lm87_detach_client, | 175 | .detach_client = lm87_detach_client, |
| 172 | }; | 176 | }; |
| @@ -506,8 +510,7 @@ static ssize_t show_vrm(struct device *dev, struct device_attribute *attr, char | |||
| 506 | } | 510 | } |
| 507 | static ssize_t set_vrm(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | 511 | static ssize_t set_vrm(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
| 508 | { | 512 | { |
| 509 | struct i2c_client *client = to_i2c_client(dev); | 513 | struct lm87_data *data = dev_get_drvdata(dev); |
| 510 | struct lm87_data *data = i2c_get_clientdata(client); | ||
| 511 | data->vrm = simple_strtoul(buf, NULL, 10); | 514 | data->vrm = simple_strtoul(buf, NULL, 10); |
| 512 | return count; | 515 | return count; |
| 513 | } | 516 | } |
| @@ -662,6 +665,7 @@ static int lm87_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 662 | struct i2c_client *new_client; | 665 | struct i2c_client *new_client; |
| 663 | struct lm87_data *data; | 666 | struct lm87_data *data; |
| 664 | int err = 0; | 667 | int err = 0; |
| 668 | static const char *names[] = { "lm87", "adm1024" }; | ||
| 665 | 669 | ||
| 666 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) | 670 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) |
| 667 | goto exit; | 671 | goto exit; |
| @@ -686,11 +690,18 @@ static int lm87_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 686 | 690 | ||
| 687 | /* Now, we do the remaining detection. */ | 691 | /* Now, we do the remaining detection. */ |
| 688 | if (kind < 0) { | 692 | if (kind < 0) { |
| 693 | u8 cid = lm87_read_value(new_client, LM87_REG_COMPANY_ID); | ||
| 689 | u8 rev = lm87_read_value(new_client, LM87_REG_REVISION); | 694 | u8 rev = lm87_read_value(new_client, LM87_REG_REVISION); |
| 690 | 695 | ||
| 691 | if (rev < 0x01 || rev > 0x08 | 696 | if (cid == 0x02 /* National Semiconductor */ |
| 692 | || (lm87_read_value(new_client, LM87_REG_CONFIG) & 0x80) | 697 | && (rev >= 0x01 && rev <= 0x08)) |
| 693 | || lm87_read_value(new_client, LM87_REG_COMPANY_ID) != 0x02) { | 698 | kind = lm87; |
| 699 | else if (cid == 0x41 /* Analog Devices */ | ||
| 700 | && (rev & 0xf0) == 0x10) | ||
| 701 | kind = adm1024; | ||
| 702 | |||
| 703 | if (kind < 0 | ||
| 704 | || (lm87_read_value(new_client, LM87_REG_CONFIG) & 0x80)) { | ||
| 694 | dev_dbg(&adapter->dev, | 705 | dev_dbg(&adapter->dev, |
| 695 | "LM87 detection failed at 0x%02x.\n", | 706 | "LM87 detection failed at 0x%02x.\n", |
| 696 | address); | 707 | address); |
| @@ -699,7 +710,7 @@ static int lm87_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 699 | } | 710 | } |
| 700 | 711 | ||
| 701 | /* We can fill in the remaining client fields */ | 712 | /* We can fill in the remaining client fields */ |
| 702 | strlcpy(new_client->name, "lm87", I2C_NAME_SIZE); | 713 | strlcpy(new_client->name, names[kind - 1], I2C_NAME_SIZE); |
| 703 | data->valid = 0; | 714 | data->valid = 0; |
| 704 | mutex_init(&data->update_lock); | 715 | mutex_init(&data->update_lock); |
| 705 | 716 | ||
diff --git a/drivers/hwmon/lm90.c b/drivers/hwmon/lm90.c index 960df9fa75af..f7ec95bedbf6 100644 --- a/drivers/hwmon/lm90.c +++ b/drivers/hwmon/lm90.c | |||
| @@ -204,7 +204,6 @@ static struct i2c_driver lm90_driver = { | |||
| 204 | .driver = { | 204 | .driver = { |
| 205 | .name = "lm90", | 205 | .name = "lm90", |
| 206 | }, | 206 | }, |
| 207 | .id = I2C_DRIVERID_LM90, | ||
| 208 | .attach_adapter = lm90_attach_adapter, | 207 | .attach_adapter = lm90_attach_adapter, |
| 209 | .detach_client = lm90_detach_client, | 208 | .detach_client = lm90_detach_client, |
| 210 | }; | 209 | }; |
| @@ -531,24 +530,24 @@ static int lm90_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 531 | kind = lm90; | 530 | kind = lm90; |
| 532 | 531 | ||
| 533 | if (kind < 0) { /* detection and identification */ | 532 | if (kind < 0) { /* detection and identification */ |
| 534 | u8 man_id, chip_id, reg_config1, reg_convrate; | 533 | int man_id, chip_id, reg_config1, reg_convrate; |
| 535 | 534 | ||
| 536 | if (lm90_read_reg(new_client, LM90_REG_R_MAN_ID, | 535 | if ((man_id = i2c_smbus_read_byte_data(new_client, |
| 537 | &man_id) < 0 | 536 | LM90_REG_R_MAN_ID)) < 0 |
| 538 | || lm90_read_reg(new_client, LM90_REG_R_CHIP_ID, | 537 | || (chip_id = i2c_smbus_read_byte_data(new_client, |
| 539 | &chip_id) < 0 | 538 | LM90_REG_R_CHIP_ID)) < 0 |
| 540 | || lm90_read_reg(new_client, LM90_REG_R_CONFIG1, | 539 | || (reg_config1 = i2c_smbus_read_byte_data(new_client, |
| 541 | ®_config1) < 0 | 540 | LM90_REG_R_CONFIG1)) < 0 |
| 542 | || lm90_read_reg(new_client, LM90_REG_R_CONVRATE, | 541 | || (reg_convrate = i2c_smbus_read_byte_data(new_client, |
| 543 | ®_convrate) < 0) | 542 | LM90_REG_R_CONVRATE)) < 0) |
| 544 | goto exit_free; | 543 | goto exit_free; |
| 545 | 544 | ||
| 546 | if ((address == 0x4C || address == 0x4D) | 545 | if ((address == 0x4C || address == 0x4D) |
| 547 | && man_id == 0x01) { /* National Semiconductor */ | 546 | && man_id == 0x01) { /* National Semiconductor */ |
| 548 | u8 reg_config2; | 547 | int reg_config2; |
| 549 | 548 | ||
| 550 | if (lm90_read_reg(new_client, LM90_REG_R_CONFIG2, | 549 | if ((reg_config2 = i2c_smbus_read_byte_data(new_client, |
| 551 | ®_config2) < 0) | 550 | LM90_REG_R_CONFIG2)) < 0) |
| 552 | goto exit_free; | 551 | goto exit_free; |
| 553 | 552 | ||
| 554 | if ((reg_config1 & 0x2A) == 0x00 | 553 | if ((reg_config1 & 0x2A) == 0x00 |
diff --git a/drivers/hwmon/lm92.c b/drivers/hwmon/lm92.c index 61d1bd1d5b6e..af5c77d568fe 100644 --- a/drivers/hwmon/lm92.c +++ b/drivers/hwmon/lm92.c | |||
| @@ -428,7 +428,6 @@ static struct i2c_driver lm92_driver = { | |||
| 428 | .driver = { | 428 | .driver = { |
| 429 | .name = "lm92", | 429 | .name = "lm92", |
| 430 | }, | 430 | }, |
| 431 | .id = I2C_DRIVERID_LM92, | ||
| 432 | .attach_adapter = lm92_attach_adapter, | 431 | .attach_adapter = lm92_attach_adapter, |
| 433 | .detach_client = lm92_detach_client, | 432 | .detach_client = lm92_detach_client, |
| 434 | }; | 433 | }; |
diff --git a/drivers/hwmon/pc87360.c b/drivers/hwmon/pc87360.c index 9d660133d517..9b462bb13fa3 100644 --- a/drivers/hwmon/pc87360.c +++ b/drivers/hwmon/pc87360.c | |||
| @@ -59,6 +59,10 @@ MODULE_PARM_DESC(init, | |||
| 59 | " 2: Forcibly enable all voltage and temperature channels, except in9\n" | 59 | " 2: Forcibly enable all voltage and temperature channels, except in9\n" |
| 60 | " 3: Forcibly enable all voltage and temperature channels, including in9"); | 60 | " 3: Forcibly enable all voltage and temperature channels, including in9"); |
| 61 | 61 | ||
| 62 | static unsigned short force_id; | ||
| 63 | module_param(force_id, ushort, 0); | ||
| 64 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 65 | |||
| 62 | /* | 66 | /* |
| 63 | * Super-I/O registers and operations | 67 | * Super-I/O registers and operations |
| 64 | */ | 68 | */ |
| @@ -826,7 +830,7 @@ static int __init pc87360_find(int sioaddr, u8 *devid, unsigned short *addresses | |||
| 826 | /* No superio_enter */ | 830 | /* No superio_enter */ |
| 827 | 831 | ||
| 828 | /* Identify device */ | 832 | /* Identify device */ |
| 829 | val = superio_inb(sioaddr, DEVID); | 833 | val = force_id ? force_id : superio_inb(sioaddr, DEVID); |
| 830 | switch (val) { | 834 | switch (val) { |
| 831 | case 0xE1: /* PC87360 */ | 835 | case 0xE1: /* PC87360 */ |
| 832 | case 0xE8: /* PC87363 */ | 836 | case 0xE8: /* PC87363 */ |
diff --git a/drivers/hwmon/pc87427.c b/drivers/hwmon/pc87427.c index d40509ad6ae6..7265f22ae5cd 100644 --- a/drivers/hwmon/pc87427.c +++ b/drivers/hwmon/pc87427.c | |||
| @@ -34,6 +34,10 @@ | |||
| 34 | #include <linux/ioport.h> | 34 | #include <linux/ioport.h> |
| 35 | #include <asm/io.h> | 35 | #include <asm/io.h> |
| 36 | 36 | ||
| 37 | static unsigned short force_id; | ||
| 38 | module_param(force_id, ushort, 0); | ||
| 39 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 40 | |||
| 37 | static struct platform_device *pdev; | 41 | static struct platform_device *pdev; |
| 38 | 42 | ||
| 39 | #define DRVNAME "pc87427" | 43 | #define DRVNAME "pc87427" |
| @@ -555,7 +559,7 @@ static int __init pc87427_find(int sioaddr, unsigned short *address) | |||
| 555 | int i, err = 0; | 559 | int i, err = 0; |
| 556 | 560 | ||
| 557 | /* Identify device */ | 561 | /* Identify device */ |
| 558 | val = superio_inb(sioaddr, SIOREG_DEVID); | 562 | val = force_id ? force_id : superio_inb(sioaddr, SIOREG_DEVID); |
| 559 | if (val != 0xf2) { /* PC87427 */ | 563 | if (val != 0xf2) { /* PC87427 */ |
| 560 | err = -ENODEV; | 564 | err = -ENODEV; |
| 561 | goto exit; | 565 | goto exit; |
diff --git a/drivers/hwmon/smsc47b397.c b/drivers/hwmon/smsc47b397.c index 0b57d2ea2cf7..f61d8f4185b2 100644 --- a/drivers/hwmon/smsc47b397.c +++ b/drivers/hwmon/smsc47b397.c | |||
| @@ -38,6 +38,10 @@ | |||
| 38 | #include <linux/mutex.h> | 38 | #include <linux/mutex.h> |
| 39 | #include <asm/io.h> | 39 | #include <asm/io.h> |
| 40 | 40 | ||
| 41 | static unsigned short force_id; | ||
| 42 | module_param(force_id, ushort, 0); | ||
| 43 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 44 | |||
| 41 | static struct platform_device *pdev; | 45 | static struct platform_device *pdev; |
| 42 | 46 | ||
| 43 | #define DRVNAME "smsc47b397" | 47 | #define DRVNAME "smsc47b397" |
| @@ -333,7 +337,7 @@ static int __init smsc47b397_find(unsigned short *addr) | |||
| 333 | u8 id, rev; | 337 | u8 id, rev; |
| 334 | 338 | ||
| 335 | superio_enter(); | 339 | superio_enter(); |
| 336 | id = superio_inb(SUPERIO_REG_DEVID); | 340 | id = force_id ? force_id : superio_inb(SUPERIO_REG_DEVID); |
| 337 | 341 | ||
| 338 | if ((id != 0x6f) && (id != 0x81) && (id != 0x85)) { | 342 | if ((id != 0x6f) && (id != 0x81) && (id != 0x85)) { |
| 339 | superio_exit(); | 343 | superio_exit(); |
diff --git a/drivers/hwmon/smsc47m1.c b/drivers/hwmon/smsc47m1.c index a10a380868e2..0d7f0c4d06bb 100644 --- a/drivers/hwmon/smsc47m1.c +++ b/drivers/hwmon/smsc47m1.c | |||
| @@ -39,6 +39,10 @@ | |||
| 39 | #include <linux/sysfs.h> | 39 | #include <linux/sysfs.h> |
| 40 | #include <asm/io.h> | 40 | #include <asm/io.h> |
| 41 | 41 | ||
| 42 | static unsigned short force_id; | ||
| 43 | module_param(force_id, ushort, 0); | ||
| 44 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 45 | |||
| 42 | static struct platform_device *pdev; | 46 | static struct platform_device *pdev; |
| 43 | 47 | ||
| 44 | #define DRVNAME "smsc47m1" | 48 | #define DRVNAME "smsc47m1" |
| @@ -399,7 +403,7 @@ static int __init smsc47m1_find(unsigned short *addr, | |||
| 399 | u8 val; | 403 | u8 val; |
| 400 | 404 | ||
| 401 | superio_enter(); | 405 | superio_enter(); |
| 402 | val = superio_inb(SUPERIO_REG_DEVID); | 406 | val = force_id ? force_id : superio_inb(SUPERIO_REG_DEVID); |
| 403 | 407 | ||
| 404 | /* | 408 | /* |
| 405 | * SMSC LPC47M10x/LPC47M112/LPC47M13x (device id 0x59), LPC47M14x | 409 | * SMSC LPC47M10x/LPC47M112/LPC47M13x (device id 0x59), LPC47M14x |
diff --git a/drivers/hwmon/smsc47m192.c b/drivers/hwmon/smsc47m192.c index b87552652588..8b0c188e60f6 100644 --- a/drivers/hwmon/smsc47m192.c +++ b/drivers/hwmon/smsc47m192.c | |||
| @@ -341,8 +341,7 @@ static ssize_t show_vrm(struct device *dev, struct device_attribute *attr, | |||
| 341 | static ssize_t set_vrm(struct device *dev, struct device_attribute *attr, | 341 | static ssize_t set_vrm(struct device *dev, struct device_attribute *attr, |
| 342 | const char *buf, size_t count) | 342 | const char *buf, size_t count) |
| 343 | { | 343 | { |
| 344 | struct i2c_client *client = to_i2c_client(dev); | 344 | struct smsc47m192_data *data = dev_get_drvdata(dev); |
| 345 | struct smsc47m192_data *data = i2c_get_clientdata(client); | ||
| 346 | data->vrm = simple_strtoul(buf, NULL, 10); | 345 | data->vrm = simple_strtoul(buf, NULL, 10); |
| 347 | return count; | 346 | return count; |
| 348 | } | 347 | } |
diff --git a/drivers/hwmon/vt1211.c b/drivers/hwmon/vt1211.c index 7dfcc8dd316d..12b43590fa53 100644 --- a/drivers/hwmon/vt1211.c +++ b/drivers/hwmon/vt1211.c | |||
| @@ -42,6 +42,10 @@ static int int_mode = -1; | |||
| 42 | module_param(int_mode, int, 0); | 42 | module_param(int_mode, int, 0); |
| 43 | MODULE_PARM_DESC(int_mode, "Force the temperature interrupt mode"); | 43 | MODULE_PARM_DESC(int_mode, "Force the temperature interrupt mode"); |
| 44 | 44 | ||
| 45 | static unsigned short force_id; | ||
| 46 | module_param(force_id, ushort, 0); | ||
| 47 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 48 | |||
| 45 | static struct platform_device *pdev; | 49 | static struct platform_device *pdev; |
| 46 | 50 | ||
| 47 | #define DRVNAME "vt1211" | 51 | #define DRVNAME "vt1211" |
| @@ -1280,10 +1284,12 @@ EXIT: | |||
| 1280 | static int __init vt1211_find(int sio_cip, unsigned short *address) | 1284 | static int __init vt1211_find(int sio_cip, unsigned short *address) |
| 1281 | { | 1285 | { |
| 1282 | int err = -ENODEV; | 1286 | int err = -ENODEV; |
| 1287 | int devid; | ||
| 1283 | 1288 | ||
| 1284 | superio_enter(sio_cip); | 1289 | superio_enter(sio_cip); |
| 1285 | 1290 | ||
| 1286 | if (superio_inb(sio_cip, SIO_VT1211_DEVID) != SIO_VT1211_ID) { | 1291 | devid = force_id ? force_id : superio_inb(sio_cip, SIO_VT1211_DEVID); |
| 1292 | if (devid != SIO_VT1211_ID) { | ||
| 1287 | goto EXIT; | 1293 | goto EXIT; |
| 1288 | } | 1294 | } |
| 1289 | 1295 | ||
diff --git a/drivers/hwmon/vt8231.c b/drivers/hwmon/vt8231.c index 2196a84603f5..f87661775fe0 100644 --- a/drivers/hwmon/vt8231.c +++ b/drivers/hwmon/vt8231.c | |||
| @@ -504,7 +504,7 @@ static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr, | |||
| 504 | case 4: data->fan_div[nr] = 2; break; | 504 | case 4: data->fan_div[nr] = 2; break; |
| 505 | case 8: data->fan_div[nr] = 3; break; | 505 | case 8: data->fan_div[nr] = 3; break; |
| 506 | default: | 506 | default: |
| 507 | dev_err(dev, "fan_div value %ld not supported." | 507 | dev_err(dev, "fan_div value %ld not supported. " |
| 508 | "Choose one of 1, 2, 4 or 8!\n", val); | 508 | "Choose one of 1, 2, 4 or 8!\n", val); |
| 509 | mutex_unlock(&data->update_lock); | 509 | mutex_unlock(&data->update_lock); |
| 510 | return -EINVAL; | 510 | return -EINVAL; |
diff --git a/drivers/hwmon/w83627ehf.c b/drivers/hwmon/w83627ehf.c index d5aa25ce5dbd..075164dd65a7 100644 --- a/drivers/hwmon/w83627ehf.c +++ b/drivers/hwmon/w83627ehf.c | |||
| @@ -59,6 +59,10 @@ static const char * w83627ehf_device_names[] = { | |||
| 59 | "w83627dhg", | 59 | "w83627dhg", |
| 60 | }; | 60 | }; |
| 61 | 61 | ||
| 62 | static unsigned short force_id; | ||
| 63 | module_param(force_id, ushort, 0); | ||
| 64 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 65 | |||
| 62 | #define DRVNAME "w83627ehf" | 66 | #define DRVNAME "w83627ehf" |
| 63 | 67 | ||
| 64 | /* | 68 | /* |
| @@ -1198,8 +1202,7 @@ static void w83627ehf_device_remove_files(struct device *dev) | |||
| 1198 | device_remove_file(dev, &sda_temp[i].dev_attr); | 1202 | device_remove_file(dev, &sda_temp[i].dev_attr); |
| 1199 | 1203 | ||
| 1200 | device_remove_file(dev, &dev_attr_name); | 1204 | device_remove_file(dev, &dev_attr_name); |
| 1201 | if (data->vid != 0x3f) | 1205 | device_remove_file(dev, &dev_attr_cpu0_vid); |
| 1202 | device_remove_file(dev, &dev_attr_cpu0_vid); | ||
| 1203 | } | 1206 | } |
| 1204 | 1207 | ||
| 1205 | /* Get the monitoring functions started */ | 1208 | /* Get the monitoring functions started */ |
| @@ -1299,11 +1302,16 @@ static int __devinit w83627ehf_probe(struct platform_device *pdev) | |||
| 1299 | } | 1302 | } |
| 1300 | } | 1303 | } |
| 1301 | 1304 | ||
| 1302 | data->vid = superio_inb(sio_data->sioreg, SIO_REG_VID_DATA) & 0x3f; | 1305 | data->vid = superio_inb(sio_data->sioreg, SIO_REG_VID_DATA); |
| 1306 | if (sio_data->kind == w83627ehf) /* 6 VID pins only */ | ||
| 1307 | data->vid &= 0x3f; | ||
| 1308 | |||
| 1309 | err = device_create_file(dev, &dev_attr_cpu0_vid); | ||
| 1310 | if (err) | ||
| 1311 | goto exit_release; | ||
| 1303 | } else { | 1312 | } else { |
| 1304 | dev_info(dev, "VID pins in output mode, CPU VID not " | 1313 | dev_info(dev, "VID pins in output mode, CPU VID not " |
| 1305 | "available\n"); | 1314 | "available\n"); |
| 1306 | data->vid = 0x3f; | ||
| 1307 | } | 1315 | } |
| 1308 | 1316 | ||
| 1309 | /* fan4 and fan5 share some pins with the GPIO and serial flash */ | 1317 | /* fan4 and fan5 share some pins with the GPIO and serial flash */ |
| @@ -1386,12 +1394,6 @@ static int __devinit w83627ehf_probe(struct platform_device *pdev) | |||
| 1386 | if (err) | 1394 | if (err) |
| 1387 | goto exit_remove; | 1395 | goto exit_remove; |
| 1388 | 1396 | ||
| 1389 | if (data->vid != 0x3f) { | ||
| 1390 | err = device_create_file(dev, &dev_attr_cpu0_vid); | ||
| 1391 | if (err) | ||
| 1392 | goto exit_remove; | ||
| 1393 | } | ||
| 1394 | |||
| 1395 | data->hwmon_dev = hwmon_device_register(dev); | 1397 | data->hwmon_dev = hwmon_device_register(dev); |
| 1396 | if (IS_ERR(data->hwmon_dev)) { | 1398 | if (IS_ERR(data->hwmon_dev)) { |
| 1397 | err = PTR_ERR(data->hwmon_dev); | 1399 | err = PTR_ERR(data->hwmon_dev); |
| @@ -1445,8 +1447,11 @@ static int __init w83627ehf_find(int sioaddr, unsigned short *addr, | |||
| 1445 | 1447 | ||
| 1446 | superio_enter(sioaddr); | 1448 | superio_enter(sioaddr); |
| 1447 | 1449 | ||
| 1448 | val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8) | 1450 | if (force_id) |
| 1449 | | superio_inb(sioaddr, SIO_REG_DEVID + 1); | 1451 | val = force_id; |
| 1452 | else | ||
| 1453 | val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8) | ||
| 1454 | | superio_inb(sioaddr, SIO_REG_DEVID + 1); | ||
| 1450 | switch (val & SIO_ID_MASK) { | 1455 | switch (val & SIO_ID_MASK) { |
| 1451 | case SIO_W83627EHF_ID: | 1456 | case SIO_W83627EHF_ID: |
| 1452 | sio_data->kind = w83627ehf; | 1457 | sio_data->kind = w83627ehf; |
diff --git a/drivers/hwmon/w83627hf.c b/drivers/hwmon/w83627hf.c index 879d0a6544cc..9564fb069957 100644 --- a/drivers/hwmon/w83627hf.c +++ b/drivers/hwmon/w83627hf.c | |||
| @@ -75,6 +75,10 @@ static int init = 1; | |||
| 75 | module_param(init, bool, 0); | 75 | module_param(init, bool, 0); |
| 76 | MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization"); | 76 | MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization"); |
| 77 | 77 | ||
| 78 | static unsigned short force_id; | ||
| 79 | module_param(force_id, ushort, 0); | ||
| 80 | MODULE_PARM_DESC(force_id, "Override the detected device ID"); | ||
| 81 | |||
| 78 | /* modified from kernel/include/traps.c */ | 82 | /* modified from kernel/include/traps.c */ |
| 79 | static int REG; /* The register to read/write */ | 83 | static int REG; /* The register to read/write */ |
| 80 | #define DEV 0x07 /* Register: Logical device select */ | 84 | #define DEV 0x07 /* Register: Logical device select */ |
| @@ -319,10 +323,8 @@ static inline u8 pwm_freq_to_reg(unsigned long val) | |||
| 319 | return (0x80 | (180000UL / (val << 8))); | 323 | return (0x80 | (180000UL / (val << 8))); |
| 320 | } | 324 | } |
| 321 | 325 | ||
| 322 | #define BEEP_MASK_FROM_REG(val) (val) | 326 | #define BEEP_MASK_FROM_REG(val) ((val) & 0xff7fff) |
| 323 | #define BEEP_MASK_TO_REG(val) ((val) & 0xffffff) | 327 | #define BEEP_MASK_TO_REG(val) ((val) & 0xff7fff) |
| 324 | #define BEEP_ENABLE_TO_REG(val) ((val)?1:0) | ||
| 325 | #define BEEP_ENABLE_FROM_REG(val) ((val)?1:0) | ||
| 326 | 328 | ||
| 327 | #define DIV_FROM_REG(val) (1 << (val)) | 329 | #define DIV_FROM_REG(val) (1 << (val)) |
| 328 | 330 | ||
| @@ -363,7 +365,6 @@ struct w83627hf_data { | |||
| 363 | u8 vid; /* Register encoding, combined */ | 365 | u8 vid; /* Register encoding, combined */ |
| 364 | u32 alarms; /* Register encoding, combined */ | 366 | u32 alarms; /* Register encoding, combined */ |
| 365 | u32 beep_mask; /* Register encoding, combined */ | 367 | u32 beep_mask; /* Register encoding, combined */ |
| 366 | u8 beep_enable; /* Boolean */ | ||
| 367 | u8 pwm[3]; /* Register value */ | 368 | u8 pwm[3]; /* Register value */ |
| 368 | u8 pwm_freq[3]; /* Register value */ | 369 | u8 pwm_freq[3]; /* Register value */ |
| 369 | u16 sens[3]; /* 1 = pentium diode; 2 = 3904 diode; | 370 | u16 sens[3]; /* 1 = pentium diode; 2 = 3904 diode; |
| @@ -713,65 +714,151 @@ show_alarms_reg(struct device *dev, struct device_attribute *attr, char *buf) | |||
| 713 | } | 714 | } |
| 714 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL); | 715 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms_reg, NULL); |
| 715 | 716 | ||
| 716 | #define show_beep_reg(REG, reg) \ | 717 | static ssize_t |
| 717 | static ssize_t show_beep_##reg (struct device *dev, struct device_attribute *attr, char *buf) \ | 718 | show_alarm(struct device *dev, struct device_attribute *attr, char *buf) |
| 718 | { \ | 719 | { |
| 719 | struct w83627hf_data *data = w83627hf_update_device(dev); \ | 720 | struct w83627hf_data *data = w83627hf_update_device(dev); |
| 720 | return sprintf(buf,"%ld\n", \ | 721 | int bitnr = to_sensor_dev_attr(attr)->index; |
| 721 | (long)BEEP_##REG##_FROM_REG(data->beep_##reg)); \ | 722 | return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1); |
| 722 | } | 723 | } |
| 723 | show_beep_reg(ENABLE, enable) | 724 | static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0); |
| 724 | show_beep_reg(MASK, mask) | 725 | static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1); |
| 726 | static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2); | ||
| 727 | static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3); | ||
| 728 | static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8); | ||
| 729 | static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9); | ||
| 730 | static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 10); | ||
| 731 | static SENSOR_DEVICE_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16); | ||
| 732 | static SENSOR_DEVICE_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17); | ||
| 733 | static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6); | ||
| 734 | static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7); | ||
| 735 | static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11); | ||
| 736 | static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4); | ||
| 737 | static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5); | ||
| 738 | static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 13); | ||
| 725 | 739 | ||
| 726 | #define BEEP_ENABLE 0 /* Store beep_enable */ | 740 | static ssize_t |
| 727 | #define BEEP_MASK 1 /* Store beep_mask */ | 741 | show_beep_mask(struct device *dev, struct device_attribute *attr, char *buf) |
| 742 | { | ||
| 743 | struct w83627hf_data *data = w83627hf_update_device(dev); | ||
| 744 | return sprintf(buf, "%ld\n", | ||
| 745 | (long)BEEP_MASK_FROM_REG(data->beep_mask)); | ||
| 746 | } | ||
| 728 | 747 | ||
| 729 | static ssize_t | 748 | static ssize_t |
| 730 | store_beep_reg(struct device *dev, const char *buf, size_t count, | 749 | store_beep_mask(struct device *dev, struct device_attribute *attr, |
| 731 | int update_mask) | 750 | const char *buf, size_t count) |
| 732 | { | 751 | { |
| 733 | struct w83627hf_data *data = dev_get_drvdata(dev); | 752 | struct w83627hf_data *data = dev_get_drvdata(dev); |
| 734 | u32 val, val2; | 753 | unsigned long val; |
| 735 | 754 | ||
| 736 | val = simple_strtoul(buf, NULL, 10); | 755 | val = simple_strtoul(buf, NULL, 10); |
| 737 | 756 | ||
| 738 | mutex_lock(&data->update_lock); | 757 | mutex_lock(&data->update_lock); |
| 739 | 758 | ||
| 740 | if (update_mask == BEEP_MASK) { /* We are storing beep_mask */ | 759 | /* preserve beep enable */ |
| 741 | data->beep_mask = BEEP_MASK_TO_REG(val); | 760 | data->beep_mask = (data->beep_mask & 0x8000) |
| 742 | w83627hf_write_value(data, W83781D_REG_BEEP_INTS1, | 761 | | BEEP_MASK_TO_REG(val); |
| 743 | data->beep_mask & 0xff); | 762 | w83627hf_write_value(data, W83781D_REG_BEEP_INTS1, |
| 744 | w83627hf_write_value(data, W83781D_REG_BEEP_INTS3, | 763 | data->beep_mask & 0xff); |
| 745 | ((data->beep_mask) >> 16) & 0xff); | 764 | w83627hf_write_value(data, W83781D_REG_BEEP_INTS3, |
| 746 | val2 = (data->beep_mask >> 8) & 0x7f; | 765 | ((data->beep_mask) >> 16) & 0xff); |
| 747 | } else { /* We are storing beep_enable */ | ||
| 748 | val2 = | ||
| 749 | w83627hf_read_value(data, W83781D_REG_BEEP_INTS2) & 0x7f; | ||
| 750 | data->beep_enable = BEEP_ENABLE_TO_REG(val); | ||
| 751 | } | ||
| 752 | |||
| 753 | w83627hf_write_value(data, W83781D_REG_BEEP_INTS2, | 766 | w83627hf_write_value(data, W83781D_REG_BEEP_INTS2, |
| 754 | val2 | data->beep_enable << 7); | 767 | (data->beep_mask >> 8) & 0xff); |
| 755 | 768 | ||
| 756 | mutex_unlock(&data->update_lock); | 769 | mutex_unlock(&data->update_lock); |
| 757 | return count; | 770 | return count; |
| 758 | } | 771 | } |
| 759 | 772 | ||
| 760 | #define sysfs_beep(REG, reg) \ | 773 | static DEVICE_ATTR(beep_mask, S_IRUGO | S_IWUSR, |
| 761 | static ssize_t show_regs_beep_##reg (struct device *dev, struct device_attribute *attr, char *buf) \ | 774 | show_beep_mask, store_beep_mask); |
| 762 | { \ | 775 | |
| 763 | return show_beep_##reg(dev, attr, buf); \ | 776 | static ssize_t |
| 764 | } \ | 777 | show_beep(struct device *dev, struct device_attribute *attr, char *buf) |
| 765 | static ssize_t \ | 778 | { |
| 766 | store_regs_beep_##reg (struct device *dev, struct device_attribute *attr, const char *buf, size_t count) \ | 779 | struct w83627hf_data *data = w83627hf_update_device(dev); |
| 767 | { \ | 780 | int bitnr = to_sensor_dev_attr(attr)->index; |
| 768 | return store_beep_reg(dev, buf, count, BEEP_##REG); \ | 781 | return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1); |
| 769 | } \ | 782 | } |
| 770 | static DEVICE_ATTR(beep_##reg, S_IRUGO | S_IWUSR, \ | 783 | |
| 771 | show_regs_beep_##reg, store_regs_beep_##reg); | 784 | static ssize_t |
| 785 | store_beep(struct device *dev, struct device_attribute *attr, | ||
| 786 | const char *buf, size_t count) | ||
| 787 | { | ||
| 788 | struct w83627hf_data *data = dev_get_drvdata(dev); | ||
| 789 | int bitnr = to_sensor_dev_attr(attr)->index; | ||
| 790 | unsigned long bit; | ||
| 791 | u8 reg; | ||
| 792 | |||
| 793 | bit = simple_strtoul(buf, NULL, 10); | ||
| 794 | if (bit & ~1) | ||
| 795 | return -EINVAL; | ||
| 796 | |||
| 797 | mutex_lock(&data->update_lock); | ||
| 798 | if (bit) | ||
| 799 | data->beep_mask |= (1 << bitnr); | ||
| 800 | else | ||
| 801 | data->beep_mask &= ~(1 << bitnr); | ||
| 802 | |||
| 803 | if (bitnr < 8) { | ||
| 804 | reg = w83627hf_read_value(data, W83781D_REG_BEEP_INTS1); | ||
| 805 | if (bit) | ||
| 806 | reg |= (1 << bitnr); | ||
| 807 | else | ||
| 808 | reg &= ~(1 << bitnr); | ||
| 809 | w83627hf_write_value(data, W83781D_REG_BEEP_INTS1, reg); | ||
| 810 | } else if (bitnr < 16) { | ||
| 811 | reg = w83627hf_read_value(data, W83781D_REG_BEEP_INTS2); | ||
| 812 | if (bit) | ||
| 813 | reg |= (1 << (bitnr - 8)); | ||
| 814 | else | ||
| 815 | reg &= ~(1 << (bitnr - 8)); | ||
| 816 | w83627hf_write_value(data, W83781D_REG_BEEP_INTS2, reg); | ||
| 817 | } else { | ||
| 818 | reg = w83627hf_read_value(data, W83781D_REG_BEEP_INTS3); | ||
| 819 | if (bit) | ||
| 820 | reg |= (1 << (bitnr - 16)); | ||
| 821 | else | ||
| 822 | reg &= ~(1 << (bitnr - 16)); | ||
| 823 | w83627hf_write_value(data, W83781D_REG_BEEP_INTS3, reg); | ||
| 824 | } | ||
| 825 | mutex_unlock(&data->update_lock); | ||
| 826 | |||
| 827 | return count; | ||
| 828 | } | ||
| 772 | 829 | ||
| 773 | sysfs_beep(ENABLE, enable); | 830 | static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO | S_IWUSR, |
| 774 | sysfs_beep(MASK, mask); | 831 | show_beep, store_beep, 0); |
| 832 | static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO | S_IWUSR, | ||
| 833 | show_beep, store_beep, 1); | ||
| 834 | static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO | S_IWUSR, | ||
| 835 | show_beep, store_beep, 2); | ||
| 836 | static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO | S_IWUSR, | ||
| 837 | show_beep, store_beep, 3); | ||
| 838 | static SENSOR_DEVICE_ATTR(in4_beep, S_IRUGO | S_IWUSR, | ||
| 839 | show_beep, store_beep, 8); | ||
| 840 | static SENSOR_DEVICE_ATTR(in5_beep, S_IRUGO | S_IWUSR, | ||
| 841 | show_beep, store_beep, 9); | ||
| 842 | static SENSOR_DEVICE_ATTR(in6_beep, S_IRUGO | S_IWUSR, | ||
| 843 | show_beep, store_beep, 10); | ||
| 844 | static SENSOR_DEVICE_ATTR(in7_beep, S_IRUGO | S_IWUSR, | ||
| 845 | show_beep, store_beep, 16); | ||
| 846 | static SENSOR_DEVICE_ATTR(in8_beep, S_IRUGO | S_IWUSR, | ||
| 847 | show_beep, store_beep, 17); | ||
| 848 | static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO | S_IWUSR, | ||
| 849 | show_beep, store_beep, 6); | ||
| 850 | static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO | S_IWUSR, | ||
| 851 | show_beep, store_beep, 7); | ||
| 852 | static SENSOR_DEVICE_ATTR(fan3_beep, S_IRUGO | S_IWUSR, | ||
| 853 | show_beep, store_beep, 11); | ||
| 854 | static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO | S_IWUSR, | ||
| 855 | show_beep, store_beep, 4); | ||
| 856 | static SENSOR_DEVICE_ATTR(temp2_beep, S_IRUGO | S_IWUSR, | ||
| 857 | show_beep, store_beep, 5); | ||
| 858 | static SENSOR_DEVICE_ATTR(temp3_beep, S_IRUGO | S_IWUSR, | ||
| 859 | show_beep, store_beep, 13); | ||
| 860 | static SENSOR_DEVICE_ATTR(beep_enable, S_IRUGO | S_IWUSR, | ||
| 861 | show_beep, store_beep, 15); | ||
| 775 | 862 | ||
| 776 | static ssize_t | 863 | static ssize_t |
| 777 | show_fan_div(struct device *dev, struct device_attribute *devattr, char *buf) | 864 | show_fan_div(struct device *dev, struct device_attribute *devattr, char *buf) |
| @@ -1014,7 +1101,7 @@ static int __init w83627hf_find(int sioaddr, unsigned short *addr, | |||
| 1014 | VAL = sioaddr + 1; | 1101 | VAL = sioaddr + 1; |
| 1015 | 1102 | ||
| 1016 | superio_enter(); | 1103 | superio_enter(); |
| 1017 | val= superio_inb(DEVID); | 1104 | val = force_id ? force_id : superio_inb(DEVID); |
| 1018 | switch (val) { | 1105 | switch (val) { |
| 1019 | case W627_DEVID: | 1106 | case W627_DEVID: |
| 1020 | sio_data->type = w83627hf; | 1107 | sio_data->type = w83627hf; |
| @@ -1073,23 +1160,31 @@ static int __init w83627hf_find(int sioaddr, unsigned short *addr, | |||
| 1073 | #define VIN_UNIT_ATTRS(_X_) \ | 1160 | #define VIN_UNIT_ATTRS(_X_) \ |
| 1074 | &sensor_dev_attr_in##_X_##_input.dev_attr.attr, \ | 1161 | &sensor_dev_attr_in##_X_##_input.dev_attr.attr, \ |
| 1075 | &sensor_dev_attr_in##_X_##_min.dev_attr.attr, \ | 1162 | &sensor_dev_attr_in##_X_##_min.dev_attr.attr, \ |
| 1076 | &sensor_dev_attr_in##_X_##_max.dev_attr.attr | 1163 | &sensor_dev_attr_in##_X_##_max.dev_attr.attr, \ |
| 1164 | &sensor_dev_attr_in##_X_##_alarm.dev_attr.attr, \ | ||
| 1165 | &sensor_dev_attr_in##_X_##_beep.dev_attr.attr | ||
| 1077 | 1166 | ||
| 1078 | #define FAN_UNIT_ATTRS(_X_) \ | 1167 | #define FAN_UNIT_ATTRS(_X_) \ |
| 1079 | &sensor_dev_attr_fan##_X_##_input.dev_attr.attr, \ | 1168 | &sensor_dev_attr_fan##_X_##_input.dev_attr.attr, \ |
| 1080 | &sensor_dev_attr_fan##_X_##_min.dev_attr.attr, \ | 1169 | &sensor_dev_attr_fan##_X_##_min.dev_attr.attr, \ |
| 1081 | &sensor_dev_attr_fan##_X_##_div.dev_attr.attr | 1170 | &sensor_dev_attr_fan##_X_##_div.dev_attr.attr, \ |
| 1171 | &sensor_dev_attr_fan##_X_##_alarm.dev_attr.attr, \ | ||
| 1172 | &sensor_dev_attr_fan##_X_##_beep.dev_attr.attr | ||
| 1082 | 1173 | ||
| 1083 | #define TEMP_UNIT_ATTRS(_X_) \ | 1174 | #define TEMP_UNIT_ATTRS(_X_) \ |
| 1084 | &sensor_dev_attr_temp##_X_##_input.dev_attr.attr, \ | 1175 | &sensor_dev_attr_temp##_X_##_input.dev_attr.attr, \ |
| 1085 | &sensor_dev_attr_temp##_X_##_max.dev_attr.attr, \ | 1176 | &sensor_dev_attr_temp##_X_##_max.dev_attr.attr, \ |
| 1086 | &sensor_dev_attr_temp##_X_##_max_hyst.dev_attr.attr, \ | 1177 | &sensor_dev_attr_temp##_X_##_max_hyst.dev_attr.attr, \ |
| 1087 | &sensor_dev_attr_temp##_X_##_type.dev_attr.attr | 1178 | &sensor_dev_attr_temp##_X_##_type.dev_attr.attr, \ |
| 1179 | &sensor_dev_attr_temp##_X_##_alarm.dev_attr.attr, \ | ||
| 1180 | &sensor_dev_attr_temp##_X_##_beep.dev_attr.attr | ||
| 1088 | 1181 | ||
| 1089 | static struct attribute *w83627hf_attributes[] = { | 1182 | static struct attribute *w83627hf_attributes[] = { |
| 1090 | &dev_attr_in0_input.attr, | 1183 | &dev_attr_in0_input.attr, |
| 1091 | &dev_attr_in0_min.attr, | 1184 | &dev_attr_in0_min.attr, |
| 1092 | &dev_attr_in0_max.attr, | 1185 | &dev_attr_in0_max.attr, |
| 1186 | &sensor_dev_attr_in0_alarm.dev_attr.attr, | ||
| 1187 | &sensor_dev_attr_in0_beep.dev_attr.attr, | ||
| 1093 | VIN_UNIT_ATTRS(2), | 1188 | VIN_UNIT_ATTRS(2), |
| 1094 | VIN_UNIT_ATTRS(3), | 1189 | VIN_UNIT_ATTRS(3), |
| 1095 | VIN_UNIT_ATTRS(4), | 1190 | VIN_UNIT_ATTRS(4), |
| @@ -1103,7 +1198,7 @@ static struct attribute *w83627hf_attributes[] = { | |||
| 1103 | TEMP_UNIT_ATTRS(2), | 1198 | TEMP_UNIT_ATTRS(2), |
| 1104 | 1199 | ||
| 1105 | &dev_attr_alarms.attr, | 1200 | &dev_attr_alarms.attr, |
| 1106 | &dev_attr_beep_enable.attr, | 1201 | &sensor_dev_attr_beep_enable.dev_attr.attr, |
| 1107 | &dev_attr_beep_mask.attr, | 1202 | &dev_attr_beep_mask.attr, |
| 1108 | 1203 | ||
| 1109 | &sensor_dev_attr_pwm1.dev_attr.attr, | 1204 | &sensor_dev_attr_pwm1.dev_attr.attr, |
| @@ -1193,12 +1288,20 @@ static int __devinit w83627hf_probe(struct platform_device *pdev) | |||
| 1193 | || (err = device_create_file(dev, | 1288 | || (err = device_create_file(dev, |
| 1194 | &sensor_dev_attr_in5_max.dev_attr)) | 1289 | &sensor_dev_attr_in5_max.dev_attr)) |
| 1195 | || (err = device_create_file(dev, | 1290 | || (err = device_create_file(dev, |
| 1291 | &sensor_dev_attr_in5_alarm.dev_attr)) | ||
| 1292 | || (err = device_create_file(dev, | ||
| 1293 | &sensor_dev_attr_in5_beep.dev_attr)) | ||
| 1294 | || (err = device_create_file(dev, | ||
| 1196 | &sensor_dev_attr_in6_input.dev_attr)) | 1295 | &sensor_dev_attr_in6_input.dev_attr)) |
| 1197 | || (err = device_create_file(dev, | 1296 | || (err = device_create_file(dev, |
| 1198 | &sensor_dev_attr_in6_min.dev_attr)) | 1297 | &sensor_dev_attr_in6_min.dev_attr)) |
| 1199 | || (err = device_create_file(dev, | 1298 | || (err = device_create_file(dev, |
| 1200 | &sensor_dev_attr_in6_max.dev_attr)) | 1299 | &sensor_dev_attr_in6_max.dev_attr)) |
| 1201 | || (err = device_create_file(dev, | 1300 | || (err = device_create_file(dev, |
| 1301 | &sensor_dev_attr_in6_alarm.dev_attr)) | ||
| 1302 | || (err = device_create_file(dev, | ||
| 1303 | &sensor_dev_attr_in6_beep.dev_attr)) | ||
| 1304 | || (err = device_create_file(dev, | ||
| 1202 | &sensor_dev_attr_pwm1_freq.dev_attr)) | 1305 | &sensor_dev_attr_pwm1_freq.dev_attr)) |
| 1203 | || (err = device_create_file(dev, | 1306 | || (err = device_create_file(dev, |
| 1204 | &sensor_dev_attr_pwm2_freq.dev_attr))) | 1307 | &sensor_dev_attr_pwm2_freq.dev_attr))) |
| @@ -1212,18 +1315,30 @@ static int __devinit w83627hf_probe(struct platform_device *pdev) | |||
| 1212 | || (err = device_create_file(dev, | 1315 | || (err = device_create_file(dev, |
| 1213 | &sensor_dev_attr_in1_max.dev_attr)) | 1316 | &sensor_dev_attr_in1_max.dev_attr)) |
| 1214 | || (err = device_create_file(dev, | 1317 | || (err = device_create_file(dev, |
| 1318 | &sensor_dev_attr_in1_alarm.dev_attr)) | ||
| 1319 | || (err = device_create_file(dev, | ||
| 1320 | &sensor_dev_attr_in1_beep.dev_attr)) | ||
| 1321 | || (err = device_create_file(dev, | ||
| 1215 | &sensor_dev_attr_fan3_input.dev_attr)) | 1322 | &sensor_dev_attr_fan3_input.dev_attr)) |
| 1216 | || (err = device_create_file(dev, | 1323 | || (err = device_create_file(dev, |
| 1217 | &sensor_dev_attr_fan3_min.dev_attr)) | 1324 | &sensor_dev_attr_fan3_min.dev_attr)) |
| 1218 | || (err = device_create_file(dev, | 1325 | || (err = device_create_file(dev, |
| 1219 | &sensor_dev_attr_fan3_div.dev_attr)) | 1326 | &sensor_dev_attr_fan3_div.dev_attr)) |
| 1220 | || (err = device_create_file(dev, | 1327 | || (err = device_create_file(dev, |
| 1328 | &sensor_dev_attr_fan3_alarm.dev_attr)) | ||
| 1329 | || (err = device_create_file(dev, | ||
| 1330 | &sensor_dev_attr_fan3_beep.dev_attr)) | ||
| 1331 | || (err = device_create_file(dev, | ||
| 1221 | &sensor_dev_attr_temp3_input.dev_attr)) | 1332 | &sensor_dev_attr_temp3_input.dev_attr)) |
| 1222 | || (err = device_create_file(dev, | 1333 | || (err = device_create_file(dev, |
| 1223 | &sensor_dev_attr_temp3_max.dev_attr)) | 1334 | &sensor_dev_attr_temp3_max.dev_attr)) |
| 1224 | || (err = device_create_file(dev, | 1335 | || (err = device_create_file(dev, |
| 1225 | &sensor_dev_attr_temp3_max_hyst.dev_attr)) | 1336 | &sensor_dev_attr_temp3_max_hyst.dev_attr)) |
| 1226 | || (err = device_create_file(dev, | 1337 | || (err = device_create_file(dev, |
| 1338 | &sensor_dev_attr_temp3_alarm.dev_attr)) | ||
| 1339 | || (err = device_create_file(dev, | ||
| 1340 | &sensor_dev_attr_temp3_beep.dev_attr)) | ||
| 1341 | || (err = device_create_file(dev, | ||
| 1227 | &sensor_dev_attr_temp3_type.dev_attr))) | 1342 | &sensor_dev_attr_temp3_type.dev_attr))) |
| 1228 | goto ERROR4; | 1343 | goto ERROR4; |
| 1229 | 1344 | ||
| @@ -1511,6 +1626,11 @@ static void __devinit w83627hf_init_device(struct platform_device *pdev) | |||
| 1511 | (w83627hf_read_value(data, | 1626 | (w83627hf_read_value(data, |
| 1512 | W83781D_REG_CONFIG) & 0xf7) | 1627 | W83781D_REG_CONFIG) & 0xf7) |
| 1513 | | 0x01); | 1628 | | 0x01); |
| 1629 | |||
| 1630 | /* Enable VBAT monitoring if needed */ | ||
| 1631 | tmp = w83627hf_read_value(data, W83781D_REG_VBAT); | ||
| 1632 | if (!(tmp & 0x01)) | ||
| 1633 | w83627hf_write_value(data, W83781D_REG_VBAT, tmp | 0x01); | ||
| 1514 | } | 1634 | } |
| 1515 | 1635 | ||
| 1516 | static void w83627hf_update_fan_div(struct w83627hf_data *data) | 1636 | static void w83627hf_update_fan_div(struct w83627hf_data *data) |
| @@ -1603,8 +1723,7 @@ static struct w83627hf_data *w83627hf_update_device(struct device *dev) | |||
| 1603 | (w83627hf_read_value(data, W83781D_REG_ALARM2) << 8) | | 1723 | (w83627hf_read_value(data, W83781D_REG_ALARM2) << 8) | |
| 1604 | (w83627hf_read_value(data, W83781D_REG_ALARM3) << 16); | 1724 | (w83627hf_read_value(data, W83781D_REG_ALARM3) << 16); |
| 1605 | i = w83627hf_read_value(data, W83781D_REG_BEEP_INTS2); | 1725 | i = w83627hf_read_value(data, W83781D_REG_BEEP_INTS2); |
| 1606 | data->beep_enable = i >> 7; | 1726 | data->beep_mask = (i << 8) | |
| 1607 | data->beep_mask = ((i & 0x7f) << 8) | | ||
| 1608 | w83627hf_read_value(data, W83781D_REG_BEEP_INTS1) | | 1727 | w83627hf_read_value(data, W83781D_REG_BEEP_INTS1) | |
| 1609 | w83627hf_read_value(data, W83781D_REG_BEEP_INTS3) << 16; | 1728 | w83627hf_read_value(data, W83781D_REG_BEEP_INTS3) << 16; |
| 1610 | data->last_updated = jiffies; | 1729 | data->last_updated = jiffies; |
diff --git a/drivers/hwmon/w83781d.c b/drivers/hwmon/w83781d.c index e0fa7520400d..7421f6ea53e1 100644 --- a/drivers/hwmon/w83781d.c +++ b/drivers/hwmon/w83781d.c | |||
| @@ -28,7 +28,6 @@ | |||
| 28 | as99127f 7 3 0 3 0x31 0x12c3 yes no | 28 | as99127f 7 3 0 3 0x31 0x12c3 yes no |
| 29 | as99127f rev.2 (type_name = as99127f) 0x31 0x5ca3 yes no | 29 | as99127f rev.2 (type_name = as99127f) 0x31 0x5ca3 yes no |
| 30 | w83781d 7 3 0 3 0x10-1 0x5ca3 yes yes | 30 | w83781d 7 3 0 3 0x10-1 0x5ca3 yes yes |
| 31 | w83627hf 9 3 2 3 0x21 0x5ca3 yes yes(LPC) | ||
| 32 | w83782d 9 3 2-4 3 0x30 0x5ca3 yes yes | 31 | w83782d 9 3 2-4 3 0x30 0x5ca3 yes yes |
| 33 | w83783s 5-6 3 2 1-2 0x40 0x5ca3 yes no | 32 | w83783s 5-6 3 2 1-2 0x40 0x5ca3 yes no |
| 34 | 33 | ||
| @@ -54,13 +53,12 @@ | |||
| 54 | static struct platform_device *pdev; | 53 | static struct platform_device *pdev; |
| 55 | 54 | ||
| 56 | /* Addresses to scan */ | 55 | /* Addresses to scan */ |
| 57 | static unsigned short normal_i2c[] = { 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, | 56 | static unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, |
| 58 | 0x26, 0x27, 0x28, 0x29, 0x2a, 0x2b, | 57 | 0x2e, 0x2f, I2C_CLIENT_END }; |
| 59 | 0x2c, 0x2d, 0x2e, 0x2f, I2C_CLIENT_END }; | ||
| 60 | static unsigned short isa_address = 0x290; | 58 | static unsigned short isa_address = 0x290; |
| 61 | 59 | ||
| 62 | /* Insmod parameters */ | 60 | /* Insmod parameters */ |
| 63 | I2C_CLIENT_INSMOD_5(w83781d, w83782d, w83783s, w83627hf, as99127f); | 61 | I2C_CLIENT_INSMOD_4(w83781d, w83782d, w83783s, as99127f); |
| 64 | I2C_CLIENT_MODULE_PARM(force_subclients, "List of subclient addresses: " | 62 | I2C_CLIENT_MODULE_PARM(force_subclients, "List of subclient addresses: " |
| 65 | "{bus, clientaddr, subclientaddr1, subclientaddr2}"); | 63 | "{bus, clientaddr, subclientaddr1, subclientaddr2}"); |
| 66 | 64 | ||
| @@ -114,7 +112,7 @@ MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization"); | |||
| 114 | #define W83781D_REG_ALARM1 0x41 | 112 | #define W83781D_REG_ALARM1 0x41 |
| 115 | #define W83781D_REG_ALARM2 0x42 | 113 | #define W83781D_REG_ALARM2 0x42 |
| 116 | 114 | ||
| 117 | /* Real-time status (W83782D, W83783S, W83627HF) */ | 115 | /* Real-time status (W83782D, W83783S) */ |
| 118 | #define W83782D_REG_ALARM1 0x459 | 116 | #define W83782D_REG_ALARM1 0x459 |
| 119 | #define W83782D_REG_ALARM2 0x45A | 117 | #define W83782D_REG_ALARM2 0x45A |
| 120 | #define W83782D_REG_ALARM3 0x45B | 118 | #define W83782D_REG_ALARM3 0x45B |
| @@ -153,10 +151,6 @@ static const u8 BIT_SCFG2[] = { 0x10, 0x20, 0x40 }; | |||
| 153 | 151 | ||
| 154 | #define W83781D_DEFAULT_BETA 3435 | 152 | #define W83781D_DEFAULT_BETA 3435 |
| 155 | 153 | ||
| 156 | /* RT Table registers */ | ||
| 157 | #define W83781D_REG_RT_IDX 0x50 | ||
| 158 | #define W83781D_REG_RT_VAL 0x51 | ||
| 159 | |||
| 160 | /* Conversions */ | 154 | /* Conversions */ |
| 161 | #define IN_TO_REG(val) SENSORS_LIMIT(((val) + 8) / 16, 0, 255) | 155 | #define IN_TO_REG(val) SENSORS_LIMIT(((val) + 8) / 16, 0, 255) |
| 162 | #define IN_FROM_REG(val) ((val) * 16) | 156 | #define IN_FROM_REG(val) ((val) * 16) |
| @@ -271,7 +265,6 @@ static struct i2c_driver w83781d_driver = { | |||
| 271 | .driver = { | 265 | .driver = { |
| 272 | .name = "w83781d", | 266 | .name = "w83781d", |
| 273 | }, | 267 | }, |
| 274 | .id = I2C_DRIVERID_W83781D, | ||
| 275 | .attach_adapter = w83781d_attach_adapter, | 268 | .attach_adapter = w83781d_attach_adapter, |
| 276 | .detach_client = w83781d_detach_client, | 269 | .detach_client = w83781d_detach_client, |
| 277 | }; | 270 | }; |
| @@ -696,7 +689,7 @@ store_fan_div(struct device *dev, struct device_attribute *da, | |||
| 696 | unsigned long val = simple_strtoul(buf, NULL, 10); | 689 | unsigned long val = simple_strtoul(buf, NULL, 10); |
| 697 | 690 | ||
| 698 | mutex_lock(&data->update_lock); | 691 | mutex_lock(&data->update_lock); |
| 699 | 692 | ||
| 700 | /* Save fan_min */ | 693 | /* Save fan_min */ |
| 701 | min = FAN_FROM_REG(data->fan_min[nr], | 694 | min = FAN_FROM_REG(data->fan_min[nr], |
| 702 | DIV_FROM_REG(data->fan_div[nr])); | 695 | DIV_FROM_REG(data->fan_div[nr])); |
| @@ -963,8 +956,6 @@ w83781d_detect_subclients(struct i2c_adapter *adapter, int address, int kind, | |||
| 963 | client_name = "w83782d subclient"; | 956 | client_name = "w83782d subclient"; |
| 964 | else if (kind == w83783s) | 957 | else if (kind == w83783s) |
| 965 | client_name = "w83783s subclient"; | 958 | client_name = "w83783s subclient"; |
| 966 | else if (kind == w83627hf) | ||
| 967 | client_name = "w83627hf subclient"; | ||
| 968 | else if (kind == as99127f) | 959 | else if (kind == as99127f) |
| 969 | client_name = "as99127f subclient"; | 960 | client_name = "as99127f subclient"; |
| 970 | 961 | ||
| @@ -1004,7 +995,7 @@ ERROR_SC_0: | |||
| 1004 | #define IN_UNIT_ATTRS(X) \ | 995 | #define IN_UNIT_ATTRS(X) \ |
| 1005 | &sensor_dev_attr_in##X##_input.dev_attr.attr, \ | 996 | &sensor_dev_attr_in##X##_input.dev_attr.attr, \ |
| 1006 | &sensor_dev_attr_in##X##_min.dev_attr.attr, \ | 997 | &sensor_dev_attr_in##X##_min.dev_attr.attr, \ |
| 1007 | &sensor_dev_attr_in##X##_max.dev_attr.attr, \ | 998 | &sensor_dev_attr_in##X##_max.dev_attr.attr, \ |
| 1008 | &sensor_dev_attr_in##X##_alarm.dev_attr.attr, \ | 999 | &sensor_dev_attr_in##X##_alarm.dev_attr.attr, \ |
| 1009 | &sensor_dev_attr_in##X##_beep.dev_attr.attr | 1000 | &sensor_dev_attr_in##X##_beep.dev_attr.attr |
| 1010 | 1001 | ||
| @@ -1268,9 +1259,7 @@ w83781d_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 1268 | kind = w83782d; | 1259 | kind = w83782d; |
| 1269 | else if (val1 == 0x40 && vendid == winbond && address == 0x2d) | 1260 | else if (val1 == 0x40 && vendid == winbond && address == 0x2d) |
| 1270 | kind = w83783s; | 1261 | kind = w83783s; |
| 1271 | else if (val1 == 0x21 && vendid == winbond) | 1262 | else if (val1 == 0x31) |
| 1272 | kind = w83627hf; | ||
| 1273 | else if (val1 == 0x31 && address >= 0x28) | ||
| 1274 | kind = as99127f; | 1263 | kind = as99127f; |
| 1275 | else { | 1264 | else { |
| 1276 | if (kind == 0) | 1265 | if (kind == 0) |
| @@ -1288,8 +1277,6 @@ w83781d_detect(struct i2c_adapter *adapter, int address, int kind) | |||
| 1288 | client_name = "w83782d"; | 1277 | client_name = "w83782d"; |
| 1289 | } else if (kind == w83783s) { | 1278 | } else if (kind == w83783s) { |
| 1290 | client_name = "w83783s"; | 1279 | client_name = "w83783s"; |
| 1291 | } else if (kind == w83627hf) { | ||
| 1292 | client_name = "w83627hf"; | ||
| 1293 | } else if (kind == as99127f) { | 1280 | } else if (kind == as99127f) { |
| 1294 | client_name = "as99127f"; | 1281 | client_name = "as99127f"; |
| 1295 | } | 1282 | } |
| @@ -1396,10 +1383,6 @@ w83781d_isa_probe(struct platform_device *pdev) | |||
| 1396 | 1383 | ||
| 1397 | reg = w83781d_read_value(data, W83781D_REG_WCHIPID); | 1384 | reg = w83781d_read_value(data, W83781D_REG_WCHIPID); |
| 1398 | switch (reg) { | 1385 | switch (reg) { |
| 1399 | case 0x21: | ||
| 1400 | data->type = w83627hf; | ||
| 1401 | name = "w83627hf"; | ||
| 1402 | break; | ||
| 1403 | case 0x30: | 1386 | case 0x30: |
| 1404 | data->type = w83782d; | 1387 | data->type = w83782d; |
| 1405 | name = "w83782d"; | 1388 | name = "w83782d"; |
| @@ -1453,9 +1436,9 @@ w83781d_isa_remove(struct platform_device *pdev) | |||
| 1453 | } | 1436 | } |
| 1454 | 1437 | ||
| 1455 | /* The SMBus locks itself, usually, but nothing may access the Winbond between | 1438 | /* The SMBus locks itself, usually, but nothing may access the Winbond between |
| 1456 | bank switches. ISA access must always be locked explicitly! | 1439 | bank switches. ISA access must always be locked explicitly! |
| 1457 | We ignore the W83781D BUSY flag at this moment - it could lead to deadlocks, | 1440 | We ignore the W83781D BUSY flag at this moment - it could lead to deadlocks, |
| 1458 | would slow down the W83781D access and should not be necessary. | 1441 | would slow down the W83781D access and should not be necessary. |
| 1459 | There are some ugly typecasts here, but the good news is - they should | 1442 | There are some ugly typecasts here, but the good news is - they should |
| 1460 | nowhere else be necessary! */ | 1443 | nowhere else be necessary! */ |
| 1461 | static int | 1444 | static int |
| @@ -1599,11 +1582,6 @@ w83781d_init_device(struct device *dev) | |||
| 1599 | int type = data->type; | 1582 | int type = data->type; |
| 1600 | u8 tmp; | 1583 | u8 tmp; |
| 1601 | 1584 | ||
| 1602 | if (type == w83627hf) | ||
| 1603 | dev_info(dev, "The W83627HF chip is better supported by the " | ||
| 1604 | "w83627hf driver, support will be dropped from the " | ||
| 1605 | "w83781d driver soon\n"); | ||
| 1606 | |||
| 1607 | if (reset && type != as99127f) { /* this resets registers we don't have | 1585 | if (reset && type != as99127f) { /* this resets registers we don't have |
| 1608 | documentation for on the as99127f */ | 1586 | documentation for on the as99127f */ |
| 1609 | /* Resetting the chip has been the default for a long time, | 1587 | /* Resetting the chip has been the default for a long time, |
| @@ -1717,8 +1695,7 @@ static struct w83781d_data *w83781d_update_device(struct device *dev) | |||
| 1717 | w83781d_read_value(data, W83781D_REG_IN_MIN(i)); | 1695 | w83781d_read_value(data, W83781D_REG_IN_MIN(i)); |
| 1718 | data->in_max[i] = | 1696 | data->in_max[i] = |
| 1719 | w83781d_read_value(data, W83781D_REG_IN_MAX(i)); | 1697 | w83781d_read_value(data, W83781D_REG_IN_MAX(i)); |
| 1720 | if ((data->type != w83782d) | 1698 | if ((data->type != w83782d) && (i == 6)) |
| 1721 | && (data->type != w83627hf) && (i == 6)) | ||
| 1722 | break; | 1699 | break; |
| 1723 | } | 1700 | } |
| 1724 | for (i = 0; i < 3; i++) { | 1701 | for (i = 0; i < 3; i++) { |
| @@ -1776,7 +1753,7 @@ static struct w83781d_data *w83781d_update_device(struct device *dev) | |||
| 1776 | data->fan_div[1] |= (i >> 4) & 0x04; | 1753 | data->fan_div[1] |= (i >> 4) & 0x04; |
| 1777 | data->fan_div[2] |= (i >> 5) & 0x04; | 1754 | data->fan_div[2] |= (i >> 5) & 0x04; |
| 1778 | } | 1755 | } |
| 1779 | if ((data->type == w83782d) || (data->type == w83627hf)) { | 1756 | if (data->type == w83782d) { |
| 1780 | data->alarms = w83781d_read_value(data, | 1757 | data->alarms = w83781d_read_value(data, |
| 1781 | W83782D_REG_ALARM1) | 1758 | W83782D_REG_ALARM1) |
| 1782 | | (w83781d_read_value(data, | 1759 | | (w83781d_read_value(data, |
| @@ -1886,13 +1863,11 @@ w83781d_isa_found(unsigned short address) | |||
| 1886 | outb_p(W83781D_REG_WCHIPID, address + W83781D_ADDR_REG_OFFSET); | 1863 | outb_p(W83781D_REG_WCHIPID, address + W83781D_ADDR_REG_OFFSET); |
| 1887 | val = inb_p(address + W83781D_DATA_REG_OFFSET); | 1864 | val = inb_p(address + W83781D_DATA_REG_OFFSET); |
| 1888 | if ((val & 0xfe) == 0x10 /* W83781D */ | 1865 | if ((val & 0xfe) == 0x10 /* W83781D */ |
| 1889 | || val == 0x30 /* W83782D */ | 1866 | || val == 0x30) /* W83782D */ |
| 1890 | || val == 0x21) /* W83627HF */ | ||
| 1891 | found = 1; | 1867 | found = 1; |
| 1892 | 1868 | ||
| 1893 | if (found) | 1869 | if (found) |
| 1894 | pr_info("w83781d: Found a %s chip at %#x\n", | 1870 | pr_info("w83781d: Found a %s chip at %#x\n", |
| 1895 | val == 0x21 ? "W83627HF" : | ||
| 1896 | val == 0x30 ? "W83782D" : "W83781D", (int)address); | 1871 | val == 0x30 ? "W83782D" : "W83781D", (int)address); |
| 1897 | 1872 | ||
| 1898 | release: | 1873 | release: |
diff --git a/drivers/hwmon/w83791d.c b/drivers/hwmon/w83791d.c index a9c01a6f0057..85bd21ee3298 100644 --- a/drivers/hwmon/w83791d.c +++ b/drivers/hwmon/w83791d.c | |||
| @@ -840,14 +840,12 @@ static ssize_t store_vrm_reg(struct device *dev, | |||
| 840 | struct device_attribute *attr, | 840 | struct device_attribute *attr, |
| 841 | const char *buf, size_t count) | 841 | const char *buf, size_t count) |
| 842 | { | 842 | { |
| 843 | struct i2c_client *client = to_i2c_client(dev); | 843 | struct w83791d_data *data = dev_get_drvdata(dev); |
| 844 | struct w83791d_data *data = i2c_get_clientdata(client); | ||
| 845 | unsigned long val = simple_strtoul(buf, NULL, 10); | ||
| 846 | 844 | ||
| 847 | /* No lock needed as vrm is internal to the driver | 845 | /* No lock needed as vrm is internal to the driver |
| 848 | (not read from a chip register) and so is not | 846 | (not read from a chip register) and so is not |
| 849 | updated in w83791d_update_device() */ | 847 | updated in w83791d_update_device() */ |
| 850 | data->vrm = val; | 848 | data->vrm = simple_strtoul(buf, NULL, 10); |
| 851 | 849 | ||
| 852 | return count; | 850 | return count; |
| 853 | } | 851 | } |
diff --git a/drivers/hwmon/w83793.c b/drivers/hwmon/w83793.c index 48599e1cc554..3ba1d6b33473 100644 --- a/drivers/hwmon/w83793.c +++ b/drivers/hwmon/w83793.c | |||
| @@ -131,6 +131,7 @@ static u8 scale_in_add[] = { 0, 0, 0, 0, 0, 0, 0, 150, 150, 0 }; | |||
| 131 | #define PWM_DUTY 0 | 131 | #define PWM_DUTY 0 |
| 132 | #define PWM_START 1 | 132 | #define PWM_START 1 |
| 133 | #define PWM_NONSTOP 2 | 133 | #define PWM_NONSTOP 2 |
| 134 | #define PWM_STOP_TIME 3 | ||
| 134 | #define W83793_REG_PWM(index, nr) (((nr) == 0 ? 0xb3 : \ | 135 | #define W83793_REG_PWM(index, nr) (((nr) == 0 ? 0xb3 : \ |
| 135 | (nr) == 1 ? 0x220 : 0x218) + (index)) | 136 | (nr) == 1 ? 0x220 : 0x218) + (index)) |
| 136 | 137 | ||
| @@ -242,9 +243,7 @@ static struct i2c_driver w83793_driver = { | |||
| 242 | static ssize_t | 243 | static ssize_t |
| 243 | show_vrm(struct device *dev, struct device_attribute *attr, char *buf) | 244 | show_vrm(struct device *dev, struct device_attribute *attr, char *buf) |
| 244 | { | 245 | { |
| 245 | struct i2c_client *client = to_i2c_client(dev); | 246 | struct w83793_data *data = dev_get_drvdata(dev); |
| 246 | struct w83793_data *data = i2c_get_clientdata(client); | ||
| 247 | |||
| 248 | return sprintf(buf, "%d\n", data->vrm); | 247 | return sprintf(buf, "%d\n", data->vrm); |
| 249 | } | 248 | } |
| 250 | 249 | ||
| @@ -263,9 +262,7 @@ static ssize_t | |||
| 263 | store_vrm(struct device *dev, struct device_attribute *attr, | 262 | store_vrm(struct device *dev, struct device_attribute *attr, |
| 264 | const char *buf, size_t count) | 263 | const char *buf, size_t count) |
| 265 | { | 264 | { |
| 266 | struct i2c_client *client = to_i2c_client(dev); | 265 | struct w83793_data *data = dev_get_drvdata(dev); |
| 267 | struct w83793_data *data = i2c_get_clientdata(client); | ||
| 268 | |||
| 269 | data->vrm = simple_strtoul(buf, NULL, 10); | 266 | data->vrm = simple_strtoul(buf, NULL, 10); |
| 270 | return count; | 267 | return count; |
| 271 | } | 268 | } |
| @@ -407,10 +404,6 @@ store_fan_min(struct device *dev, struct device_attribute *attr, | |||
| 407 | return count; | 404 | return count; |
| 408 | } | 405 | } |
| 409 | 406 | ||
| 410 | #define PWM_DUTY 0 | ||
| 411 | #define PWM_START 1 | ||
| 412 | #define PWM_NONSTOP 2 | ||
| 413 | #define PWM_STOP_TIME 3 | ||
| 414 | static ssize_t | 407 | static ssize_t |
| 415 | show_pwm(struct device *dev, struct device_attribute *attr, char *buf) | 408 | show_pwm(struct device *dev, struct device_attribute *attr, char *buf) |
| 416 | { | 409 | { |
diff --git a/drivers/hwmon/w83l785ts.c b/drivers/hwmon/w83l785ts.c index b5db354e2f19..1d6259d29e74 100644 --- a/drivers/hwmon/w83l785ts.c +++ b/drivers/hwmon/w83l785ts.c | |||
| @@ -96,7 +96,6 @@ static struct i2c_driver w83l785ts_driver = { | |||
| 96 | .driver = { | 96 | .driver = { |
| 97 | .name = "w83l785ts", | 97 | .name = "w83l785ts", |
| 98 | }, | 98 | }, |
| 99 | .id = I2C_DRIVERID_W83L785TS, | ||
| 100 | .attach_adapter = w83l785ts_attach_adapter, | 99 | .attach_adapter = w83l785ts_attach_adapter, |
| 101 | .detach_client = w83l785ts_detach_client, | 100 | .detach_client = w83l785ts_detach_client, |
| 102 | }; | 101 | }; |
diff --git a/drivers/hwmon/w83l786ng.c b/drivers/hwmon/w83l786ng.c new file mode 100644 index 000000000000..1dbee4fa23ad --- /dev/null +++ b/drivers/hwmon/w83l786ng.c | |||
| @@ -0,0 +1,821 @@ | |||
| 1 | /* | ||
| 2 | w83l786ng.c - Linux kernel driver for hardware monitoring | ||
| 3 | Copyright (c) 2007 Kevin Lo <kevlo@kevlo.org> | ||
| 4 | |||
| 5 | This program is free software; you can redistribute it and/or modify | ||
| 6 | it under the terms of the GNU General Public License as published by | ||
| 7 | the Free Software Foundation - version 2. | ||
| 8 | |||
| 9 | This program is distributed in the hope that it will be useful, | ||
| 10 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 11 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 12 | GNU General Public License 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 | ||
| 16 | Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
| 17 | 02110-1301 USA. | ||
| 18 | */ | ||
| 19 | |||
| 20 | /* | ||
| 21 | Supports following chips: | ||
| 22 | |||
| 23 | Chip #vin #fanin #pwm #temp wchipid vendid i2c ISA | ||
| 24 | w83l786ng 3 2 2 2 0x7b 0x5ca3 yes no | ||
| 25 | */ | ||
| 26 | |||
| 27 | #include <linux/module.h> | ||
| 28 | #include <linux/init.h> | ||
| 29 | #include <linux/slab.h> | ||
| 30 | #include <linux/i2c.h> | ||
| 31 | #include <linux/hwmon.h> | ||
| 32 | #include <linux/hwmon-vid.h> | ||
| 33 | #include <linux/hwmon-sysfs.h> | ||
| 34 | #include <linux/err.h> | ||
| 35 | #include <linux/mutex.h> | ||
| 36 | |||
| 37 | /* Addresses to scan */ | ||
| 38 | static unsigned short normal_i2c[] = { 0x2e, 0x2f, I2C_CLIENT_END }; | ||
| 39 | |||
| 40 | /* Insmod parameters */ | ||
| 41 | I2C_CLIENT_INSMOD_1(w83l786ng); | ||
| 42 | |||
| 43 | static int reset; | ||
| 44 | module_param(reset, bool, 0); | ||
| 45 | MODULE_PARM_DESC(reset, "Set to 1 to reset chip, not recommended"); | ||
| 46 | |||
| 47 | #define W83L786NG_REG_IN_MIN(nr) (0x2C + (nr) * 2) | ||
| 48 | #define W83L786NG_REG_IN_MAX(nr) (0x2B + (nr) * 2) | ||
| 49 | #define W83L786NG_REG_IN(nr) ((nr) + 0x20) | ||
| 50 | |||
| 51 | #define W83L786NG_REG_FAN(nr) ((nr) + 0x28) | ||
| 52 | #define W83L786NG_REG_FAN_MIN(nr) ((nr) + 0x3B) | ||
| 53 | |||
| 54 | #define W83L786NG_REG_CONFIG 0x40 | ||
| 55 | #define W83L786NG_REG_ALARM1 0x41 | ||
| 56 | #define W83L786NG_REG_ALARM2 0x42 | ||
| 57 | #define W83L786NG_REG_GPIO_EN 0x47 | ||
| 58 | #define W83L786NG_REG_MAN_ID2 0x4C | ||
| 59 | #define W83L786NG_REG_MAN_ID1 0x4D | ||
| 60 | #define W83L786NG_REG_CHIP_ID 0x4E | ||
| 61 | |||
| 62 | #define W83L786NG_REG_DIODE 0x53 | ||
| 63 | #define W83L786NG_REG_FAN_DIV 0x54 | ||
| 64 | #define W83L786NG_REG_FAN_CFG 0x80 | ||
| 65 | |||
| 66 | #define W83L786NG_REG_TOLERANCE 0x8D | ||
| 67 | |||
| 68 | static const u8 W83L786NG_REG_TEMP[2][3] = { | ||
| 69 | { 0x25, /* TEMP 0 in DataSheet */ | ||
| 70 | 0x35, /* TEMP 0 Over in DataSheet */ | ||
| 71 | 0x36 }, /* TEMP 0 Hyst in DataSheet */ | ||
| 72 | { 0x26, /* TEMP 1 in DataSheet */ | ||
| 73 | 0x37, /* TEMP 1 Over in DataSheet */ | ||
| 74 | 0x38 } /* TEMP 1 Hyst in DataSheet */ | ||
| 75 | }; | ||
| 76 | |||
| 77 | static const u8 W83L786NG_PWM_MODE_SHIFT[] = {6, 7}; | ||
| 78 | static const u8 W83L786NG_PWM_ENABLE_SHIFT[] = {2, 4}; | ||
| 79 | |||
| 80 | /* FAN Duty Cycle, be used to control */ | ||
| 81 | static const u8 W83L786NG_REG_PWM[] = {0x81, 0x87}; | ||
| 82 | |||
| 83 | |||
| 84 | static inline u8 | ||
| 85 | FAN_TO_REG(long rpm, int div) | ||
| 86 | { | ||
| 87 | if (rpm == 0) | ||
| 88 | return 255; | ||
| 89 | rpm = SENSORS_LIMIT(rpm, 1, 1000000); | ||
| 90 | return SENSORS_LIMIT((1350000 + rpm * div / 2) / (rpm * div), 1, 254); | ||
| 91 | } | ||
| 92 | |||
| 93 | #define FAN_FROM_REG(val,div) ((val) == 0 ? -1 : \ | ||
| 94 | ((val) == 255 ? 0 : \ | ||
| 95 | 1350000 / ((val) * (div)))) | ||
| 96 | |||
| 97 | /* for temp */ | ||
| 98 | #define TEMP_TO_REG(val) (SENSORS_LIMIT(((val) < 0 ? (val)+0x100*1000 \ | ||
| 99 | : (val)) / 1000, 0, 0xff)) | ||
| 100 | #define TEMP_FROM_REG(val) (((val) & 0x80 ? (val)-0x100 : (val)) * 1000) | ||
| 101 | |||
| 102 | /* The analog voltage inputs have 8mV LSB. Since the sysfs output is | ||
| 103 | in mV as would be measured on the chip input pin, need to just | ||
| 104 | multiply/divide by 8 to translate from/to register values. */ | ||
| 105 | #define IN_TO_REG(val) (SENSORS_LIMIT((((val) + 4) / 8), 0, 255)) | ||
| 106 | #define IN_FROM_REG(val) ((val) * 8) | ||
| 107 | |||
| 108 | #define DIV_FROM_REG(val) (1 << (val)) | ||
| 109 | |||
| 110 | static inline u8 | ||
| 111 | DIV_TO_REG(long val) | ||
| 112 | { | ||
| 113 | int i; | ||
| 114 | val = SENSORS_LIMIT(val, 1, 128) >> 1; | ||
| 115 | for (i = 0; i < 7; i++) { | ||
| 116 | if (val == 0) | ||
| 117 | break; | ||
| 118 | val >>= 1; | ||
| 119 | } | ||
| 120 | return ((u8) i); | ||
| 121 | } | ||
| 122 | |||
| 123 | struct w83l786ng_data { | ||
| 124 | struct i2c_client client; | ||
| 125 | struct device *hwmon_dev; | ||
| 126 | struct mutex update_lock; | ||
| 127 | char valid; /* !=0 if following fields are valid */ | ||
| 128 | unsigned long last_updated; /* In jiffies */ | ||
| 129 | unsigned long last_nonvolatile; /* In jiffies, last time we update the | ||
| 130 | nonvolatile registers */ | ||
| 131 | |||
| 132 | u8 in[3]; | ||
| 133 | u8 in_max[3]; | ||
| 134 | u8 in_min[3]; | ||
| 135 | u8 fan[2]; | ||
| 136 | u8 fan_div[2]; | ||
| 137 | u8 fan_min[2]; | ||
| 138 | u8 temp_type[2]; | ||
| 139 | u8 temp[2][3]; | ||
| 140 | u8 pwm[2]; | ||
| 141 | u8 pwm_mode[2]; /* 0->DC variable voltage | ||
| 142 | 1->PWM variable duty cycle */ | ||
| 143 | |||
| 144 | u8 pwm_enable[2]; /* 1->manual | ||
| 145 | 2->thermal cruise (also called SmartFan I) */ | ||
| 146 | u8 tolerance[2]; | ||
| 147 | }; | ||
| 148 | |||
| 149 | static int w83l786ng_attach_adapter(struct i2c_adapter *adapter); | ||
| 150 | static int w83l786ng_detect(struct i2c_adapter *adapter, int address, int kind); | ||
| 151 | static int w83l786ng_detach_client(struct i2c_client *client); | ||
| 152 | static void w83l786ng_init_client(struct i2c_client *client); | ||
| 153 | static struct w83l786ng_data *w83l786ng_update_device(struct device *dev); | ||
| 154 | |||
| 155 | static struct i2c_driver w83l786ng_driver = { | ||
| 156 | .driver = { | ||
| 157 | .name = "w83l786ng", | ||
| 158 | }, | ||
| 159 | .attach_adapter = w83l786ng_attach_adapter, | ||
| 160 | .detach_client = w83l786ng_detach_client, | ||
| 161 | }; | ||
| 162 | |||
| 163 | static u8 | ||
| 164 | w83l786ng_read_value(struct i2c_client *client, u8 reg) | ||
| 165 | { | ||
| 166 | return i2c_smbus_read_byte_data(client, reg); | ||
| 167 | } | ||
| 168 | |||
| 169 | static int | ||
| 170 | w83l786ng_write_value(struct i2c_client *client, u8 reg, u8 value) | ||
| 171 | { | ||
| 172 | return i2c_smbus_write_byte_data(client, reg, value); | ||
| 173 | } | ||
| 174 | |||
| 175 | /* following are the sysfs callback functions */ | ||
| 176 | #define show_in_reg(reg) \ | ||
| 177 | static ssize_t \ | ||
| 178 | show_##reg(struct device *dev, struct device_attribute *attr, \ | ||
| 179 | char *buf) \ | ||
| 180 | { \ | ||
| 181 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 182 | struct w83l786ng_data *data = w83l786ng_update_device(dev); \ | ||
| 183 | return sprintf(buf,"%d\n", IN_FROM_REG(data->reg[nr])); \ | ||
| 184 | } | ||
| 185 | |||
| 186 | show_in_reg(in) | ||
| 187 | show_in_reg(in_min) | ||
| 188 | show_in_reg(in_max) | ||
| 189 | |||
| 190 | #define store_in_reg(REG, reg) \ | ||
| 191 | static ssize_t \ | ||
| 192 | store_in_##reg (struct device *dev, struct device_attribute *attr, \ | ||
| 193 | const char *buf, size_t count) \ | ||
| 194 | { \ | ||
| 195 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 196 | struct i2c_client *client = to_i2c_client(dev); \ | ||
| 197 | struct w83l786ng_data *data = i2c_get_clientdata(client); \ | ||
| 198 | unsigned long val = simple_strtoul(buf, NULL, 10); \ | ||
| 199 | mutex_lock(&data->update_lock); \ | ||
| 200 | data->in_##reg[nr] = IN_TO_REG(val); \ | ||
| 201 | w83l786ng_write_value(client, W83L786NG_REG_IN_##REG(nr), \ | ||
| 202 | data->in_##reg[nr]); \ | ||
| 203 | mutex_unlock(&data->update_lock); \ | ||
| 204 | return count; \ | ||
| 205 | } | ||
| 206 | |||
| 207 | store_in_reg(MIN, min) | ||
| 208 | store_in_reg(MAX, max) | ||
| 209 | |||
| 210 | static struct sensor_device_attribute sda_in_input[] = { | ||
| 211 | SENSOR_ATTR(in0_input, S_IRUGO, show_in, NULL, 0), | ||
| 212 | SENSOR_ATTR(in1_input, S_IRUGO, show_in, NULL, 1), | ||
| 213 | SENSOR_ATTR(in2_input, S_IRUGO, show_in, NULL, 2), | ||
| 214 | }; | ||
| 215 | |||
| 216 | static struct sensor_device_attribute sda_in_min[] = { | ||
| 217 | SENSOR_ATTR(in0_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 0), | ||
| 218 | SENSOR_ATTR(in1_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 1), | ||
| 219 | SENSOR_ATTR(in2_min, S_IWUSR | S_IRUGO, show_in_min, store_in_min, 2), | ||
| 220 | }; | ||
| 221 | |||
| 222 | static struct sensor_device_attribute sda_in_max[] = { | ||
| 223 | SENSOR_ATTR(in0_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 0), | ||
| 224 | SENSOR_ATTR(in1_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 1), | ||
| 225 | SENSOR_ATTR(in2_max, S_IWUSR | S_IRUGO, show_in_max, store_in_max, 2), | ||
| 226 | }; | ||
| 227 | |||
| 228 | #define show_fan_reg(reg) \ | ||
| 229 | static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \ | ||
| 230 | char *buf) \ | ||
| 231 | { \ | ||
| 232 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 233 | struct w83l786ng_data *data = w83l786ng_update_device(dev); \ | ||
| 234 | return sprintf(buf,"%d\n", \ | ||
| 235 | FAN_FROM_REG(data->fan[nr], DIV_FROM_REG(data->fan_div[nr]))); \ | ||
| 236 | } | ||
| 237 | |||
| 238 | show_fan_reg(fan); | ||
| 239 | show_fan_reg(fan_min); | ||
| 240 | |||
| 241 | static ssize_t | ||
| 242 | store_fan_min(struct device *dev, struct device_attribute *attr, | ||
| 243 | const char *buf, size_t count) | ||
| 244 | { | ||
| 245 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 246 | struct i2c_client *client = to_i2c_client(dev); | ||
| 247 | struct w83l786ng_data *data = i2c_get_clientdata(client); | ||
| 248 | u32 val; | ||
| 249 | |||
| 250 | val = simple_strtoul(buf, NULL, 10); | ||
| 251 | mutex_lock(&data->update_lock); | ||
| 252 | data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr])); | ||
| 253 | w83l786ng_write_value(client, W83L786NG_REG_FAN_MIN(nr), | ||
| 254 | data->fan_min[nr]); | ||
| 255 | mutex_unlock(&data->update_lock); | ||
| 256 | |||
| 257 | return count; | ||
| 258 | } | ||
| 259 | |||
| 260 | static ssize_t | ||
| 261 | show_fan_div(struct device *dev, struct device_attribute *attr, | ||
| 262 | char *buf) | ||
| 263 | { | ||
| 264 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 265 | struct w83l786ng_data *data = w83l786ng_update_device(dev); | ||
| 266 | return sprintf(buf, "%u\n", DIV_FROM_REG(data->fan_div[nr])); | ||
| 267 | } | ||
| 268 | |||
| 269 | /* Note: we save and restore the fan minimum here, because its value is | ||
| 270 | determined in part by the fan divisor. This follows the principle of | ||
| 271 | least surprise; the user doesn't expect the fan minimum to change just | ||
| 272 | because the divisor changed. */ | ||
| 273 | static ssize_t | ||
| 274 | store_fan_div(struct device *dev, struct device_attribute *attr, | ||
| 275 | const char *buf, size_t count) | ||
| 276 | { | ||
| 277 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 278 | struct i2c_client *client = to_i2c_client(dev); | ||
| 279 | struct w83l786ng_data *data = i2c_get_clientdata(client); | ||
| 280 | |||
| 281 | unsigned long min; | ||
| 282 | u8 tmp_fan_div; | ||
| 283 | u8 fan_div_reg; | ||
| 284 | u8 keep_mask = 0; | ||
| 285 | u8 new_shift = 0; | ||
| 286 | |||
| 287 | /* Save fan_min */ | ||
| 288 | mutex_lock(&data->update_lock); | ||
| 289 | min = FAN_FROM_REG(data->fan_min[nr], DIV_FROM_REG(data->fan_div[nr])); | ||
| 290 | |||
| 291 | data->fan_div[nr] = DIV_TO_REG(simple_strtoul(buf, NULL, 10)); | ||
| 292 | |||
| 293 | switch (nr) { | ||
| 294 | case 0: | ||
| 295 | keep_mask = 0xf8; | ||
| 296 | new_shift = 0; | ||
| 297 | break; | ||
| 298 | case 1: | ||
| 299 | keep_mask = 0x8f; | ||
| 300 | new_shift = 4; | ||
| 301 | break; | ||
| 302 | } | ||
| 303 | |||
| 304 | fan_div_reg = w83l786ng_read_value(client, W83L786NG_REG_FAN_DIV) | ||
| 305 | & keep_mask; | ||
| 306 | |||
| 307 | tmp_fan_div = (data->fan_div[nr] << new_shift) & ~keep_mask; | ||
| 308 | |||
| 309 | w83l786ng_write_value(client, W83L786NG_REG_FAN_DIV, | ||
| 310 | fan_div_reg | tmp_fan_div); | ||
| 311 | |||
| 312 | /* Restore fan_min */ | ||
| 313 | data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr])); | ||
| 314 | w83l786ng_write_value(client, W83L786NG_REG_FAN_MIN(nr), | ||
| 315 | data->fan_min[nr]); | ||
| 316 | mutex_unlock(&data->update_lock); | ||
| 317 | |||
| 318 | return count; | ||
| 319 | } | ||
| 320 | |||
| 321 | static struct sensor_device_attribute sda_fan_input[] = { | ||
| 322 | SENSOR_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0), | ||
| 323 | SENSOR_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1), | ||
| 324 | }; | ||
| 325 | |||
| 326 | static struct sensor_device_attribute sda_fan_min[] = { | ||
| 327 | SENSOR_ATTR(fan1_min, S_IWUSR | S_IRUGO, show_fan_min, | ||
| 328 | store_fan_min, 0), | ||
| 329 | SENSOR_ATTR(fan2_min, S_IWUSR | S_IRUGO, show_fan_min, | ||
| 330 | store_fan_min, 1), | ||
| 331 | }; | ||
| 332 | |||
| 333 | static struct sensor_device_attribute sda_fan_div[] = { | ||
| 334 | SENSOR_ATTR(fan1_div, S_IWUSR | S_IRUGO, show_fan_div, | ||
| 335 | store_fan_div, 0), | ||
| 336 | SENSOR_ATTR(fan2_div, S_IWUSR | S_IRUGO, show_fan_div, | ||
| 337 | store_fan_div, 1), | ||
| 338 | }; | ||
| 339 | |||
| 340 | |||
| 341 | /* read/write the temperature, includes measured value and limits */ | ||
| 342 | |||
| 343 | static ssize_t | ||
| 344 | show_temp(struct device *dev, struct device_attribute *attr, char *buf) | ||
| 345 | { | ||
| 346 | struct sensor_device_attribute_2 *sensor_attr = | ||
| 347 | to_sensor_dev_attr_2(attr); | ||
| 348 | int nr = sensor_attr->nr; | ||
| 349 | int index = sensor_attr->index; | ||
| 350 | struct w83l786ng_data *data = w83l786ng_update_device(dev); | ||
| 351 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[nr][index])); | ||
| 352 | } | ||
| 353 | |||
| 354 | static ssize_t | ||
| 355 | store_temp(struct device *dev, struct device_attribute *attr, | ||
| 356 | const char *buf, size_t count) | ||
| 357 | { | ||
| 358 | struct sensor_device_attribute_2 *sensor_attr = | ||
| 359 | to_sensor_dev_attr_2(attr); | ||
| 360 | int nr = sensor_attr->nr; | ||
| 361 | int index = sensor_attr->index; | ||
| 362 | struct i2c_client *client = to_i2c_client(dev); | ||
| 363 | struct w83l786ng_data *data = i2c_get_clientdata(client); | ||
| 364 | s32 val; | ||
| 365 | |||
| 366 | val = simple_strtol(buf, NULL, 10); | ||
| 367 | mutex_lock(&data->update_lock); | ||
| 368 | data->temp[nr][index] = TEMP_TO_REG(val); | ||
| 369 | w83l786ng_write_value(client, W83L786NG_REG_TEMP[nr][index], | ||
| 370 | data->temp[nr][index]); | ||
| 371 | mutex_unlock(&data->update_lock); | ||
| 372 | |||
| 373 | return count; | ||
| 374 | } | ||
| 375 | |||
| 376 | static struct sensor_device_attribute_2 sda_temp_input[] = { | ||
| 377 | SENSOR_ATTR_2(temp1_input, S_IRUGO, show_temp, NULL, 0, 0), | ||
| 378 | SENSOR_ATTR_2(temp2_input, S_IRUGO, show_temp, NULL, 1, 0), | ||
| 379 | }; | ||
| 380 | |||
| 381 | static struct sensor_device_attribute_2 sda_temp_max[] = { | ||
| 382 | SENSOR_ATTR_2(temp1_max, S_IRUGO | S_IWUSR, | ||
| 383 | show_temp, store_temp, 0, 1), | ||
| 384 | SENSOR_ATTR_2(temp2_max, S_IRUGO | S_IWUSR, | ||
| 385 | show_temp, store_temp, 1, 1), | ||
| 386 | }; | ||
| 387 | |||
| 388 | static struct sensor_device_attribute_2 sda_temp_max_hyst[] = { | ||
| 389 | SENSOR_ATTR_2(temp1_max_hyst, S_IRUGO | S_IWUSR, | ||
| 390 | show_temp, store_temp, 0, 2), | ||
| 391 | SENSOR_ATTR_2(temp2_max_hyst, S_IRUGO | S_IWUSR, | ||
| 392 | show_temp, store_temp, 1, 2), | ||
| 393 | }; | ||
| 394 | |||
| 395 | #define show_pwm_reg(reg) \ | ||
| 396 | static ssize_t show_##reg (struct device *dev, struct device_attribute *attr, \ | ||
| 397 | char *buf) \ | ||
| 398 | { \ | ||
| 399 | struct w83l786ng_data *data = w83l786ng_update_device(dev); \ | ||
| 400 | int nr = to_sensor_dev_attr(attr)->index; \ | ||
| 401 | return sprintf(buf, "%d\n", data->reg[nr]); \ | ||
| 402 | } | ||
| 403 | |||
| 404 | show_pwm_reg(pwm_mode) | ||
| 405 | show_pwm_reg(pwm_enable) | ||
| 406 | show_pwm_reg(pwm) | ||
| 407 | |||
| 408 | static ssize_t | ||
| 409 | store_pwm_mode(struct device *dev, struct device_attribute *attr, | ||
| 410 | const char *buf, size_t count) | ||
| 411 | { | ||
| 412 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 413 | struct i2c_client *client = to_i2c_client(dev); | ||
| 414 | struct w83l786ng_data *data = i2c_get_clientdata(client); | ||
| 415 | u32 val = simple_strtoul(buf, NULL, 10); | ||
| 416 | u8 reg; | ||
| 417 | |||
| 418 | if (val > 1) | ||
| 419 | return -EINVAL; | ||
| 420 | mutex_lock(&data->update_lock); | ||
| 421 | data->pwm_mode[nr] = val; | ||
| 422 | reg = w83l786ng_read_value(client, W83L786NG_REG_FAN_CFG); | ||
| 423 | reg &= ~(1 << W83L786NG_PWM_MODE_SHIFT[nr]); | ||
| 424 | if (!val) | ||
| 425 | reg |= 1 << W83L786NG_PWM_MODE_SHIFT[nr]; | ||
| 426 | w83l786ng_write_value(client, W83L786NG_REG_FAN_CFG, reg); | ||
| 427 | mutex_unlock(&data->update_lock); | ||
| 428 | return count; | ||
| 429 | } | ||
| 430 | |||
| 431 | static ssize_t | ||
| 432 | store_pwm(struct device *dev, struct device_attribute *attr, | ||
| 433 | const char *buf, size_t count) | ||
| 434 | { | ||
| 435 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 436 | struct i2c_client *client = to_i2c_client(dev); | ||
| 437 | struct w83l786ng_data *data = i2c_get_clientdata(client); | ||
| 438 | u32 val = SENSORS_LIMIT(simple_strtoul(buf, NULL, 10), 0, 255); | ||
| 439 | |||
| 440 | mutex_lock(&data->update_lock); | ||
| 441 | data->pwm[nr] = val; | ||
| 442 | w83l786ng_write_value(client, W83L786NG_REG_PWM[nr], val); | ||
| 443 | mutex_unlock(&data->update_lock); | ||
| 444 | return count; | ||
| 445 | } | ||
| 446 | |||
| 447 | static ssize_t | ||
| 448 | store_pwm_enable(struct device *dev, struct device_attribute *attr, | ||
| 449 | const char *buf, size_t count) | ||
| 450 | { | ||
| 451 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 452 | struct i2c_client *client = to_i2c_client(dev); | ||
| 453 | struct w83l786ng_data *data = i2c_get_clientdata(client); | ||
| 454 | u32 val = simple_strtoul(buf, NULL, 10); | ||
| 455 | |||
| 456 | u8 reg; | ||
| 457 | |||
| 458 | if (!val || (val > 2)) /* only modes 1 and 2 are supported */ | ||
| 459 | return -EINVAL; | ||
| 460 | |||
| 461 | mutex_lock(&data->update_lock); | ||
| 462 | reg = w83l786ng_read_value(client, W83L786NG_REG_FAN_CFG); | ||
| 463 | data->pwm_enable[nr] = val; | ||
| 464 | reg &= ~(0x02 << W83L786NG_PWM_ENABLE_SHIFT[nr]); | ||
| 465 | reg |= (val - 1) << W83L786NG_PWM_ENABLE_SHIFT[nr]; | ||
| 466 | w83l786ng_write_value(client, W83L786NG_REG_FAN_CFG, reg); | ||
| 467 | mutex_unlock(&data->update_lock); | ||
| 468 | return count; | ||
| 469 | } | ||
| 470 | |||
| 471 | static struct sensor_device_attribute sda_pwm[] = { | ||
| 472 | SENSOR_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 0), | ||
| 473 | SENSOR_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, store_pwm, 1), | ||
| 474 | }; | ||
| 475 | |||
| 476 | static struct sensor_device_attribute sda_pwm_mode[] = { | ||
| 477 | SENSOR_ATTR(pwm1_mode, S_IWUSR | S_IRUGO, show_pwm_mode, | ||
| 478 | store_pwm_mode, 0), | ||
| 479 | SENSOR_ATTR(pwm2_mode, S_IWUSR | S_IRUGO, show_pwm_mode, | ||
| 480 | store_pwm_mode, 1), | ||
| 481 | }; | ||
| 482 | |||
| 483 | static struct sensor_device_attribute sda_pwm_enable[] = { | ||
| 484 | SENSOR_ATTR(pwm1_enable, S_IWUSR | S_IRUGO, show_pwm_enable, | ||
| 485 | store_pwm_enable, 0), | ||
| 486 | SENSOR_ATTR(pwm2_enable, S_IWUSR | S_IRUGO, show_pwm_enable, | ||
| 487 | store_pwm_enable, 1), | ||
| 488 | }; | ||
| 489 | |||
| 490 | /* For Smart Fan I/Thermal Cruise and Smart Fan II */ | ||
| 491 | static ssize_t | ||
| 492 | show_tolerance(struct device *dev, struct device_attribute *attr, char *buf) | ||
| 493 | { | ||
| 494 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 495 | struct w83l786ng_data *data = w83l786ng_update_device(dev); | ||
| 496 | return sprintf(buf, "%ld\n", (long)data->tolerance[nr]); | ||
| 497 | } | ||
| 498 | |||
| 499 | static ssize_t | ||
| 500 | store_tolerance(struct device *dev, struct device_attribute *attr, | ||
| 501 | const char *buf, size_t count) | ||
| 502 | { | ||
| 503 | int nr = to_sensor_dev_attr(attr)->index; | ||
| 504 | struct i2c_client *client = to_i2c_client(dev); | ||
| 505 | struct w83l786ng_data *data = i2c_get_clientdata(client); | ||
| 506 | u32 val; | ||
| 507 | u8 tol_tmp, tol_mask; | ||
| 508 | |||
| 509 | val = simple_strtoul(buf, NULL, 10); | ||
| 510 | |||
| 511 | mutex_lock(&data->update_lock); | ||
| 512 | tol_mask = w83l786ng_read_value(client, | ||
| 513 | W83L786NG_REG_TOLERANCE) & ((nr == 1) ? 0x0f : 0xf0); | ||
| 514 | tol_tmp = SENSORS_LIMIT(val, 0, 15); | ||
| 515 | tol_tmp &= 0x0f; | ||
| 516 | data->tolerance[nr] = tol_tmp; | ||
| 517 | if (nr == 1) { | ||
| 518 | tol_tmp <<= 4; | ||
| 519 | } | ||
| 520 | |||
| 521 | w83l786ng_write_value(client, W83L786NG_REG_TOLERANCE, | ||
| 522 | tol_mask | tol_tmp); | ||
| 523 | mutex_unlock(&data->update_lock); | ||
| 524 | return count; | ||
| 525 | } | ||
| 526 | |||
| 527 | static struct sensor_device_attribute sda_tolerance[] = { | ||
| 528 | SENSOR_ATTR(pwm1_tolerance, S_IWUSR | S_IRUGO, | ||
| 529 | show_tolerance, store_tolerance, 0), | ||
| 530 | SENSOR_ATTR(pwm2_tolerance, S_IWUSR | S_IRUGO, | ||
| 531 | show_tolerance, store_tolerance, 1), | ||
| 532 | }; | ||
| 533 | |||
| 534 | |||
| 535 | #define IN_UNIT_ATTRS(X) \ | ||
| 536 | &sda_in_input[X].dev_attr.attr, \ | ||
| 537 | &sda_in_min[X].dev_attr.attr, \ | ||
| 538 | &sda_in_max[X].dev_attr.attr | ||
| 539 | |||
| 540 | #define FAN_UNIT_ATTRS(X) \ | ||
| 541 | &sda_fan_input[X].dev_attr.attr, \ | ||
| 542 | &sda_fan_min[X].dev_attr.attr, \ | ||
| 543 | &sda_fan_div[X].dev_attr.attr | ||
| 544 | |||
| 545 | #define TEMP_UNIT_ATTRS(X) \ | ||
| 546 | &sda_temp_input[X].dev_attr.attr, \ | ||
| 547 | &sda_temp_max[X].dev_attr.attr, \ | ||
| 548 | &sda_temp_max_hyst[X].dev_attr.attr | ||
| 549 | |||
| 550 | #define PWM_UNIT_ATTRS(X) \ | ||
| 551 | &sda_pwm[X].dev_attr.attr, \ | ||
| 552 | &sda_pwm_mode[X].dev_attr.attr, \ | ||
| 553 | &sda_pwm_enable[X].dev_attr.attr | ||
| 554 | |||
| 555 | #define TOLERANCE_UNIT_ATTRS(X) \ | ||
| 556 | &sda_tolerance[X].dev_attr.attr | ||
| 557 | |||
| 558 | static struct attribute *w83l786ng_attributes[] = { | ||
| 559 | IN_UNIT_ATTRS(0), | ||
| 560 | IN_UNIT_ATTRS(1), | ||
| 561 | IN_UNIT_ATTRS(2), | ||
| 562 | FAN_UNIT_ATTRS(0), | ||
| 563 | FAN_UNIT_ATTRS(1), | ||
| 564 | TEMP_UNIT_ATTRS(0), | ||
| 565 | TEMP_UNIT_ATTRS(1), | ||
| 566 | PWM_UNIT_ATTRS(0), | ||
| 567 | PWM_UNIT_ATTRS(1), | ||
| 568 | TOLERANCE_UNIT_ATTRS(0), | ||
| 569 | TOLERANCE_UNIT_ATTRS(1), | ||
| 570 | NULL | ||
| 571 | }; | ||
| 572 | |||
| 573 | static const struct attribute_group w83l786ng_group = { | ||
| 574 | .attrs = w83l786ng_attributes, | ||
| 575 | }; | ||
| 576 | |||
| 577 | static int | ||
| 578 | w83l786ng_attach_adapter(struct i2c_adapter *adapter) | ||
| 579 | { | ||
| 580 | if (!(adapter->class & I2C_CLASS_HWMON)) | ||
| 581 | return 0; | ||
| 582 | return i2c_probe(adapter, &addr_data, w83l786ng_detect); | ||
| 583 | } | ||
| 584 | |||
| 585 | static int | ||
| 586 | w83l786ng_detect(struct i2c_adapter *adapter, int address, int kind) | ||
| 587 | { | ||
| 588 | struct i2c_client *client; | ||
| 589 | struct device *dev; | ||
| 590 | struct w83l786ng_data *data; | ||
| 591 | int i, err = 0; | ||
| 592 | u8 reg_tmp; | ||
| 593 | |||
| 594 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) { | ||
| 595 | goto exit; | ||
| 596 | } | ||
| 597 | |||
| 598 | /* OK. For now, we presume we have a valid client. We now create the | ||
| 599 | client structure, even though we cannot fill it completely yet. | ||
| 600 | But it allows us to access w83l786ng_{read,write}_value. */ | ||
| 601 | |||
| 602 | if (!(data = kzalloc(sizeof(struct w83l786ng_data), GFP_KERNEL))) { | ||
| 603 | err = -ENOMEM; | ||
| 604 | goto exit; | ||
| 605 | } | ||
| 606 | |||
| 607 | client = &data->client; | ||
| 608 | dev = &client->dev; | ||
| 609 | i2c_set_clientdata(client, data); | ||
| 610 | client->addr = address; | ||
| 611 | client->adapter = adapter; | ||
| 612 | client->driver = &w83l786ng_driver; | ||
| 613 | |||
| 614 | /* | ||
| 615 | * Now we do the remaining detection. A negative kind means that | ||
| 616 | * the driver was loaded with no force parameter (default), so we | ||
| 617 | * must both detect and identify the chip (actually there is only | ||
| 618 | * one possible kind of chip for now, W83L786NG). A zero kind means | ||
| 619 | * that the driver was loaded with the force parameter, the detection | ||
| 620 | * step shall be skipped. A positive kind means that the driver | ||
| 621 | * was loaded with the force parameter and a given kind of chip is | ||
| 622 | * requested, so both the detection and the identification steps | ||
| 623 | * are skipped. | ||
| 624 | */ | ||
| 625 | if (kind < 0) { /* detection */ | ||
| 626 | if (((w83l786ng_read_value(client, | ||
| 627 | W83L786NG_REG_CONFIG) & 0x80) != 0x00)) { | ||
| 628 | dev_dbg(&adapter->dev, | ||
| 629 | "W83L786NG detection failed at 0x%02x.\n", | ||
| 630 | address); | ||
| 631 | goto exit_free; | ||
| 632 | } | ||
| 633 | } | ||
| 634 | |||
| 635 | if (kind <= 0) { /* identification */ | ||
| 636 | u16 man_id; | ||
| 637 | u8 chip_id; | ||
| 638 | |||
| 639 | man_id = (w83l786ng_read_value(client, | ||
| 640 | W83L786NG_REG_MAN_ID1) << 8) + | ||
| 641 | w83l786ng_read_value(client, W83L786NG_REG_MAN_ID2); | ||
| 642 | chip_id = w83l786ng_read_value(client, W83L786NG_REG_CHIP_ID); | ||
| 643 | |||
| 644 | if (man_id == 0x5CA3) { /* Winbond */ | ||
| 645 | if (chip_id == 0x80) { /* W83L786NG */ | ||
| 646 | kind = w83l786ng; | ||
| 647 | } | ||
| 648 | } | ||
| 649 | |||
| 650 | if (kind <= 0) { /* identification failed */ | ||
| 651 | dev_info(&adapter->dev, | ||
| 652 | "Unsupported chip (man_id=0x%04X, " | ||
| 653 | "chip_id=0x%02X).\n", man_id, chip_id); | ||
| 654 | goto exit_free; | ||
| 655 | } | ||
| 656 | } | ||
| 657 | |||
| 658 | /* Fill in the remaining client fields and put into the global list */ | ||
| 659 | strlcpy(client->name, "w83l786ng", I2C_NAME_SIZE); | ||
| 660 | mutex_init(&data->update_lock); | ||
| 661 | |||
| 662 | /* Tell the I2C layer a new client has arrived */ | ||
| 663 | if ((err = i2c_attach_client(client))) | ||
| 664 | goto exit_free; | ||
| 665 | |||
| 666 | /* Initialize the chip */ | ||
| 667 | w83l786ng_init_client(client); | ||
| 668 | |||
| 669 | /* A few vars need to be filled upon startup */ | ||
| 670 | for (i = 0; i < 2; i++) { | ||
| 671 | data->fan_min[i] = w83l786ng_read_value(client, | ||
| 672 | W83L786NG_REG_FAN_MIN(i)); | ||
| 673 | } | ||
| 674 | |||
| 675 | /* Update the fan divisor */ | ||
| 676 | reg_tmp = w83l786ng_read_value(client, W83L786NG_REG_FAN_DIV); | ||
| 677 | data->fan_div[0] = reg_tmp & 0x07; | ||
| 678 | data->fan_div[1] = (reg_tmp >> 4) & 0x07; | ||
| 679 | |||
| 680 | /* Register sysfs hooks */ | ||
| 681 | if ((err = sysfs_create_group(&client->dev.kobj, &w83l786ng_group))) | ||
| 682 | goto exit_remove; | ||
| 683 | |||
| 684 | data->hwmon_dev = hwmon_device_register(dev); | ||
| 685 | if (IS_ERR(data->hwmon_dev)) { | ||
| 686 | err = PTR_ERR(data->hwmon_dev); | ||
| 687 | goto exit_remove; | ||
| 688 | } | ||
| 689 | |||
| 690 | return 0; | ||
| 691 | |||
| 692 | /* Unregister sysfs hooks */ | ||
| 693 | |||
| 694 | exit_remove: | ||
| 695 | sysfs_remove_group(&client->dev.kobj, &w83l786ng_group); | ||
| 696 | i2c_detach_client(client); | ||
| 697 | exit_free: | ||
| 698 | kfree(data); | ||
| 699 | exit: | ||
| 700 | return err; | ||
| 701 | } | ||
| 702 | |||
| 703 | static int | ||
| 704 | w83l786ng_detach_client(struct i2c_client *client) | ||
| 705 | { | ||
| 706 | struct w83l786ng_data *data = i2c_get_clientdata(client); | ||
| 707 | int err; | ||
| 708 | |||
| 709 | hwmon_device_unregister(data->hwmon_dev); | ||
| 710 | sysfs_remove_group(&client->dev.kobj, &w83l786ng_group); | ||
| 711 | |||
| 712 | if ((err = i2c_detach_client(client))) | ||
| 713 | return err; | ||
| 714 | |||
| 715 | kfree(data); | ||
| 716 | |||
| 717 | return 0; | ||
| 718 | } | ||
| 719 | |||
| 720 | static void | ||
| 721 | w83l786ng_init_client(struct i2c_client *client) | ||
| 722 | { | ||
| 723 | u8 tmp; | ||
| 724 | |||
| 725 | if (reset) | ||
| 726 | w83l786ng_write_value(client, W83L786NG_REG_CONFIG, 0x80); | ||
| 727 | |||
| 728 | /* Start monitoring */ | ||
| 729 | tmp = w83l786ng_read_value(client, W83L786NG_REG_CONFIG); | ||
| 730 | if (!(tmp & 0x01)) | ||
| 731 | w83l786ng_write_value(client, W83L786NG_REG_CONFIG, tmp | 0x01); | ||
| 732 | } | ||
| 733 | |||
| 734 | static struct w83l786ng_data *w83l786ng_update_device(struct device *dev) | ||
| 735 | { | ||
| 736 | struct i2c_client *client = to_i2c_client(dev); | ||
| 737 | struct w83l786ng_data *data = i2c_get_clientdata(client); | ||
| 738 | int i, j; | ||
| 739 | u8 reg_tmp, pwmcfg; | ||
| 740 | |||
| 741 | mutex_lock(&data->update_lock); | ||
| 742 | if (time_after(jiffies, data->last_updated + HZ + HZ / 2) | ||
| 743 | || !data->valid) { | ||
| 744 | dev_dbg(&client->dev, "Updating w83l786ng data.\n"); | ||
| 745 | |||
| 746 | /* Update the voltages measured value and limits */ | ||
| 747 | for (i = 0; i < 3; i++) { | ||
| 748 | data->in[i] = w83l786ng_read_value(client, | ||
| 749 | W83L786NG_REG_IN(i)); | ||
| 750 | data->in_min[i] = w83l786ng_read_value(client, | ||
| 751 | W83L786NG_REG_IN_MIN(i)); | ||
| 752 | data->in_max[i] = w83l786ng_read_value(client, | ||
| 753 | W83L786NG_REG_IN_MAX(i)); | ||
| 754 | } | ||
| 755 | |||
| 756 | /* Update the fan counts and limits */ | ||
| 757 | for (i = 0; i < 2; i++) { | ||
| 758 | data->fan[i] = w83l786ng_read_value(client, | ||
| 759 | W83L786NG_REG_FAN(i)); | ||
| 760 | data->fan_min[i] = w83l786ng_read_value(client, | ||
| 761 | W83L786NG_REG_FAN_MIN(i)); | ||
| 762 | } | ||
| 763 | |||
| 764 | /* Update the fan divisor */ | ||
| 765 | reg_tmp = w83l786ng_read_value(client, W83L786NG_REG_FAN_DIV); | ||
| 766 | data->fan_div[0] = reg_tmp & 0x07; | ||
| 767 | data->fan_div[1] = (reg_tmp >> 4) & 0x07; | ||
| 768 | |||
| 769 | pwmcfg = w83l786ng_read_value(client, W83L786NG_REG_FAN_CFG); | ||
| 770 | for (i = 0; i < 2; i++) { | ||
| 771 | data->pwm_mode[i] = | ||
| 772 | ((pwmcfg >> W83L786NG_PWM_MODE_SHIFT[i]) & 1) | ||
| 773 | ? 0 : 1; | ||
| 774 | data->pwm_enable[i] = | ||
| 775 | ((pwmcfg >> W83L786NG_PWM_ENABLE_SHIFT[i]) & 2) + 1; | ||
| 776 | data->pwm[i] = w83l786ng_read_value(client, | ||
| 777 | W83L786NG_REG_PWM[i]); | ||
| 778 | } | ||
| 779 | |||
| 780 | |||
| 781 | /* Update the temperature sensors */ | ||
| 782 | for (i = 0; i < 2; i++) { | ||
| 783 | for (j = 0; j < 3; j++) { | ||
| 784 | data->temp[i][j] = w83l786ng_read_value(client, | ||
| 785 | W83L786NG_REG_TEMP[i][j]); | ||
| 786 | } | ||
| 787 | } | ||
| 788 | |||
| 789 | /* Update Smart Fan I/II tolerance */ | ||
| 790 | reg_tmp = w83l786ng_read_value(client, W83L786NG_REG_TOLERANCE); | ||
| 791 | data->tolerance[0] = reg_tmp & 0x0f; | ||
| 792 | data->tolerance[1] = (reg_tmp >> 4) & 0x0f; | ||
| 793 | |||
| 794 | data->last_updated = jiffies; | ||
| 795 | data->valid = 1; | ||
| 796 | |||
| 797 | } | ||
| 798 | |||
| 799 | mutex_unlock(&data->update_lock); | ||
| 800 | |||
| 801 | return data; | ||
| 802 | } | ||
| 803 | |||
| 804 | static int __init | ||
| 805 | sensors_w83l786ng_init(void) | ||
| 806 | { | ||
| 807 | return i2c_add_driver(&w83l786ng_driver); | ||
| 808 | } | ||
| 809 | |||
| 810 | static void __exit | ||
| 811 | sensors_w83l786ng_exit(void) | ||
| 812 | { | ||
| 813 | i2c_del_driver(&w83l786ng_driver); | ||
| 814 | } | ||
| 815 | |||
| 816 | MODULE_AUTHOR("Kevin Lo"); | ||
| 817 | MODULE_DESCRIPTION("w83l786ng driver"); | ||
| 818 | MODULE_LICENSE("GPL"); | ||
| 819 | |||
| 820 | module_init(sensors_w83l786ng_init); | ||
| 821 | module_exit(sensors_w83l786ng_exit); | ||
diff --git a/drivers/i2c/chips/eeprom.c b/drivers/i2c/chips/eeprom.c index fde297b21ad7..7dee001e5133 100644 --- a/drivers/i2c/chips/eeprom.c +++ b/drivers/i2c/chips/eeprom.c | |||
| @@ -71,7 +71,6 @@ static struct i2c_driver eeprom_driver = { | |||
| 71 | .driver = { | 71 | .driver = { |
| 72 | .name = "eeprom", | 72 | .name = "eeprom", |
| 73 | }, | 73 | }, |
| 74 | .id = I2C_DRIVERID_EEPROM, | ||
| 75 | .attach_adapter = eeprom_attach_adapter, | 74 | .attach_adapter = eeprom_attach_adapter, |
| 76 | .detach_client = eeprom_detach_client, | 75 | .detach_client = eeprom_detach_client, |
| 77 | }; | 76 | }; |
diff --git a/drivers/i2c/chips/pcf8574.c b/drivers/i2c/chips/pcf8574.c index b3b830ccf209..e5b31329b56e 100644 --- a/drivers/i2c/chips/pcf8574.c +++ b/drivers/i2c/chips/pcf8574.c | |||
| @@ -67,7 +67,6 @@ static struct i2c_driver pcf8574_driver = { | |||
| 67 | .driver = { | 67 | .driver = { |
| 68 | .name = "pcf8574", | 68 | .name = "pcf8574", |
| 69 | }, | 69 | }, |
| 70 | .id = I2C_DRIVERID_PCF8574, | ||
| 71 | .attach_adapter = pcf8574_attach_adapter, | 70 | .attach_adapter = pcf8574_attach_adapter, |
| 72 | .detach_client = pcf8574_detach_client, | 71 | .detach_client = pcf8574_detach_client, |
| 73 | }; | 72 | }; |
diff --git a/drivers/i2c/chips/pcf8591.c b/drivers/i2c/chips/pcf8591.c index 865f4409c06b..66c7c3bb9429 100644 --- a/drivers/i2c/chips/pcf8591.c +++ b/drivers/i2c/chips/pcf8591.c | |||
| @@ -92,7 +92,6 @@ static struct i2c_driver pcf8591_driver = { | |||
| 92 | .driver = { | 92 | .driver = { |
| 93 | .name = "pcf8591", | 93 | .name = "pcf8591", |
| 94 | }, | 94 | }, |
| 95 | .id = I2C_DRIVERID_PCF8591, | ||
| 96 | .attach_adapter = pcf8591_attach_adapter, | 95 | .attach_adapter = pcf8591_attach_adapter, |
| 97 | .detach_client = pcf8591_detach_client, | 96 | .detach_client = pcf8591_detach_client, |
| 98 | }; | 97 | }; |
diff --git a/drivers/misc/Kconfig b/drivers/misc/Kconfig index 78cd33861766..7b5220ca7d7f 100644 --- a/drivers/misc/Kconfig +++ b/drivers/misc/Kconfig | |||
| @@ -285,4 +285,13 @@ config INTEL_MENLOW | |||
| 285 | 285 | ||
| 286 | If unsure, say N. | 286 | If unsure, say N. |
| 287 | 287 | ||
| 288 | config ENCLOSURE_SERVICES | ||
| 289 | tristate "Enclosure Services" | ||
| 290 | default n | ||
| 291 | help | ||
| 292 | Provides support for intelligent enclosures (bays which | ||
| 293 | contain storage devices). You also need either a host | ||
| 294 | driver (SCSI/ATA) which supports enclosures | ||
| 295 | or a SCSI enclosure device (SES) to use these services. | ||
| 296 | |||
| 288 | endif # MISC_DEVICES | 297 | endif # MISC_DEVICES |
diff --git a/drivers/misc/Makefile b/drivers/misc/Makefile index 1f41654aae4d..7f13549cc87e 100644 --- a/drivers/misc/Makefile +++ b/drivers/misc/Makefile | |||
| @@ -20,3 +20,4 @@ obj-$(CONFIG_THINKPAD_ACPI) += thinkpad_acpi.o | |||
| 20 | obj-$(CONFIG_FUJITSU_LAPTOP) += fujitsu-laptop.o | 20 | obj-$(CONFIG_FUJITSU_LAPTOP) += fujitsu-laptop.o |
| 21 | obj-$(CONFIG_EEPROM_93CX6) += eeprom_93cx6.o | 21 | obj-$(CONFIG_EEPROM_93CX6) += eeprom_93cx6.o |
| 22 | obj-$(CONFIG_INTEL_MENLOW) += intel_menlow.o | 22 | obj-$(CONFIG_INTEL_MENLOW) += intel_menlow.o |
| 23 | obj-$(CONFIG_ENCLOSURE_SERVICES) += enclosure.o | ||
diff --git a/drivers/misc/enclosure.c b/drivers/misc/enclosure.c new file mode 100644 index 000000000000..6fcb0e96adf4 --- /dev/null +++ b/drivers/misc/enclosure.c | |||
| @@ -0,0 +1,484 @@ | |||
| 1 | /* | ||
| 2 | * Enclosure Services | ||
| 3 | * | ||
| 4 | * Copyright (C) 2008 James Bottomley <James.Bottomley@HansenPartnership.com> | ||
| 5 | * | ||
| 6 | **----------------------------------------------------------------------------- | ||
| 7 | ** | ||
| 8 | ** This program is free software; you can redistribute it and/or | ||
| 9 | ** modify it under the terms of the GNU General Public License | ||
| 10 | ** version 2 as published by the Free Software Foundation. | ||
| 11 | ** | ||
| 12 | ** This program is distributed in the hope that it will be useful, | ||
| 13 | ** but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 14 | ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 15 | ** GNU General Public License for more details. | ||
| 16 | ** | ||
| 17 | ** You should have received a copy of the GNU General Public License | ||
| 18 | ** along with this program; if not, write to the Free Software | ||
| 19 | ** Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
| 20 | ** | ||
| 21 | **----------------------------------------------------------------------------- | ||
| 22 | */ | ||
| 23 | #include <linux/device.h> | ||
| 24 | #include <linux/enclosure.h> | ||
| 25 | #include <linux/err.h> | ||
| 26 | #include <linux/list.h> | ||
| 27 | #include <linux/kernel.h> | ||
| 28 | #include <linux/module.h> | ||
| 29 | #include <linux/mutex.h> | ||
| 30 | |||
| 31 | static LIST_HEAD(container_list); | ||
| 32 | static DEFINE_MUTEX(container_list_lock); | ||
| 33 | static struct class enclosure_class; | ||
| 34 | static struct class enclosure_component_class; | ||
| 35 | |||
| 36 | /** | ||
| 37 | * enclosure_find - find an enclosure given a device | ||
| 38 | * @dev: the device to find for | ||
| 39 | * | ||
| 40 | * Looks through the list of registered enclosures to see | ||
| 41 | * if it can find a match for a device. Returns NULL if no | ||
| 42 | * enclosure is found. Obtains a reference to the enclosure class | ||
| 43 | * device which must be released with class_device_put(). | ||
| 44 | */ | ||
| 45 | struct enclosure_device *enclosure_find(struct device *dev) | ||
| 46 | { | ||
| 47 | struct enclosure_device *edev = NULL; | ||
| 48 | |||
| 49 | mutex_lock(&container_list_lock); | ||
| 50 | list_for_each_entry(edev, &container_list, node) { | ||
| 51 | if (edev->cdev.dev == dev) { | ||
| 52 | class_device_get(&edev->cdev); | ||
| 53 | mutex_unlock(&container_list_lock); | ||
| 54 | return edev; | ||
| 55 | } | ||
| 56 | } | ||
| 57 | mutex_unlock(&container_list_lock); | ||
| 58 | |||
| 59 | return NULL; | ||
| 60 | } | ||
| 61 | EXPORT_SYMBOL_GPL(enclosure_find); | ||
| 62 | |||
| 63 | /** | ||
| 64 | * enclosure_for_each_device - calls a function for each enclosure | ||
| 65 | * @fn: the function to call | ||
| 66 | * @data: the data to pass to each call | ||
| 67 | * | ||
| 68 | * Loops over all the enclosures calling the function. | ||
| 69 | * | ||
| 70 | * Note, this function uses a mutex which will be held across calls to | ||
| 71 | * @fn, so it must have non atomic context, and @fn may (although it | ||
| 72 | * should not) sleep or otherwise cause the mutex to be held for | ||
| 73 | * indefinite periods | ||
| 74 | */ | ||
| 75 | int enclosure_for_each_device(int (*fn)(struct enclosure_device *, void *), | ||
| 76 | void *data) | ||
| 77 | { | ||
| 78 | int error = 0; | ||
| 79 | struct enclosure_device *edev; | ||
| 80 | |||
| 81 | mutex_lock(&container_list_lock); | ||
| 82 | list_for_each_entry(edev, &container_list, node) { | ||
| 83 | error = fn(edev, data); | ||
| 84 | if (error) | ||
| 85 | break; | ||
| 86 | } | ||
| 87 | mutex_unlock(&container_list_lock); | ||
| 88 | |||
| 89 | return error; | ||
| 90 | } | ||
| 91 | EXPORT_SYMBOL_GPL(enclosure_for_each_device); | ||
| 92 | |||
| 93 | /** | ||
| 94 | * enclosure_register - register device as an enclosure | ||
| 95 | * | ||
| 96 | * @dev: device containing the enclosure | ||
| 97 | * @components: number of components in the enclosure | ||
| 98 | * | ||
| 99 | * This sets up the device for being an enclosure. Note that @dev does | ||
| 100 | * not have to be a dedicated enclosure device. It may be some other type | ||
| 101 | * of device that additionally responds to enclosure services | ||
| 102 | */ | ||
| 103 | struct enclosure_device * | ||
| 104 | enclosure_register(struct device *dev, const char *name, int components, | ||
| 105 | struct enclosure_component_callbacks *cb) | ||
| 106 | { | ||
| 107 | struct enclosure_device *edev = | ||
| 108 | kzalloc(sizeof(struct enclosure_device) + | ||
| 109 | sizeof(struct enclosure_component)*components, | ||
| 110 | GFP_KERNEL); | ||
| 111 | int err, i; | ||
| 112 | |||
| 113 | BUG_ON(!cb); | ||
| 114 | |||
| 115 | if (!edev) | ||
| 116 | return ERR_PTR(-ENOMEM); | ||
| 117 | |||
| 118 | edev->components = components; | ||
| 119 | |||
| 120 | edev->cdev.class = &enclosure_class; | ||
| 121 | edev->cdev.dev = get_device(dev); | ||
| 122 | edev->cb = cb; | ||
| 123 | snprintf(edev->cdev.class_id, BUS_ID_SIZE, "%s", name); | ||
| 124 | err = class_device_register(&edev->cdev); | ||
| 125 | if (err) | ||
| 126 | goto err; | ||
| 127 | |||
| 128 | for (i = 0; i < components; i++) | ||
| 129 | edev->component[i].number = -1; | ||
| 130 | |||
| 131 | mutex_lock(&container_list_lock); | ||
| 132 | list_add_tail(&edev->node, &container_list); | ||
| 133 | mutex_unlock(&container_list_lock); | ||
| 134 | |||
| 135 | return edev; | ||
| 136 | |||
| 137 | err: | ||
| 138 | put_device(edev->cdev.dev); | ||
| 139 | kfree(edev); | ||
| 140 | return ERR_PTR(err); | ||
| 141 | } | ||
| 142 | EXPORT_SYMBOL_GPL(enclosure_register); | ||
| 143 | |||
| 144 | static struct enclosure_component_callbacks enclosure_null_callbacks; | ||
| 145 | |||
| 146 | /** | ||
| 147 | * enclosure_unregister - remove an enclosure | ||
| 148 | * | ||
| 149 | * @edev: the registered enclosure to remove; | ||
| 150 | */ | ||
| 151 | void enclosure_unregister(struct enclosure_device *edev) | ||
| 152 | { | ||
| 153 | int i; | ||
| 154 | |||
| 155 | mutex_lock(&container_list_lock); | ||
| 156 | list_del(&edev->node); | ||
| 157 | mutex_unlock(&container_list_lock); | ||
| 158 | |||
| 159 | for (i = 0; i < edev->components; i++) | ||
| 160 | if (edev->component[i].number != -1) | ||
| 161 | class_device_unregister(&edev->component[i].cdev); | ||
| 162 | |||
| 163 | /* prevent any callbacks into service user */ | ||
| 164 | edev->cb = &enclosure_null_callbacks; | ||
| 165 | class_device_unregister(&edev->cdev); | ||
| 166 | } | ||
| 167 | EXPORT_SYMBOL_GPL(enclosure_unregister); | ||
| 168 | |||
| 169 | static void enclosure_release(struct class_device *cdev) | ||
| 170 | { | ||
| 171 | struct enclosure_device *edev = to_enclosure_device(cdev); | ||
| 172 | |||
| 173 | put_device(cdev->dev); | ||
| 174 | kfree(edev); | ||
| 175 | } | ||
| 176 | |||
| 177 | static void enclosure_component_release(struct class_device *cdev) | ||
| 178 | { | ||
| 179 | if (cdev->dev) | ||
| 180 | put_device(cdev->dev); | ||
| 181 | class_device_put(cdev->parent); | ||
| 182 | } | ||
| 183 | |||
| 184 | /** | ||
| 185 | * enclosure_component_register - add a particular component to an enclosure | ||
| 186 | * @edev: the enclosure to add the component | ||
| 187 | * @num: the device number | ||
| 188 | * @type: the type of component being added | ||
| 189 | * @name: an optional name to appear in sysfs (leave NULL if none) | ||
| 190 | * | ||
| 191 | * Registers the component. The name is optional for enclosures that | ||
| 192 | * give their components a unique name. If not, leave the field NULL | ||
| 193 | * and a name will be assigned. | ||
| 194 | * | ||
| 195 | * Returns a pointer to the enclosure component or an error. | ||
| 196 | */ | ||
| 197 | struct enclosure_component * | ||
| 198 | enclosure_component_register(struct enclosure_device *edev, | ||
| 199 | unsigned int number, | ||
| 200 | enum enclosure_component_type type, | ||
| 201 | const char *name) | ||
| 202 | { | ||
| 203 | struct enclosure_component *ecomp; | ||
| 204 | struct class_device *cdev; | ||
| 205 | int err; | ||
| 206 | |||
| 207 | if (number >= edev->components) | ||
| 208 | return ERR_PTR(-EINVAL); | ||
| 209 | |||
| 210 | ecomp = &edev->component[number]; | ||
| 211 | |||
| 212 | if (ecomp->number != -1) | ||
| 213 | return ERR_PTR(-EINVAL); | ||
| 214 | |||
| 215 | ecomp->type = type; | ||
| 216 | ecomp->number = number; | ||
| 217 | cdev = &ecomp->cdev; | ||
| 218 | cdev->parent = class_device_get(&edev->cdev); | ||
| 219 | cdev->class = &enclosure_component_class; | ||
| 220 | if (name) | ||
| 221 | snprintf(cdev->class_id, BUS_ID_SIZE, "%s", name); | ||
| 222 | else | ||
| 223 | snprintf(cdev->class_id, BUS_ID_SIZE, "%u", number); | ||
| 224 | |||
| 225 | err = class_device_register(cdev); | ||
| 226 | if (err) | ||
| 227 | ERR_PTR(err); | ||
| 228 | |||
| 229 | return ecomp; | ||
| 230 | } | ||
| 231 | EXPORT_SYMBOL_GPL(enclosure_component_register); | ||
| 232 | |||
| 233 | /** | ||
| 234 | * enclosure_add_device - add a device as being part of an enclosure | ||
| 235 | * @edev: the enclosure device being added to. | ||
| 236 | * @num: the number of the component | ||
| 237 | * @dev: the device being added | ||
| 238 | * | ||
| 239 | * Declares a real device to reside in slot (or identifier) @num of an | ||
| 240 | * enclosure. This will cause the relevant sysfs links to appear. | ||
| 241 | * This function may also be used to change a device associated with | ||
| 242 | * an enclosure without having to call enclosure_remove_device() in | ||
| 243 | * between. | ||
| 244 | * | ||
| 245 | * Returns zero on success or an error. | ||
| 246 | */ | ||
| 247 | int enclosure_add_device(struct enclosure_device *edev, int component, | ||
| 248 | struct device *dev) | ||
| 249 | { | ||
| 250 | struct class_device *cdev; | ||
| 251 | |||
| 252 | if (!edev || component >= edev->components) | ||
| 253 | return -EINVAL; | ||
| 254 | |||
| 255 | cdev = &edev->component[component].cdev; | ||
| 256 | |||
| 257 | class_device_del(cdev); | ||
| 258 | if (cdev->dev) | ||
| 259 | put_device(cdev->dev); | ||
| 260 | cdev->dev = get_device(dev); | ||
| 261 | return class_device_add(cdev); | ||
| 262 | } | ||
| 263 | EXPORT_SYMBOL_GPL(enclosure_add_device); | ||
| 264 | |||
| 265 | /** | ||
| 266 | * enclosure_remove_device - remove a device from an enclosure | ||
| 267 | * @edev: the enclosure device | ||
| 268 | * @num: the number of the component to remove | ||
| 269 | * | ||
| 270 | * Returns zero on success or an error. | ||
| 271 | * | ||
| 272 | */ | ||
| 273 | int enclosure_remove_device(struct enclosure_device *edev, int component) | ||
| 274 | { | ||
| 275 | struct class_device *cdev; | ||
| 276 | |||
| 277 | if (!edev || component >= edev->components) | ||
| 278 | return -EINVAL; | ||
| 279 | |||
| 280 | cdev = &edev->component[component].cdev; | ||
| 281 | |||
| 282 | class_device_del(cdev); | ||
| 283 | if (cdev->dev) | ||
| 284 | put_device(cdev->dev); | ||
| 285 | cdev->dev = NULL; | ||
| 286 | return class_device_add(cdev); | ||
| 287 | } | ||
| 288 | EXPORT_SYMBOL_GPL(enclosure_remove_device); | ||
| 289 | |||
| 290 | /* | ||
| 291 | * sysfs pieces below | ||
| 292 | */ | ||
| 293 | |||
| 294 | static ssize_t enclosure_show_components(struct class_device *cdev, char *buf) | ||
| 295 | { | ||
| 296 | struct enclosure_device *edev = to_enclosure_device(cdev); | ||
| 297 | |||
| 298 | return snprintf(buf, 40, "%d\n", edev->components); | ||
| 299 | } | ||
| 300 | |||
| 301 | static struct class_device_attribute enclosure_attrs[] = { | ||
| 302 | __ATTR(components, S_IRUGO, enclosure_show_components, NULL), | ||
| 303 | __ATTR_NULL | ||
| 304 | }; | ||
| 305 | |||
| 306 | static struct class enclosure_class = { | ||
| 307 | .name = "enclosure", | ||
| 308 | .owner = THIS_MODULE, | ||
| 309 | .release = enclosure_release, | ||
| 310 | .class_dev_attrs = enclosure_attrs, | ||
| 311 | }; | ||
| 312 | |||
| 313 | static const char *const enclosure_status [] = { | ||
| 314 | [ENCLOSURE_STATUS_UNSUPPORTED] = "unsupported", | ||
| 315 | [ENCLOSURE_STATUS_OK] = "OK", | ||
| 316 | [ENCLOSURE_STATUS_CRITICAL] = "critical", | ||
| 317 | [ENCLOSURE_STATUS_NON_CRITICAL] = "non-critical", | ||
| 318 | [ENCLOSURE_STATUS_UNRECOVERABLE] = "unrecoverable", | ||
| 319 | [ENCLOSURE_STATUS_NOT_INSTALLED] = "not installed", | ||
| 320 | [ENCLOSURE_STATUS_UNKNOWN] = "unknown", | ||
| 321 | [ENCLOSURE_STATUS_UNAVAILABLE] = "unavailable", | ||
| 322 | }; | ||
| 323 | |||
| 324 | static const char *const enclosure_type [] = { | ||
| 325 | [ENCLOSURE_COMPONENT_DEVICE] = "device", | ||
| 326 | [ENCLOSURE_COMPONENT_ARRAY_DEVICE] = "array device", | ||
| 327 | }; | ||
| 328 | |||
| 329 | static ssize_t get_component_fault(struct class_device *cdev, char *buf) | ||
| 330 | { | ||
| 331 | struct enclosure_device *edev = to_enclosure_device(cdev->parent); | ||
| 332 | struct enclosure_component *ecomp = to_enclosure_component(cdev); | ||
| 333 | |||
| 334 | if (edev->cb->get_fault) | ||
| 335 | edev->cb->get_fault(edev, ecomp); | ||
| 336 | return snprintf(buf, 40, "%d\n", ecomp->fault); | ||
| 337 | } | ||
| 338 | |||
| 339 | static ssize_t set_component_fault(struct class_device *cdev, const char *buf, | ||
| 340 | size_t count) | ||
| 341 | { | ||
| 342 | struct enclosure_device *edev = to_enclosure_device(cdev->parent); | ||
| 343 | struct enclosure_component *ecomp = to_enclosure_component(cdev); | ||
| 344 | int val = simple_strtoul(buf, NULL, 0); | ||
| 345 | |||
| 346 | if (edev->cb->set_fault) | ||
| 347 | edev->cb->set_fault(edev, ecomp, val); | ||
| 348 | return count; | ||
| 349 | } | ||
| 350 | |||
| 351 | static ssize_t get_component_status(struct class_device *cdev, char *buf) | ||
| 352 | { | ||
| 353 | struct enclosure_device *edev = to_enclosure_device(cdev->parent); | ||
| 354 | struct enclosure_component *ecomp = to_enclosure_component(cdev); | ||
| 355 | |||
| 356 | if (edev->cb->get_status) | ||
| 357 | edev->cb->get_status(edev, ecomp); | ||
| 358 | return snprintf(buf, 40, "%s\n", enclosure_status[ecomp->status]); | ||
| 359 | } | ||
| 360 | |||
| 361 | static ssize_t set_component_status(struct class_device *cdev, const char *buf, | ||
| 362 | size_t count) | ||
| 363 | { | ||
| 364 | struct enclosure_device *edev = to_enclosure_device(cdev->parent); | ||
| 365 | struct enclosure_component *ecomp = to_enclosure_component(cdev); | ||
| 366 | int i; | ||
| 367 | |||
| 368 | for (i = 0; enclosure_status[i]; i++) { | ||
| 369 | if (strncmp(buf, enclosure_status[i], | ||
| 370 | strlen(enclosure_status[i])) == 0 && | ||
| 371 | (buf[strlen(enclosure_status[i])] == '\n' || | ||
| 372 | buf[strlen(enclosure_status[i])] == '\0')) | ||
| 373 | break; | ||
| 374 | } | ||
| 375 | |||
| 376 | if (enclosure_status[i] && edev->cb->set_status) { | ||
| 377 | edev->cb->set_status(edev, ecomp, i); | ||
| 378 | return count; | ||
| 379 | } else | ||
| 380 | return -EINVAL; | ||
| 381 | } | ||
| 382 | |||
| 383 | static ssize_t get_component_active(struct class_device *cdev, char *buf) | ||
| 384 | { | ||
| 385 | struct enclosure_device *edev = to_enclosure_device(cdev->parent); | ||
| 386 | struct enclosure_component *ecomp = to_enclosure_component(cdev); | ||
| 387 | |||
| 388 | if (edev->cb->get_active) | ||
| 389 | edev->cb->get_active(edev, ecomp); | ||
| 390 | return snprintf(buf, 40, "%d\n", ecomp->active); | ||
| 391 | } | ||
| 392 | |||
| 393 | static ssize_t set_component_active(struct class_device *cdev, const char *buf, | ||
| 394 | size_t count) | ||
| 395 | { | ||
| 396 | struct enclosure_device *edev = to_enclosure_device(cdev->parent); | ||
| 397 | struct enclosure_component *ecomp = to_enclosure_component(cdev); | ||
| 398 | int val = simple_strtoul(buf, NULL, 0); | ||
| 399 | |||
| 400 | if (edev->cb->set_active) | ||
| 401 | edev->cb->set_active(edev, ecomp, val); | ||
| 402 | return count; | ||
| 403 | } | ||
| 404 | |||
| 405 | static ssize_t get_component_locate(struct class_device *cdev, char *buf) | ||
| 406 | { | ||
| 407 | struct enclosure_device *edev = to_enclosure_device(cdev->parent); | ||
| 408 | struct enclosure_component *ecomp = to_enclosure_component(cdev); | ||
| 409 | |||
| 410 | if (edev->cb->get_locate) | ||
| 411 | edev->cb->get_locate(edev, ecomp); | ||
| 412 | return snprintf(buf, 40, "%d\n", ecomp->locate); | ||
| 413 | } | ||
| 414 | |||
| 415 | static ssize_t set_component_locate(struct class_device *cdev, const char *buf, | ||
| 416 | size_t count) | ||
| 417 | { | ||
| 418 | struct enclosure_device *edev = to_enclosure_device(cdev->parent); | ||
| 419 | struct enclosure_component *ecomp = to_enclosure_component(cdev); | ||
| 420 | int val = simple_strtoul(buf, NULL, 0); | ||
| 421 | |||
| 422 | if (edev->cb->set_locate) | ||
| 423 | edev->cb->set_locate(edev, ecomp, val); | ||
| 424 | return count; | ||
| 425 | } | ||
| 426 | |||
| 427 | static ssize_t get_component_type(struct class_device *cdev, char *buf) | ||
| 428 | { | ||
| 429 | struct enclosure_component *ecomp = to_enclosure_component(cdev); | ||
| 430 | |||
| 431 | return snprintf(buf, 40, "%s\n", enclosure_type[ecomp->type]); | ||
| 432 | } | ||
| 433 | |||
| 434 | |||
| 435 | static struct class_device_attribute enclosure_component_attrs[] = { | ||
| 436 | __ATTR(fault, S_IRUGO | S_IWUSR, get_component_fault, | ||
| 437 | set_component_fault), | ||
| 438 | __ATTR(status, S_IRUGO | S_IWUSR, get_component_status, | ||
| 439 | set_component_status), | ||
| 440 | __ATTR(active, S_IRUGO | S_IWUSR, get_component_active, | ||
| 441 | set_component_active), | ||
| 442 | __ATTR(locate, S_IRUGO | S_IWUSR, get_component_locate, | ||
| 443 | set_component_locate), | ||
| 444 | __ATTR(type, S_IRUGO, get_component_type, NULL), | ||
| 445 | __ATTR_NULL | ||
| 446 | }; | ||
| 447 | |||
| 448 | static struct class enclosure_component_class = { | ||
| 449 | .name = "enclosure_component", | ||
| 450 | .owner = THIS_MODULE, | ||
| 451 | .class_dev_attrs = enclosure_component_attrs, | ||
| 452 | .release = enclosure_component_release, | ||
| 453 | }; | ||
| 454 | |||
| 455 | static int __init enclosure_init(void) | ||
| 456 | { | ||
| 457 | int err; | ||
| 458 | |||
| 459 | err = class_register(&enclosure_class); | ||
| 460 | if (err) | ||
| 461 | return err; | ||
| 462 | err = class_register(&enclosure_component_class); | ||
| 463 | if (err) | ||
| 464 | goto err_out; | ||
| 465 | |||
| 466 | return 0; | ||
| 467 | err_out: | ||
| 468 | class_unregister(&enclosure_class); | ||
| 469 | |||
| 470 | return err; | ||
| 471 | } | ||
| 472 | |||
| 473 | static void __exit enclosure_exit(void) | ||
| 474 | { | ||
| 475 | class_unregister(&enclosure_component_class); | ||
| 476 | class_unregister(&enclosure_class); | ||
| 477 | } | ||
| 478 | |||
| 479 | module_init(enclosure_init); | ||
| 480 | module_exit(enclosure_exit); | ||
| 481 | |||
| 482 | MODULE_AUTHOR("James Bottomley"); | ||
| 483 | MODULE_DESCRIPTION("Enclosure Services"); | ||
| 484 | MODULE_LICENSE("GPL v2"); | ||
diff --git a/drivers/scsi/Kconfig b/drivers/scsi/Kconfig index 14fc7f39e83e..a5f0aaaf0dd4 100644 --- a/drivers/scsi/Kconfig +++ b/drivers/scsi/Kconfig | |||
| @@ -179,7 +179,15 @@ config CHR_DEV_SCH | |||
| 179 | say M here and read <file:Documentation/kbuild/modules.txt> and | 179 | say M here and read <file:Documentation/kbuild/modules.txt> and |
| 180 | <file:Documentation/scsi/scsi.txt>. The module will be called ch.o. | 180 | <file:Documentation/scsi/scsi.txt>. The module will be called ch.o. |
| 181 | If unsure, say N. | 181 | If unsure, say N. |
| 182 | 182 | ||
| 183 | config SCSI_ENCLOSURE | ||
| 184 | tristate "SCSI Enclosure Support" | ||
| 185 | depends on SCSI && ENCLOSURE_SERVICES | ||
| 186 | help | ||
| 187 | Enclosures are devices sitting on or in SCSI backplanes that | ||
| 188 | manage devices. If you have a disk cage, the chances are that | ||
| 189 | it has an enclosure device. Selecting this option will just allow | ||
| 190 | certain enclosure conditions to be reported and is not required. | ||
| 183 | 191 | ||
| 184 | comment "Some SCSI devices (e.g. CD jukebox) support multiple LUNs" | 192 | comment "Some SCSI devices (e.g. CD jukebox) support multiple LUNs" |
| 185 | depends on SCSI | 193 | depends on SCSI |
| @@ -350,17 +358,6 @@ config SGIWD93_SCSI | |||
| 350 | If you have a Western Digital WD93 SCSI controller on | 358 | If you have a Western Digital WD93 SCSI controller on |
| 351 | an SGI MIPS system, say Y. Otherwise, say N. | 359 | an SGI MIPS system, say Y. Otherwise, say N. |
| 352 | 360 | ||
| 353 | config SCSI_DECNCR | ||
| 354 | tristate "DEC NCR53C94 Scsi Driver" | ||
| 355 | depends on MACH_DECSTATION && SCSI && TC | ||
| 356 | help | ||
| 357 | Say Y here to support the NCR53C94 SCSI controller chips on IOASIC | ||
| 358 | based TURBOchannel DECstations and TURBOchannel PMAZ-A cards. | ||
| 359 | |||
| 360 | config SCSI_DECSII | ||
| 361 | tristate "DEC SII Scsi Driver" | ||
| 362 | depends on MACH_DECSTATION && SCSI && 32BIT | ||
| 363 | |||
| 364 | config BLK_DEV_3W_XXXX_RAID | 361 | config BLK_DEV_3W_XXXX_RAID |
| 365 | tristate "3ware 5/6/7/8xxx ATA-RAID support" | 362 | tristate "3ware 5/6/7/8xxx ATA-RAID support" |
| 366 | depends on PCI && SCSI | 363 | depends on PCI && SCSI |
| @@ -1263,17 +1260,6 @@ config SCSI_NCR53C8XX_NO_DISCONNECT | |||
| 1263 | not allow targets to disconnect is not reasonable if there is more | 1260 | not allow targets to disconnect is not reasonable if there is more |
| 1264 | than 1 device on a SCSI bus. The normal answer therefore is N. | 1261 | than 1 device on a SCSI bus. The normal answer therefore is N. |
| 1265 | 1262 | ||
| 1266 | config SCSI_MCA_53C9X | ||
| 1267 | tristate "NCR MCA 53C9x SCSI support" | ||
| 1268 | depends on MCA_LEGACY && SCSI && BROKEN_ON_SMP | ||
| 1269 | help | ||
| 1270 | Some MicroChannel machines, notably the NCR 35xx line, use a SCSI | ||
| 1271 | controller based on the NCR 53C94. This driver will allow use of | ||
| 1272 | the controller on the 3550, and very possibly others. | ||
| 1273 | |||
| 1274 | To compile this driver as a module, choose M here: the | ||
| 1275 | module will be called mca_53c9x. | ||
| 1276 | |||
| 1277 | config SCSI_PAS16 | 1263 | config SCSI_PAS16 |
| 1278 | tristate "PAS16 SCSI support" | 1264 | tristate "PAS16 SCSI support" |
| 1279 | depends on ISA && SCSI | 1265 | depends on ISA && SCSI |
| @@ -1600,45 +1586,6 @@ config GVP11_SCSI | |||
| 1600 | To compile this driver as a module, choose M here: the | 1586 | To compile this driver as a module, choose M here: the |
| 1601 | module will be called gvp11. | 1587 | module will be called gvp11. |
| 1602 | 1588 | ||
| 1603 | config CYBERSTORM_SCSI | ||
| 1604 | tristate "CyberStorm SCSI support" | ||
| 1605 | depends on ZORRO && SCSI | ||
| 1606 | help | ||
| 1607 | If you have an Amiga with an original (MkI) Phase5 Cyberstorm | ||
| 1608 | accelerator board and the optional Cyberstorm SCSI controller, | ||
| 1609 | answer Y. Otherwise, say N. | ||
| 1610 | |||
| 1611 | config CYBERSTORMII_SCSI | ||
| 1612 | tristate "CyberStorm Mk II SCSI support" | ||
| 1613 | depends on ZORRO && SCSI | ||
| 1614 | help | ||
| 1615 | If you have an Amiga with a Phase5 Cyberstorm MkII accelerator board | ||
| 1616 | and the optional Cyberstorm SCSI controller, say Y. Otherwise, | ||
| 1617 | answer N. | ||
| 1618 | |||
| 1619 | config BLZ2060_SCSI | ||
| 1620 | tristate "Blizzard 2060 SCSI support" | ||
| 1621 | depends on ZORRO && SCSI | ||
| 1622 | help | ||
| 1623 | If you have an Amiga with a Phase5 Blizzard 2060 accelerator board | ||
| 1624 | and want to use the onboard SCSI controller, say Y. Otherwise, | ||
| 1625 | answer N. | ||
| 1626 | |||
| 1627 | config BLZ1230_SCSI | ||
| 1628 | tristate "Blizzard 1230IV/1260 SCSI support" | ||
| 1629 | depends on ZORRO && SCSI | ||
| 1630 | help | ||
| 1631 | If you have an Amiga 1200 with a Phase5 Blizzard 1230IV or Blizzard | ||
| 1632 | 1260 accelerator, and the optional SCSI module, say Y. Otherwise, | ||
| 1633 | say N. | ||
| 1634 | |||
| 1635 | config FASTLANE_SCSI | ||
| 1636 | tristate "Fastlane SCSI support" | ||
| 1637 | depends on ZORRO && SCSI | ||
| 1638 | help | ||
| 1639 | If you have the Phase5 Fastlane Z3 SCSI controller, or plan to use | ||
| 1640 | one in the near future, say Y to this question. Otherwise, say N. | ||
| 1641 | |||
| 1642 | config SCSI_A4000T | 1589 | config SCSI_A4000T |
| 1643 | tristate "A4000T NCR53c710 SCSI support (EXPERIMENTAL)" | 1590 | tristate "A4000T NCR53c710 SCSI support (EXPERIMENTAL)" |
| 1644 | depends on AMIGA && SCSI && EXPERIMENTAL | 1591 | depends on AMIGA && SCSI && EXPERIMENTAL |
| @@ -1666,15 +1613,6 @@ config SCSI_ZORRO7XX | |||
| 1666 | accelerator card for the Amiga 1200, | 1613 | accelerator card for the Amiga 1200, |
| 1667 | - the SCSI controller on the GVP Turbo 040/060 accelerator. | 1614 | - the SCSI controller on the GVP Turbo 040/060 accelerator. |
| 1668 | 1615 | ||
| 1669 | config OKTAGON_SCSI | ||
| 1670 | tristate "BSC Oktagon SCSI support (EXPERIMENTAL)" | ||
| 1671 | depends on ZORRO && SCSI && EXPERIMENTAL | ||
| 1672 | help | ||
| 1673 | If you have the BSC Oktagon SCSI disk controller for the Amiga, say | ||
| 1674 | Y to this question. If you're in doubt about whether you have one, | ||
| 1675 | see the picture at | ||
| 1676 | <http://amiga.resource.cx/exp/search.pl?product=oktagon>. | ||
| 1677 | |||
| 1678 | config ATARI_SCSI | 1616 | config ATARI_SCSI |
| 1679 | tristate "Atari native SCSI support" | 1617 | tristate "Atari native SCSI support" |
| 1680 | depends on ATARI && SCSI | 1618 | depends on ATARI && SCSI |
| @@ -1727,18 +1665,6 @@ config MAC_SCSI | |||
| 1727 | SCSI-HOWTO, available from | 1665 | SCSI-HOWTO, available from |
| 1728 | <http://www.tldp.org/docs.html#howto>. | 1666 | <http://www.tldp.org/docs.html#howto>. |
| 1729 | 1667 | ||
| 1730 | config SCSI_MAC_ESP | ||
| 1731 | tristate "Macintosh NCR53c9[46] SCSI" | ||
| 1732 | depends on MAC && SCSI | ||
| 1733 | help | ||
| 1734 | This is the NCR 53c9x SCSI controller found on most of the 68040 | ||
| 1735 | based Macintoshes. If you have one of these say Y and read the | ||
| 1736 | SCSI-HOWTO, available from | ||
| 1737 | <http://www.tldp.org/docs.html#howto>. | ||
| 1738 | |||
| 1739 | To compile this driver as a module, choose M here: the | ||
| 1740 | module will be called mac_esp. | ||
| 1741 | |||
| 1742 | config MVME147_SCSI | 1668 | config MVME147_SCSI |
| 1743 | bool "WD33C93 SCSI driver for MVME147" | 1669 | bool "WD33C93 SCSI driver for MVME147" |
| 1744 | depends on MVME147 && SCSI=y | 1670 | depends on MVME147 && SCSI=y |
| @@ -1779,6 +1705,7 @@ config SUN3_SCSI | |||
| 1779 | config SUN3X_ESP | 1705 | config SUN3X_ESP |
| 1780 | bool "Sun3x ESP SCSI" | 1706 | bool "Sun3x ESP SCSI" |
| 1781 | depends on SUN3X && SCSI=y | 1707 | depends on SUN3X && SCSI=y |
| 1708 | select SCSI_SPI_ATTRS | ||
| 1782 | help | 1709 | help |
| 1783 | The ESP was an on-board SCSI controller used on Sun 3/80 | 1710 | The ESP was an on-board SCSI controller used on Sun 3/80 |
| 1784 | machines. Say Y here to compile in support for it. | 1711 | machines. Say Y here to compile in support for it. |
diff --git a/drivers/scsi/Makefile b/drivers/scsi/Makefile index 93e1428d03fc..925c26b4fff9 100644 --- a/drivers/scsi/Makefile +++ b/drivers/scsi/Makefile | |||
| @@ -44,15 +44,8 @@ obj-$(CONFIG_A2091_SCSI) += a2091.o wd33c93.o | |||
| 44 | obj-$(CONFIG_GVP11_SCSI) += gvp11.o wd33c93.o | 44 | obj-$(CONFIG_GVP11_SCSI) += gvp11.o wd33c93.o |
| 45 | obj-$(CONFIG_MVME147_SCSI) += mvme147.o wd33c93.o | 45 | obj-$(CONFIG_MVME147_SCSI) += mvme147.o wd33c93.o |
| 46 | obj-$(CONFIG_SGIWD93_SCSI) += sgiwd93.o wd33c93.o | 46 | obj-$(CONFIG_SGIWD93_SCSI) += sgiwd93.o wd33c93.o |
| 47 | obj-$(CONFIG_CYBERSTORM_SCSI) += NCR53C9x.o cyberstorm.o | ||
| 48 | obj-$(CONFIG_CYBERSTORMII_SCSI) += NCR53C9x.o cyberstormII.o | ||
| 49 | obj-$(CONFIG_BLZ2060_SCSI) += NCR53C9x.o blz2060.o | ||
| 50 | obj-$(CONFIG_BLZ1230_SCSI) += NCR53C9x.o blz1230.o | ||
| 51 | obj-$(CONFIG_FASTLANE_SCSI) += NCR53C9x.o fastlane.o | ||
| 52 | obj-$(CONFIG_OKTAGON_SCSI) += NCR53C9x.o oktagon_esp_mod.o | ||
| 53 | obj-$(CONFIG_ATARI_SCSI) += atari_scsi.o | 47 | obj-$(CONFIG_ATARI_SCSI) += atari_scsi.o |
| 54 | obj-$(CONFIG_MAC_SCSI) += mac_scsi.o | 48 | obj-$(CONFIG_MAC_SCSI) += mac_scsi.o |
| 55 | obj-$(CONFIG_SCSI_MAC_ESP) += mac_esp.o NCR53C9x.o | ||
| 56 | obj-$(CONFIG_SUN3_SCSI) += sun3_scsi.o sun3_scsi_vme.o | 49 | obj-$(CONFIG_SUN3_SCSI) += sun3_scsi.o sun3_scsi_vme.o |
| 57 | obj-$(CONFIG_MVME16x_SCSI) += 53c700.o mvme16x_scsi.o | 50 | obj-$(CONFIG_MVME16x_SCSI) += 53c700.o mvme16x_scsi.o |
| 58 | obj-$(CONFIG_BVME6000_SCSI) += 53c700.o bvme6000_scsi.o | 51 | obj-$(CONFIG_BVME6000_SCSI) += 53c700.o bvme6000_scsi.o |
| @@ -95,7 +88,6 @@ obj-$(CONFIG_SCSI_SYM53C8XX_2) += sym53c8xx_2/ | |||
| 95 | obj-$(CONFIG_SCSI_ZALON) += zalon7xx.o | 88 | obj-$(CONFIG_SCSI_ZALON) += zalon7xx.o |
| 96 | obj-$(CONFIG_SCSI_EATA_PIO) += eata_pio.o | 89 | obj-$(CONFIG_SCSI_EATA_PIO) += eata_pio.o |
| 97 | obj-$(CONFIG_SCSI_7000FASST) += wd7000.o | 90 | obj-$(CONFIG_SCSI_7000FASST) += wd7000.o |
| 98 | obj-$(CONFIG_SCSI_MCA_53C9X) += NCR53C9x.o mca_53c9x.o | ||
| 99 | obj-$(CONFIG_SCSI_IBMMCA) += ibmmca.o | 91 | obj-$(CONFIG_SCSI_IBMMCA) += ibmmca.o |
| 100 | obj-$(CONFIG_SCSI_EATA) += eata.o | 92 | obj-$(CONFIG_SCSI_EATA) += eata.o |
| 101 | obj-$(CONFIG_SCSI_DC395x) += dc395x.o | 93 | obj-$(CONFIG_SCSI_DC395x) += dc395x.o |
| @@ -112,13 +104,12 @@ obj-$(CONFIG_SCSI_QLOGICPTI) += qlogicpti.o | |||
| 112 | obj-$(CONFIG_BLK_DEV_IDESCSI) += ide-scsi.o | 104 | obj-$(CONFIG_BLK_DEV_IDESCSI) += ide-scsi.o |
| 113 | obj-$(CONFIG_SCSI_MESH) += mesh.o | 105 | obj-$(CONFIG_SCSI_MESH) += mesh.o |
| 114 | obj-$(CONFIG_SCSI_MAC53C94) += mac53c94.o | 106 | obj-$(CONFIG_SCSI_MAC53C94) += mac53c94.o |
| 115 | obj-$(CONFIG_SCSI_DECNCR) += NCR53C9x.o dec_esp.o | ||
| 116 | obj-$(CONFIG_BLK_DEV_3W_XXXX_RAID) += 3w-xxxx.o | 107 | obj-$(CONFIG_BLK_DEV_3W_XXXX_RAID) += 3w-xxxx.o |
| 117 | obj-$(CONFIG_SCSI_3W_9XXX) += 3w-9xxx.o | 108 | obj-$(CONFIG_SCSI_3W_9XXX) += 3w-9xxx.o |
| 118 | obj-$(CONFIG_SCSI_PPA) += ppa.o | 109 | obj-$(CONFIG_SCSI_PPA) += ppa.o |
| 119 | obj-$(CONFIG_SCSI_IMM) += imm.o | 110 | obj-$(CONFIG_SCSI_IMM) += imm.o |
| 120 | obj-$(CONFIG_JAZZ_ESP) += esp_scsi.o jazz_esp.o | 111 | obj-$(CONFIG_JAZZ_ESP) += esp_scsi.o jazz_esp.o |
| 121 | obj-$(CONFIG_SUN3X_ESP) += NCR53C9x.o sun3x_esp.o | 112 | obj-$(CONFIG_SUN3X_ESP) += esp_scsi.o sun3x_esp.o |
| 122 | obj-$(CONFIG_SCSI_LASI700) += 53c700.o lasi700.o | 113 | obj-$(CONFIG_SCSI_LASI700) += 53c700.o lasi700.o |
| 123 | obj-$(CONFIG_SCSI_SNI_53C710) += 53c700.o sni_53c710.o | 114 | obj-$(CONFIG_SCSI_SNI_53C710) += 53c700.o sni_53c710.o |
| 124 | obj-$(CONFIG_SCSI_NSP32) += nsp32.o | 115 | obj-$(CONFIG_SCSI_NSP32) += nsp32.o |
| @@ -138,6 +129,7 @@ obj-$(CONFIG_BLK_DEV_SD) += sd_mod.o | |||
| 138 | obj-$(CONFIG_BLK_DEV_SR) += sr_mod.o | 129 | obj-$(CONFIG_BLK_DEV_SR) += sr_mod.o |
| 139 | obj-$(CONFIG_CHR_DEV_SG) += sg.o | 130 | obj-$(CONFIG_CHR_DEV_SG) += sg.o |
| 140 | obj-$(CONFIG_CHR_DEV_SCH) += ch.o | 131 | obj-$(CONFIG_CHR_DEV_SCH) += ch.o |
| 132 | obj-$(CONFIG_SCSI_ENCLOSURE) += ses.o | ||
| 141 | 133 | ||
| 142 | # This goes last, so that "real" scsi devices probe earlier | 134 | # This goes last, so that "real" scsi devices probe earlier |
| 143 | obj-$(CONFIG_SCSI_DEBUG) += scsi_debug.o | 135 | obj-$(CONFIG_SCSI_DEBUG) += scsi_debug.o |
diff --git a/drivers/scsi/NCR53C9x.c b/drivers/scsi/NCR53C9x.c deleted file mode 100644 index 5b0efc903918..000000000000 --- a/drivers/scsi/NCR53C9x.c +++ /dev/null | |||
| @@ -1,3654 +0,0 @@ | |||
| 1 | /* NCR53C9x.c: Generic SCSI driver code for NCR53C9x chips. | ||
| 2 | * | ||
| 3 | * Originally esp.c : EnhancedScsiProcessor Sun SCSI driver code. | ||
| 4 | * | ||
| 5 | * Copyright (C) 1995, 1998 David S. Miller (davem@caip.rutgers.edu) | ||
| 6 | * | ||
| 7 | * Most DMA dependencies put in driver specific files by | ||
| 8 | * Jesper Skov (jskov@cygnus.co.uk) | ||
| 9 | * | ||
| 10 | * Set up to use esp_read/esp_write (preprocessor macros in NCR53c9x.h) by | ||
| 11 | * Tymm Twillman (tymm@coe.missouri.edu) | ||
| 12 | */ | ||
| 13 | |||
| 14 | /* TODO: | ||
| 15 | * | ||
| 16 | * 1) Maybe disable parity checking in config register one for SCSI1 | ||
| 17 | * targets. (Gilmore says parity error on the SBus can lock up | ||
| 18 | * old sun4c's) | ||
| 19 | * 2) Add support for DMA2 pipelining. | ||
| 20 | * 3) Add tagged queueing. | ||
| 21 | * 4) Maybe change use of "esp" to something more "NCR"'ish. | ||
| 22 | */ | ||
| 23 | |||
| 24 | #include <linux/module.h> | ||
| 25 | |||
| 26 | #include <linux/kernel.h> | ||
| 27 | #include <linux/delay.h> | ||
| 28 | #include <linux/types.h> | ||
| 29 | #include <linux/string.h> | ||
| 30 | #include <linux/slab.h> | ||
| 31 | #include <linux/blkdev.h> | ||
| 32 | #include <linux/interrupt.h> | ||
| 33 | #include <linux/proc_fs.h> | ||
| 34 | #include <linux/stat.h> | ||
| 35 | #include <linux/init.h> | ||
| 36 | |||
| 37 | #include "scsi.h" | ||
| 38 | #include <scsi/scsi_host.h> | ||
| 39 | #include "NCR53C9x.h" | ||
| 40 | |||
| 41 | #include <asm/system.h> | ||
| 42 | #include <asm/ptrace.h> | ||
| 43 | #include <asm/pgtable.h> | ||
| 44 | #include <asm/io.h> | ||
| 45 | #include <asm/irq.h> | ||
| 46 | |||
| 47 | /* Command phase enumeration. */ | ||
| 48 | enum { | ||
| 49 | not_issued = 0x00, /* Still in the issue_SC queue. */ | ||
| 50 | |||
| 51 | /* Various forms of selecting a target. */ | ||
| 52 | #define in_slct_mask 0x10 | ||
| 53 | in_slct_norm = 0x10, /* ESP is arbitrating, normal selection */ | ||
| 54 | in_slct_stop = 0x11, /* ESP will select, then stop with IRQ */ | ||
| 55 | in_slct_msg = 0x12, /* select, then send a message */ | ||
| 56 | in_slct_tag = 0x13, /* select and send tagged queue msg */ | ||
| 57 | in_slct_sneg = 0x14, /* select and acquire sync capabilities */ | ||
| 58 | |||
| 59 | /* Any post selection activity. */ | ||
| 60 | #define in_phases_mask 0x20 | ||
| 61 | in_datain = 0x20, /* Data is transferring from the bus */ | ||
| 62 | in_dataout = 0x21, /* Data is transferring to the bus */ | ||
| 63 | in_data_done = 0x22, /* Last DMA data operation done (maybe) */ | ||
| 64 | in_msgin = 0x23, /* Eating message from target */ | ||
| 65 | in_msgincont = 0x24, /* Eating more msg bytes from target */ | ||
| 66 | in_msgindone = 0x25, /* Decide what to do with what we got */ | ||
| 67 | in_msgout = 0x26, /* Sending message to target */ | ||
| 68 | in_msgoutdone = 0x27, /* Done sending msg out */ | ||
| 69 | in_cmdbegin = 0x28, /* Sending cmd after abnormal selection */ | ||
| 70 | in_cmdend = 0x29, /* Done sending slow cmd */ | ||
| 71 | in_status = 0x2a, /* Was in status phase, finishing cmd */ | ||
| 72 | in_freeing = 0x2b, /* freeing the bus for cmd cmplt or disc */ | ||
| 73 | in_the_dark = 0x2c, /* Don't know what bus phase we are in */ | ||
| 74 | |||
| 75 | /* Special states, ie. not normal bus transitions... */ | ||
| 76 | #define in_spec_mask 0x80 | ||
| 77 | in_abortone = 0x80, /* Aborting one command currently */ | ||
| 78 | in_abortall = 0x81, /* Blowing away all commands we have */ | ||
| 79 | in_resetdev = 0x82, /* SCSI target reset in progress */ | ||
| 80 | in_resetbus = 0x83, /* SCSI bus reset in progress */ | ||
| 81 | in_tgterror = 0x84, /* Target did something stupid */ | ||
| 82 | }; | ||
| 83 | |||
| 84 | enum { | ||
| 85 | /* Zero has special meaning, see skipahead[12]. */ | ||
| 86 | /*0*/ do_never, | ||
| 87 | |||
| 88 | /*1*/ do_phase_determine, | ||
| 89 | /*2*/ do_reset_bus, | ||
| 90 | /*3*/ do_reset_complete, | ||
| 91 | /*4*/ do_work_bus, | ||
| 92 | /*5*/ do_intr_end | ||
| 93 | }; | ||
| 94 | |||
| 95 | /* The master ring of all esp hosts we are managing in this driver. */ | ||
| 96 | static struct NCR_ESP *espchain; | ||
| 97 | int nesps = 0, esps_in_use = 0, esps_running = 0; | ||
| 98 | EXPORT_SYMBOL(nesps); | ||
| 99 | EXPORT_SYMBOL(esps_running); | ||
| 100 | |||
| 101 | irqreturn_t esp_intr(int irq, void *dev_id); | ||
| 102 | |||
| 103 | /* Debugging routines */ | ||
| 104 | static struct esp_cmdstrings { | ||
| 105 | unchar cmdchar; | ||
| 106 | char *text; | ||
| 107 | } esp_cmd_strings[] = { | ||
| 108 | /* Miscellaneous */ | ||
| 109 | { ESP_CMD_NULL, "ESP_NOP", }, | ||
| 110 | { ESP_CMD_FLUSH, "FIFO_FLUSH", }, | ||
| 111 | { ESP_CMD_RC, "RSTESP", }, | ||
| 112 | { ESP_CMD_RS, "RSTSCSI", }, | ||
| 113 | /* Disconnected State Group */ | ||
| 114 | { ESP_CMD_RSEL, "RESLCTSEQ", }, | ||
| 115 | { ESP_CMD_SEL, "SLCTNATN", }, | ||
| 116 | { ESP_CMD_SELA, "SLCTATN", }, | ||
| 117 | { ESP_CMD_SELAS, "SLCTATNSTOP", }, | ||
| 118 | { ESP_CMD_ESEL, "ENSLCTRESEL", }, | ||
| 119 | { ESP_CMD_DSEL, "DISSELRESEL", }, | ||
| 120 | { ESP_CMD_SA3, "SLCTATN3", }, | ||
| 121 | { ESP_CMD_RSEL3, "RESLCTSEQ", }, | ||
| 122 | /* Target State Group */ | ||
| 123 | { ESP_CMD_SMSG, "SNDMSG", }, | ||
| 124 | { ESP_CMD_SSTAT, "SNDSTATUS", }, | ||
| 125 | { ESP_CMD_SDATA, "SNDDATA", }, | ||
| 126 | { ESP_CMD_DSEQ, "DISCSEQ", }, | ||
| 127 | { ESP_CMD_TSEQ, "TERMSEQ", }, | ||
| 128 | { ESP_CMD_TCCSEQ, "TRGTCMDCOMPSEQ", }, | ||
| 129 | { ESP_CMD_DCNCT, "DISC", }, | ||
| 130 | { ESP_CMD_RMSG, "RCVMSG", }, | ||
| 131 | { ESP_CMD_RCMD, "RCVCMD", }, | ||
| 132 | { ESP_CMD_RDATA, "RCVDATA", }, | ||
| 133 | { ESP_CMD_RCSEQ, "RCVCMDSEQ", }, | ||
| 134 | /* Initiator State Group */ | ||
| 135 | { ESP_CMD_TI, "TRANSINFO", }, | ||
| 136 | { ESP_CMD_ICCSEQ, "INICMDSEQCOMP", }, | ||
| 137 | { ESP_CMD_MOK, "MSGACCEPTED", }, | ||
| 138 | { ESP_CMD_TPAD, "TPAD", }, | ||
| 139 | { ESP_CMD_SATN, "SATN", }, | ||
| 140 | { ESP_CMD_RATN, "RATN", }, | ||
| 141 | }; | ||
| 142 | #define NUM_ESP_COMMANDS ((sizeof(esp_cmd_strings)) / (sizeof(struct esp_cmdstrings))) | ||
| 143 | |||
| 144 | /* Print textual representation of an ESP command */ | ||
| 145 | static inline void esp_print_cmd(unchar espcmd) | ||
| 146 | { | ||
| 147 | unchar dma_bit = espcmd & ESP_CMD_DMA; | ||
| 148 | int i; | ||
| 149 | |||
| 150 | espcmd &= ~dma_bit; | ||
| 151 | for(i=0; i<NUM_ESP_COMMANDS; i++) | ||
| 152 | if(esp_cmd_strings[i].cmdchar == espcmd) | ||
| 153 | break; | ||
| 154 | if(i==NUM_ESP_COMMANDS) | ||
| 155 | printk("ESP_Unknown"); | ||
| 156 | else | ||
| 157 | printk("%s%s", esp_cmd_strings[i].text, | ||
| 158 | ((dma_bit) ? "+DMA" : "")); | ||
| 159 | } | ||
| 160 | |||
| 161 | /* Print the status register's value */ | ||
| 162 | static inline void esp_print_statreg(unchar statreg) | ||
| 163 | { | ||
| 164 | unchar phase; | ||
| 165 | |||
| 166 | printk("STATUS<"); | ||
| 167 | phase = statreg & ESP_STAT_PMASK; | ||
| 168 | printk("%s,", (phase == ESP_DOP ? "DATA-OUT" : | ||
| 169 | (phase == ESP_DIP ? "DATA-IN" : | ||
| 170 | (phase == ESP_CMDP ? "COMMAND" : | ||
| 171 | (phase == ESP_STATP ? "STATUS" : | ||
| 172 | (phase == ESP_MOP ? "MSG-OUT" : | ||
| 173 | (phase == ESP_MIP ? "MSG_IN" : | ||
| 174 | "unknown"))))))); | ||
| 175 | if(statreg & ESP_STAT_TDONE) | ||
| 176 | printk("TRANS_DONE,"); | ||
| 177 | if(statreg & ESP_STAT_TCNT) | ||
| 178 | printk("TCOUNT_ZERO,"); | ||
| 179 | if(statreg & ESP_STAT_PERR) | ||
| 180 | printk("P_ERROR,"); | ||
| 181 | if(statreg & ESP_STAT_SPAM) | ||
| 182 | printk("SPAM,"); | ||
| 183 | if(statreg & ESP_STAT_INTR) | ||
| 184 | printk("IRQ,"); | ||
| 185 | printk(">"); | ||
| 186 | } | ||
| 187 | |||
| 188 | /* Print the interrupt register's value */ | ||
| 189 | static inline void esp_print_ireg(unchar intreg) | ||
| 190 | { | ||
| 191 | printk("INTREG< "); | ||
| 192 | if(intreg & ESP_INTR_S) | ||
| 193 | printk("SLCT_NATN "); | ||
| 194 | if(intreg & ESP_INTR_SATN) | ||
| 195 | printk("SLCT_ATN "); | ||
| 196 | if(intreg & ESP_INTR_RSEL) | ||
| 197 | printk("RSLCT "); | ||
| 198 | if(intreg & ESP_INTR_FDONE) | ||
| 199 | printk("FDONE "); | ||
| 200 | if(intreg & ESP_INTR_BSERV) | ||
| 201 | printk("BSERV "); | ||
| 202 | if(intreg & ESP_INTR_DC) | ||
| 203 | printk("DISCNCT "); | ||
| 204 | if(intreg & ESP_INTR_IC) | ||
| 205 | printk("ILL_CMD "); | ||
| 206 | if(intreg & ESP_INTR_SR) | ||
| 207 | printk("SCSI_BUS_RESET "); | ||
| 208 | printk(">"); | ||
| 209 | } | ||
| 210 | |||
| 211 | /* Print the sequence step registers contents */ | ||
| 212 | static inline void esp_print_seqreg(unchar stepreg) | ||
| 213 | { | ||
| 214 | stepreg &= ESP_STEP_VBITS; | ||
| 215 | printk("STEP<%s>", | ||
| 216 | (stepreg == ESP_STEP_ASEL ? "SLCT_ARB_CMPLT" : | ||
| 217 | (stepreg == ESP_STEP_SID ? "1BYTE_MSG_SENT" : | ||
| 218 | (stepreg == ESP_STEP_NCMD ? "NOT_IN_CMD_PHASE" : | ||
| 219 | (stepreg == ESP_STEP_PPC ? "CMD_BYTES_LOST" : | ||
| 220 | (stepreg == ESP_STEP_FINI4 ? "CMD_SENT_OK" : | ||
| 221 | "UNKNOWN")))))); | ||
| 222 | } | ||
| 223 | |||
| 224 | static char *phase_string(int phase) | ||
| 225 | { | ||
| 226 | switch(phase) { | ||
| 227 | case not_issued: | ||
| 228 | return "UNISSUED"; | ||
| 229 | case in_slct_norm: | ||
| 230 | return "SLCTNORM"; | ||
| 231 | case in_slct_stop: | ||
| 232 | return "SLCTSTOP"; | ||
| 233 | case in_slct_msg: | ||
| 234 | return "SLCTMSG"; | ||
| 235 | case in_slct_tag: | ||
| 236 | return "SLCTTAG"; | ||
| 237 | case in_slct_sneg: | ||
| 238 | return "SLCTSNEG"; | ||
| 239 | case in_datain: | ||
| 240 | return "DATAIN"; | ||
| 241 | case in_dataout: | ||
| 242 | return "DATAOUT"; | ||
| 243 | case in_data_done: | ||
| 244 | return "DATADONE"; | ||
| 245 | case in_msgin: | ||
| 246 | return "MSGIN"; | ||
| 247 | case in_msgincont: | ||
| 248 | return "MSGINCONT"; | ||
| 249 | case in_msgindone: | ||
| 250 | return "MSGINDONE"; | ||
| 251 | case in_msgout: | ||
| 252 | return "MSGOUT"; | ||
| 253 | case in_msgoutdone: | ||
| 254 | return "MSGOUTDONE"; | ||
| 255 | case in_cmdbegin: | ||
| 256 | return "CMDBEGIN"; | ||
| 257 | case in_cmdend: | ||
| 258 | return "CMDEND"; | ||
| 259 | case in_status: | ||
| 260 | return "STATUS"; | ||
| 261 | case in_freeing: | ||
| 262 | return "FREEING"; | ||
| 263 | case in_the_dark: | ||
| 264 | return "CLUELESS"; | ||
| 265 | case in_abortone: | ||
| 266 | return "ABORTONE"; | ||
| 267 | case in_abortall: | ||
| 268 | return "ABORTALL"; | ||
| 269 | case in_resetdev: | ||
| 270 | return "RESETDEV"; | ||
| 271 | case in_resetbus: | ||
| 272 | return "RESETBUS"; | ||
| 273 | case in_tgterror: | ||
| 274 | return "TGTERROR"; | ||
| 275 | default: | ||
| 276 | return "UNKNOWN"; | ||
| 277 | }; | ||
| 278 | } | ||
| 279 | |||
| 280 | #ifdef DEBUG_STATE_MACHINE | ||
| 281 | static inline void esp_advance_phase(Scsi_Cmnd *s, int newphase) | ||
| 282 | { | ||
| 283 | ESPLOG(("<%s>", phase_string(newphase))); | ||
| 284 | s->SCp.sent_command = s->SCp.phase; | ||
| 285 | s->SCp.phase = newphase; | ||
| 286 | } | ||
| 287 | #else | ||
| 288 | #define esp_advance_phase(__s, __newphase) \ | ||
| 289 | (__s)->SCp.sent_command = (__s)->SCp.phase; \ | ||
| 290 | (__s)->SCp.phase = (__newphase); | ||
| 291 | #endif | ||
| 292 | |||
| 293 | #ifdef DEBUG_ESP_CMDS | ||
| 294 | static inline void esp_cmd(struct NCR_ESP *esp, struct ESP_regs *eregs, | ||
| 295 | unchar cmd) | ||
| 296 | { | ||
| 297 | esp->espcmdlog[esp->espcmdent] = cmd; | ||
| 298 | esp->espcmdent = (esp->espcmdent + 1) & 31; | ||
| 299 | esp_write(eregs->esp_cmnd, cmd); | ||
| 300 | } | ||
| 301 | #else | ||
| 302 | #define esp_cmd(__esp, __eregs, __cmd) esp_write((__eregs)->esp_cmnd, (__cmd)) | ||
| 303 | #endif | ||
| 304 | |||
| 305 | /* How we use the various Linux SCSI data structures for operation. | ||
| 306 | * | ||
| 307 | * struct scsi_cmnd: | ||
| 308 | * | ||
| 309 | * We keep track of the syncronous capabilities of a target | ||
| 310 | * in the device member, using sync_min_period and | ||
| 311 | * sync_max_offset. These are the values we directly write | ||
| 312 | * into the ESP registers while running a command. If offset | ||
| 313 | * is zero the ESP will use asynchronous transfers. | ||
| 314 | * If the borken flag is set we assume we shouldn't even bother | ||
| 315 | * trying to negotiate for synchronous transfer as this target | ||
| 316 | * is really stupid. If we notice the target is dropping the | ||
| 317 | * bus, and we have been allowing it to disconnect, we clear | ||
| 318 | * the disconnect flag. | ||
| 319 | */ | ||
| 320 | |||
| 321 | /* Manipulation of the ESP command queues. Thanks to the aha152x driver | ||
| 322 | * and its author, Juergen E. Fischer, for the methods used here. | ||
| 323 | * Note that these are per-ESP queues, not global queues like | ||
| 324 | * the aha152x driver uses. | ||
| 325 | */ | ||
| 326 | static inline void append_SC(Scsi_Cmnd **SC, Scsi_Cmnd *new_SC) | ||
| 327 | { | ||
| 328 | Scsi_Cmnd *end; | ||
| 329 | |||
| 330 | new_SC->host_scribble = (unsigned char *) NULL; | ||
| 331 | if(!*SC) | ||
| 332 | *SC = new_SC; | ||
| 333 | else { | ||
| 334 | for(end=*SC;end->host_scribble;end=(Scsi_Cmnd *)end->host_scribble) | ||
| 335 | ; | ||
| 336 | end->host_scribble = (unsigned char *) new_SC; | ||
| 337 | } | ||
| 338 | } | ||
| 339 | |||
| 340 | static inline void prepend_SC(Scsi_Cmnd **SC, Scsi_Cmnd *new_SC) | ||
| 341 | { | ||
| 342 | new_SC->host_scribble = (unsigned char *) *SC; | ||
| 343 | *SC = new_SC; | ||
| 344 | } | ||
| 345 | |||
| 346 | static inline Scsi_Cmnd *remove_first_SC(Scsi_Cmnd **SC) | ||
| 347 | { | ||
| 348 | Scsi_Cmnd *ptr; | ||
| 349 | |||
| 350 | ptr = *SC; | ||
| 351 | if(ptr) | ||
| 352 | *SC = (Scsi_Cmnd *) (*SC)->host_scribble; | ||
| 353 | return ptr; | ||
| 354 | } | ||
| 355 | |||
| 356 | static inline Scsi_Cmnd *remove_SC(Scsi_Cmnd **SC, int target, int lun) | ||
| 357 | { | ||
| 358 | Scsi_Cmnd *ptr, *prev; | ||
| 359 | |||
| 360 | for(ptr = *SC, prev = NULL; | ||
| 361 | ptr && ((ptr->device->id != target) || (ptr->device->lun != lun)); | ||
| 362 | prev = ptr, ptr = (Scsi_Cmnd *) ptr->host_scribble) | ||
| 363 | ; | ||
| 364 | if(ptr) { | ||
| 365 | if(prev) | ||
| 366 | prev->host_scribble=ptr->host_scribble; | ||
| 367 | else | ||
| 368 | *SC=(Scsi_Cmnd *)ptr->host_scribble; | ||
| 369 | } | ||
| 370 | return ptr; | ||
| 371 | } | ||
| 372 | |||
| 373 | /* Resetting various pieces of the ESP scsi driver chipset */ | ||
| 374 | |||
| 375 | /* Reset the ESP chip, _not_ the SCSI bus. */ | ||
| 376 | static void esp_reset_esp(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 377 | { | ||
| 378 | int family_code, version, i; | ||
| 379 | volatile int trash; | ||
| 380 | |||
| 381 | /* Now reset the ESP chip */ | ||
| 382 | esp_cmd(esp, eregs, ESP_CMD_RC); | ||
| 383 | esp_cmd(esp, eregs, ESP_CMD_NULL | ESP_CMD_DMA); | ||
| 384 | if(esp->erev == fast) | ||
| 385 | esp_write(eregs->esp_cfg2, ESP_CONFIG2_FENAB); | ||
| 386 | esp_cmd(esp, eregs, ESP_CMD_NULL | ESP_CMD_DMA); | ||
| 387 | |||
| 388 | /* This is the only point at which it is reliable to read | ||
| 389 | * the ID-code for a fast ESP chip variant. | ||
| 390 | */ | ||
| 391 | esp->max_period = ((35 * esp->ccycle) / 1000); | ||
| 392 | if(esp->erev == fast) { | ||
| 393 | char *erev2string[] = { | ||
| 394 | "Emulex FAS236", | ||
| 395 | "Emulex FPESP100A", | ||
| 396 | "fast", | ||
| 397 | "QLogic FAS366", | ||
| 398 | "Emulex FAS216", | ||
| 399 | "Symbios Logic 53CF9x-2", | ||
| 400 | "unknown!" | ||
| 401 | }; | ||
| 402 | |||
| 403 | version = esp_read(eregs->esp_uid); | ||
| 404 | family_code = (version & 0xf8) >> 3; | ||
| 405 | if(family_code == 0x02) { | ||
| 406 | if ((version & 7) == 2) | ||
| 407 | esp->erev = fas216; | ||
| 408 | else | ||
| 409 | esp->erev = fas236; | ||
| 410 | } else if(family_code == 0x0a) | ||
| 411 | esp->erev = fas366; /* Version is usually '5'. */ | ||
| 412 | else if(family_code == 0x00) { | ||
| 413 | if ((version & 7) == 2) | ||
| 414 | esp->erev = fas100a; /* NCR53C9X */ | ||
| 415 | else | ||
| 416 | esp->erev = espunknown; | ||
| 417 | } else if(family_code == 0x14) { | ||
| 418 | if ((version & 7) == 2) | ||
| 419 | esp->erev = fsc; | ||
| 420 | else | ||
| 421 | esp->erev = espunknown; | ||
| 422 | } else if(family_code == 0x00) { | ||
| 423 | if ((version & 7) == 2) | ||
| 424 | esp->erev = fas100a; /* NCR53C9X */ | ||
| 425 | else | ||
| 426 | esp->erev = espunknown; | ||
| 427 | } else | ||
| 428 | esp->erev = espunknown; | ||
| 429 | ESPLOG(("esp%d: FAST chip is %s (family=%d, version=%d)\n", | ||
| 430 | esp->esp_id, erev2string[esp->erev - fas236], | ||
| 431 | family_code, (version & 7))); | ||
| 432 | |||
| 433 | esp->min_period = ((4 * esp->ccycle) / 1000); | ||
| 434 | } else { | ||
| 435 | esp->min_period = ((5 * esp->ccycle) / 1000); | ||
| 436 | } | ||
| 437 | |||
| 438 | /* Reload the configuration registers */ | ||
| 439 | esp_write(eregs->esp_cfact, esp->cfact); | ||
| 440 | esp->prev_stp = 0; | ||
| 441 | esp_write(eregs->esp_stp, 0); | ||
| 442 | esp->prev_soff = 0; | ||
| 443 | esp_write(eregs->esp_soff, 0); | ||
| 444 | esp_write(eregs->esp_timeo, esp->neg_defp); | ||
| 445 | esp->max_period = (esp->max_period + 3)>>2; | ||
| 446 | esp->min_period = (esp->min_period + 3)>>2; | ||
| 447 | |||
| 448 | esp_write(eregs->esp_cfg1, esp->config1); | ||
| 449 | switch(esp->erev) { | ||
| 450 | case esp100: | ||
| 451 | /* nothing to do */ | ||
| 452 | break; | ||
| 453 | case esp100a: | ||
| 454 | esp_write(eregs->esp_cfg2, esp->config2); | ||
| 455 | break; | ||
| 456 | case esp236: | ||
| 457 | /* Slow 236 */ | ||
| 458 | esp_write(eregs->esp_cfg2, esp->config2); | ||
| 459 | esp->prev_cfg3 = esp->config3[0]; | ||
| 460 | esp_write(eregs->esp_cfg3, esp->prev_cfg3); | ||
| 461 | break; | ||
| 462 | case fas366: | ||
| 463 | panic("esp: FAS366 support not present, please notify " | ||
| 464 | "jongk@cs.utwente.nl"); | ||
| 465 | break; | ||
| 466 | case fas216: | ||
| 467 | case fas236: | ||
| 468 | case fsc: | ||
| 469 | /* Fast ESP variants */ | ||
| 470 | esp_write(eregs->esp_cfg2, esp->config2); | ||
| 471 | for(i=0; i<8; i++) | ||
| 472 | esp->config3[i] |= ESP_CONFIG3_FCLK; | ||
| 473 | esp->prev_cfg3 = esp->config3[0]; | ||
| 474 | esp_write(eregs->esp_cfg3, esp->prev_cfg3); | ||
| 475 | if(esp->diff) | ||
| 476 | esp->radelay = 0; | ||
| 477 | else | ||
| 478 | esp->radelay = 16; | ||
| 479 | /* Different timeout constant for these chips */ | ||
| 480 | esp->neg_defp = | ||
| 481 | FSC_NEG_DEFP(esp->cfreq, | ||
| 482 | (esp->cfact == ESP_CCF_F0 ? | ||
| 483 | ESP_CCF_F7 + 1 : esp->cfact)); | ||
| 484 | esp_write(eregs->esp_timeo, esp->neg_defp); | ||
| 485 | /* Enable Active Negotiation if possible */ | ||
| 486 | if((esp->erev == fsc) && !esp->diff) | ||
| 487 | esp_write(eregs->esp_cfg4, ESP_CONFIG4_EAN); | ||
| 488 | break; | ||
| 489 | case fas100a: | ||
| 490 | /* Fast 100a */ | ||
| 491 | esp_write(eregs->esp_cfg2, esp->config2); | ||
| 492 | for(i=0; i<8; i++) | ||
| 493 | esp->config3[i] |= ESP_CONFIG3_FCLOCK; | ||
| 494 | esp->prev_cfg3 = esp->config3[0]; | ||
| 495 | esp_write(eregs->esp_cfg3, esp->prev_cfg3); | ||
| 496 | esp->radelay = 32; | ||
| 497 | break; | ||
| 498 | default: | ||
| 499 | panic("esp: what could it be... I wonder..."); | ||
| 500 | break; | ||
| 501 | }; | ||
| 502 | |||
| 503 | /* Eat any bitrot in the chip */ | ||
| 504 | trash = esp_read(eregs->esp_intrpt); | ||
| 505 | udelay(100); | ||
| 506 | } | ||
| 507 | |||
| 508 | /* This places the ESP into a known state at boot time. */ | ||
| 509 | void esp_bootup_reset(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 510 | { | ||
| 511 | volatile unchar trash; | ||
| 512 | |||
| 513 | /* Reset the DMA */ | ||
| 514 | if(esp->dma_reset) | ||
| 515 | esp->dma_reset(esp); | ||
| 516 | |||
| 517 | /* Reset the ESP */ | ||
| 518 | esp_reset_esp(esp, eregs); | ||
| 519 | |||
| 520 | /* Reset the SCSI bus, but tell ESP not to generate an irq */ | ||
| 521 | esp_write(eregs->esp_cfg1, (esp_read(eregs->esp_cfg1) | ESP_CONFIG1_SRRDISAB)); | ||
| 522 | esp_cmd(esp, eregs, ESP_CMD_RS); | ||
| 523 | udelay(400); | ||
| 524 | esp_write(eregs->esp_cfg1, esp->config1); | ||
| 525 | |||
| 526 | /* Eat any bitrot in the chip and we are done... */ | ||
| 527 | trash = esp_read(eregs->esp_intrpt); | ||
| 528 | } | ||
| 529 | EXPORT_SYMBOL(esp_bootup_reset); | ||
| 530 | |||
| 531 | /* Allocate structure and insert basic data such as SCSI chip frequency | ||
| 532 | * data and a pointer to the device | ||
| 533 | */ | ||
| 534 | struct NCR_ESP* esp_allocate(struct scsi_host_template *tpnt, void *esp_dev, | ||
| 535 | int hotplug) | ||
| 536 | { | ||
| 537 | struct NCR_ESP *esp, *elink; | ||
| 538 | struct Scsi_Host *esp_host; | ||
| 539 | |||
| 540 | if (hotplug) | ||
| 541 | esp_host = scsi_host_alloc(tpnt, sizeof(struct NCR_ESP)); | ||
| 542 | else | ||
| 543 | esp_host = scsi_register(tpnt, sizeof(struct NCR_ESP)); | ||
| 544 | if(!esp_host) | ||
| 545 | panic("Cannot register ESP SCSI host"); | ||
| 546 | esp = (struct NCR_ESP *) esp_host->hostdata; | ||
| 547 | if(!esp) | ||
| 548 | panic("No esp in hostdata"); | ||
| 549 | esp->ehost = esp_host; | ||
| 550 | esp->edev = esp_dev; | ||
| 551 | esp->esp_id = nesps++; | ||
| 552 | |||
| 553 | /* Set bitshift value (only used on Amiga with multiple ESPs) */ | ||
| 554 | esp->shift = 2; | ||
| 555 | |||
| 556 | /* Put into the chain of esp chips detected */ | ||
| 557 | if(espchain) { | ||
| 558 | elink = espchain; | ||
| 559 | while(elink->next) elink = elink->next; | ||
| 560 | elink->next = esp; | ||
| 561 | } else { | ||
| 562 | espchain = esp; | ||
| 563 | } | ||
| 564 | esp->next = NULL; | ||
| 565 | |||
| 566 | return esp; | ||
| 567 | } | ||
| 568 | |||
| 569 | void esp_deallocate(struct NCR_ESP *esp) | ||
| 570 | { | ||
| 571 | struct NCR_ESP *elink; | ||
| 572 | |||
| 573 | if(espchain == esp) { | ||
| 574 | espchain = NULL; | ||
| 575 | } else { | ||
| 576 | for(elink = espchain; elink && (elink->next != esp); elink = elink->next); | ||
| 577 | if(elink) | ||
| 578 | elink->next = esp->next; | ||
| 579 | } | ||
| 580 | nesps--; | ||
| 581 | } | ||
| 582 | |||
| 583 | /* Complete initialization of ESP structure and device | ||
| 584 | * Caller must have initialized appropriate parts of the ESP structure | ||
| 585 | * between the call to esp_allocate and this function. | ||
| 586 | */ | ||
| 587 | void esp_initialize(struct NCR_ESP *esp) | ||
| 588 | { | ||
| 589 | struct ESP_regs *eregs = esp->eregs; | ||
| 590 | unsigned int fmhz; | ||
| 591 | unchar ccf; | ||
| 592 | int i; | ||
| 593 | |||
| 594 | /* Check out the clock properties of the chip. */ | ||
| 595 | |||
| 596 | /* This is getting messy but it has to be done | ||
| 597 | * correctly or else you get weird behavior all | ||
| 598 | * over the place. We are trying to basically | ||
| 599 | * figure out three pieces of information. | ||
| 600 | * | ||
| 601 | * a) Clock Conversion Factor | ||
| 602 | * | ||
| 603 | * This is a representation of the input | ||
| 604 | * crystal clock frequency going into the | ||
| 605 | * ESP on this machine. Any operation whose | ||
| 606 | * timing is longer than 400ns depends on this | ||
| 607 | * value being correct. For example, you'll | ||
| 608 | * get blips for arbitration/selection during | ||
| 609 | * high load or with multiple targets if this | ||
| 610 | * is not set correctly. | ||
| 611 | * | ||
| 612 | * b) Selection Time-Out | ||
| 613 | * | ||
| 614 | * The ESP isn't very bright and will arbitrate | ||
| 615 | * for the bus and try to select a target | ||
| 616 | * forever if you let it. This value tells | ||
| 617 | * the ESP when it has taken too long to | ||
| 618 | * negotiate and that it should interrupt | ||
| 619 | * the CPU so we can see what happened. | ||
| 620 | * The value is computed as follows (from | ||
| 621 | * NCR/Symbios chip docs). | ||
| 622 | * | ||
| 623 | * (Time Out Period) * (Input Clock) | ||
| 624 | * STO = ---------------------------------- | ||
| 625 | * (8192) * (Clock Conversion Factor) | ||
| 626 | * | ||
| 627 | * You usually want the time out period to be | ||
| 628 | * around 250ms, I think we'll set it a little | ||
| 629 | * bit higher to account for fully loaded SCSI | ||
| 630 | * bus's and slow devices that don't respond so | ||
| 631 | * quickly to selection attempts. (yeah, I know | ||
| 632 | * this is out of spec. but there is a lot of | ||
| 633 | * buggy pieces of firmware out there so bite me) | ||
| 634 | * | ||
| 635 | * c) Imperical constants for synchronous offset | ||
| 636 | * and transfer period register values | ||
| 637 | * | ||
| 638 | * This entails the smallest and largest sync | ||
| 639 | * period we could ever handle on this ESP. | ||
| 640 | */ | ||
| 641 | |||
| 642 | fmhz = esp->cfreq; | ||
| 643 | |||
| 644 | if(fmhz <= (5000000)) | ||
| 645 | ccf = 0; | ||
| 646 | else | ||
| 647 | ccf = (((5000000 - 1) + (fmhz))/(5000000)); | ||
| 648 | if(!ccf || ccf > 8) { | ||
| 649 | /* If we can't find anything reasonable, | ||
| 650 | * just assume 20MHZ. This is the clock | ||
| 651 | * frequency of the older sun4c's where I've | ||
| 652 | * been unable to find the clock-frequency | ||
| 653 | * PROM property. All other machines provide | ||
| 654 | * useful values it seems. | ||
| 655 | */ | ||
| 656 | ccf = ESP_CCF_F4; | ||
| 657 | fmhz = (20000000); | ||
| 658 | } | ||
| 659 | if(ccf==(ESP_CCF_F7+1)) | ||
| 660 | esp->cfact = ESP_CCF_F0; | ||
| 661 | else if(ccf == ESP_CCF_NEVER) | ||
| 662 | esp->cfact = ESP_CCF_F2; | ||
| 663 | else | ||
| 664 | esp->cfact = ccf; | ||
| 665 | esp->cfreq = fmhz; | ||
| 666 | esp->ccycle = ESP_MHZ_TO_CYCLE(fmhz); | ||
| 667 | esp->ctick = ESP_TICK(ccf, esp->ccycle); | ||
| 668 | esp->neg_defp = ESP_NEG_DEFP(fmhz, ccf); | ||
| 669 | esp->sync_defp = SYNC_DEFP_SLOW; | ||
| 670 | |||
| 671 | printk("SCSI ID %d Clk %dMHz CCF=%d TOut %d ", | ||
| 672 | esp->scsi_id, (esp->cfreq / 1000000), | ||
| 673 | ccf, (int) esp->neg_defp); | ||
| 674 | |||
| 675 | /* Fill in ehost data */ | ||
| 676 | esp->ehost->base = (unsigned long)eregs; | ||
| 677 | esp->ehost->this_id = esp->scsi_id; | ||
| 678 | esp->ehost->irq = esp->irq; | ||
| 679 | |||
| 680 | /* SCSI id mask */ | ||
| 681 | esp->scsi_id_mask = (1 << esp->scsi_id); | ||
| 682 | |||
| 683 | /* Probe the revision of this esp */ | ||
| 684 | esp->config1 = (ESP_CONFIG1_PENABLE | (esp->scsi_id & 7)); | ||
| 685 | esp->config2 = (ESP_CONFIG2_SCSI2ENAB | ESP_CONFIG2_REGPARITY); | ||
| 686 | esp_write(eregs->esp_cfg2, esp->config2); | ||
| 687 | if((esp_read(eregs->esp_cfg2) & ~(ESP_CONFIG2_MAGIC)) != | ||
| 688 | (ESP_CONFIG2_SCSI2ENAB | ESP_CONFIG2_REGPARITY)) { | ||
| 689 | printk("NCR53C90(esp100)\n"); | ||
| 690 | esp->erev = esp100; | ||
| 691 | } else { | ||
| 692 | esp->config2 = 0; | ||
| 693 | esp_write(eregs->esp_cfg2, 0); | ||
| 694 | esp_write(eregs->esp_cfg3, 5); | ||
| 695 | if(esp_read(eregs->esp_cfg3) != 5) { | ||
| 696 | printk("NCR53C90A(esp100a)\n"); | ||
| 697 | esp->erev = esp100a; | ||
| 698 | } else { | ||
| 699 | int target; | ||
| 700 | |||
| 701 | for(target=0; target<8; target++) | ||
| 702 | esp->config3[target] = 0; | ||
| 703 | esp->prev_cfg3 = 0; | ||
| 704 | esp_write(eregs->esp_cfg3, 0); | ||
| 705 | if(ccf > ESP_CCF_F5) { | ||
| 706 | printk("NCR53C9XF(espfast)\n"); | ||
| 707 | esp->erev = fast; | ||
| 708 | esp->sync_defp = SYNC_DEFP_FAST; | ||
| 709 | } else { | ||
| 710 | printk("NCR53C9x(esp236)\n"); | ||
| 711 | esp->erev = esp236; | ||
| 712 | } | ||
| 713 | } | ||
| 714 | } | ||
| 715 | |||
| 716 | /* Initialize the command queues */ | ||
| 717 | esp->current_SC = NULL; | ||
| 718 | esp->disconnected_SC = NULL; | ||
| 719 | esp->issue_SC = NULL; | ||
| 720 | |||
| 721 | /* Clear the state machines. */ | ||
| 722 | esp->targets_present = 0; | ||
| 723 | esp->resetting_bus = 0; | ||
| 724 | esp->snip = 0; | ||
| 725 | |||
| 726 | init_waitqueue_head(&esp->reset_queue); | ||
| 727 | |||
| 728 | esp->fas_premature_intr_workaround = 0; | ||
| 729 | for(i = 0; i < 32; i++) | ||
| 730 | esp->espcmdlog[i] = 0; | ||
| 731 | esp->espcmdent = 0; | ||
| 732 | for(i = 0; i < 16; i++) { | ||
| 733 | esp->cur_msgout[i] = 0; | ||
| 734 | esp->cur_msgin[i] = 0; | ||
| 735 | } | ||
| 736 | esp->prevmsgout = esp->prevmsgin = 0; | ||
| 737 | esp->msgout_len = esp->msgin_len = 0; | ||
| 738 | |||
| 739 | /* Clear the one behind caches to hold unmatchable values. */ | ||
| 740 | esp->prev_soff = esp->prev_stp = esp->prev_cfg3 = 0xff; | ||
| 741 | |||
| 742 | /* Reset the thing before we try anything... */ | ||
| 743 | esp_bootup_reset(esp, eregs); | ||
| 744 | |||
| 745 | esps_in_use++; | ||
| 746 | } | ||
| 747 | |||
| 748 | /* The info function will return whatever useful | ||
| 749 | * information the developer sees fit. If not provided, then | ||
| 750 | * the name field will be used instead. | ||
| 751 | */ | ||
| 752 | const char *esp_info(struct Scsi_Host *host) | ||
| 753 | { | ||
| 754 | struct NCR_ESP *esp; | ||
| 755 | |||
| 756 | esp = (struct NCR_ESP *) host->hostdata; | ||
| 757 | switch(esp->erev) { | ||
| 758 | case esp100: | ||
| 759 | return "ESP100 (NCR53C90)"; | ||
| 760 | case esp100a: | ||
| 761 | return "ESP100A (NCR53C90A)"; | ||
| 762 | case esp236: | ||
| 763 | return "ESP236 (NCR53C9x)"; | ||
| 764 | case fas216: | ||
| 765 | return "Emulex FAS216"; | ||
| 766 | case fas236: | ||
| 767 | return "Emulex FAS236"; | ||
| 768 | case fas366: | ||
| 769 | return "QLogic FAS366"; | ||
| 770 | case fas100a: | ||
| 771 | return "FPESP100A"; | ||
| 772 | case fsc: | ||
| 773 | return "Symbios Logic 53CF9x-2"; | ||
| 774 | default: | ||
| 775 | panic("Bogon ESP revision"); | ||
| 776 | }; | ||
| 777 | } | ||
| 778 | EXPORT_SYMBOL(esp_info); | ||
| 779 | |||
| 780 | /* From Wolfgang Stanglmeier's NCR scsi driver. */ | ||
| 781 | struct info_str | ||
| 782 | { | ||
| 783 | char *buffer; | ||
| 784 | int length; | ||
| 785 | int offset; | ||
| 786 | int pos; | ||
| 787 | }; | ||
| 788 | |||
| 789 | static void copy_mem_info(struct info_str *info, char *data, int len) | ||
| 790 | { | ||
| 791 | if (info->pos + len > info->length) | ||
| 792 | len = info->length - info->pos; | ||
| 793 | |||
| 794 | if (info->pos + len < info->offset) { | ||
| 795 | info->pos += len; | ||
| 796 | return; | ||
| 797 | } | ||
| 798 | if (info->pos < info->offset) { | ||
| 799 | data += (info->offset - info->pos); | ||
| 800 | len -= (info->offset - info->pos); | ||
| 801 | } | ||
| 802 | |||
| 803 | if (len > 0) { | ||
| 804 | memcpy(info->buffer + info->pos, data, len); | ||
| 805 | info->pos += len; | ||
| 806 | } | ||
| 807 | } | ||
| 808 | |||
| 809 | static int copy_info(struct info_str *info, char *fmt, ...) | ||
| 810 | { | ||
| 811 | va_list args; | ||
| 812 | char buf[81]; | ||
| 813 | int len; | ||
| 814 | |||
| 815 | va_start(args, fmt); | ||
| 816 | len = vsprintf(buf, fmt, args); | ||
| 817 | va_end(args); | ||
| 818 | |||
| 819 | copy_mem_info(info, buf, len); | ||
| 820 | return len; | ||
| 821 | } | ||
| 822 | |||
| 823 | static int esp_host_info(struct NCR_ESP *esp, char *ptr, off_t offset, int len) | ||
| 824 | { | ||
| 825 | struct scsi_device *sdev; | ||
| 826 | struct info_str info; | ||
| 827 | int i; | ||
| 828 | |||
| 829 | info.buffer = ptr; | ||
| 830 | info.length = len; | ||
| 831 | info.offset = offset; | ||
| 832 | info.pos = 0; | ||
| 833 | |||
| 834 | copy_info(&info, "ESP Host Adapter:\n"); | ||
| 835 | copy_info(&info, "\tESP Model\t\t"); | ||
| 836 | switch(esp->erev) { | ||
| 837 | case esp100: | ||
| 838 | copy_info(&info, "ESP100 (NCR53C90)\n"); | ||
| 839 | break; | ||
| 840 | case esp100a: | ||
| 841 | copy_info(&info, "ESP100A (NCR53C90A)\n"); | ||
| 842 | break; | ||
| 843 | case esp236: | ||
| 844 | copy_info(&info, "ESP236 (NCR53C9x)\n"); | ||
| 845 | break; | ||
| 846 | case fas216: | ||
| 847 | copy_info(&info, "Emulex FAS216\n"); | ||
| 848 | break; | ||
| 849 | case fas236: | ||
| 850 | copy_info(&info, "Emulex FAS236\n"); | ||
| 851 | break; | ||
| 852 | case fas100a: | ||
| 853 | copy_info(&info, "FPESP100A\n"); | ||
| 854 | break; | ||
| 855 | case fast: | ||
| 856 | copy_info(&info, "Generic FAST\n"); | ||
| 857 | break; | ||
| 858 | case fas366: | ||
| 859 | copy_info(&info, "QLogic FAS366\n"); | ||
| 860 | break; | ||
| 861 | case fsc: | ||
| 862 | copy_info(&info, "Symbios Logic 53C9x-2\n"); | ||
| 863 | break; | ||
| 864 | case espunknown: | ||
| 865 | default: | ||
| 866 | copy_info(&info, "Unknown!\n"); | ||
| 867 | break; | ||
| 868 | }; | ||
| 869 | copy_info(&info, "\tLive Targets\t\t[ "); | ||
| 870 | for(i = 0; i < 15; i++) { | ||
| 871 | if(esp->targets_present & (1 << i)) | ||
| 872 | copy_info(&info, "%d ", i); | ||
| 873 | } | ||
| 874 | copy_info(&info, "]\n\n"); | ||
| 875 | |||
| 876 | /* Now describe the state of each existing target. */ | ||
| 877 | copy_info(&info, "Target #\tconfig3\t\tSync Capabilities\tDisconnect\n"); | ||
| 878 | |||
| 879 | shost_for_each_device(sdev, esp->ehost) { | ||
| 880 | struct esp_device *esp_dev = sdev->hostdata; | ||
| 881 | uint id = sdev->id; | ||
| 882 | |||
| 883 | if (!(esp->targets_present & (1 << id))) | ||
| 884 | continue; | ||
| 885 | |||
| 886 | copy_info(&info, "%d\t\t", id); | ||
| 887 | copy_info(&info, "%08lx\t", esp->config3[id]); | ||
| 888 | copy_info(&info, "[%02lx,%02lx]\t\t\t", | ||
| 889 | esp_dev->sync_max_offset, | ||
| 890 | esp_dev->sync_min_period); | ||
| 891 | copy_info(&info, "%s\n", esp_dev->disconnect ? "yes" : "no"); | ||
| 892 | } | ||
| 893 | |||
| 894 | return info.pos > info.offset? info.pos - info.offset : 0; | ||
| 895 | } | ||
| 896 | |||
| 897 | /* ESP proc filesystem code. */ | ||
| 898 | int esp_proc_info(struct Scsi_Host *shost, char *buffer, char **start, off_t offset, int length, | ||
| 899 | int inout) | ||
| 900 | { | ||
| 901 | struct NCR_ESP *esp = (struct NCR_ESP *)shost->hostdata; | ||
| 902 | |||
| 903 | if(inout) | ||
| 904 | return -EINVAL; /* not yet */ | ||
| 905 | if(start) | ||
| 906 | *start = buffer; | ||
| 907 | return esp_host_info(esp, buffer, offset, length); | ||
| 908 | } | ||
| 909 | EXPORT_SYMBOL(esp_proc_info); | ||
| 910 | |||
| 911 | static void esp_get_dmabufs(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 912 | { | ||
| 913 | if(sp->use_sg == 0) { | ||
| 914 | sp->SCp.this_residual = sp->request_bufflen; | ||
| 915 | sp->SCp.buffer = (struct scatterlist *) sp->request_buffer; | ||
| 916 | sp->SCp.buffers_residual = 0; | ||
| 917 | if (esp->dma_mmu_get_scsi_one) | ||
| 918 | esp->dma_mmu_get_scsi_one(esp, sp); | ||
| 919 | else | ||
| 920 | sp->SCp.ptr = | ||
| 921 | (char *) virt_to_phys(sp->request_buffer); | ||
| 922 | } else { | ||
| 923 | sp->SCp.buffer = (struct scatterlist *) sp->request_buffer; | ||
| 924 | sp->SCp.buffers_residual = sp->use_sg - 1; | ||
| 925 | sp->SCp.this_residual = sp->SCp.buffer->length; | ||
| 926 | if (esp->dma_mmu_get_scsi_sgl) | ||
| 927 | esp->dma_mmu_get_scsi_sgl(esp, sp); | ||
| 928 | else | ||
| 929 | sp->SCp.ptr = | ||
| 930 | (char *) virt_to_phys(sg_virt(sp->SCp.buffer)); | ||
| 931 | } | ||
| 932 | } | ||
| 933 | |||
| 934 | static void esp_release_dmabufs(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 935 | { | ||
| 936 | if(sp->use_sg == 0) { | ||
| 937 | if (esp->dma_mmu_release_scsi_one) | ||
| 938 | esp->dma_mmu_release_scsi_one(esp, sp); | ||
| 939 | } else { | ||
| 940 | if (esp->dma_mmu_release_scsi_sgl) | ||
| 941 | esp->dma_mmu_release_scsi_sgl(esp, sp); | ||
| 942 | } | ||
| 943 | } | ||
| 944 | |||
| 945 | static void esp_restore_pointers(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 946 | { | ||
| 947 | struct esp_pointers *ep = &esp->data_pointers[scmd_id(sp)]; | ||
| 948 | |||
| 949 | sp->SCp.ptr = ep->saved_ptr; | ||
| 950 | sp->SCp.buffer = ep->saved_buffer; | ||
| 951 | sp->SCp.this_residual = ep->saved_this_residual; | ||
| 952 | sp->SCp.buffers_residual = ep->saved_buffers_residual; | ||
| 953 | } | ||
| 954 | |||
| 955 | static void esp_save_pointers(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 956 | { | ||
| 957 | struct esp_pointers *ep = &esp->data_pointers[scmd_id(sp)]; | ||
| 958 | |||
| 959 | ep->saved_ptr = sp->SCp.ptr; | ||
| 960 | ep->saved_buffer = sp->SCp.buffer; | ||
| 961 | ep->saved_this_residual = sp->SCp.this_residual; | ||
| 962 | ep->saved_buffers_residual = sp->SCp.buffers_residual; | ||
| 963 | } | ||
| 964 | |||
| 965 | /* Some rules: | ||
| 966 | * | ||
| 967 | * 1) Never ever panic while something is live on the bus. | ||
| 968 | * If there is to be any chance of syncing the disks this | ||
| 969 | * rule is to be obeyed. | ||
| 970 | * | ||
| 971 | * 2) Any target that causes a foul condition will no longer | ||
| 972 | * have synchronous transfers done to it, no questions | ||
| 973 | * asked. | ||
| 974 | * | ||
| 975 | * 3) Keep register accesses to a minimum. Think about some | ||
| 976 | * day when we have Xbus machines this is running on and | ||
| 977 | * the ESP chip is on the other end of the machine on a | ||
| 978 | * different board from the cpu where this is running. | ||
| 979 | */ | ||
| 980 | |||
| 981 | /* Fire off a command. We assume the bus is free and that the only | ||
| 982 | * case where we could see an interrupt is where we have disconnected | ||
| 983 | * commands active and they are trying to reselect us. | ||
| 984 | */ | ||
| 985 | static inline void esp_check_cmd(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 986 | { | ||
| 987 | switch(sp->cmd_len) { | ||
| 988 | case 6: | ||
| 989 | case 10: | ||
| 990 | case 12: | ||
| 991 | esp->esp_slowcmd = 0; | ||
| 992 | break; | ||
| 993 | |||
| 994 | default: | ||
| 995 | esp->esp_slowcmd = 1; | ||
| 996 | esp->esp_scmdleft = sp->cmd_len; | ||
| 997 | esp->esp_scmdp = &sp->cmnd[0]; | ||
| 998 | break; | ||
| 999 | }; | ||
| 1000 | } | ||
| 1001 | |||
| 1002 | static inline void build_sync_nego_msg(struct NCR_ESP *esp, int period, int offset) | ||
| 1003 | { | ||
| 1004 | esp->cur_msgout[0] = EXTENDED_MESSAGE; | ||
| 1005 | esp->cur_msgout[1] = 3; | ||
| 1006 | esp->cur_msgout[2] = EXTENDED_SDTR; | ||
| 1007 | esp->cur_msgout[3] = period; | ||
| 1008 | esp->cur_msgout[4] = offset; | ||
| 1009 | esp->msgout_len = 5; | ||
| 1010 | } | ||
| 1011 | |||
| 1012 | static void esp_exec_cmd(struct NCR_ESP *esp) | ||
| 1013 | { | ||
| 1014 | struct ESP_regs *eregs = esp->eregs; | ||
| 1015 | struct esp_device *esp_dev; | ||
| 1016 | Scsi_Cmnd *SCptr; | ||
| 1017 | struct scsi_device *SDptr; | ||
| 1018 | volatile unchar *cmdp = esp->esp_command; | ||
| 1019 | unsigned char the_esp_command; | ||
| 1020 | int lun, target; | ||
| 1021 | int i; | ||
| 1022 | |||
| 1023 | /* Hold off if we have disconnected commands and | ||
| 1024 | * an IRQ is showing... | ||
| 1025 | */ | ||
| 1026 | if(esp->disconnected_SC && esp->dma_irq_p(esp)) | ||
| 1027 | return; | ||
| 1028 | |||
| 1029 | /* Grab first member of the issue queue. */ | ||
| 1030 | SCptr = esp->current_SC = remove_first_SC(&esp->issue_SC); | ||
| 1031 | |||
| 1032 | /* Safe to panic here because current_SC is null. */ | ||
| 1033 | if(!SCptr) | ||
| 1034 | panic("esp: esp_exec_cmd and issue queue is NULL"); | ||
| 1035 | |||
| 1036 | SDptr = SCptr->device; | ||
| 1037 | esp_dev = SDptr->hostdata; | ||
| 1038 | lun = SCptr->device->lun; | ||
| 1039 | target = SCptr->device->id; | ||
| 1040 | |||
| 1041 | esp->snip = 0; | ||
| 1042 | esp->msgout_len = 0; | ||
| 1043 | |||
| 1044 | /* Send it out whole, or piece by piece? The ESP | ||
| 1045 | * only knows how to automatically send out 6, 10, | ||
| 1046 | * and 12 byte commands. I used to think that the | ||
| 1047 | * Linux SCSI code would never throw anything other | ||
| 1048 | * than that to us, but then again there is the | ||
| 1049 | * SCSI generic driver which can send us anything. | ||
| 1050 | */ | ||
| 1051 | esp_check_cmd(esp, SCptr); | ||
| 1052 | |||
| 1053 | /* If arbitration/selection is successful, the ESP will leave | ||
| 1054 | * ATN asserted, causing the target to go into message out | ||
| 1055 | * phase. The ESP will feed the target the identify and then | ||
| 1056 | * the target can only legally go to one of command, | ||
| 1057 | * datain/out, status, or message in phase, or stay in message | ||
| 1058 | * out phase (should we be trying to send a sync negotiation | ||
| 1059 | * message after the identify). It is not allowed to drop | ||
| 1060 | * BSY, but some buggy targets do and we check for this | ||
| 1061 | * condition in the selection complete code. Most of the time | ||
| 1062 | * we'll make the command bytes available to the ESP and it | ||
| 1063 | * will not interrupt us until it finishes command phase, we | ||
| 1064 | * cannot do this for command sizes the ESP does not | ||
| 1065 | * understand and in this case we'll get interrupted right | ||
| 1066 | * when the target goes into command phase. | ||
| 1067 | * | ||
| 1068 | * It is absolutely _illegal_ in the presence of SCSI-2 devices | ||
| 1069 | * to use the ESP select w/o ATN command. When SCSI-2 devices are | ||
| 1070 | * present on the bus we _must_ always go straight to message out | ||
| 1071 | * phase with an identify message for the target. Being that | ||
| 1072 | * selection attempts in SCSI-1 w/o ATN was an option, doing SCSI-2 | ||
| 1073 | * selections should not confuse SCSI-1 we hope. | ||
| 1074 | */ | ||
| 1075 | |||
| 1076 | if(esp_dev->sync) { | ||
| 1077 | /* this targets sync is known */ | ||
| 1078 | #ifdef CONFIG_SCSI_MAC_ESP | ||
| 1079 | do_sync_known: | ||
| 1080 | #endif | ||
| 1081 | if(esp_dev->disconnect) | ||
| 1082 | *cmdp++ = IDENTIFY(1, lun); | ||
| 1083 | else | ||
| 1084 | *cmdp++ = IDENTIFY(0, lun); | ||
| 1085 | |||
| 1086 | if(esp->esp_slowcmd) { | ||
| 1087 | the_esp_command = (ESP_CMD_SELAS | ESP_CMD_DMA); | ||
| 1088 | esp_advance_phase(SCptr, in_slct_stop); | ||
| 1089 | } else { | ||
| 1090 | the_esp_command = (ESP_CMD_SELA | ESP_CMD_DMA); | ||
| 1091 | esp_advance_phase(SCptr, in_slct_norm); | ||
| 1092 | } | ||
| 1093 | } else if(!(esp->targets_present & (1<<target)) || !(esp_dev->disconnect)) { | ||
| 1094 | /* After the bootup SCSI code sends both the | ||
| 1095 | * TEST_UNIT_READY and INQUIRY commands we want | ||
| 1096 | * to at least attempt allowing the device to | ||
| 1097 | * disconnect. | ||
| 1098 | */ | ||
| 1099 | ESPMISC(("esp: Selecting device for first time. target=%d " | ||
| 1100 | "lun=%d\n", target, SCptr->device->lun)); | ||
| 1101 | if(!SDptr->borken && !esp_dev->disconnect) | ||
| 1102 | esp_dev->disconnect = 1; | ||
| 1103 | |||
| 1104 | *cmdp++ = IDENTIFY(0, lun); | ||
| 1105 | esp->prevmsgout = NOP; | ||
| 1106 | esp_advance_phase(SCptr, in_slct_norm); | ||
| 1107 | the_esp_command = (ESP_CMD_SELA | ESP_CMD_DMA); | ||
| 1108 | |||
| 1109 | /* Take no chances... */ | ||
| 1110 | esp_dev->sync_max_offset = 0; | ||
| 1111 | esp_dev->sync_min_period = 0; | ||
| 1112 | } else { | ||
| 1113 | int toshiba_cdrom_hwbug_wkaround = 0; | ||
| 1114 | |||
| 1115 | #ifdef CONFIG_SCSI_MAC_ESP | ||
| 1116 | /* Never allow synchronous transfers (disconnect OK) on | ||
| 1117 | * Macintosh. Well, maybe later when we figured out how to | ||
| 1118 | * do DMA on the machines that support it ... | ||
| 1119 | */ | ||
| 1120 | esp_dev->disconnect = 1; | ||
| 1121 | esp_dev->sync_max_offset = 0; | ||
| 1122 | esp_dev->sync_min_period = 0; | ||
| 1123 | esp_dev->sync = 1; | ||
| 1124 | esp->snip = 0; | ||
| 1125 | goto do_sync_known; | ||
| 1126 | #endif | ||
| 1127 | /* We've talked to this guy before, | ||
| 1128 | * but never negotiated. Let's try | ||
| 1129 | * sync negotiation. | ||
| 1130 | */ | ||
| 1131 | if(!SDptr->borken) { | ||
| 1132 | if((SDptr->type == TYPE_ROM) && | ||
| 1133 | (!strncmp(SDptr->vendor, "TOSHIBA", 7))) { | ||
| 1134 | /* Nice try sucker... */ | ||
| 1135 | ESPMISC(("esp%d: Disabling sync for buggy " | ||
| 1136 | "Toshiba CDROM.\n", esp->esp_id)); | ||
| 1137 | toshiba_cdrom_hwbug_wkaround = 1; | ||
| 1138 | build_sync_nego_msg(esp, 0, 0); | ||
| 1139 | } else { | ||
| 1140 | build_sync_nego_msg(esp, esp->sync_defp, 15); | ||
| 1141 | } | ||
| 1142 | } else { | ||
| 1143 | build_sync_nego_msg(esp, 0, 0); | ||
| 1144 | } | ||
| 1145 | esp_dev->sync = 1; | ||
| 1146 | esp->snip = 1; | ||
| 1147 | |||
| 1148 | /* A fix for broken SCSI1 targets, when they disconnect | ||
| 1149 | * they lock up the bus and confuse ESP. So disallow | ||
| 1150 | * disconnects for SCSI1 targets for now until we | ||
| 1151 | * find a better fix. | ||
| 1152 | * | ||
| 1153 | * Addendum: This is funny, I figured out what was going | ||
| 1154 | * on. The blotzed SCSI1 target would disconnect, | ||
| 1155 | * one of the other SCSI2 targets or both would be | ||
| 1156 | * disconnected as well. The SCSI1 target would | ||
| 1157 | * stay disconnected long enough that we start | ||
| 1158 | * up a command on one of the SCSI2 targets. As | ||
| 1159 | * the ESP is arbitrating for the bus the SCSI1 | ||
| 1160 | * target begins to arbitrate as well to reselect | ||
| 1161 | * the ESP. The SCSI1 target refuses to drop it's | ||
| 1162 | * ID bit on the data bus even though the ESP is | ||
| 1163 | * at ID 7 and is the obvious winner for any | ||
| 1164 | * arbitration. The ESP is a poor sport and refuses | ||
| 1165 | * to lose arbitration, it will continue indefinitely | ||
| 1166 | * trying to arbitrate for the bus and can only be | ||
| 1167 | * stopped via a chip reset or SCSI bus reset. | ||
| 1168 | * Therefore _no_ disconnects for SCSI1 targets | ||
| 1169 | * thank you very much. ;-) | ||
| 1170 | */ | ||
| 1171 | if(((SDptr->scsi_level < 3) && (SDptr->type != TYPE_TAPE)) || | ||
| 1172 | toshiba_cdrom_hwbug_wkaround || SDptr->borken) { | ||
| 1173 | ESPMISC((KERN_INFO "esp%d: Disabling DISCONNECT for target %d " | ||
| 1174 | "lun %d\n", esp->esp_id, SCptr->device->id, SCptr->device->lun)); | ||
| 1175 | esp_dev->disconnect = 0; | ||
| 1176 | *cmdp++ = IDENTIFY(0, lun); | ||
| 1177 | } else { | ||
| 1178 | *cmdp++ = IDENTIFY(1, lun); | ||
| 1179 | } | ||
| 1180 | |||
| 1181 | /* ESP fifo is only so big... | ||
| 1182 | * Make this look like a slow command. | ||
| 1183 | */ | ||
| 1184 | esp->esp_slowcmd = 1; | ||
| 1185 | esp->esp_scmdleft = SCptr->cmd_len; | ||
| 1186 | esp->esp_scmdp = &SCptr->cmnd[0]; | ||
| 1187 | |||
| 1188 | the_esp_command = (ESP_CMD_SELAS | ESP_CMD_DMA); | ||
| 1189 | esp_advance_phase(SCptr, in_slct_msg); | ||
| 1190 | } | ||
| 1191 | |||
| 1192 | if(!esp->esp_slowcmd) | ||
| 1193 | for(i = 0; i < SCptr->cmd_len; i++) | ||
| 1194 | *cmdp++ = SCptr->cmnd[i]; | ||
| 1195 | |||
| 1196 | esp_write(eregs->esp_busid, (target & 7)); | ||
| 1197 | if (esp->prev_soff != esp_dev->sync_max_offset || | ||
| 1198 | esp->prev_stp != esp_dev->sync_min_period || | ||
| 1199 | (esp->erev > esp100a && | ||
| 1200 | esp->prev_cfg3 != esp->config3[target])) { | ||
| 1201 | esp->prev_soff = esp_dev->sync_max_offset; | ||
| 1202 | esp_write(eregs->esp_soff, esp->prev_soff); | ||
| 1203 | esp->prev_stp = esp_dev->sync_min_period; | ||
| 1204 | esp_write(eregs->esp_stp, esp->prev_stp); | ||
| 1205 | if(esp->erev > esp100a) { | ||
| 1206 | esp->prev_cfg3 = esp->config3[target]; | ||
| 1207 | esp_write(eregs->esp_cfg3, esp->prev_cfg3); | ||
| 1208 | } | ||
| 1209 | } | ||
| 1210 | i = (cmdp - esp->esp_command); | ||
| 1211 | |||
| 1212 | /* Set up the DMA and ESP counters */ | ||
| 1213 | if(esp->do_pio_cmds){ | ||
| 1214 | int j = 0; | ||
| 1215 | |||
| 1216 | /* | ||
| 1217 | * XXX MSch: | ||
| 1218 | * | ||
| 1219 | * It seems this is required, at least to clean up | ||
| 1220 | * after failed commands when using PIO mode ... | ||
| 1221 | */ | ||
| 1222 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 1223 | |||
| 1224 | for(;j<i;j++) | ||
| 1225 | esp_write(eregs->esp_fdata, esp->esp_command[j]); | ||
| 1226 | the_esp_command &= ~ESP_CMD_DMA; | ||
| 1227 | |||
| 1228 | /* Tell ESP to "go". */ | ||
| 1229 | esp_cmd(esp, eregs, the_esp_command); | ||
| 1230 | } else { | ||
| 1231 | /* Set up the ESP counters */ | ||
| 1232 | esp_write(eregs->esp_tclow, i); | ||
| 1233 | esp_write(eregs->esp_tcmed, 0); | ||
| 1234 | esp->dma_init_write(esp, esp->esp_command_dvma, i); | ||
| 1235 | |||
| 1236 | /* Tell ESP to "go". */ | ||
| 1237 | esp_cmd(esp, eregs, the_esp_command); | ||
| 1238 | } | ||
| 1239 | } | ||
| 1240 | |||
| 1241 | /* Queue a SCSI command delivered from the mid-level Linux SCSI code. */ | ||
| 1242 | int esp_queue(Scsi_Cmnd *SCpnt, void (*done)(Scsi_Cmnd *)) | ||
| 1243 | { | ||
| 1244 | struct NCR_ESP *esp; | ||
| 1245 | |||
| 1246 | /* Set up func ptr and initial driver cmd-phase. */ | ||
| 1247 | SCpnt->scsi_done = done; | ||
| 1248 | SCpnt->SCp.phase = not_issued; | ||
| 1249 | |||
| 1250 | esp = (struct NCR_ESP *) SCpnt->device->host->hostdata; | ||
| 1251 | |||
| 1252 | if(esp->dma_led_on) | ||
| 1253 | esp->dma_led_on(esp); | ||
| 1254 | |||
| 1255 | /* We use the scratch area. */ | ||
| 1256 | ESPQUEUE(("esp_queue: target=%d lun=%d ", SCpnt->device->id, SCpnt->lun)); | ||
| 1257 | ESPDISC(("N<%02x,%02x>", SCpnt->device->id, SCpnt->lun)); | ||
| 1258 | |||
| 1259 | esp_get_dmabufs(esp, SCpnt); | ||
| 1260 | esp_save_pointers(esp, SCpnt); /* FIXME for tag queueing */ | ||
| 1261 | |||
| 1262 | SCpnt->SCp.Status = CHECK_CONDITION; | ||
| 1263 | SCpnt->SCp.Message = 0xff; | ||
| 1264 | SCpnt->SCp.sent_command = 0; | ||
| 1265 | |||
| 1266 | /* Place into our queue. */ | ||
| 1267 | if(SCpnt->cmnd[0] == REQUEST_SENSE) { | ||
| 1268 | ESPQUEUE(("RQSENSE\n")); | ||
| 1269 | prepend_SC(&esp->issue_SC, SCpnt); | ||
| 1270 | } else { | ||
| 1271 | ESPQUEUE(("\n")); | ||
| 1272 | append_SC(&esp->issue_SC, SCpnt); | ||
| 1273 | } | ||
| 1274 | |||
| 1275 | /* Run it now if we can. */ | ||
| 1276 | if(!esp->current_SC && !esp->resetting_bus) | ||
| 1277 | esp_exec_cmd(esp); | ||
| 1278 | |||
| 1279 | return 0; | ||
| 1280 | } | ||
| 1281 | |||
| 1282 | /* Dump driver state. */ | ||
| 1283 | static void esp_dump_cmd(Scsi_Cmnd *SCptr) | ||
| 1284 | { | ||
| 1285 | ESPLOG(("[tgt<%02x> lun<%02x> " | ||
| 1286 | "pphase<%s> cphase<%s>]", | ||
| 1287 | SCptr->device->id, SCptr->device->lun, | ||
| 1288 | phase_string(SCptr->SCp.sent_command), | ||
| 1289 | phase_string(SCptr->SCp.phase))); | ||
| 1290 | } | ||
| 1291 | |||
| 1292 | static void esp_dump_state(struct NCR_ESP *esp, | ||
| 1293 | struct ESP_regs *eregs) | ||
| 1294 | { | ||
| 1295 | Scsi_Cmnd *SCptr = esp->current_SC; | ||
| 1296 | #ifdef DEBUG_ESP_CMDS | ||
| 1297 | int i; | ||
| 1298 | #endif | ||
| 1299 | |||
| 1300 | ESPLOG(("esp%d: dumping state\n", esp->esp_id)); | ||
| 1301 | |||
| 1302 | /* Print DMA status */ | ||
| 1303 | esp->dma_dump_state(esp); | ||
| 1304 | |||
| 1305 | ESPLOG(("esp%d: SW [sreg<%02x> sstep<%02x> ireg<%02x>]\n", | ||
| 1306 | esp->esp_id, esp->sreg, esp->seqreg, esp->ireg)); | ||
| 1307 | ESPLOG(("esp%d: HW reread [sreg<%02x> sstep<%02x> ireg<%02x>]\n", | ||
| 1308 | esp->esp_id, esp_read(eregs->esp_status), esp_read(eregs->esp_sstep), | ||
| 1309 | esp_read(eregs->esp_intrpt))); | ||
| 1310 | #ifdef DEBUG_ESP_CMDS | ||
| 1311 | printk("esp%d: last ESP cmds [", esp->esp_id); | ||
| 1312 | i = (esp->espcmdent - 1) & 31; | ||
| 1313 | printk("<"); | ||
| 1314 | esp_print_cmd(esp->espcmdlog[i]); | ||
| 1315 | printk(">"); | ||
| 1316 | i = (i - 1) & 31; | ||
| 1317 | printk("<"); | ||
| 1318 | esp_print_cmd(esp->espcmdlog[i]); | ||
| 1319 | printk(">"); | ||
| 1320 | i = (i - 1) & 31; | ||
| 1321 | printk("<"); | ||
| 1322 | esp_print_cmd(esp->espcmdlog[i]); | ||
| 1323 | printk(">"); | ||
| 1324 | i = (i - 1) & 31; | ||
| 1325 | printk("<"); | ||
| 1326 | esp_print_cmd(esp->espcmdlog[i]); | ||
| 1327 | printk(">"); | ||
| 1328 | printk("]\n"); | ||
| 1329 | #endif /* (DEBUG_ESP_CMDS) */ | ||
| 1330 | |||
| 1331 | if(SCptr) { | ||
| 1332 | ESPLOG(("esp%d: current command ", esp->esp_id)); | ||
| 1333 | esp_dump_cmd(SCptr); | ||
| 1334 | } | ||
| 1335 | ESPLOG(("\n")); | ||
| 1336 | SCptr = esp->disconnected_SC; | ||
| 1337 | ESPLOG(("esp%d: disconnected ", esp->esp_id)); | ||
| 1338 | while(SCptr) { | ||
| 1339 | esp_dump_cmd(SCptr); | ||
| 1340 | SCptr = (Scsi_Cmnd *) SCptr->host_scribble; | ||
| 1341 | } | ||
| 1342 | ESPLOG(("\n")); | ||
| 1343 | } | ||
| 1344 | |||
| 1345 | /* Abort a command. The host_lock is acquired by caller. */ | ||
| 1346 | int esp_abort(Scsi_Cmnd *SCptr) | ||
| 1347 | { | ||
| 1348 | struct NCR_ESP *esp = (struct NCR_ESP *) SCptr->device->host->hostdata; | ||
| 1349 | struct ESP_regs *eregs = esp->eregs; | ||
| 1350 | int don; | ||
| 1351 | |||
| 1352 | ESPLOG(("esp%d: Aborting command\n", esp->esp_id)); | ||
| 1353 | esp_dump_state(esp, eregs); | ||
| 1354 | |||
| 1355 | /* Wheee, if this is the current command on the bus, the | ||
| 1356 | * best we can do is assert ATN and wait for msgout phase. | ||
| 1357 | * This should even fix a hung SCSI bus when we lose state | ||
| 1358 | * in the driver and timeout because the eventual phase change | ||
| 1359 | * will cause the ESP to (eventually) give an interrupt. | ||
| 1360 | */ | ||
| 1361 | if(esp->current_SC == SCptr) { | ||
| 1362 | esp->cur_msgout[0] = ABORT; | ||
| 1363 | esp->msgout_len = 1; | ||
| 1364 | esp->msgout_ctr = 0; | ||
| 1365 | esp_cmd(esp, eregs, ESP_CMD_SATN); | ||
| 1366 | return SUCCESS; | ||
| 1367 | } | ||
| 1368 | |||
| 1369 | /* If it is still in the issue queue then we can safely | ||
| 1370 | * call the completion routine and report abort success. | ||
| 1371 | */ | ||
| 1372 | don = esp->dma_ports_p(esp); | ||
| 1373 | if(don) { | ||
| 1374 | esp->dma_ints_off(esp); | ||
| 1375 | synchronize_irq(esp->irq); | ||
| 1376 | } | ||
| 1377 | if(esp->issue_SC) { | ||
| 1378 | Scsi_Cmnd **prev, *this; | ||
| 1379 | for(prev = (&esp->issue_SC), this = esp->issue_SC; | ||
| 1380 | this; | ||
| 1381 | prev = (Scsi_Cmnd **) &(this->host_scribble), | ||
| 1382 | this = (Scsi_Cmnd *) this->host_scribble) { | ||
| 1383 | if(this == SCptr) { | ||
| 1384 | *prev = (Scsi_Cmnd *) this->host_scribble; | ||
| 1385 | this->host_scribble = NULL; | ||
| 1386 | esp_release_dmabufs(esp, this); | ||
| 1387 | this->result = DID_ABORT << 16; | ||
| 1388 | this->scsi_done(this); | ||
| 1389 | if(don) | ||
| 1390 | esp->dma_ints_on(esp); | ||
| 1391 | return SUCCESS; | ||
| 1392 | } | ||
| 1393 | } | ||
| 1394 | } | ||
| 1395 | |||
| 1396 | /* Yuck, the command to abort is disconnected, it is not | ||
| 1397 | * worth trying to abort it now if something else is live | ||
| 1398 | * on the bus at this time. So, we let the SCSI code wait | ||
| 1399 | * a little bit and try again later. | ||
| 1400 | */ | ||
| 1401 | if(esp->current_SC) { | ||
| 1402 | if(don) | ||
| 1403 | esp->dma_ints_on(esp); | ||
| 1404 | return FAILED; | ||
| 1405 | } | ||
| 1406 | |||
| 1407 | /* It's disconnected, we have to reconnect to re-establish | ||
| 1408 | * the nexus and tell the device to abort. However, we really | ||
| 1409 | * cannot 'reconnect' per se. Don't try to be fancy, just | ||
| 1410 | * indicate failure, which causes our caller to reset the whole | ||
| 1411 | * bus. | ||
| 1412 | */ | ||
| 1413 | |||
| 1414 | if(don) | ||
| 1415 | esp->dma_ints_on(esp); | ||
| 1416 | return FAILED; | ||
| 1417 | } | ||
| 1418 | |||
| 1419 | /* We've sent ESP_CMD_RS to the ESP, the interrupt had just | ||
| 1420 | * arrived indicating the end of the SCSI bus reset. Our job | ||
| 1421 | * is to clean out the command queues and begin re-execution | ||
| 1422 | * of SCSI commands once more. | ||
| 1423 | */ | ||
| 1424 | static int esp_finish_reset(struct NCR_ESP *esp, | ||
| 1425 | struct ESP_regs *eregs) | ||
| 1426 | { | ||
| 1427 | Scsi_Cmnd *sp = esp->current_SC; | ||
| 1428 | |||
| 1429 | /* Clean up currently executing command, if any. */ | ||
| 1430 | if (sp != NULL) { | ||
| 1431 | esp_release_dmabufs(esp, sp); | ||
| 1432 | sp->result = (DID_RESET << 16); | ||
| 1433 | sp->scsi_done(sp); | ||
| 1434 | esp->current_SC = NULL; | ||
| 1435 | } | ||
| 1436 | |||
| 1437 | /* Clean up disconnected queue, they have been invalidated | ||
| 1438 | * by the bus reset. | ||
| 1439 | */ | ||
| 1440 | if (esp->disconnected_SC) { | ||
| 1441 | while((sp = remove_first_SC(&esp->disconnected_SC)) != NULL) { | ||
| 1442 | esp_release_dmabufs(esp, sp); | ||
| 1443 | sp->result = (DID_RESET << 16); | ||
| 1444 | sp->scsi_done(sp); | ||
| 1445 | } | ||
| 1446 | } | ||
| 1447 | |||
| 1448 | /* SCSI bus reset is complete. */ | ||
| 1449 | esp->resetting_bus = 0; | ||
| 1450 | wake_up(&esp->reset_queue); | ||
| 1451 | |||
| 1452 | /* Ok, now it is safe to get commands going once more. */ | ||
| 1453 | if(esp->issue_SC) | ||
| 1454 | esp_exec_cmd(esp); | ||
| 1455 | |||
| 1456 | return do_intr_end; | ||
| 1457 | } | ||
| 1458 | |||
| 1459 | static int esp_do_resetbus(struct NCR_ESP *esp, | ||
| 1460 | struct ESP_regs *eregs) | ||
| 1461 | { | ||
| 1462 | ESPLOG(("esp%d: Resetting scsi bus\n", esp->esp_id)); | ||
| 1463 | esp->resetting_bus = 1; | ||
| 1464 | esp_cmd(esp, eregs, ESP_CMD_RS); | ||
| 1465 | |||
| 1466 | return do_intr_end; | ||
| 1467 | } | ||
| 1468 | |||
| 1469 | /* Reset ESP chip, reset hanging bus, then kill active and | ||
| 1470 | * disconnected commands for targets without soft reset. | ||
| 1471 | * | ||
| 1472 | * The host_lock is acquired by caller. | ||
| 1473 | */ | ||
| 1474 | int esp_reset(Scsi_Cmnd *SCptr) | ||
| 1475 | { | ||
| 1476 | struct NCR_ESP *esp = (struct NCR_ESP *) SCptr->device->host->hostdata; | ||
| 1477 | |||
| 1478 | spin_lock_irq(esp->ehost->host_lock); | ||
| 1479 | (void) esp_do_resetbus(esp, esp->eregs); | ||
| 1480 | spin_unlock_irq(esp->ehost->host_lock); | ||
| 1481 | |||
| 1482 | wait_event(esp->reset_queue, (esp->resetting_bus == 0)); | ||
| 1483 | |||
| 1484 | return SUCCESS; | ||
| 1485 | } | ||
| 1486 | |||
| 1487 | /* Internal ESP done function. */ | ||
| 1488 | static void esp_done(struct NCR_ESP *esp, int error) | ||
| 1489 | { | ||
| 1490 | Scsi_Cmnd *done_SC; | ||
| 1491 | |||
| 1492 | if(esp->current_SC) { | ||
| 1493 | done_SC = esp->current_SC; | ||
| 1494 | esp->current_SC = NULL; | ||
| 1495 | esp_release_dmabufs(esp, done_SC); | ||
| 1496 | done_SC->result = error; | ||
| 1497 | done_SC->scsi_done(done_SC); | ||
| 1498 | |||
| 1499 | /* Bus is free, issue any commands in the queue. */ | ||
| 1500 | if(esp->issue_SC && !esp->current_SC) | ||
| 1501 | esp_exec_cmd(esp); | ||
| 1502 | } else { | ||
| 1503 | /* Panic is safe as current_SC is null so we may still | ||
| 1504 | * be able to accept more commands to sync disk buffers. | ||
| 1505 | */ | ||
| 1506 | ESPLOG(("panicing\n")); | ||
| 1507 | panic("esp: done() called with NULL esp->current_SC"); | ||
| 1508 | } | ||
| 1509 | } | ||
| 1510 | |||
| 1511 | /* Wheee, ESP interrupt engine. */ | ||
| 1512 | |||
| 1513 | /* Forward declarations. */ | ||
| 1514 | static int esp_do_phase_determine(struct NCR_ESP *esp, | ||
| 1515 | struct ESP_regs *eregs); | ||
| 1516 | static int esp_do_data_finale(struct NCR_ESP *esp, struct ESP_regs *eregs); | ||
| 1517 | static int esp_select_complete(struct NCR_ESP *esp, struct ESP_regs *eregs); | ||
| 1518 | static int esp_do_status(struct NCR_ESP *esp, struct ESP_regs *eregs); | ||
| 1519 | static int esp_do_msgin(struct NCR_ESP *esp, struct ESP_regs *eregs); | ||
| 1520 | static int esp_do_msgindone(struct NCR_ESP *esp, struct ESP_regs *eregs); | ||
| 1521 | static int esp_do_msgout(struct NCR_ESP *esp, struct ESP_regs *eregs); | ||
| 1522 | static int esp_do_cmdbegin(struct NCR_ESP *esp, struct ESP_regs *eregs); | ||
| 1523 | |||
| 1524 | #define sreg_datainp(__sreg) (((__sreg) & ESP_STAT_PMASK) == ESP_DIP) | ||
| 1525 | #define sreg_dataoutp(__sreg) (((__sreg) & ESP_STAT_PMASK) == ESP_DOP) | ||
| 1526 | |||
| 1527 | /* We try to avoid some interrupts by jumping ahead and see if the ESP | ||
| 1528 | * has gotten far enough yet. Hence the following. | ||
| 1529 | */ | ||
| 1530 | static inline int skipahead1(struct NCR_ESP *esp, struct ESP_regs *eregs, | ||
| 1531 | Scsi_Cmnd *scp, int prev_phase, int new_phase) | ||
| 1532 | { | ||
| 1533 | if(scp->SCp.sent_command != prev_phase) | ||
| 1534 | return 0; | ||
| 1535 | |||
| 1536 | if(esp->dma_irq_p(esp)) { | ||
| 1537 | /* Yes, we are able to save an interrupt. */ | ||
| 1538 | esp->sreg = (esp_read(eregs->esp_status) & ~(ESP_STAT_INTR)); | ||
| 1539 | esp->ireg = esp_read(eregs->esp_intrpt); | ||
| 1540 | if(!(esp->ireg & ESP_INTR_SR)) | ||
| 1541 | return 0; | ||
| 1542 | else | ||
| 1543 | return do_reset_complete; | ||
| 1544 | } | ||
| 1545 | /* Ho hum, target is taking forever... */ | ||
| 1546 | scp->SCp.sent_command = new_phase; /* so we don't recurse... */ | ||
| 1547 | return do_intr_end; | ||
| 1548 | } | ||
| 1549 | |||
| 1550 | static inline int skipahead2(struct NCR_ESP *esp, | ||
| 1551 | struct ESP_regs *eregs, | ||
| 1552 | Scsi_Cmnd *scp, int prev_phase1, int prev_phase2, | ||
| 1553 | int new_phase) | ||
| 1554 | { | ||
| 1555 | if(scp->SCp.sent_command != prev_phase1 && | ||
| 1556 | scp->SCp.sent_command != prev_phase2) | ||
| 1557 | return 0; | ||
| 1558 | if(esp->dma_irq_p(esp)) { | ||
| 1559 | /* Yes, we are able to save an interrupt. */ | ||
| 1560 | esp->sreg = (esp_read(eregs->esp_status) & ~(ESP_STAT_INTR)); | ||
| 1561 | esp->ireg = esp_read(eregs->esp_intrpt); | ||
| 1562 | if(!(esp->ireg & ESP_INTR_SR)) | ||
| 1563 | return 0; | ||
| 1564 | else | ||
| 1565 | return do_reset_complete; | ||
| 1566 | } | ||
| 1567 | /* Ho hum, target is taking forever... */ | ||
| 1568 | scp->SCp.sent_command = new_phase; /* so we don't recurse... */ | ||
| 1569 | return do_intr_end; | ||
| 1570 | } | ||
| 1571 | |||
| 1572 | /* Misc. esp helper macros. */ | ||
| 1573 | #define esp_setcount(__eregs, __cnt) \ | ||
| 1574 | esp_write((__eregs)->esp_tclow, ((__cnt) & 0xff)); \ | ||
| 1575 | esp_write((__eregs)->esp_tcmed, (((__cnt) >> 8) & 0xff)) | ||
| 1576 | |||
| 1577 | #define esp_getcount(__eregs) \ | ||
| 1578 | ((esp_read((__eregs)->esp_tclow)&0xff) | \ | ||
| 1579 | ((esp_read((__eregs)->esp_tcmed)&0xff) << 8)) | ||
| 1580 | |||
| 1581 | #define fcount(__esp, __eregs) \ | ||
| 1582 | (esp_read((__eregs)->esp_fflags) & ESP_FF_FBYTES) | ||
| 1583 | |||
| 1584 | #define fnzero(__esp, __eregs) \ | ||
| 1585 | (esp_read((__eregs)->esp_fflags) & ESP_FF_ONOTZERO) | ||
| 1586 | |||
| 1587 | /* XXX speculative nops unnecessary when continuing amidst a data phase | ||
| 1588 | * XXX even on esp100!!! another case of flooding the bus with I/O reg | ||
| 1589 | * XXX writes... | ||
| 1590 | */ | ||
| 1591 | #define esp_maybe_nop(__esp, __eregs) \ | ||
| 1592 | if((__esp)->erev == esp100) \ | ||
| 1593 | esp_cmd((__esp), (__eregs), ESP_CMD_NULL) | ||
| 1594 | |||
| 1595 | #define sreg_to_dataphase(__sreg) \ | ||
| 1596 | ((((__sreg) & ESP_STAT_PMASK) == ESP_DOP) ? in_dataout : in_datain) | ||
| 1597 | |||
| 1598 | /* The ESP100 when in synchronous data phase, can mistake a long final | ||
| 1599 | * REQ pulse from the target as an extra byte, it places whatever is on | ||
| 1600 | * the data lines into the fifo. For now, we will assume when this | ||
| 1601 | * happens that the target is a bit quirky and we don't want to | ||
| 1602 | * be talking synchronously to it anyways. Regardless, we need to | ||
| 1603 | * tell the ESP to eat the extraneous byte so that we can proceed | ||
| 1604 | * to the next phase. | ||
| 1605 | */ | ||
| 1606 | static inline int esp100_sync_hwbug(struct NCR_ESP *esp, struct ESP_regs *eregs, | ||
| 1607 | Scsi_Cmnd *sp, int fifocnt) | ||
| 1608 | { | ||
| 1609 | /* Do not touch this piece of code. */ | ||
| 1610 | if((!(esp->erev == esp100)) || | ||
| 1611 | (!(sreg_datainp((esp->sreg = esp_read(eregs->esp_status))) && !fifocnt) && | ||
| 1612 | !(sreg_dataoutp(esp->sreg) && !fnzero(esp, eregs)))) { | ||
| 1613 | if(sp->SCp.phase == in_dataout) | ||
| 1614 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 1615 | return 0; | ||
| 1616 | } else { | ||
| 1617 | /* Async mode for this guy. */ | ||
| 1618 | build_sync_nego_msg(esp, 0, 0); | ||
| 1619 | |||
| 1620 | /* Ack the bogus byte, but set ATN first. */ | ||
| 1621 | esp_cmd(esp, eregs, ESP_CMD_SATN); | ||
| 1622 | esp_cmd(esp, eregs, ESP_CMD_MOK); | ||
| 1623 | return 1; | ||
| 1624 | } | ||
| 1625 | } | ||
| 1626 | |||
| 1627 | /* This closes the window during a selection with a reselect pending, because | ||
| 1628 | * we use DMA for the selection process the FIFO should hold the correct | ||
| 1629 | * contents if we get reselected during this process. So we just need to | ||
| 1630 | * ack the possible illegal cmd interrupt pending on the esp100. | ||
| 1631 | */ | ||
| 1632 | static inline int esp100_reconnect_hwbug(struct NCR_ESP *esp, | ||
| 1633 | struct ESP_regs *eregs) | ||
| 1634 | { | ||
| 1635 | volatile unchar junk; | ||
| 1636 | |||
| 1637 | if(esp->erev != esp100) | ||
| 1638 | return 0; | ||
| 1639 | junk = esp_read(eregs->esp_intrpt); | ||
| 1640 | |||
| 1641 | if(junk & ESP_INTR_SR) | ||
| 1642 | return 1; | ||
| 1643 | return 0; | ||
| 1644 | } | ||
| 1645 | |||
| 1646 | /* This verifies the BUSID bits during a reselection so that we know which | ||
| 1647 | * target is talking to us. | ||
| 1648 | */ | ||
| 1649 | static inline int reconnect_target(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 1650 | { | ||
| 1651 | int it, me = esp->scsi_id_mask, targ = 0; | ||
| 1652 | |||
| 1653 | if(2 != fcount(esp, eregs)) | ||
| 1654 | return -1; | ||
| 1655 | it = esp_read(eregs->esp_fdata); | ||
| 1656 | if(!(it & me)) | ||
| 1657 | return -1; | ||
| 1658 | it &= ~me; | ||
| 1659 | if(it & (it - 1)) | ||
| 1660 | return -1; | ||
| 1661 | while(!(it & 1)) | ||
| 1662 | targ++, it >>= 1; | ||
| 1663 | return targ; | ||
| 1664 | } | ||
| 1665 | |||
| 1666 | /* This verifies the identify from the target so that we know which lun is | ||
| 1667 | * being reconnected. | ||
| 1668 | */ | ||
| 1669 | static inline int reconnect_lun(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 1670 | { | ||
| 1671 | int lun; | ||
| 1672 | |||
| 1673 | if((esp->sreg & ESP_STAT_PMASK) != ESP_MIP) | ||
| 1674 | return -1; | ||
| 1675 | lun = esp_read(eregs->esp_fdata); | ||
| 1676 | |||
| 1677 | /* Yes, you read this correctly. We report lun of zero | ||
| 1678 | * if we see parity error. ESP reports parity error for | ||
| 1679 | * the lun byte, and this is the only way to hope to recover | ||
| 1680 | * because the target is connected. | ||
| 1681 | */ | ||
| 1682 | if(esp->sreg & ESP_STAT_PERR) | ||
| 1683 | return 0; | ||
| 1684 | |||
| 1685 | /* Check for illegal bits being set in the lun. */ | ||
| 1686 | if((lun & 0x40) || !(lun & 0x80)) | ||
| 1687 | return -1; | ||
| 1688 | |||
| 1689 | return lun & 7; | ||
| 1690 | } | ||
| 1691 | |||
| 1692 | /* This puts the driver in a state where it can revitalize a command that | ||
| 1693 | * is being continued due to reselection. | ||
| 1694 | */ | ||
| 1695 | static inline void esp_connect(struct NCR_ESP *esp, struct ESP_regs *eregs, | ||
| 1696 | Scsi_Cmnd *sp) | ||
| 1697 | { | ||
| 1698 | struct scsi_device *dp = sp->device; | ||
| 1699 | struct esp_device *esp_dev = dp->hostdata; | ||
| 1700 | |||
| 1701 | if(esp->prev_soff != esp_dev->sync_max_offset || | ||
| 1702 | esp->prev_stp != esp_dev->sync_min_period || | ||
| 1703 | (esp->erev > esp100a && | ||
| 1704 | esp->prev_cfg3 != esp->config3[scmd_id(sp)])) { | ||
| 1705 | esp->prev_soff = esp_dev->sync_max_offset; | ||
| 1706 | esp_write(eregs->esp_soff, esp->prev_soff); | ||
| 1707 | esp->prev_stp = esp_dev->sync_min_period; | ||
| 1708 | esp_write(eregs->esp_stp, esp->prev_stp); | ||
| 1709 | if(esp->erev > esp100a) { | ||
| 1710 | esp->prev_cfg3 = esp->config3[scmd_id(sp)]; | ||
| 1711 | esp_write(eregs->esp_cfg3, esp->prev_cfg3); | ||
| 1712 | } | ||
| 1713 | } | ||
| 1714 | esp->current_SC = sp; | ||
| 1715 | } | ||
| 1716 | |||
| 1717 | /* This will place the current working command back into the issue queue | ||
| 1718 | * if we are to receive a reselection amidst a selection attempt. | ||
| 1719 | */ | ||
| 1720 | static inline void esp_reconnect(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 1721 | { | ||
| 1722 | if(!esp->disconnected_SC) | ||
| 1723 | ESPLOG(("esp%d: Weird, being reselected but disconnected " | ||
| 1724 | "command queue is empty.\n", esp->esp_id)); | ||
| 1725 | esp->snip = 0; | ||
| 1726 | esp->current_SC = NULL; | ||
| 1727 | sp->SCp.phase = not_issued; | ||
| 1728 | append_SC(&esp->issue_SC, sp); | ||
| 1729 | } | ||
| 1730 | |||
| 1731 | /* Begin message in phase. */ | ||
| 1732 | static int esp_do_msgin(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 1733 | { | ||
| 1734 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 1735 | esp_maybe_nop(esp, eregs); | ||
| 1736 | esp_cmd(esp, eregs, ESP_CMD_TI); | ||
| 1737 | esp->msgin_len = 1; | ||
| 1738 | esp->msgin_ctr = 0; | ||
| 1739 | esp_advance_phase(esp->current_SC, in_msgindone); | ||
| 1740 | return do_work_bus; | ||
| 1741 | } | ||
| 1742 | |||
| 1743 | static inline void advance_sg(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 1744 | { | ||
| 1745 | ++sp->SCp.buffer; | ||
| 1746 | --sp->SCp.buffers_residual; | ||
| 1747 | sp->SCp.this_residual = sp->SCp.buffer->length; | ||
| 1748 | if (esp->dma_advance_sg) | ||
| 1749 | esp->dma_advance_sg (sp); | ||
| 1750 | else | ||
| 1751 | sp->SCp.ptr = (char *) virt_to_phys(sg_virt(sp->SCp.buffer)); | ||
| 1752 | |||
| 1753 | } | ||
| 1754 | |||
| 1755 | /* Please note that the way I've coded these routines is that I _always_ | ||
| 1756 | * check for a disconnect during any and all information transfer | ||
| 1757 | * phases. The SCSI standard states that the target _can_ cause a BUS | ||
| 1758 | * FREE condition by dropping all MSG/CD/IO/BSY signals. Also note | ||
| 1759 | * that during information transfer phases the target controls every | ||
| 1760 | * change in phase, the only thing the initiator can do is "ask" for | ||
| 1761 | * a message out phase by driving ATN true. The target can, and sometimes | ||
| 1762 | * will, completely ignore this request so we cannot assume anything when | ||
| 1763 | * we try to force a message out phase to abort/reset a target. Most of | ||
| 1764 | * the time the target will eventually be nice and go to message out, so | ||
| 1765 | * we may have to hold on to our state about what we want to tell the target | ||
| 1766 | * for some period of time. | ||
| 1767 | */ | ||
| 1768 | |||
| 1769 | /* I think I have things working here correctly. Even partial transfers | ||
| 1770 | * within a buffer or sub-buffer should not upset us at all no matter | ||
| 1771 | * how bad the target and/or ESP fucks things up. | ||
| 1772 | */ | ||
| 1773 | static int esp_do_data(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 1774 | { | ||
| 1775 | Scsi_Cmnd *SCptr = esp->current_SC; | ||
| 1776 | int thisphase, hmuch; | ||
| 1777 | |||
| 1778 | ESPDATA(("esp_do_data: ")); | ||
| 1779 | esp_maybe_nop(esp, eregs); | ||
| 1780 | thisphase = sreg_to_dataphase(esp->sreg); | ||
| 1781 | esp_advance_phase(SCptr, thisphase); | ||
| 1782 | ESPDATA(("newphase<%s> ", (thisphase == in_datain) ? "DATAIN" : "DATAOUT")); | ||
| 1783 | hmuch = esp->dma_can_transfer(esp, SCptr); | ||
| 1784 | |||
| 1785 | /* | ||
| 1786 | * XXX MSch: cater for PIO transfer here; PIO used if hmuch == 0 | ||
| 1787 | */ | ||
| 1788 | if (hmuch) { /* DMA */ | ||
| 1789 | /* | ||
| 1790 | * DMA | ||
| 1791 | */ | ||
| 1792 | ESPDATA(("hmuch<%d> ", hmuch)); | ||
| 1793 | esp->current_transfer_size = hmuch; | ||
| 1794 | esp_setcount(eregs, (esp->fas_premature_intr_workaround ? | ||
| 1795 | (hmuch + 0x40) : hmuch)); | ||
| 1796 | esp->dma_setup(esp, (__u32)((unsigned long)SCptr->SCp.ptr), | ||
| 1797 | hmuch, (thisphase == in_datain)); | ||
| 1798 | ESPDATA(("DMA|TI --> do_intr_end\n")); | ||
| 1799 | esp_cmd(esp, eregs, ESP_CMD_DMA | ESP_CMD_TI); | ||
| 1800 | return do_intr_end; | ||
| 1801 | /* | ||
| 1802 | * end DMA | ||
| 1803 | */ | ||
| 1804 | } else { | ||
| 1805 | /* | ||
| 1806 | * PIO | ||
| 1807 | */ | ||
| 1808 | int oldphase, i = 0; /* or where we left off last time ?? esp->current_data ?? */ | ||
| 1809 | int fifocnt = 0; | ||
| 1810 | unsigned char *p = phys_to_virt((unsigned long)SCptr->SCp.ptr); | ||
| 1811 | |||
| 1812 | oldphase = esp_read(eregs->esp_status) & ESP_STAT_PMASK; | ||
| 1813 | |||
| 1814 | /* | ||
| 1815 | * polled transfer; ugly, can we make this happen in a DRQ | ||
| 1816 | * interrupt handler ?? | ||
| 1817 | * requires keeping track of state information in host or | ||
| 1818 | * command struct! | ||
| 1819 | * Problem: I've never seen a DRQ happen on Mac, not even | ||
| 1820 | * with ESP_CMD_DMA ... | ||
| 1821 | */ | ||
| 1822 | |||
| 1823 | /* figure out how much needs to be transferred */ | ||
| 1824 | hmuch = SCptr->SCp.this_residual; | ||
| 1825 | ESPDATA(("hmuch<%d> pio ", hmuch)); | ||
| 1826 | esp->current_transfer_size = hmuch; | ||
| 1827 | |||
| 1828 | /* tell the ESP ... */ | ||
| 1829 | esp_setcount(eregs, hmuch); | ||
| 1830 | |||
| 1831 | /* loop */ | ||
| 1832 | while (hmuch) { | ||
| 1833 | int j, fifo_stuck = 0, newphase; | ||
| 1834 | unsigned long timeout; | ||
| 1835 | #if 0 | ||
| 1836 | unsigned long flags; | ||
| 1837 | #endif | ||
| 1838 | #if 0 | ||
| 1839 | if ( i % 10 ) | ||
| 1840 | ESPDATA(("\r")); | ||
| 1841 | else | ||
| 1842 | ESPDATA(( /*"\n"*/ "\r")); | ||
| 1843 | #endif | ||
| 1844 | #if 0 | ||
| 1845 | local_irq_save(flags); | ||
| 1846 | #endif | ||
| 1847 | if(thisphase == in_datain) { | ||
| 1848 | /* 'go' ... */ | ||
| 1849 | esp_cmd(esp, eregs, ESP_CMD_TI); | ||
| 1850 | |||
| 1851 | /* wait for data */ | ||
| 1852 | timeout = 1000000; | ||
| 1853 | while (!((esp->sreg=esp_read(eregs->esp_status)) & ESP_STAT_INTR) && --timeout) | ||
| 1854 | udelay(2); | ||
| 1855 | if (timeout == 0) | ||
| 1856 | printk("DRQ datain timeout! \n"); | ||
| 1857 | |||
| 1858 | newphase = esp->sreg & ESP_STAT_PMASK; | ||
| 1859 | |||
| 1860 | /* see how much we got ... */ | ||
| 1861 | fifocnt = (esp_read(eregs->esp_fflags) & ESP_FF_FBYTES); | ||
| 1862 | |||
| 1863 | if (!fifocnt) | ||
| 1864 | fifo_stuck++; | ||
| 1865 | else | ||
| 1866 | fifo_stuck = 0; | ||
| 1867 | |||
| 1868 | ESPDATA(("\rgot %d st %x ph %x", fifocnt, esp->sreg, newphase)); | ||
| 1869 | |||
| 1870 | /* read fifo */ | ||
| 1871 | for(j=0;j<fifocnt;j++) | ||
| 1872 | p[i++] = esp_read(eregs->esp_fdata); | ||
| 1873 | |||
| 1874 | ESPDATA(("(%d) ", i)); | ||
| 1875 | |||
| 1876 | /* how many to go ?? */ | ||
| 1877 | hmuch -= fifocnt; | ||
| 1878 | |||
| 1879 | /* break if status phase !! */ | ||
| 1880 | if(newphase == ESP_STATP) { | ||
| 1881 | /* clear int. */ | ||
| 1882 | esp->ireg = esp_read(eregs->esp_intrpt); | ||
| 1883 | break; | ||
| 1884 | } | ||
| 1885 | } else { | ||
| 1886 | #define MAX_FIFO 8 | ||
| 1887 | /* how much will fit ? */ | ||
| 1888 | int this_count = MAX_FIFO - fifocnt; | ||
| 1889 | if (this_count > hmuch) | ||
| 1890 | this_count = hmuch; | ||
| 1891 | |||
| 1892 | /* fill fifo */ | ||
| 1893 | for(j=0;j<this_count;j++) | ||
| 1894 | esp_write(eregs->esp_fdata, p[i++]); | ||
| 1895 | |||
| 1896 | /* how many left if this goes out ?? */ | ||
| 1897 | hmuch -= this_count; | ||
| 1898 | |||
| 1899 | /* 'go' ... */ | ||
| 1900 | esp_cmd(esp, eregs, ESP_CMD_TI); | ||
| 1901 | |||
| 1902 | /* wait for 'got it' */ | ||
| 1903 | timeout = 1000000; | ||
| 1904 | while (!((esp->sreg=esp_read(eregs->esp_status)) & ESP_STAT_INTR) && --timeout) | ||
| 1905 | udelay(2); | ||
| 1906 | if (timeout == 0) | ||
| 1907 | printk("DRQ dataout timeout! \n"); | ||
| 1908 | |||
| 1909 | newphase = esp->sreg & ESP_STAT_PMASK; | ||
| 1910 | |||
| 1911 | /* need to check how much was sent ?? */ | ||
| 1912 | fifocnt = (esp_read(eregs->esp_fflags) & ESP_FF_FBYTES); | ||
| 1913 | |||
| 1914 | ESPDATA(("\rsent %d st %x ph %x", this_count - fifocnt, esp->sreg, newphase)); | ||
| 1915 | |||
| 1916 | ESPDATA(("(%d) ", i)); | ||
| 1917 | |||
| 1918 | /* break if status phase !! */ | ||
| 1919 | if(newphase == ESP_STATP) { | ||
| 1920 | /* clear int. */ | ||
| 1921 | esp->ireg = esp_read(eregs->esp_intrpt); | ||
| 1922 | break; | ||
| 1923 | } | ||
| 1924 | |||
| 1925 | } | ||
| 1926 | |||
| 1927 | /* clear int. */ | ||
| 1928 | esp->ireg = esp_read(eregs->esp_intrpt); | ||
| 1929 | |||
| 1930 | ESPDATA(("ir %x ... ", esp->ireg)); | ||
| 1931 | |||
| 1932 | if (hmuch == 0) | ||
| 1933 | ESPDATA(("done! \n")); | ||
| 1934 | |||
| 1935 | #if 0 | ||
| 1936 | local_irq_restore(flags); | ||
| 1937 | #endif | ||
| 1938 | |||
| 1939 | /* check new bus phase */ | ||
| 1940 | if (newphase != oldphase && i < esp->current_transfer_size) { | ||
| 1941 | /* something happened; disconnect ?? */ | ||
| 1942 | ESPDATA(("phase change, dropped out with %d done ... ", i)); | ||
| 1943 | break; | ||
| 1944 | } | ||
| 1945 | |||
| 1946 | /* check int. status */ | ||
| 1947 | if (esp->ireg & ESP_INTR_DC) { | ||
| 1948 | /* disconnect */ | ||
| 1949 | ESPDATA(("disconnect; %d transferred ... ", i)); | ||
| 1950 | break; | ||
| 1951 | } else if (esp->ireg & ESP_INTR_FDONE) { | ||
| 1952 | /* function done */ | ||
| 1953 | ESPDATA(("function done; %d transferred ... ", i)); | ||
| 1954 | break; | ||
| 1955 | } | ||
| 1956 | |||
| 1957 | /* XXX fixme: bail out on stall */ | ||
| 1958 | if (fifo_stuck > 10) { | ||
| 1959 | /* we're stuck */ | ||
| 1960 | ESPDATA(("fifo stall; %d transferred ... ", i)); | ||
| 1961 | break; | ||
| 1962 | } | ||
| 1963 | } | ||
| 1964 | |||
| 1965 | ESPDATA(("\n")); | ||
| 1966 | /* check successful completion ?? */ | ||
| 1967 | |||
| 1968 | if (thisphase == in_dataout) | ||
| 1969 | hmuch += fifocnt; /* stuck?? adjust data pointer ...*/ | ||
| 1970 | |||
| 1971 | /* tell do_data_finale how much was transferred */ | ||
| 1972 | esp->current_transfer_size -= hmuch; | ||
| 1973 | |||
| 1974 | /* still not completely sure on this one ... */ | ||
| 1975 | return /*do_intr_end*/ do_work_bus /*do_phase_determine*/ ; | ||
| 1976 | |||
| 1977 | /* | ||
| 1978 | * end PIO | ||
| 1979 | */ | ||
| 1980 | } | ||
| 1981 | return do_intr_end; | ||
| 1982 | } | ||
| 1983 | |||
| 1984 | /* See how successful the data transfer was. */ | ||
| 1985 | static int esp_do_data_finale(struct NCR_ESP *esp, | ||
| 1986 | struct ESP_regs *eregs) | ||
| 1987 | { | ||
| 1988 | Scsi_Cmnd *SCptr = esp->current_SC; | ||
| 1989 | struct esp_device *esp_dev = SCptr->device->hostdata; | ||
| 1990 | int bogus_data = 0, bytes_sent = 0, fifocnt, ecount = 0; | ||
| 1991 | |||
| 1992 | if(esp->dma_led_off) | ||
| 1993 | esp->dma_led_off(esp); | ||
| 1994 | |||
| 1995 | ESPDATA(("esp_do_data_finale: ")); | ||
| 1996 | |||
| 1997 | if(SCptr->SCp.phase == in_datain) { | ||
| 1998 | if(esp->sreg & ESP_STAT_PERR) { | ||
| 1999 | /* Yuck, parity error. The ESP asserts ATN | ||
| 2000 | * so that we can go to message out phase | ||
| 2001 | * immediately and inform the target that | ||
| 2002 | * something bad happened. | ||
| 2003 | */ | ||
| 2004 | ESPLOG(("esp%d: data bad parity detected.\n", | ||
| 2005 | esp->esp_id)); | ||
| 2006 | esp->cur_msgout[0] = INITIATOR_ERROR; | ||
| 2007 | esp->msgout_len = 1; | ||
| 2008 | } | ||
| 2009 | if(esp->dma_drain) | ||
| 2010 | esp->dma_drain(esp); | ||
| 2011 | } | ||
| 2012 | if(esp->dma_invalidate) | ||
| 2013 | esp->dma_invalidate(esp); | ||
| 2014 | |||
| 2015 | /* This could happen for the above parity error case. */ | ||
| 2016 | if(!(esp->ireg == ESP_INTR_BSERV)) { | ||
| 2017 | /* Please go to msgout phase, please please please... */ | ||
| 2018 | ESPLOG(("esp%d: !BSERV after data, probably to msgout\n", | ||
| 2019 | esp->esp_id)); | ||
| 2020 | return esp_do_phase_determine(esp, eregs); | ||
| 2021 | } | ||
| 2022 | |||
| 2023 | /* Check for partial transfers and other horrible events. */ | ||
| 2024 | fifocnt = (esp_read(eregs->esp_fflags) & ESP_FF_FBYTES); | ||
| 2025 | ecount = esp_getcount(eregs); | ||
| 2026 | if(esp->fas_premature_intr_workaround) | ||
| 2027 | ecount -= 0x40; | ||
| 2028 | bytes_sent = esp->current_transfer_size; | ||
| 2029 | |||
| 2030 | ESPDATA(("trans_sz=%d, ", bytes_sent)); | ||
| 2031 | if(!(esp->sreg & ESP_STAT_TCNT)) | ||
| 2032 | bytes_sent -= ecount; | ||
| 2033 | if(SCptr->SCp.phase == in_dataout) | ||
| 2034 | bytes_sent -= fifocnt; | ||
| 2035 | |||
| 2036 | ESPDATA(("bytes_sent=%d (ecount=%d, fifocnt=%d), ", bytes_sent, | ||
| 2037 | ecount, fifocnt)); | ||
| 2038 | |||
| 2039 | /* If we were in synchronous mode, check for peculiarities. */ | ||
| 2040 | if(esp_dev->sync_max_offset) | ||
| 2041 | bogus_data = esp100_sync_hwbug(esp, eregs, SCptr, fifocnt); | ||
| 2042 | else | ||
| 2043 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 2044 | |||
| 2045 | /* Until we are sure of what has happened, we are certainly | ||
| 2046 | * in the dark. | ||
| 2047 | */ | ||
| 2048 | esp_advance_phase(SCptr, in_the_dark); | ||
| 2049 | |||
| 2050 | /* Check for premature interrupt condition. Can happen on FAS2x6 | ||
| 2051 | * chips. QLogic recommends a workaround by overprogramming the | ||
| 2052 | * transfer counters, but this makes doing scatter-gather impossible. | ||
| 2053 | * Until there is a way to disable scatter-gather for a single target, | ||
| 2054 | * and not only for the entire host adapter as it is now, the workaround | ||
| 2055 | * is way to expensive performance wise. | ||
| 2056 | * Instead, it turns out that when this happens the target has disconnected | ||
| 2057 | * already but it doesn't show in the interrupt register. Compensate for | ||
| 2058 | * that here to try and avoid a SCSI bus reset. | ||
| 2059 | */ | ||
| 2060 | if(!esp->fas_premature_intr_workaround && (fifocnt == 1) && | ||
| 2061 | sreg_dataoutp(esp->sreg)) { | ||
| 2062 | ESPLOG(("esp%d: Premature interrupt, enabling workaround\n", | ||
| 2063 | esp->esp_id)); | ||
| 2064 | #if 0 | ||
| 2065 | /* Disable scatter-gather operations, they are not possible | ||
| 2066 | * when using this workaround. | ||
| 2067 | */ | ||
| 2068 | esp->ehost->sg_tablesize = 0; | ||
| 2069 | esp->ehost->use_clustering = ENABLE_CLUSTERING; | ||
| 2070 | esp->fas_premature_intr_workaround = 1; | ||
| 2071 | bytes_sent = 0; | ||
| 2072 | if(SCptr->use_sg) { | ||
| 2073 | ESPLOG(("esp%d: Aborting scatter-gather operation\n", | ||
| 2074 | esp->esp_id)); | ||
| 2075 | esp->cur_msgout[0] = ABORT; | ||
| 2076 | esp->msgout_len = 1; | ||
| 2077 | esp->msgout_ctr = 0; | ||
| 2078 | esp_cmd(esp, eregs, ESP_CMD_SATN); | ||
| 2079 | esp_setcount(eregs, 0xffff); | ||
| 2080 | esp_cmd(esp, eregs, ESP_CMD_NULL); | ||
| 2081 | esp_cmd(esp, eregs, ESP_CMD_TPAD | ESP_CMD_DMA); | ||
| 2082 | return do_intr_end; | ||
| 2083 | } | ||
| 2084 | #else | ||
| 2085 | /* Just set the disconnected bit. That's what appears to | ||
| 2086 | * happen anyway. The state machine will pick it up when | ||
| 2087 | * we return. | ||
| 2088 | */ | ||
| 2089 | esp->ireg |= ESP_INTR_DC; | ||
| 2090 | #endif | ||
| 2091 | } | ||
| 2092 | |||
| 2093 | if(bytes_sent < 0) { | ||
| 2094 | /* I've seen this happen due to lost state in this | ||
| 2095 | * driver. No idea why it happened, but allowing | ||
| 2096 | * this value to be negative caused things to | ||
| 2097 | * lock up. This allows greater chance of recovery. | ||
| 2098 | * In fact every time I've seen this, it has been | ||
| 2099 | * a driver bug without question. | ||
| 2100 | */ | ||
| 2101 | ESPLOG(("esp%d: yieee, bytes_sent < 0!\n", esp->esp_id)); | ||
| 2102 | ESPLOG(("esp%d: csz=%d fifocount=%d ecount=%d\n", | ||
| 2103 | esp->esp_id, | ||
| 2104 | esp->current_transfer_size, fifocnt, ecount)); | ||
| 2105 | ESPLOG(("esp%d: use_sg=%d ptr=%p this_residual=%d\n", | ||
| 2106 | esp->esp_id, | ||
| 2107 | SCptr->use_sg, SCptr->SCp.ptr, SCptr->SCp.this_residual)); | ||
| 2108 | ESPLOG(("esp%d: Forcing async for target %d\n", esp->esp_id, | ||
| 2109 | SCptr->device->id)); | ||
| 2110 | SCptr->device->borken = 1; | ||
| 2111 | esp_dev->sync = 0; | ||
| 2112 | bytes_sent = 0; | ||
| 2113 | } | ||
| 2114 | |||
| 2115 | /* Update the state of our transfer. */ | ||
| 2116 | SCptr->SCp.ptr += bytes_sent; | ||
| 2117 | SCptr->SCp.this_residual -= bytes_sent; | ||
| 2118 | if(SCptr->SCp.this_residual < 0) { | ||
| 2119 | /* shit */ | ||
| 2120 | ESPLOG(("esp%d: Data transfer overrun.\n", esp->esp_id)); | ||
| 2121 | SCptr->SCp.this_residual = 0; | ||
| 2122 | } | ||
| 2123 | |||
| 2124 | /* Maybe continue. */ | ||
| 2125 | if(!bogus_data) { | ||
| 2126 | ESPDATA(("!bogus_data, ")); | ||
| 2127 | /* NO MATTER WHAT, we advance the scatterlist, | ||
| 2128 | * if the target should decide to disconnect | ||
| 2129 | * in between scatter chunks (which is common) | ||
| 2130 | * we could die horribly! I used to have the sg | ||
| 2131 | * advance occur only if we are going back into | ||
| 2132 | * (or are staying in) a data phase, you can | ||
| 2133 | * imagine the hell I went through trying to | ||
| 2134 | * figure this out. | ||
| 2135 | */ | ||
| 2136 | if(!SCptr->SCp.this_residual && SCptr->SCp.buffers_residual) | ||
| 2137 | advance_sg(esp, SCptr); | ||
| 2138 | #ifdef DEBUG_ESP_DATA | ||
| 2139 | if(sreg_datainp(esp->sreg) || sreg_dataoutp(esp->sreg)) { | ||
| 2140 | ESPDATA(("to more data\n")); | ||
| 2141 | } else { | ||
| 2142 | ESPDATA(("to new phase\n")); | ||
| 2143 | } | ||
| 2144 | #endif | ||
| 2145 | return esp_do_phase_determine(esp, eregs); | ||
| 2146 | } | ||
| 2147 | /* Bogus data, just wait for next interrupt. */ | ||
| 2148 | ESPLOG(("esp%d: bogus_data during end of data phase\n", | ||
| 2149 | esp->esp_id)); | ||
| 2150 | return do_intr_end; | ||
| 2151 | } | ||
| 2152 | |||
| 2153 | /* We received a non-good status return at the end of | ||
| 2154 | * running a SCSI command. This is used to decide if | ||
| 2155 | * we should clear our synchronous transfer state for | ||
| 2156 | * such a device when that happens. | ||
| 2157 | * | ||
| 2158 | * The idea is that when spinning up a disk or rewinding | ||
| 2159 | * a tape, we don't want to go into a loop re-negotiating | ||
| 2160 | * synchronous capabilities over and over. | ||
| 2161 | */ | ||
| 2162 | static int esp_should_clear_sync(Scsi_Cmnd *sp) | ||
| 2163 | { | ||
| 2164 | unchar cmd = sp->cmnd[0]; | ||
| 2165 | |||
| 2166 | /* These cases are for spinning up a disk and | ||
| 2167 | * waiting for that spinup to complete. | ||
| 2168 | */ | ||
| 2169 | if(cmd == START_STOP) | ||
| 2170 | return 0; | ||
| 2171 | |||
| 2172 | if(cmd == TEST_UNIT_READY) | ||
| 2173 | return 0; | ||
| 2174 | |||
| 2175 | /* One more special case for SCSI tape drives, | ||
| 2176 | * this is what is used to probe the device for | ||
| 2177 | * completion of a rewind or tape load operation. | ||
| 2178 | */ | ||
| 2179 | if(sp->device->type == TYPE_TAPE && cmd == MODE_SENSE) | ||
| 2180 | return 0; | ||
| 2181 | |||
| 2182 | return 1; | ||
| 2183 | } | ||
| 2184 | |||
| 2185 | /* Either a command is completing or a target is dropping off the bus | ||
| 2186 | * to continue the command in the background so we can do other work. | ||
| 2187 | */ | ||
| 2188 | static int esp_do_freebus(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 2189 | { | ||
| 2190 | Scsi_Cmnd *SCptr = esp->current_SC; | ||
| 2191 | int rval; | ||
| 2192 | |||
| 2193 | rval = skipahead2(esp, eregs, SCptr, in_status, in_msgindone, in_freeing); | ||
| 2194 | if(rval) | ||
| 2195 | return rval; | ||
| 2196 | |||
| 2197 | if(esp->ireg != ESP_INTR_DC) { | ||
| 2198 | ESPLOG(("esp%d: Target will not disconnect\n", esp->esp_id)); | ||
| 2199 | return do_reset_bus; /* target will not drop BSY... */ | ||
| 2200 | } | ||
| 2201 | esp->msgout_len = 0; | ||
| 2202 | esp->prevmsgout = NOP; | ||
| 2203 | if(esp->prevmsgin == COMMAND_COMPLETE) { | ||
| 2204 | struct esp_device *esp_dev = SCptr->device->hostdata; | ||
| 2205 | /* Normal end of nexus. */ | ||
| 2206 | if(esp->disconnected_SC) | ||
| 2207 | esp_cmd(esp, eregs, ESP_CMD_ESEL); | ||
| 2208 | |||
| 2209 | if(SCptr->SCp.Status != GOOD && | ||
| 2210 | SCptr->SCp.Status != CONDITION_GOOD && | ||
| 2211 | ((1<<scmd_id(SCptr)) & esp->targets_present) && | ||
| 2212 | esp_dev->sync && esp_dev->sync_max_offset) { | ||
| 2213 | /* SCSI standard says that the synchronous capabilities | ||
| 2214 | * should be renegotiated at this point. Most likely | ||
| 2215 | * we are about to request sense from this target | ||
| 2216 | * in which case we want to avoid using sync | ||
| 2217 | * transfers until we are sure of the current target | ||
| 2218 | * state. | ||
| 2219 | */ | ||
| 2220 | ESPMISC(("esp: Status <%d> for target %d lun %d\n", | ||
| 2221 | SCptr->SCp.Status, SCptr->device->id, SCptr->device->lun)); | ||
| 2222 | |||
| 2223 | /* But don't do this when spinning up a disk at | ||
| 2224 | * boot time while we poll for completion as it | ||
| 2225 | * fills up the console with messages. Also, tapes | ||
| 2226 | * can report not ready many times right after | ||
| 2227 | * loading up a tape. | ||
| 2228 | */ | ||
| 2229 | if(esp_should_clear_sync(SCptr) != 0) | ||
| 2230 | esp_dev->sync = 0; | ||
| 2231 | } | ||
| 2232 | ESPDISC(("F<%02x,%02x>", SCptr->device->id, SCptr->device->lun)); | ||
| 2233 | esp_done(esp, ((SCptr->SCp.Status & 0xff) | | ||
| 2234 | ((SCptr->SCp.Message & 0xff)<<8) | | ||
| 2235 | (DID_OK << 16))); | ||
| 2236 | } else if(esp->prevmsgin == DISCONNECT) { | ||
| 2237 | /* Normal disconnect. */ | ||
| 2238 | esp_cmd(esp, eregs, ESP_CMD_ESEL); | ||
| 2239 | ESPDISC(("D<%02x,%02x>", SCptr->device->id, SCptr->device->lun)); | ||
| 2240 | append_SC(&esp->disconnected_SC, SCptr); | ||
| 2241 | esp->current_SC = NULL; | ||
| 2242 | if(esp->issue_SC) | ||
| 2243 | esp_exec_cmd(esp); | ||
| 2244 | } else { | ||
| 2245 | /* Driver bug, we do not expect a disconnect here | ||
| 2246 | * and should not have advanced the state engine | ||
| 2247 | * to in_freeing. | ||
| 2248 | */ | ||
| 2249 | ESPLOG(("esp%d: last msg not disc and not cmd cmplt.\n", | ||
| 2250 | esp->esp_id)); | ||
| 2251 | return do_reset_bus; | ||
| 2252 | } | ||
| 2253 | return do_intr_end; | ||
| 2254 | } | ||
| 2255 | |||
| 2256 | /* When a reselect occurs, and we cannot find the command to | ||
| 2257 | * reconnect to in our queues, we do this. | ||
| 2258 | */ | ||
| 2259 | static int esp_bad_reconnect(struct NCR_ESP *esp) | ||
| 2260 | { | ||
| 2261 | Scsi_Cmnd *sp; | ||
| 2262 | |||
| 2263 | ESPLOG(("esp%d: Eieeee, reconnecting unknown command!\n", | ||
| 2264 | esp->esp_id)); | ||
| 2265 | ESPLOG(("QUEUE DUMP\n")); | ||
| 2266 | sp = esp->issue_SC; | ||
| 2267 | ESPLOG(("esp%d: issue_SC[", esp->esp_id)); | ||
| 2268 | while(sp) { | ||
| 2269 | ESPLOG(("<%02x,%02x>", sp->device->id, sp->device->lun)); | ||
| 2270 | sp = (Scsi_Cmnd *) sp->host_scribble; | ||
| 2271 | } | ||
| 2272 | ESPLOG(("]\n")); | ||
| 2273 | sp = esp->current_SC; | ||
| 2274 | ESPLOG(("esp%d: current_SC[", esp->esp_id)); | ||
| 2275 | while(sp) { | ||
| 2276 | ESPLOG(("<%02x,%02x>", sp->device->id, sp->device->lun)); | ||
| 2277 | sp = (Scsi_Cmnd *) sp->host_scribble; | ||
| 2278 | } | ||
| 2279 | ESPLOG(("]\n")); | ||
| 2280 | sp = esp->disconnected_SC; | ||
| 2281 | ESPLOG(("esp%d: disconnected_SC[", esp->esp_id)); | ||
| 2282 | while(sp) { | ||
| 2283 | ESPLOG(("<%02x,%02x>", sp->device->id, sp->device->lun)); | ||
| 2284 | sp = (Scsi_Cmnd *) sp->host_scribble; | ||
| 2285 | } | ||
| 2286 | ESPLOG(("]\n")); | ||
| 2287 | return do_reset_bus; | ||
| 2288 | } | ||
| 2289 | |||
| 2290 | /* Do the needy when a target tries to reconnect to us. */ | ||
| 2291 | static int esp_do_reconnect(struct NCR_ESP *esp, | ||
| 2292 | struct ESP_regs *eregs) | ||
| 2293 | { | ||
| 2294 | int lun, target; | ||
| 2295 | Scsi_Cmnd *SCptr; | ||
| 2296 | |||
| 2297 | /* Check for all bogus conditions first. */ | ||
| 2298 | target = reconnect_target(esp, eregs); | ||
| 2299 | if(target < 0) { | ||
| 2300 | ESPDISC(("bad bus bits\n")); | ||
| 2301 | return do_reset_bus; | ||
| 2302 | } | ||
| 2303 | lun = reconnect_lun(esp, eregs); | ||
| 2304 | if(lun < 0) { | ||
| 2305 | ESPDISC(("target=%2x, bad identify msg\n", target)); | ||
| 2306 | return do_reset_bus; | ||
| 2307 | } | ||
| 2308 | |||
| 2309 | /* Things look ok... */ | ||
| 2310 | ESPDISC(("R<%02x,%02x>", target, lun)); | ||
| 2311 | |||
| 2312 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 2313 | if(esp100_reconnect_hwbug(esp, eregs)) | ||
| 2314 | return do_reset_bus; | ||
| 2315 | esp_cmd(esp, eregs, ESP_CMD_NULL); | ||
| 2316 | |||
| 2317 | SCptr = remove_SC(&esp->disconnected_SC, (unchar) target, (unchar) lun); | ||
| 2318 | if(!SCptr) | ||
| 2319 | return esp_bad_reconnect(esp); | ||
| 2320 | |||
| 2321 | esp_connect(esp, eregs, SCptr); | ||
| 2322 | esp_cmd(esp, eregs, ESP_CMD_MOK); | ||
| 2323 | |||
| 2324 | /* Reconnect implies a restore pointers operation. */ | ||
| 2325 | esp_restore_pointers(esp, SCptr); | ||
| 2326 | |||
| 2327 | esp->snip = 0; | ||
| 2328 | esp_advance_phase(SCptr, in_the_dark); | ||
| 2329 | return do_intr_end; | ||
| 2330 | } | ||
| 2331 | |||
| 2332 | /* End of NEXUS (hopefully), pick up status + message byte then leave if | ||
| 2333 | * all goes well. | ||
| 2334 | */ | ||
| 2335 | static int esp_do_status(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 2336 | { | ||
| 2337 | Scsi_Cmnd *SCptr = esp->current_SC; | ||
| 2338 | int intr, rval; | ||
| 2339 | |||
| 2340 | rval = skipahead1(esp, eregs, SCptr, in_the_dark, in_status); | ||
| 2341 | if(rval) | ||
| 2342 | return rval; | ||
| 2343 | |||
| 2344 | intr = esp->ireg; | ||
| 2345 | ESPSTAT(("esp_do_status: ")); | ||
| 2346 | if(intr != ESP_INTR_DC) { | ||
| 2347 | int message_out = 0; /* for parity problems */ | ||
| 2348 | |||
| 2349 | /* Ack the message. */ | ||
| 2350 | ESPSTAT(("ack msg, ")); | ||
| 2351 | esp_cmd(esp, eregs, ESP_CMD_MOK); | ||
| 2352 | |||
| 2353 | if(esp->dma_poll) | ||
| 2354 | esp->dma_poll(esp, (unsigned char *) esp->esp_command); | ||
| 2355 | |||
| 2356 | ESPSTAT(("got something, ")); | ||
| 2357 | /* ESP chimes in with one of | ||
| 2358 | * | ||
| 2359 | * 1) function done interrupt: | ||
| 2360 | * both status and message in bytes | ||
| 2361 | * are available | ||
| 2362 | * | ||
| 2363 | * 2) bus service interrupt: | ||
| 2364 | * only status byte was acquired | ||
| 2365 | * | ||
| 2366 | * 3) Anything else: | ||
| 2367 | * can't happen, but we test for it | ||
| 2368 | * anyways | ||
| 2369 | * | ||
| 2370 | * ALSO: If bad parity was detected on either | ||
| 2371 | * the status _or_ the message byte then | ||
| 2372 | * the ESP has asserted ATN on the bus | ||
| 2373 | * and we must therefore wait for the | ||
| 2374 | * next phase change. | ||
| 2375 | */ | ||
| 2376 | if(intr & ESP_INTR_FDONE) { | ||
| 2377 | /* We got it all, hallejulia. */ | ||
| 2378 | ESPSTAT(("got both, ")); | ||
| 2379 | SCptr->SCp.Status = esp->esp_command[0]; | ||
| 2380 | SCptr->SCp.Message = esp->esp_command[1]; | ||
| 2381 | esp->prevmsgin = SCptr->SCp.Message; | ||
| 2382 | esp->cur_msgin[0] = SCptr->SCp.Message; | ||
| 2383 | if(esp->sreg & ESP_STAT_PERR) { | ||
| 2384 | /* There was bad parity for the | ||
| 2385 | * message byte, the status byte | ||
| 2386 | * was ok. | ||
| 2387 | */ | ||
| 2388 | message_out = MSG_PARITY_ERROR; | ||
| 2389 | } | ||
| 2390 | } else if(intr == ESP_INTR_BSERV) { | ||
| 2391 | /* Only got status byte. */ | ||
| 2392 | ESPLOG(("esp%d: got status only, ", esp->esp_id)); | ||
| 2393 | if(!(esp->sreg & ESP_STAT_PERR)) { | ||
| 2394 | SCptr->SCp.Status = esp->esp_command[0]; | ||
| 2395 | SCptr->SCp.Message = 0xff; | ||
| 2396 | } else { | ||
| 2397 | /* The status byte had bad parity. | ||
| 2398 | * we leave the scsi_pointer Status | ||
| 2399 | * field alone as we set it to a default | ||
| 2400 | * of CHECK_CONDITION in esp_queue. | ||
| 2401 | */ | ||
| 2402 | message_out = INITIATOR_ERROR; | ||
| 2403 | } | ||
| 2404 | } else { | ||
| 2405 | /* This shouldn't happen ever. */ | ||
| 2406 | ESPSTAT(("got bolixed\n")); | ||
| 2407 | esp_advance_phase(SCptr, in_the_dark); | ||
| 2408 | return esp_do_phase_determine(esp, eregs); | ||
| 2409 | } | ||
| 2410 | |||
| 2411 | if(!message_out) { | ||
| 2412 | ESPSTAT(("status=%2x msg=%2x, ", SCptr->SCp.Status, | ||
| 2413 | SCptr->SCp.Message)); | ||
| 2414 | if(SCptr->SCp.Message == COMMAND_COMPLETE) { | ||
| 2415 | ESPSTAT(("and was COMMAND_COMPLETE\n")); | ||
| 2416 | esp_advance_phase(SCptr, in_freeing); | ||
| 2417 | return esp_do_freebus(esp, eregs); | ||
| 2418 | } else { | ||
| 2419 | ESPLOG(("esp%d: and _not_ COMMAND_COMPLETE\n", | ||
| 2420 | esp->esp_id)); | ||
| 2421 | esp->msgin_len = esp->msgin_ctr = 1; | ||
| 2422 | esp_advance_phase(SCptr, in_msgindone); | ||
| 2423 | return esp_do_msgindone(esp, eregs); | ||
| 2424 | } | ||
| 2425 | } else { | ||
| 2426 | /* With luck we'll be able to let the target | ||
| 2427 | * know that bad parity happened, it will know | ||
| 2428 | * which byte caused the problems and send it | ||
| 2429 | * again. For the case where the status byte | ||
| 2430 | * receives bad parity, I do not believe most | ||
| 2431 | * targets recover very well. We'll see. | ||
| 2432 | */ | ||
| 2433 | ESPLOG(("esp%d: bad parity somewhere mout=%2x\n", | ||
| 2434 | esp->esp_id, message_out)); | ||
| 2435 | esp->cur_msgout[0] = message_out; | ||
| 2436 | esp->msgout_len = esp->msgout_ctr = 1; | ||
| 2437 | esp_advance_phase(SCptr, in_the_dark); | ||
| 2438 | return esp_do_phase_determine(esp, eregs); | ||
| 2439 | } | ||
| 2440 | } else { | ||
| 2441 | /* If we disconnect now, all hell breaks loose. */ | ||
| 2442 | ESPLOG(("esp%d: whoops, disconnect\n", esp->esp_id)); | ||
| 2443 | esp_advance_phase(SCptr, in_the_dark); | ||
| 2444 | return esp_do_phase_determine(esp, eregs); | ||
| 2445 | } | ||
| 2446 | } | ||
| 2447 | |||
| 2448 | static int esp_enter_status(struct NCR_ESP *esp, | ||
| 2449 | struct ESP_regs *eregs) | ||
| 2450 | { | ||
| 2451 | unchar thecmd = ESP_CMD_ICCSEQ; | ||
| 2452 | |||
| 2453 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 2454 | |||
| 2455 | if(esp->do_pio_cmds) { | ||
| 2456 | esp_advance_phase(esp->current_SC, in_status); | ||
| 2457 | esp_cmd(esp, eregs, thecmd); | ||
| 2458 | while(!(esp_read(esp->eregs->esp_status) & ESP_STAT_INTR)); | ||
| 2459 | esp->esp_command[0] = esp_read(eregs->esp_fdata); | ||
| 2460 | while(!(esp_read(esp->eregs->esp_status) & ESP_STAT_INTR)); | ||
| 2461 | esp->esp_command[1] = esp_read(eregs->esp_fdata); | ||
| 2462 | } else { | ||
| 2463 | esp->esp_command[0] = esp->esp_command[1] = 0xff; | ||
| 2464 | esp_write(eregs->esp_tclow, 2); | ||
| 2465 | esp_write(eregs->esp_tcmed, 0); | ||
| 2466 | esp->dma_init_read(esp, esp->esp_command_dvma, 2); | ||
| 2467 | thecmd |= ESP_CMD_DMA; | ||
| 2468 | esp_cmd(esp, eregs, thecmd); | ||
| 2469 | esp_advance_phase(esp->current_SC, in_status); | ||
| 2470 | } | ||
| 2471 | |||
| 2472 | return esp_do_status(esp, eregs); | ||
| 2473 | } | ||
| 2474 | |||
| 2475 | static int esp_disconnect_amidst_phases(struct NCR_ESP *esp, | ||
| 2476 | struct ESP_regs *eregs) | ||
| 2477 | { | ||
| 2478 | Scsi_Cmnd *sp = esp->current_SC; | ||
| 2479 | struct esp_device *esp_dev = sp->device->hostdata; | ||
| 2480 | |||
| 2481 | /* This means real problems if we see this | ||
| 2482 | * here. Unless we were actually trying | ||
| 2483 | * to force the device to abort/reset. | ||
| 2484 | */ | ||
| 2485 | ESPLOG(("esp%d: Disconnect amidst phases, ", esp->esp_id)); | ||
| 2486 | ESPLOG(("pphase<%s> cphase<%s>, ", | ||
| 2487 | phase_string(sp->SCp.phase), | ||
| 2488 | phase_string(sp->SCp.sent_command))); | ||
| 2489 | |||
| 2490 | if(esp->disconnected_SC) | ||
| 2491 | esp_cmd(esp, eregs, ESP_CMD_ESEL); | ||
| 2492 | |||
| 2493 | switch(esp->cur_msgout[0]) { | ||
| 2494 | default: | ||
| 2495 | /* We didn't expect this to happen at all. */ | ||
| 2496 | ESPLOG(("device is bolixed\n")); | ||
| 2497 | esp_advance_phase(sp, in_tgterror); | ||
| 2498 | esp_done(esp, (DID_ERROR << 16)); | ||
| 2499 | break; | ||
| 2500 | |||
| 2501 | case BUS_DEVICE_RESET: | ||
| 2502 | ESPLOG(("device reset successful\n")); | ||
| 2503 | esp_dev->sync_max_offset = 0; | ||
| 2504 | esp_dev->sync_min_period = 0; | ||
| 2505 | esp_dev->sync = 0; | ||
| 2506 | esp_advance_phase(sp, in_resetdev); | ||
| 2507 | esp_done(esp, (DID_RESET << 16)); | ||
| 2508 | break; | ||
| 2509 | |||
| 2510 | case ABORT: | ||
| 2511 | ESPLOG(("device abort successful\n")); | ||
| 2512 | esp_advance_phase(sp, in_abortone); | ||
| 2513 | esp_done(esp, (DID_ABORT << 16)); | ||
| 2514 | break; | ||
| 2515 | |||
| 2516 | }; | ||
| 2517 | return do_intr_end; | ||
| 2518 | } | ||
| 2519 | |||
| 2520 | static int esp_enter_msgout(struct NCR_ESP *esp, | ||
| 2521 | struct ESP_regs *eregs) | ||
| 2522 | { | ||
| 2523 | esp_advance_phase(esp->current_SC, in_msgout); | ||
| 2524 | return esp_do_msgout(esp, eregs); | ||
| 2525 | } | ||
| 2526 | |||
| 2527 | static int esp_enter_msgin(struct NCR_ESP *esp, | ||
| 2528 | struct ESP_regs *eregs) | ||
| 2529 | { | ||
| 2530 | esp_advance_phase(esp->current_SC, in_msgin); | ||
| 2531 | return esp_do_msgin(esp, eregs); | ||
| 2532 | } | ||
| 2533 | |||
| 2534 | static int esp_enter_cmd(struct NCR_ESP *esp, | ||
| 2535 | struct ESP_regs *eregs) | ||
| 2536 | { | ||
| 2537 | esp_advance_phase(esp->current_SC, in_cmdbegin); | ||
| 2538 | return esp_do_cmdbegin(esp, eregs); | ||
| 2539 | } | ||
| 2540 | |||
| 2541 | static int esp_enter_badphase(struct NCR_ESP *esp, | ||
| 2542 | struct ESP_regs *eregs) | ||
| 2543 | { | ||
| 2544 | ESPLOG(("esp%d: Bizarre bus phase %2x.\n", esp->esp_id, | ||
| 2545 | esp->sreg & ESP_STAT_PMASK)); | ||
| 2546 | return do_reset_bus; | ||
| 2547 | } | ||
| 2548 | |||
| 2549 | typedef int (*espfunc_t)(struct NCR_ESP *, | ||
| 2550 | struct ESP_regs *); | ||
| 2551 | |||
| 2552 | static espfunc_t phase_vector[] = { | ||
| 2553 | esp_do_data, /* ESP_DOP */ | ||
| 2554 | esp_do_data, /* ESP_DIP */ | ||
| 2555 | esp_enter_cmd, /* ESP_CMDP */ | ||
| 2556 | esp_enter_status, /* ESP_STATP */ | ||
| 2557 | esp_enter_badphase, /* ESP_STAT_PMSG */ | ||
| 2558 | esp_enter_badphase, /* ESP_STAT_PMSG | ESP_STAT_PIO */ | ||
| 2559 | esp_enter_msgout, /* ESP_MOP */ | ||
| 2560 | esp_enter_msgin, /* ESP_MIP */ | ||
| 2561 | }; | ||
| 2562 | |||
| 2563 | /* The target has control of the bus and we have to see where it has | ||
| 2564 | * taken us. | ||
| 2565 | */ | ||
| 2566 | static int esp_do_phase_determine(struct NCR_ESP *esp, | ||
| 2567 | struct ESP_regs *eregs) | ||
| 2568 | { | ||
| 2569 | if ((esp->ireg & ESP_INTR_DC) != 0) | ||
| 2570 | return esp_disconnect_amidst_phases(esp, eregs); | ||
| 2571 | return phase_vector[esp->sreg & ESP_STAT_PMASK](esp, eregs); | ||
| 2572 | } | ||
| 2573 | |||
| 2574 | /* First interrupt after exec'ing a cmd comes here. */ | ||
| 2575 | static int esp_select_complete(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 2576 | { | ||
| 2577 | Scsi_Cmnd *SCptr = esp->current_SC; | ||
| 2578 | struct esp_device *esp_dev = SCptr->device->hostdata; | ||
| 2579 | int cmd_bytes_sent, fcnt; | ||
| 2580 | |||
| 2581 | fcnt = (esp_read(eregs->esp_fflags) & ESP_FF_FBYTES); | ||
| 2582 | cmd_bytes_sent = esp->dma_bytes_sent(esp, fcnt); | ||
| 2583 | if(esp->dma_invalidate) | ||
| 2584 | esp->dma_invalidate(esp); | ||
| 2585 | |||
| 2586 | /* Let's check to see if a reselect happened | ||
| 2587 | * while we we're trying to select. This must | ||
| 2588 | * be checked first. | ||
| 2589 | */ | ||
| 2590 | if(esp->ireg == (ESP_INTR_RSEL | ESP_INTR_FDONE)) { | ||
| 2591 | esp_reconnect(esp, SCptr); | ||
| 2592 | return esp_do_reconnect(esp, eregs); | ||
| 2593 | } | ||
| 2594 | |||
| 2595 | /* Looks like things worked, we should see a bus service & | ||
| 2596 | * a function complete interrupt at this point. Note we | ||
| 2597 | * are doing a direct comparison because we don't want to | ||
| 2598 | * be fooled into thinking selection was successful if | ||
| 2599 | * ESP_INTR_DC is set, see below. | ||
| 2600 | */ | ||
| 2601 | if(esp->ireg == (ESP_INTR_FDONE | ESP_INTR_BSERV)) { | ||
| 2602 | /* target speaks... */ | ||
| 2603 | esp->targets_present |= (1<<scmd_id(SCptr)); | ||
| 2604 | |||
| 2605 | /* What if the target ignores the sdtr? */ | ||
| 2606 | if(esp->snip) | ||
| 2607 | esp_dev->sync = 1; | ||
| 2608 | |||
| 2609 | /* See how far, if at all, we got in getting | ||
| 2610 | * the information out to the target. | ||
| 2611 | */ | ||
| 2612 | switch(esp->seqreg) { | ||
| 2613 | default: | ||
| 2614 | |||
| 2615 | case ESP_STEP_ASEL: | ||
| 2616 | /* Arbitration won, target selected, but | ||
| 2617 | * we are in some phase which is not command | ||
| 2618 | * phase nor is it message out phase. | ||
| 2619 | * | ||
| 2620 | * XXX We've confused the target, obviously. | ||
| 2621 | * XXX So clear it's state, but we also end | ||
| 2622 | * XXX up clearing everyone elses. That isn't | ||
| 2623 | * XXX so nice. I'd like to just reset this | ||
| 2624 | * XXX target, but if I cannot even get it's | ||
| 2625 | * XXX attention and finish selection to talk | ||
| 2626 | * XXX to it, there is not much more I can do. | ||
| 2627 | * XXX If we have a loaded bus we're going to | ||
| 2628 | * XXX spend the next second or so renegotiating | ||
| 2629 | * XXX for synchronous transfers. | ||
| 2630 | */ | ||
| 2631 | ESPLOG(("esp%d: STEP_ASEL for tgt %d\n", | ||
| 2632 | esp->esp_id, SCptr->device->id)); | ||
| 2633 | |||
| 2634 | case ESP_STEP_SID: | ||
| 2635 | /* Arbitration won, target selected, went | ||
| 2636 | * to message out phase, sent one message | ||
| 2637 | * byte, then we stopped. ATN is asserted | ||
| 2638 | * on the SCSI bus and the target is still | ||
| 2639 | * there hanging on. This is a legal | ||
| 2640 | * sequence step if we gave the ESP a select | ||
| 2641 | * and stop command. | ||
| 2642 | * | ||
| 2643 | * XXX See above, I could set the borken flag | ||
| 2644 | * XXX in the device struct and retry the | ||
| 2645 | * XXX command. But would that help for | ||
| 2646 | * XXX tagged capable targets? | ||
| 2647 | */ | ||
| 2648 | |||
| 2649 | case ESP_STEP_NCMD: | ||
| 2650 | /* Arbitration won, target selected, maybe | ||
| 2651 | * sent the one message byte in message out | ||
| 2652 | * phase, but we did not go to command phase | ||
| 2653 | * in the end. Actually, we could have sent | ||
| 2654 | * only some of the message bytes if we tried | ||
| 2655 | * to send out the entire identify and tag | ||
| 2656 | * message using ESP_CMD_SA3. | ||
| 2657 | */ | ||
| 2658 | cmd_bytes_sent = 0; | ||
| 2659 | break; | ||
| 2660 | |||
| 2661 | case ESP_STEP_PPC: | ||
| 2662 | /* No, not the powerPC pinhead. Arbitration | ||
| 2663 | * won, all message bytes sent if we went to | ||
| 2664 | * message out phase, went to command phase | ||
| 2665 | * but only part of the command was sent. | ||
| 2666 | * | ||
| 2667 | * XXX I've seen this, but usually in conjunction | ||
| 2668 | * XXX with a gross error which appears to have | ||
| 2669 | * XXX occurred between the time I told the | ||
| 2670 | * XXX ESP to arbitrate and when I got the | ||
| 2671 | * XXX interrupt. Could I have misloaded the | ||
| 2672 | * XXX command bytes into the fifo? Actually, | ||
| 2673 | * XXX I most likely missed a phase, and therefore | ||
| 2674 | * XXX went into never never land and didn't even | ||
| 2675 | * XXX know it. That was the old driver though. | ||
| 2676 | * XXX What is even more peculiar is that the ESP | ||
| 2677 | * XXX showed the proper function complete and | ||
| 2678 | * XXX bus service bits in the interrupt register. | ||
| 2679 | */ | ||
| 2680 | |||
| 2681 | case ESP_STEP_FINI4: | ||
| 2682 | case ESP_STEP_FINI5: | ||
| 2683 | case ESP_STEP_FINI6: | ||
| 2684 | case ESP_STEP_FINI7: | ||
| 2685 | /* Account for the identify message */ | ||
| 2686 | if(SCptr->SCp.phase == in_slct_norm) | ||
| 2687 | cmd_bytes_sent -= 1; | ||
| 2688 | }; | ||
| 2689 | esp_cmd(esp, eregs, ESP_CMD_NULL); | ||
| 2690 | |||
| 2691 | /* Be careful, we could really get fucked during synchronous | ||
| 2692 | * data transfers if we try to flush the fifo now. | ||
| 2693 | */ | ||
| 2694 | if(!fcnt && /* Fifo is empty and... */ | ||
| 2695 | /* either we are not doing synchronous transfers or... */ | ||
| 2696 | (!esp_dev->sync_max_offset || | ||
| 2697 | /* We are not going into data in phase. */ | ||
| 2698 | ((esp->sreg & ESP_STAT_PMASK) != ESP_DIP))) | ||
| 2699 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); /* flush is safe */ | ||
| 2700 | |||
| 2701 | /* See how far we got if this is not a slow command. */ | ||
| 2702 | if(!esp->esp_slowcmd) { | ||
| 2703 | if(cmd_bytes_sent < 0) | ||
| 2704 | cmd_bytes_sent = 0; | ||
| 2705 | if(cmd_bytes_sent != SCptr->cmd_len) { | ||
| 2706 | /* Crapola, mark it as a slowcmd | ||
| 2707 | * so that we have some chance of | ||
| 2708 | * keeping the command alive with | ||
| 2709 | * good luck. | ||
| 2710 | * | ||
| 2711 | * XXX Actually, if we didn't send it all | ||
| 2712 | * XXX this means either we didn't set things | ||
| 2713 | * XXX up properly (driver bug) or the target | ||
| 2714 | * XXX or the ESP detected parity on one of | ||
| 2715 | * XXX the command bytes. This makes much | ||
| 2716 | * XXX more sense, and therefore this code | ||
| 2717 | * XXX should be changed to send out a | ||
| 2718 | * XXX parity error message or if the status | ||
| 2719 | * XXX register shows no parity error then | ||
| 2720 | * XXX just expect the target to bring the | ||
| 2721 | * XXX bus into message in phase so that it | ||
| 2722 | * XXX can send us the parity error message. | ||
| 2723 | * XXX SCSI sucks... | ||
| 2724 | */ | ||
| 2725 | esp->esp_slowcmd = 1; | ||
| 2726 | esp->esp_scmdp = &(SCptr->cmnd[cmd_bytes_sent]); | ||
| 2727 | esp->esp_scmdleft = (SCptr->cmd_len - cmd_bytes_sent); | ||
| 2728 | } | ||
| 2729 | } | ||
| 2730 | |||
| 2731 | /* Now figure out where we went. */ | ||
| 2732 | esp_advance_phase(SCptr, in_the_dark); | ||
| 2733 | return esp_do_phase_determine(esp, eregs); | ||
| 2734 | } | ||
| 2735 | |||
| 2736 | /* Did the target even make it? */ | ||
| 2737 | if(esp->ireg == ESP_INTR_DC) { | ||
| 2738 | /* wheee... nobody there or they didn't like | ||
| 2739 | * what we told it to do, clean up. | ||
| 2740 | */ | ||
| 2741 | |||
| 2742 | /* If anyone is off the bus, but working on | ||
| 2743 | * a command in the background for us, tell | ||
| 2744 | * the ESP to listen for them. | ||
| 2745 | */ | ||
| 2746 | if(esp->disconnected_SC) | ||
| 2747 | esp_cmd(esp, eregs, ESP_CMD_ESEL); | ||
| 2748 | |||
| 2749 | if(((1<<SCptr->device->id) & esp->targets_present) && | ||
| 2750 | esp->seqreg && esp->cur_msgout[0] == EXTENDED_MESSAGE && | ||
| 2751 | (SCptr->SCp.phase == in_slct_msg || | ||
| 2752 | SCptr->SCp.phase == in_slct_stop)) { | ||
| 2753 | /* shit */ | ||
| 2754 | esp->snip = 0; | ||
| 2755 | ESPLOG(("esp%d: Failed synchronous negotiation for target %d " | ||
| 2756 | "lun %d\n", esp->esp_id, SCptr->device->id, SCptr->device->lun)); | ||
| 2757 | esp_dev->sync_max_offset = 0; | ||
| 2758 | esp_dev->sync_min_period = 0; | ||
| 2759 | esp_dev->sync = 1; /* so we don't negotiate again */ | ||
| 2760 | |||
| 2761 | /* Run the command again, this time though we | ||
| 2762 | * won't try to negotiate for synchronous transfers. | ||
| 2763 | * | ||
| 2764 | * XXX I'd like to do something like send an | ||
| 2765 | * XXX INITIATOR_ERROR or ABORT message to the | ||
| 2766 | * XXX target to tell it, "Sorry I confused you, | ||
| 2767 | * XXX please come back and I will be nicer next | ||
| 2768 | * XXX time". But that requires having the target | ||
| 2769 | * XXX on the bus, and it has dropped BSY on us. | ||
| 2770 | */ | ||
| 2771 | esp->current_SC = NULL; | ||
| 2772 | esp_advance_phase(SCptr, not_issued); | ||
| 2773 | prepend_SC(&esp->issue_SC, SCptr); | ||
| 2774 | esp_exec_cmd(esp); | ||
| 2775 | return do_intr_end; | ||
| 2776 | } | ||
| 2777 | |||
| 2778 | /* Ok, this is normal, this is what we see during boot | ||
| 2779 | * or whenever when we are scanning the bus for targets. | ||
| 2780 | * But first make sure that is really what is happening. | ||
| 2781 | */ | ||
| 2782 | if(((1<<SCptr->device->id) & esp->targets_present)) { | ||
| 2783 | ESPLOG(("esp%d: Warning, live target %d not responding to " | ||
| 2784 | "selection.\n", esp->esp_id, SCptr->device->id)); | ||
| 2785 | |||
| 2786 | /* This _CAN_ happen. The SCSI standard states that | ||
| 2787 | * the target is to _not_ respond to selection if | ||
| 2788 | * _it_ detects bad parity on the bus for any reason. | ||
| 2789 | * Therefore, we assume that if we've talked successfully | ||
| 2790 | * to this target before, bad parity is the problem. | ||
| 2791 | */ | ||
| 2792 | esp_done(esp, (DID_PARITY << 16)); | ||
| 2793 | } else { | ||
| 2794 | /* Else, there really isn't anyone there. */ | ||
| 2795 | ESPMISC(("esp: selection failure, maybe nobody there?\n")); | ||
| 2796 | ESPMISC(("esp: target %d lun %d\n", | ||
| 2797 | SCptr->device->id, SCptr->device->lun)); | ||
| 2798 | esp_done(esp, (DID_BAD_TARGET << 16)); | ||
| 2799 | } | ||
| 2800 | return do_intr_end; | ||
| 2801 | } | ||
| 2802 | |||
| 2803 | |||
| 2804 | ESPLOG(("esp%d: Selection failure.\n", esp->esp_id)); | ||
| 2805 | printk("esp%d: Currently -- ", esp->esp_id); | ||
| 2806 | esp_print_ireg(esp->ireg); | ||
| 2807 | printk(" "); | ||
| 2808 | esp_print_statreg(esp->sreg); | ||
| 2809 | printk(" "); | ||
| 2810 | esp_print_seqreg(esp->seqreg); | ||
| 2811 | printk("\n"); | ||
| 2812 | printk("esp%d: New -- ", esp->esp_id); | ||
| 2813 | esp->sreg = esp_read(eregs->esp_status); | ||
| 2814 | esp->seqreg = esp_read(eregs->esp_sstep); | ||
| 2815 | esp->ireg = esp_read(eregs->esp_intrpt); | ||
| 2816 | esp_print_ireg(esp->ireg); | ||
| 2817 | printk(" "); | ||
| 2818 | esp_print_statreg(esp->sreg); | ||
| 2819 | printk(" "); | ||
| 2820 | esp_print_seqreg(esp->seqreg); | ||
| 2821 | printk("\n"); | ||
| 2822 | ESPLOG(("esp%d: resetting bus\n", esp->esp_id)); | ||
| 2823 | return do_reset_bus; /* ugh... */ | ||
| 2824 | } | ||
| 2825 | |||
| 2826 | /* Continue reading bytes for msgin phase. */ | ||
| 2827 | static int esp_do_msgincont(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 2828 | { | ||
| 2829 | if(esp->ireg & ESP_INTR_BSERV) { | ||
| 2830 | /* in the right phase too? */ | ||
| 2831 | if((esp->sreg & ESP_STAT_PMASK) == ESP_MIP) { | ||
| 2832 | /* phew... */ | ||
| 2833 | esp_cmd(esp, eregs, ESP_CMD_TI); | ||
| 2834 | esp_advance_phase(esp->current_SC, in_msgindone); | ||
| 2835 | return do_intr_end; | ||
| 2836 | } | ||
| 2837 | |||
| 2838 | /* We changed phase but ESP shows bus service, | ||
| 2839 | * in this case it is most likely that we, the | ||
| 2840 | * hacker who has been up for 20hrs straight | ||
| 2841 | * staring at the screen, drowned in coffee | ||
| 2842 | * smelling like retched cigarette ashes | ||
| 2843 | * have miscoded something..... so, try to | ||
| 2844 | * recover as best we can. | ||
| 2845 | */ | ||
| 2846 | ESPLOG(("esp%d: message in mis-carriage.\n", esp->esp_id)); | ||
| 2847 | } | ||
| 2848 | esp_advance_phase(esp->current_SC, in_the_dark); | ||
| 2849 | return do_phase_determine; | ||
| 2850 | } | ||
| 2851 | |||
| 2852 | static int check_singlebyte_msg(struct NCR_ESP *esp, | ||
| 2853 | struct ESP_regs *eregs) | ||
| 2854 | { | ||
| 2855 | esp->prevmsgin = esp->cur_msgin[0]; | ||
| 2856 | if(esp->cur_msgin[0] & 0x80) { | ||
| 2857 | /* wheee... */ | ||
| 2858 | ESPLOG(("esp%d: target sends identify amidst phases\n", | ||
| 2859 | esp->esp_id)); | ||
| 2860 | esp_advance_phase(esp->current_SC, in_the_dark); | ||
| 2861 | return 0; | ||
| 2862 | } else if(((esp->cur_msgin[0] & 0xf0) == 0x20) || | ||
| 2863 | (esp->cur_msgin[0] == EXTENDED_MESSAGE)) { | ||
| 2864 | esp->msgin_len = 2; | ||
| 2865 | esp_advance_phase(esp->current_SC, in_msgincont); | ||
| 2866 | return 0; | ||
| 2867 | } | ||
| 2868 | esp_advance_phase(esp->current_SC, in_the_dark); | ||
| 2869 | switch(esp->cur_msgin[0]) { | ||
| 2870 | default: | ||
| 2871 | /* We don't want to hear about it. */ | ||
| 2872 | ESPLOG(("esp%d: msg %02x which we don't know about\n", esp->esp_id, | ||
| 2873 | esp->cur_msgin[0])); | ||
| 2874 | return MESSAGE_REJECT; | ||
| 2875 | |||
| 2876 | case NOP: | ||
| 2877 | ESPLOG(("esp%d: target %d sends a nop\n", esp->esp_id, | ||
| 2878 | esp->current_SC->device->id)); | ||
| 2879 | return 0; | ||
| 2880 | |||
| 2881 | case RESTORE_POINTERS: | ||
| 2882 | /* In this case we might also have to backup the | ||
| 2883 | * "slow command" pointer. It is rare to get such | ||
| 2884 | * a save/restore pointer sequence so early in the | ||
| 2885 | * bus transition sequences, but cover it. | ||
| 2886 | */ | ||
| 2887 | if(esp->esp_slowcmd) { | ||
| 2888 | esp->esp_scmdleft = esp->current_SC->cmd_len; | ||
| 2889 | esp->esp_scmdp = &esp->current_SC->cmnd[0]; | ||
| 2890 | } | ||
| 2891 | esp_restore_pointers(esp, esp->current_SC); | ||
| 2892 | return 0; | ||
| 2893 | |||
| 2894 | case SAVE_POINTERS: | ||
| 2895 | esp_save_pointers(esp, esp->current_SC); | ||
| 2896 | return 0; | ||
| 2897 | |||
| 2898 | case COMMAND_COMPLETE: | ||
| 2899 | case DISCONNECT: | ||
| 2900 | /* Freeing the bus, let it go. */ | ||
| 2901 | esp->current_SC->SCp.phase = in_freeing; | ||
| 2902 | return 0; | ||
| 2903 | |||
| 2904 | case MESSAGE_REJECT: | ||
| 2905 | ESPMISC(("msg reject, ")); | ||
| 2906 | if(esp->prevmsgout == EXTENDED_MESSAGE) { | ||
| 2907 | struct esp_device *esp_dev = esp->current_SC->device->hostdata; | ||
| 2908 | |||
| 2909 | /* Doesn't look like this target can | ||
| 2910 | * do synchronous or WIDE transfers. | ||
| 2911 | */ | ||
| 2912 | ESPSDTR(("got reject, was trying nego, clearing sync/WIDE\n")); | ||
| 2913 | esp_dev->sync = 1; | ||
| 2914 | esp_dev->wide = 1; | ||
| 2915 | esp_dev->sync_min_period = 0; | ||
| 2916 | esp_dev->sync_max_offset = 0; | ||
| 2917 | return 0; | ||
| 2918 | } else { | ||
| 2919 | ESPMISC(("not sync nego, sending ABORT\n")); | ||
| 2920 | return ABORT; | ||
| 2921 | } | ||
| 2922 | }; | ||
| 2923 | } | ||
| 2924 | |||
| 2925 | /* Target negotiates for synchronous transfers before we do, this | ||
| 2926 | * is legal although very strange. What is even funnier is that | ||
| 2927 | * the SCSI2 standard specifically recommends against targets doing | ||
| 2928 | * this because so many initiators cannot cope with this occurring. | ||
| 2929 | */ | ||
| 2930 | static int target_with_ants_in_pants(struct NCR_ESP *esp, | ||
| 2931 | Scsi_Cmnd *SCptr, | ||
| 2932 | struct esp_device *esp_dev) | ||
| 2933 | { | ||
| 2934 | if(esp_dev->sync || SCptr->device->borken) { | ||
| 2935 | /* sorry, no can do */ | ||
| 2936 | ESPSDTR(("forcing to async, ")); | ||
| 2937 | build_sync_nego_msg(esp, 0, 0); | ||
| 2938 | esp_dev->sync = 1; | ||
| 2939 | esp->snip = 1; | ||
| 2940 | ESPLOG(("esp%d: hoping for msgout\n", esp->esp_id)); | ||
| 2941 | esp_advance_phase(SCptr, in_the_dark); | ||
| 2942 | return EXTENDED_MESSAGE; | ||
| 2943 | } | ||
| 2944 | |||
| 2945 | /* Ok, we'll check them out... */ | ||
| 2946 | return 0; | ||
| 2947 | } | ||
| 2948 | |||
| 2949 | static void sync_report(struct NCR_ESP *esp) | ||
| 2950 | { | ||
| 2951 | int msg3, msg4; | ||
| 2952 | char *type; | ||
| 2953 | |||
| 2954 | msg3 = esp->cur_msgin[3]; | ||
| 2955 | msg4 = esp->cur_msgin[4]; | ||
| 2956 | if(msg4) { | ||
| 2957 | int hz = 1000000000 / (msg3 * 4); | ||
| 2958 | int integer = hz / 1000000; | ||
| 2959 | int fraction = (hz - (integer * 1000000)) / 10000; | ||
| 2960 | if((msg3 * 4) < 200) { | ||
| 2961 | type = "FAST"; | ||
| 2962 | } else { | ||
| 2963 | type = "synchronous"; | ||
| 2964 | } | ||
| 2965 | |||
| 2966 | /* Do not transform this back into one big printk | ||
| 2967 | * again, it triggers a bug in our sparc64-gcc272 | ||
| 2968 | * sibling call optimization. -DaveM | ||
| 2969 | */ | ||
| 2970 | ESPLOG((KERN_INFO "esp%d: target %d ", | ||
| 2971 | esp->esp_id, esp->current_SC->device->id)); | ||
| 2972 | ESPLOG(("[period %dns offset %d %d.%02dMHz ", | ||
| 2973 | (int) msg3 * 4, (int) msg4, | ||
| 2974 | integer, fraction)); | ||
| 2975 | ESPLOG(("%s SCSI%s]\n", type, | ||
| 2976 | (((msg3 * 4) < 200) ? "-II" : ""))); | ||
| 2977 | } else { | ||
| 2978 | ESPLOG((KERN_INFO "esp%d: target %d asynchronous\n", | ||
| 2979 | esp->esp_id, esp->current_SC->device->id)); | ||
| 2980 | } | ||
| 2981 | } | ||
| 2982 | |||
| 2983 | static int check_multibyte_msg(struct NCR_ESP *esp, | ||
| 2984 | struct ESP_regs *eregs) | ||
| 2985 | { | ||
| 2986 | Scsi_Cmnd *SCptr = esp->current_SC; | ||
| 2987 | struct esp_device *esp_dev = SCptr->device->hostdata; | ||
| 2988 | unchar regval = 0; | ||
| 2989 | int message_out = 0; | ||
| 2990 | |||
| 2991 | ESPSDTR(("chk multibyte msg: ")); | ||
| 2992 | if(esp->cur_msgin[2] == EXTENDED_SDTR) { | ||
| 2993 | int period = esp->cur_msgin[3]; | ||
| 2994 | int offset = esp->cur_msgin[4]; | ||
| 2995 | |||
| 2996 | ESPSDTR(("is sync nego response, ")); | ||
| 2997 | if(!esp->snip) { | ||
| 2998 | int rval; | ||
| 2999 | |||
| 3000 | /* Target negotiates first! */ | ||
| 3001 | ESPSDTR(("target jumps the gun, ")); | ||
| 3002 | message_out = EXTENDED_MESSAGE; /* we must respond */ | ||
| 3003 | rval = target_with_ants_in_pants(esp, SCptr, esp_dev); | ||
| 3004 | if(rval) | ||
| 3005 | return rval; | ||
| 3006 | } | ||
| 3007 | |||
| 3008 | ESPSDTR(("examining sdtr, ")); | ||
| 3009 | |||
| 3010 | /* Offset cannot be larger than ESP fifo size. */ | ||
| 3011 | if(offset > 15) { | ||
| 3012 | ESPSDTR(("offset too big %2x, ", offset)); | ||
| 3013 | offset = 15; | ||
| 3014 | ESPSDTR(("sending back new offset\n")); | ||
| 3015 | build_sync_nego_msg(esp, period, offset); | ||
| 3016 | return EXTENDED_MESSAGE; | ||
| 3017 | } | ||
| 3018 | |||
| 3019 | if(offset && period > esp->max_period) { | ||
| 3020 | /* Yeee, async for this slow device. */ | ||
| 3021 | ESPSDTR(("period too long %2x, ", period)); | ||
| 3022 | build_sync_nego_msg(esp, 0, 0); | ||
| 3023 | ESPSDTR(("hoping for msgout\n")); | ||
| 3024 | esp_advance_phase(esp->current_SC, in_the_dark); | ||
| 3025 | return EXTENDED_MESSAGE; | ||
| 3026 | } else if (offset && period < esp->min_period) { | ||
| 3027 | ESPSDTR(("period too short %2x, ", period)); | ||
| 3028 | period = esp->min_period; | ||
| 3029 | if(esp->erev > esp236) | ||
| 3030 | regval = 4; | ||
| 3031 | else | ||
| 3032 | regval = 5; | ||
| 3033 | } else if(offset) { | ||
| 3034 | int tmp; | ||
| 3035 | |||
| 3036 | ESPSDTR(("period is ok, ")); | ||
| 3037 | tmp = esp->ccycle / 1000; | ||
| 3038 | regval = (((period << 2) + tmp - 1) / tmp); | ||
| 3039 | if(regval && (esp->erev > esp236)) { | ||
| 3040 | if(period >= 50) | ||
| 3041 | regval--; | ||
| 3042 | } | ||
| 3043 | } | ||
| 3044 | |||
| 3045 | if(offset) { | ||
| 3046 | unchar bit; | ||
| 3047 | |||
| 3048 | esp_dev->sync_min_period = (regval & 0x1f); | ||
| 3049 | esp_dev->sync_max_offset = (offset | esp->radelay); | ||
| 3050 | if(esp->erev > esp236) { | ||
| 3051 | if(esp->erev == fas100a) | ||
| 3052 | bit = ESP_CONFIG3_FAST; | ||
| 3053 | else | ||
| 3054 | bit = ESP_CONFIG3_FSCSI; | ||
| 3055 | if(period < 50) | ||
| 3056 | esp->config3[SCptr->device->id] |= bit; | ||
| 3057 | else | ||
| 3058 | esp->config3[SCptr->device->id] &= ~bit; | ||
| 3059 | esp->prev_cfg3 = esp->config3[SCptr->device->id]; | ||
| 3060 | esp_write(eregs->esp_cfg3, esp->prev_cfg3); | ||
| 3061 | } | ||
| 3062 | esp->prev_soff = esp_dev->sync_min_period; | ||
| 3063 | esp_write(eregs->esp_soff, esp->prev_soff); | ||
| 3064 | esp->prev_stp = esp_dev->sync_max_offset; | ||
| 3065 | esp_write(eregs->esp_stp, esp->prev_stp); | ||
| 3066 | |||
| 3067 | ESPSDTR(("soff=%2x stp=%2x cfg3=%2x\n", | ||
| 3068 | esp_dev->sync_max_offset, | ||
| 3069 | esp_dev->sync_min_period, | ||
| 3070 | esp->config3[scmd_id(SCptr)])); | ||
| 3071 | |||
| 3072 | esp->snip = 0; | ||
| 3073 | } else if(esp_dev->sync_max_offset) { | ||
| 3074 | unchar bit; | ||
| 3075 | |||
| 3076 | /* back to async mode */ | ||
| 3077 | ESPSDTR(("unaccaptable sync nego, forcing async\n")); | ||
| 3078 | esp_dev->sync_max_offset = 0; | ||
| 3079 | esp_dev->sync_min_period = 0; | ||
| 3080 | esp->prev_soff = 0; | ||
| 3081 | esp_write(eregs->esp_soff, 0); | ||
| 3082 | esp->prev_stp = 0; | ||
| 3083 | esp_write(eregs->esp_stp, 0); | ||
| 3084 | if(esp->erev > esp236) { | ||
| 3085 | if(esp->erev == fas100a) | ||
| 3086 | bit = ESP_CONFIG3_FAST; | ||
| 3087 | else | ||
| 3088 | bit = ESP_CONFIG3_FSCSI; | ||
| 3089 | esp->config3[SCptr->device->id] &= ~bit; | ||
| 3090 | esp->prev_cfg3 = esp->config3[SCptr->device->id]; | ||
| 3091 | esp_write(eregs->esp_cfg3, esp->prev_cfg3); | ||
| 3092 | } | ||
| 3093 | } | ||
| 3094 | |||
| 3095 | sync_report(esp); | ||
| 3096 | |||
| 3097 | ESPSDTR(("chk multibyte msg: sync is known, ")); | ||
| 3098 | esp_dev->sync = 1; | ||
| 3099 | |||
| 3100 | if(message_out) { | ||
| 3101 | ESPLOG(("esp%d: sending sdtr back, hoping for msgout\n", | ||
| 3102 | esp->esp_id)); | ||
| 3103 | build_sync_nego_msg(esp, period, offset); | ||
| 3104 | esp_advance_phase(SCptr, in_the_dark); | ||
| 3105 | return EXTENDED_MESSAGE; | ||
| 3106 | } | ||
| 3107 | |||
| 3108 | ESPSDTR(("returning zero\n")); | ||
| 3109 | esp_advance_phase(SCptr, in_the_dark); /* ...or else! */ | ||
| 3110 | return 0; | ||
| 3111 | } else if(esp->cur_msgin[2] == EXTENDED_WDTR) { | ||
| 3112 | ESPLOG(("esp%d: AIEEE wide msg received\n", esp->esp_id)); | ||
| 3113 | message_out = MESSAGE_REJECT; | ||
| 3114 | } else if(esp->cur_msgin[2] == EXTENDED_MODIFY_DATA_POINTER) { | ||
| 3115 | ESPLOG(("esp%d: rejecting modify data ptr msg\n", esp->esp_id)); | ||
| 3116 | message_out = MESSAGE_REJECT; | ||
| 3117 | } | ||
| 3118 | esp_advance_phase(SCptr, in_the_dark); | ||
| 3119 | return message_out; | ||
| 3120 | } | ||
| 3121 | |||
| 3122 | static int esp_do_msgindone(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 3123 | { | ||
| 3124 | Scsi_Cmnd *SCptr = esp->current_SC; | ||
| 3125 | int message_out = 0, it = 0, rval; | ||
| 3126 | |||
| 3127 | rval = skipahead1(esp, eregs, SCptr, in_msgin, in_msgindone); | ||
| 3128 | if(rval) | ||
| 3129 | return rval; | ||
| 3130 | if(SCptr->SCp.sent_command != in_status) { | ||
| 3131 | if(!(esp->ireg & ESP_INTR_DC)) { | ||
| 3132 | if(esp->msgin_len && (esp->sreg & ESP_STAT_PERR)) { | ||
| 3133 | message_out = MSG_PARITY_ERROR; | ||
| 3134 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 3135 | } else if((it = (esp_read(eregs->esp_fflags) & ESP_FF_FBYTES))!=1) { | ||
| 3136 | /* We certainly dropped the ball somewhere. */ | ||
| 3137 | message_out = INITIATOR_ERROR; | ||
| 3138 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 3139 | } else if(!esp->msgin_len) { | ||
| 3140 | it = esp_read(eregs->esp_fdata); | ||
| 3141 | esp_advance_phase(SCptr, in_msgincont); | ||
| 3142 | } else { | ||
| 3143 | /* it is ok and we want it */ | ||
| 3144 | it = esp->cur_msgin[esp->msgin_ctr] = | ||
| 3145 | esp_read(eregs->esp_fdata); | ||
| 3146 | esp->msgin_ctr++; | ||
| 3147 | } | ||
| 3148 | } else { | ||
| 3149 | esp_advance_phase(SCptr, in_the_dark); | ||
| 3150 | return do_work_bus; | ||
| 3151 | } | ||
| 3152 | } else { | ||
| 3153 | it = esp->cur_msgin[0]; | ||
| 3154 | } | ||
| 3155 | if(!message_out && esp->msgin_len) { | ||
| 3156 | if(esp->msgin_ctr < esp->msgin_len) { | ||
| 3157 | esp_advance_phase(SCptr, in_msgincont); | ||
| 3158 | } else if(esp->msgin_len == 1) { | ||
| 3159 | message_out = check_singlebyte_msg(esp, eregs); | ||
| 3160 | } else if(esp->msgin_len == 2) { | ||
| 3161 | if(esp->cur_msgin[0] == EXTENDED_MESSAGE) { | ||
| 3162 | if((it+2) >= 15) { | ||
| 3163 | message_out = MESSAGE_REJECT; | ||
| 3164 | } else { | ||
| 3165 | esp->msgin_len = (it + 2); | ||
| 3166 | esp_advance_phase(SCptr, in_msgincont); | ||
| 3167 | } | ||
| 3168 | } else { | ||
| 3169 | message_out = MESSAGE_REJECT; /* foo on you */ | ||
| 3170 | } | ||
| 3171 | } else { | ||
| 3172 | message_out = check_multibyte_msg(esp, eregs); | ||
| 3173 | } | ||
| 3174 | } | ||
| 3175 | if(message_out < 0) { | ||
| 3176 | return -message_out; | ||
| 3177 | } else if(message_out) { | ||
| 3178 | if(((message_out != 1) && | ||
| 3179 | ((message_out < 0x20) || (message_out & 0x80)))) | ||
| 3180 | esp->msgout_len = 1; | ||
| 3181 | esp->cur_msgout[0] = message_out; | ||
| 3182 | esp_cmd(esp, eregs, ESP_CMD_SATN); | ||
| 3183 | esp_advance_phase(SCptr, in_the_dark); | ||
| 3184 | esp->msgin_len = 0; | ||
| 3185 | } | ||
| 3186 | esp->sreg = esp_read(eregs->esp_status); | ||
| 3187 | esp->sreg &= ~(ESP_STAT_INTR); | ||
| 3188 | if((esp->sreg & (ESP_STAT_PMSG|ESP_STAT_PCD)) == (ESP_STAT_PMSG|ESP_STAT_PCD)) | ||
| 3189 | esp_cmd(esp, eregs, ESP_CMD_MOK); | ||
| 3190 | if((SCptr->SCp.sent_command == in_msgindone) && | ||
| 3191 | (SCptr->SCp.phase == in_freeing)) | ||
| 3192 | return esp_do_freebus(esp, eregs); | ||
| 3193 | return do_intr_end; | ||
| 3194 | } | ||
| 3195 | |||
| 3196 | static int esp_do_cmdbegin(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 3197 | { | ||
| 3198 | unsigned char tmp; | ||
| 3199 | Scsi_Cmnd *SCptr = esp->current_SC; | ||
| 3200 | |||
| 3201 | esp_advance_phase(SCptr, in_cmdend); | ||
| 3202 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 3203 | tmp = *esp->esp_scmdp++; | ||
| 3204 | esp->esp_scmdleft--; | ||
| 3205 | esp_write(eregs->esp_fdata, tmp); | ||
| 3206 | esp_cmd(esp, eregs, ESP_CMD_TI); | ||
| 3207 | return do_intr_end; | ||
| 3208 | } | ||
| 3209 | |||
| 3210 | static int esp_do_cmddone(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 3211 | { | ||
| 3212 | esp_cmd(esp, eregs, ESP_CMD_NULL); | ||
| 3213 | if(esp->ireg & ESP_INTR_BSERV) { | ||
| 3214 | esp_advance_phase(esp->current_SC, in_the_dark); | ||
| 3215 | return esp_do_phase_determine(esp, eregs); | ||
| 3216 | } | ||
| 3217 | ESPLOG(("esp%d: in do_cmddone() but didn't get BSERV interrupt.\n", | ||
| 3218 | esp->esp_id)); | ||
| 3219 | return do_reset_bus; | ||
| 3220 | } | ||
| 3221 | |||
| 3222 | static int esp_do_msgout(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 3223 | { | ||
| 3224 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 3225 | switch(esp->msgout_len) { | ||
| 3226 | case 1: | ||
| 3227 | esp_write(eregs->esp_fdata, esp->cur_msgout[0]); | ||
| 3228 | esp_cmd(esp, eregs, ESP_CMD_TI); | ||
| 3229 | break; | ||
| 3230 | |||
| 3231 | case 2: | ||
| 3232 | if(esp->do_pio_cmds){ | ||
| 3233 | esp_write(eregs->esp_fdata, esp->cur_msgout[0]); | ||
| 3234 | esp_write(eregs->esp_fdata, esp->cur_msgout[1]); | ||
| 3235 | esp_cmd(esp, eregs, ESP_CMD_TI); | ||
| 3236 | } else { | ||
| 3237 | esp->esp_command[0] = esp->cur_msgout[0]; | ||
| 3238 | esp->esp_command[1] = esp->cur_msgout[1]; | ||
| 3239 | esp->dma_setup(esp, esp->esp_command_dvma, 2, 0); | ||
| 3240 | esp_setcount(eregs, 2); | ||
| 3241 | esp_cmd(esp, eregs, ESP_CMD_DMA | ESP_CMD_TI); | ||
| 3242 | } | ||
| 3243 | break; | ||
| 3244 | |||
| 3245 | case 4: | ||
| 3246 | esp->snip = 1; | ||
| 3247 | if(esp->do_pio_cmds){ | ||
| 3248 | esp_write(eregs->esp_fdata, esp->cur_msgout[0]); | ||
| 3249 | esp_write(eregs->esp_fdata, esp->cur_msgout[1]); | ||
| 3250 | esp_write(eregs->esp_fdata, esp->cur_msgout[2]); | ||
| 3251 | esp_write(eregs->esp_fdata, esp->cur_msgout[3]); | ||
| 3252 | esp_cmd(esp, eregs, ESP_CMD_TI); | ||
| 3253 | } else { | ||
| 3254 | esp->esp_command[0] = esp->cur_msgout[0]; | ||
| 3255 | esp->esp_command[1] = esp->cur_msgout[1]; | ||
| 3256 | esp->esp_command[2] = esp->cur_msgout[2]; | ||
| 3257 | esp->esp_command[3] = esp->cur_msgout[3]; | ||
| 3258 | esp->dma_setup(esp, esp->esp_command_dvma, 4, 0); | ||
| 3259 | esp_setcount(eregs, 4); | ||
| 3260 | esp_cmd(esp, eregs, ESP_CMD_DMA | ESP_CMD_TI); | ||
| 3261 | } | ||
| 3262 | break; | ||
| 3263 | |||
| 3264 | case 5: | ||
| 3265 | esp->snip = 1; | ||
| 3266 | if(esp->do_pio_cmds){ | ||
| 3267 | esp_write(eregs->esp_fdata, esp->cur_msgout[0]); | ||
| 3268 | esp_write(eregs->esp_fdata, esp->cur_msgout[1]); | ||
| 3269 | esp_write(eregs->esp_fdata, esp->cur_msgout[2]); | ||
| 3270 | esp_write(eregs->esp_fdata, esp->cur_msgout[3]); | ||
| 3271 | esp_write(eregs->esp_fdata, esp->cur_msgout[4]); | ||
| 3272 | esp_cmd(esp, eregs, ESP_CMD_TI); | ||
| 3273 | } else { | ||
| 3274 | esp->esp_command[0] = esp->cur_msgout[0]; | ||
| 3275 | esp->esp_command[1] = esp->cur_msgout[1]; | ||
| 3276 | esp->esp_command[2] = esp->cur_msgout[2]; | ||
| 3277 | esp->esp_command[3] = esp->cur_msgout[3]; | ||
| 3278 | esp->esp_command[4] = esp->cur_msgout[4]; | ||
| 3279 | esp->dma_setup(esp, esp->esp_command_dvma, 5, 0); | ||
| 3280 | esp_setcount(eregs, 5); | ||
| 3281 | esp_cmd(esp, eregs, ESP_CMD_DMA | ESP_CMD_TI); | ||
| 3282 | } | ||
| 3283 | break; | ||
| 3284 | |||
| 3285 | default: | ||
| 3286 | /* whoops */ | ||
| 3287 | ESPMISC(("bogus msgout sending NOP\n")); | ||
| 3288 | esp->cur_msgout[0] = NOP; | ||
| 3289 | esp_write(eregs->esp_fdata, esp->cur_msgout[0]); | ||
| 3290 | esp->msgout_len = 1; | ||
| 3291 | esp_cmd(esp, eregs, ESP_CMD_TI); | ||
| 3292 | break; | ||
| 3293 | } | ||
| 3294 | esp_advance_phase(esp->current_SC, in_msgoutdone); | ||
| 3295 | return do_intr_end; | ||
| 3296 | } | ||
| 3297 | |||
| 3298 | static int esp_do_msgoutdone(struct NCR_ESP *esp, | ||
| 3299 | struct ESP_regs *eregs) | ||
| 3300 | { | ||
| 3301 | if((esp->msgout_len > 1) && esp->dma_barrier) | ||
| 3302 | esp->dma_barrier(esp); | ||
| 3303 | |||
| 3304 | if(!(esp->ireg & ESP_INTR_DC)) { | ||
| 3305 | esp_cmd(esp, eregs, ESP_CMD_NULL); | ||
| 3306 | switch(esp->sreg & ESP_STAT_PMASK) { | ||
| 3307 | case ESP_MOP: | ||
| 3308 | /* whoops, parity error */ | ||
| 3309 | ESPLOG(("esp%d: still in msgout, parity error assumed\n", | ||
| 3310 | esp->esp_id)); | ||
| 3311 | if(esp->msgout_len > 1) | ||
| 3312 | esp_cmd(esp, eregs, ESP_CMD_SATN); | ||
| 3313 | esp_advance_phase(esp->current_SC, in_msgout); | ||
| 3314 | return do_work_bus; | ||
| 3315 | |||
| 3316 | case ESP_DIP: | ||
| 3317 | break; | ||
| 3318 | |||
| 3319 | default: | ||
| 3320 | if(!fcount(esp, eregs) && | ||
| 3321 | !(((struct esp_device *)esp->current_SC->device->hostdata)->sync_max_offset)) | ||
| 3322 | esp_cmd(esp, eregs, ESP_CMD_FLUSH); | ||
| 3323 | break; | ||
| 3324 | |||
| 3325 | }; | ||
| 3326 | } | ||
| 3327 | |||
| 3328 | /* If we sent out a synchronous negotiation message, update | ||
| 3329 | * our state. | ||
| 3330 | */ | ||
| 3331 | if(esp->cur_msgout[2] == EXTENDED_MESSAGE && | ||
| 3332 | esp->cur_msgout[4] == EXTENDED_SDTR) { | ||
| 3333 | esp->snip = 1; /* anal retentiveness... */ | ||
| 3334 | } | ||
| 3335 | |||
| 3336 | esp->prevmsgout = esp->cur_msgout[0]; | ||
| 3337 | esp->msgout_len = 0; | ||
| 3338 | esp_advance_phase(esp->current_SC, in_the_dark); | ||
| 3339 | return esp_do_phase_determine(esp, eregs); | ||
| 3340 | } | ||
| 3341 | |||
| 3342 | static int esp_bus_unexpected(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 3343 | { | ||
| 3344 | ESPLOG(("esp%d: command in weird state %2x\n", | ||
| 3345 | esp->esp_id, esp->current_SC->SCp.phase)); | ||
| 3346 | return do_reset_bus; | ||
| 3347 | } | ||
| 3348 | |||
| 3349 | static espfunc_t bus_vector[] = { | ||
| 3350 | esp_do_data_finale, | ||
| 3351 | esp_do_data_finale, | ||
| 3352 | esp_bus_unexpected, | ||
| 3353 | esp_do_msgin, | ||
| 3354 | esp_do_msgincont, | ||
| 3355 | esp_do_msgindone, | ||
| 3356 | esp_do_msgout, | ||
| 3357 | esp_do_msgoutdone, | ||
| 3358 | esp_do_cmdbegin, | ||
| 3359 | esp_do_cmddone, | ||
| 3360 | esp_do_status, | ||
| 3361 | esp_do_freebus, | ||
| 3362 | esp_do_phase_determine, | ||
| 3363 | esp_bus_unexpected, | ||
| 3364 | esp_bus_unexpected, | ||
| 3365 | esp_bus_unexpected, | ||
| 3366 | }; | ||
| 3367 | |||
| 3368 | /* This is the second tier in our dual-level SCSI state machine. */ | ||
| 3369 | static int esp_work_bus(struct NCR_ESP *esp, struct ESP_regs *eregs) | ||
| 3370 | { | ||
| 3371 | Scsi_Cmnd *SCptr = esp->current_SC; | ||
| 3372 | unsigned int phase; | ||
| 3373 | |||
| 3374 | ESPBUS(("esp_work_bus: ")); | ||
| 3375 | if(!SCptr) { | ||
| 3376 | ESPBUS(("reconnect\n")); | ||
| 3377 | return esp_do_reconnect(esp, eregs); | ||
| 3378 | } | ||
| 3379 | phase = SCptr->SCp.phase; | ||
| 3380 | if ((phase & 0xf0) == in_phases_mask) | ||
| 3381 | return bus_vector[(phase & 0x0f)](esp, eregs); | ||
| 3382 | else if((phase & 0xf0) == in_slct_mask) | ||
| 3383 | return esp_select_complete(esp, eregs); | ||
| 3384 | else | ||
| 3385 | return esp_bus_unexpected(esp, eregs); | ||
| 3386 | } | ||
| 3387 | |||
| 3388 | static espfunc_t isvc_vector[] = { | ||
| 3389 | NULL, | ||
| 3390 | esp_do_phase_determine, | ||
| 3391 | esp_do_resetbus, | ||
| 3392 | esp_finish_reset, | ||
| 3393 | esp_work_bus | ||
| 3394 | }; | ||
| 3395 | |||
| 3396 | /* Main interrupt handler for an esp adapter. */ | ||
| 3397 | void esp_handle(struct NCR_ESP *esp) | ||
| 3398 | { | ||
| 3399 | struct ESP_regs *eregs; | ||
| 3400 | Scsi_Cmnd *SCptr; | ||
| 3401 | int what_next = do_intr_end; | ||
| 3402 | eregs = esp->eregs; | ||
| 3403 | SCptr = esp->current_SC; | ||
| 3404 | |||
| 3405 | if(esp->dma_irq_entry) | ||
| 3406 | esp->dma_irq_entry(esp); | ||
| 3407 | |||
| 3408 | /* Check for errors. */ | ||
| 3409 | esp->sreg = esp_read(eregs->esp_status); | ||
| 3410 | esp->sreg &= (~ESP_STAT_INTR); | ||
| 3411 | esp->seqreg = (esp_read(eregs->esp_sstep) & ESP_STEP_VBITS); | ||
| 3412 | esp->ireg = esp_read(eregs->esp_intrpt); /* Unlatch intr and stat regs */ | ||
| 3413 | ESPIRQ(("handle_irq: [sreg<%02x> sstep<%02x> ireg<%02x>]\n", | ||
| 3414 | esp->sreg, esp->seqreg, esp->ireg)); | ||
| 3415 | if(esp->sreg & (ESP_STAT_SPAM)) { | ||
| 3416 | /* Gross error, could be due to one of: | ||
| 3417 | * | ||
| 3418 | * - top of fifo overwritten, could be because | ||
| 3419 | * we tried to do a synchronous transfer with | ||
| 3420 | * an offset greater than ESP fifo size | ||
| 3421 | * | ||
| 3422 | * - top of command register overwritten | ||
| 3423 | * | ||
| 3424 | * - DMA setup to go in one direction, SCSI | ||
| 3425 | * bus points in the other, whoops | ||
| 3426 | * | ||
| 3427 | * - weird phase change during asynchronous | ||
| 3428 | * data phase while we are initiator | ||
| 3429 | */ | ||
| 3430 | ESPLOG(("esp%d: Gross error sreg=%2x\n", esp->esp_id, esp->sreg)); | ||
| 3431 | |||
| 3432 | /* If a command is live on the bus we cannot safely | ||
| 3433 | * reset the bus, so we'll just let the pieces fall | ||
| 3434 | * where they may. Here we are hoping that the | ||
| 3435 | * target will be able to cleanly go away soon | ||
| 3436 | * so we can safely reset things. | ||
| 3437 | */ | ||
| 3438 | if(!SCptr) { | ||
| 3439 | ESPLOG(("esp%d: No current cmd during gross error, " | ||
| 3440 | "resetting bus\n", esp->esp_id)); | ||
| 3441 | what_next = do_reset_bus; | ||
| 3442 | goto state_machine; | ||
| 3443 | } | ||
| 3444 | } | ||
| 3445 | |||
| 3446 | /* No current cmd is only valid at this point when there are | ||
| 3447 | * commands off the bus or we are trying a reset. | ||
| 3448 | */ | ||
| 3449 | if(!SCptr && !esp->disconnected_SC && !(esp->ireg & ESP_INTR_SR)) { | ||
| 3450 | /* Panic is safe, since current_SC is null. */ | ||
| 3451 | ESPLOG(("esp%d: no command in esp_handle()\n", esp->esp_id)); | ||
| 3452 | panic("esp_handle: current_SC == penguin within interrupt!"); | ||
| 3453 | } | ||
| 3454 | |||
| 3455 | if(esp->ireg & (ESP_INTR_IC)) { | ||
| 3456 | /* Illegal command fed to ESP. Outside of obvious | ||
| 3457 | * software bugs that could cause this, there is | ||
| 3458 | * a condition with ESP100 where we can confuse the | ||
| 3459 | * ESP into an erroneous illegal command interrupt | ||
| 3460 | * because it does not scrape the FIFO properly | ||
| 3461 | * for reselection. See esp100_reconnect_hwbug() | ||
| 3462 | * to see how we try very hard to avoid this. | ||
| 3463 | */ | ||
| 3464 | ESPLOG(("esp%d: invalid command\n", esp->esp_id)); | ||
| 3465 | |||
| 3466 | esp_dump_state(esp, eregs); | ||
| 3467 | |||
| 3468 | if(SCptr) { | ||
| 3469 | /* Devices with very buggy firmware can drop BSY | ||
| 3470 | * during a scatter list interrupt when using sync | ||
| 3471 | * mode transfers. We continue the transfer as | ||
| 3472 | * expected, the target drops the bus, the ESP | ||
| 3473 | * gets confused, and we get a illegal command | ||
| 3474 | * interrupt because the bus is in the disconnected | ||
| 3475 | * state now and ESP_CMD_TI is only allowed when | ||
| 3476 | * a nexus is alive on the bus. | ||
| 3477 | */ | ||
| 3478 | ESPLOG(("esp%d: Forcing async and disabling disconnect for " | ||
| 3479 | "target %d\n", esp->esp_id, SCptr->device->id)); | ||
| 3480 | SCptr->device->borken = 1; /* foo on you */ | ||
| 3481 | } | ||
| 3482 | |||
| 3483 | what_next = do_reset_bus; | ||
| 3484 | } else if(!(esp->ireg & ~(ESP_INTR_FDONE | ESP_INTR_BSERV | ESP_INTR_DC))) { | ||
| 3485 | int phase; | ||
| 3486 | |||
| 3487 | if(SCptr) { | ||
| 3488 | phase = SCptr->SCp.phase; | ||
| 3489 | if(phase & in_phases_mask) { | ||
| 3490 | what_next = esp_work_bus(esp, eregs); | ||
| 3491 | } else if(phase & in_slct_mask) { | ||
| 3492 | what_next = esp_select_complete(esp, eregs); | ||
| 3493 | } else { | ||
| 3494 | ESPLOG(("esp%d: interrupt for no good reason...\n", | ||
| 3495 | esp->esp_id)); | ||
| 3496 | what_next = do_intr_end; | ||
| 3497 | } | ||
| 3498 | } else { | ||
| 3499 | ESPLOG(("esp%d: BSERV or FDONE or DC while SCptr==NULL\n", | ||
| 3500 | esp->esp_id)); | ||
| 3501 | what_next = do_reset_bus; | ||
| 3502 | } | ||
| 3503 | } else if(esp->ireg & ESP_INTR_SR) { | ||
| 3504 | ESPLOG(("esp%d: SCSI bus reset interrupt\n", esp->esp_id)); | ||
| 3505 | what_next = do_reset_complete; | ||
| 3506 | } else if(esp->ireg & (ESP_INTR_S | ESP_INTR_SATN)) { | ||
| 3507 | ESPLOG(("esp%d: AIEEE we have been selected by another initiator!\n", | ||
| 3508 | esp->esp_id)); | ||
| 3509 | what_next = do_reset_bus; | ||
| 3510 | } else if(esp->ireg & ESP_INTR_RSEL) { | ||
| 3511 | if(!SCptr) { | ||
| 3512 | /* This is ok. */ | ||
| 3513 | what_next = esp_do_reconnect(esp, eregs); | ||
| 3514 | } else if(SCptr->SCp.phase & in_slct_mask) { | ||
| 3515 | /* Only selection code knows how to clean | ||
| 3516 | * up properly. | ||
| 3517 | */ | ||
| 3518 | ESPDISC(("Reselected during selection attempt\n")); | ||
| 3519 | what_next = esp_select_complete(esp, eregs); | ||
| 3520 | } else { | ||
| 3521 | ESPLOG(("esp%d: Reselected while bus is busy\n", | ||
| 3522 | esp->esp_id)); | ||
| 3523 | what_next = do_reset_bus; | ||
| 3524 | } | ||
| 3525 | } | ||
| 3526 | |||
| 3527 | /* This is tier-one in our dual level SCSI state machine. */ | ||
| 3528 | state_machine: | ||
| 3529 | while(what_next != do_intr_end) { | ||
| 3530 | if (what_next >= do_phase_determine && | ||
| 3531 | what_next < do_intr_end) | ||
| 3532 | what_next = isvc_vector[what_next](esp, eregs); | ||
| 3533 | else { | ||
| 3534 | /* state is completely lost ;-( */ | ||
| 3535 | ESPLOG(("esp%d: interrupt engine loses state, resetting bus\n", | ||
| 3536 | esp->esp_id)); | ||
| 3537 | what_next = do_reset_bus; | ||
| 3538 | } | ||
| 3539 | } | ||
| 3540 | if(esp->dma_irq_exit) | ||
| 3541 | esp->dma_irq_exit(esp); | ||
| 3542 | } | ||
| 3543 | EXPORT_SYMBOL(esp_handle); | ||
| 3544 | |||
| 3545 | #ifndef CONFIG_SMP | ||
| 3546 | irqreturn_t esp_intr(int irq, void *dev_id) | ||
| 3547 | { | ||
| 3548 | struct NCR_ESP *esp; | ||
| 3549 | unsigned long flags; | ||
| 3550 | int again; | ||
| 3551 | struct Scsi_Host *dev = dev_id; | ||
| 3552 | |||
| 3553 | /* Handle all ESP interrupts showing at this IRQ level. */ | ||
| 3554 | spin_lock_irqsave(dev->host_lock, flags); | ||
| 3555 | repeat: | ||
| 3556 | again = 0; | ||
| 3557 | for_each_esp(esp) { | ||
| 3558 | #ifndef __mips__ | ||
| 3559 | if(((esp)->irq & 0xff) == irq) { | ||
| 3560 | #endif | ||
| 3561 | if(esp->dma_irq_p(esp)) { | ||
| 3562 | again = 1; | ||
| 3563 | |||
| 3564 | esp->dma_ints_off(esp); | ||
| 3565 | |||
| 3566 | ESPIRQ(("I%d(", esp->esp_id)); | ||
| 3567 | esp_handle(esp); | ||
| 3568 | ESPIRQ((")")); | ||
| 3569 | |||
| 3570 | esp->dma_ints_on(esp); | ||
| 3571 | } | ||
| 3572 | #ifndef __mips__ | ||
| 3573 | } | ||
| 3574 | #endif | ||
| 3575 | } | ||
| 3576 | if(again) | ||
| 3577 | goto repeat; | ||
| 3578 | spin_unlock_irqrestore(dev->host_lock, flags); | ||
| 3579 | return IRQ_HANDLED; | ||
| 3580 | } | ||
| 3581 | #else | ||
| 3582 | /* For SMP we only service one ESP on the list list at our IRQ level! */ | ||
| 3583 | irqreturn_t esp_intr(int irq, void *dev_id) | ||
| 3584 | { | ||
| 3585 | struct NCR_ESP *esp; | ||
| 3586 | unsigned long flags; | ||
| 3587 | struct Scsi_Host *dev = dev_id; | ||
| 3588 | |||
| 3589 | /* Handle all ESP interrupts showing at this IRQ level. */ | ||
| 3590 | spin_lock_irqsave(dev->host_lock, flags); | ||
| 3591 | for_each_esp(esp) { | ||
| 3592 | if(((esp)->irq & 0xf) == irq) { | ||
| 3593 | if(esp->dma_irq_p(esp)) { | ||
| 3594 | esp->dma_ints_off(esp); | ||
| 3595 | |||
| 3596 | ESPIRQ(("I[%d:%d](", | ||
| 3597 | smp_processor_id(), esp->esp_id)); | ||
| 3598 | esp_handle(esp); | ||
| 3599 | ESPIRQ((")")); | ||
| 3600 | |||
| 3601 | esp->dma_ints_on(esp); | ||
| 3602 | goto out; | ||
| 3603 | } | ||
| 3604 | } | ||
| 3605 | } | ||
| 3606 | out: | ||
| 3607 | spin_unlock_irqrestore(dev->host_lock, flags); | ||
| 3608 | return IRQ_HANDLED; | ||
| 3609 | } | ||
| 3610 | #endif | ||
| 3611 | |||
| 3612 | int esp_slave_alloc(struct scsi_device *SDptr) | ||
| 3613 | { | ||
| 3614 | struct esp_device *esp_dev = | ||
| 3615 | kzalloc(sizeof(struct esp_device), GFP_ATOMIC); | ||
| 3616 | |||
| 3617 | if (!esp_dev) | ||
| 3618 | return -ENOMEM; | ||
| 3619 | SDptr->hostdata = esp_dev; | ||
| 3620 | return 0; | ||
| 3621 | } | ||
| 3622 | |||
| 3623 | void esp_slave_destroy(struct scsi_device *SDptr) | ||
| 3624 | { | ||
| 3625 | struct NCR_ESP *esp = (struct NCR_ESP *) SDptr->host->hostdata; | ||
| 3626 | |||
| 3627 | esp->targets_present &= ~(1 << sdev_id(SDptr)); | ||
| 3628 | kfree(SDptr->hostdata); | ||
| 3629 | SDptr->hostdata = NULL; | ||
| 3630 | } | ||
| 3631 | |||
| 3632 | #ifdef MODULE | ||
| 3633 | int init_module(void) { return 0; } | ||
| 3634 | void cleanup_module(void) {} | ||
| 3635 | void esp_release(void) | ||
| 3636 | { | ||
| 3637 | esps_in_use--; | ||
| 3638 | esps_running = esps_in_use; | ||
| 3639 | } | ||
| 3640 | EXPORT_SYMBOL(esp_release); | ||
| 3641 | #endif | ||
| 3642 | |||
| 3643 | EXPORT_SYMBOL(esp_abort); | ||
| 3644 | EXPORT_SYMBOL(esp_allocate); | ||
| 3645 | EXPORT_SYMBOL(esp_deallocate); | ||
| 3646 | EXPORT_SYMBOL(esp_initialize); | ||
| 3647 | EXPORT_SYMBOL(esp_intr); | ||
| 3648 | EXPORT_SYMBOL(esp_queue); | ||
| 3649 | EXPORT_SYMBOL(esp_reset); | ||
| 3650 | EXPORT_SYMBOL(esp_slave_alloc); | ||
| 3651 | EXPORT_SYMBOL(esp_slave_destroy); | ||
| 3652 | EXPORT_SYMBOL(esps_in_use); | ||
| 3653 | |||
| 3654 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/scsi/NCR53C9x.h b/drivers/scsi/NCR53C9x.h deleted file mode 100644 index 00a0ba040dba..000000000000 --- a/drivers/scsi/NCR53C9x.h +++ /dev/null | |||
| @@ -1,668 +0,0 @@ | |||
| 1 | /* NCR53C9x.c: Defines and structures for the NCR53C9x generic driver. | ||
| 2 | * | ||
| 3 | * Originally esp.h: Defines and structures for the Sparc ESP | ||
| 4 | * (Enhanced SCSI Processor) driver under Linux. | ||
| 5 | * | ||
| 6 | * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu) | ||
| 7 | * | ||
| 8 | * Generalization by Jesper Skov (jskov@cygnus.co.uk) | ||
| 9 | * | ||
| 10 | * More generalization (for i386 stuff) by Tymm Twillman (tymm@computer.org) | ||
| 11 | */ | ||
| 12 | |||
| 13 | #ifndef NCR53C9X_H | ||
| 14 | #define NCR53C9X_H | ||
| 15 | |||
| 16 | #include <linux/interrupt.h> | ||
| 17 | |||
| 18 | /* djweis for mac driver */ | ||
| 19 | #if defined(CONFIG_MAC) | ||
| 20 | #define PAD_SIZE 15 | ||
| 21 | #else | ||
| 22 | #define PAD_SIZE 3 | ||
| 23 | #endif | ||
| 24 | |||
| 25 | /* Handle multiple hostadapters on Amiga | ||
| 26 | * generally PAD_SIZE = 3 | ||
| 27 | * but there is one exception: Oktagon (PAD_SIZE = 1) */ | ||
| 28 | #if defined(CONFIG_OKTAGON_SCSI) || defined(CONFIG_OKTAGON_SCSI_MODULE) | ||
| 29 | #undef PAD_SIZE | ||
| 30 | #if defined(CONFIG_BLZ1230_SCSI) || defined(CONFIG_BLZ1230_SCSI_MODULE) || \ | ||
| 31 | defined(CONFIG_BLZ2060_SCSI) || defined(CONFIG_BLZ2060_SCSI_MODULE) || \ | ||
| 32 | defined(CONFIG_CYBERSTORM_SCSI) || defined(CONFIG_CYBERSTORM_SCSI_MODULE) || \ | ||
| 33 | defined(CONFIG_CYBERSTORMII_SCSI) || defined(CONFIG_CYBERSTORMII_SCSI_MODULE) || \ | ||
| 34 | defined(CONFIG_FASTLANE_SCSI) || defined(CONFIG_FASTLANE_SCSI_MODULE) | ||
| 35 | #define MULTIPLE_PAD_SIZES | ||
| 36 | #else | ||
| 37 | #define PAD_SIZE 1 | ||
| 38 | #endif | ||
| 39 | #endif | ||
| 40 | |||
| 41 | /* Macros for debugging messages */ | ||
| 42 | |||
| 43 | #define DEBUG_ESP | ||
| 44 | /* #define DEBUG_ESP_DATA */ | ||
| 45 | /* #define DEBUG_ESP_QUEUE */ | ||
| 46 | /* #define DEBUG_ESP_DISCONNECT */ | ||
| 47 | /* #define DEBUG_ESP_STATUS */ | ||
| 48 | /* #define DEBUG_ESP_PHASES */ | ||
| 49 | /* #define DEBUG_ESP_WORKBUS */ | ||
| 50 | /* #define DEBUG_STATE_MACHINE */ | ||
| 51 | /* #define DEBUG_ESP_CMDS */ | ||
| 52 | /* #define DEBUG_ESP_IRQS */ | ||
| 53 | /* #define DEBUG_SDTR */ | ||
| 54 | /* #define DEBUG_ESP_SG */ | ||
| 55 | |||
| 56 | /* Use the following to sprinkle debugging messages in a way which | ||
| 57 | * suits you if combinations of the above become too verbose when | ||
| 58 | * trying to track down a specific problem. | ||
| 59 | */ | ||
| 60 | /* #define DEBUG_ESP_MISC */ | ||
| 61 | |||
| 62 | #if defined(DEBUG_ESP) | ||
| 63 | #define ESPLOG(foo) printk foo | ||
| 64 | #else | ||
| 65 | #define ESPLOG(foo) | ||
| 66 | #endif /* (DEBUG_ESP) */ | ||
| 67 | |||
| 68 | #if defined(DEBUG_ESP_DATA) | ||
| 69 | #define ESPDATA(foo) printk foo | ||
| 70 | #else | ||
| 71 | #define ESPDATA(foo) | ||
| 72 | #endif | ||
| 73 | |||
| 74 | #if defined(DEBUG_ESP_QUEUE) | ||
| 75 | #define ESPQUEUE(foo) printk foo | ||
| 76 | #else | ||
| 77 | #define ESPQUEUE(foo) | ||
| 78 | #endif | ||
| 79 | |||
| 80 | #if defined(DEBUG_ESP_DISCONNECT) | ||
| 81 | #define ESPDISC(foo) printk foo | ||
| 82 | #else | ||
| 83 | #define ESPDISC(foo) | ||
| 84 | #endif | ||
| 85 | |||
| 86 | #if defined(DEBUG_ESP_STATUS) | ||
| 87 | #define ESPSTAT(foo) printk foo | ||
| 88 | #else | ||
| 89 | #define ESPSTAT(foo) | ||
| 90 | #endif | ||
| 91 | |||
| 92 | #if defined(DEBUG_ESP_PHASES) | ||
| 93 | #define ESPPHASE(foo) printk foo | ||
| 94 | #else | ||
| 95 | #define ESPPHASE(foo) | ||
| 96 | #endif | ||
| 97 | |||
| 98 | #if defined(DEBUG_ESP_WORKBUS) | ||
| 99 | #define ESPBUS(foo) printk foo | ||
| 100 | #else | ||
| 101 | #define ESPBUS(foo) | ||
| 102 | #endif | ||
| 103 | |||
| 104 | #if defined(DEBUG_ESP_IRQS) | ||
| 105 | #define ESPIRQ(foo) printk foo | ||
| 106 | #else | ||
| 107 | #define ESPIRQ(foo) | ||
| 108 | #endif | ||
| 109 | |||
| 110 | #if defined(DEBUG_SDTR) | ||
| 111 | #define ESPSDTR(foo) printk foo | ||
| 112 | #else | ||
| 113 | #define ESPSDTR(foo) | ||
| 114 | #endif | ||
| 115 | |||
| 116 | #if defined(DEBUG_ESP_MISC) | ||
| 117 | #define ESPMISC(foo) printk foo | ||
| 118 | #else | ||
| 119 | #define ESPMISC(foo) | ||
| 120 | #endif | ||
| 121 | |||
| 122 | /* | ||
| 123 | * padding for register structure | ||
| 124 | */ | ||
| 125 | #ifdef CONFIG_JAZZ_ESP | ||
| 126 | #define EREGS_PAD(n) | ||
| 127 | #else | ||
| 128 | #ifndef MULTIPLE_PAD_SIZES | ||
| 129 | #define EREGS_PAD(n) unchar n[PAD_SIZE]; | ||
| 130 | #endif | ||
| 131 | #endif | ||
| 132 | |||
| 133 | /* The ESP SCSI controllers have their register sets in three | ||
| 134 | * "classes": | ||
| 135 | * | ||
| 136 | * 1) Registers which are both read and write. | ||
| 137 | * 2) Registers which are read only. | ||
| 138 | * 3) Registers which are write only. | ||
| 139 | * | ||
| 140 | * Yet, they all live within the same IO space. | ||
| 141 | */ | ||
| 142 | |||
| 143 | #if !defined(__i386__) && !defined(__x86_64__) | ||
| 144 | |||
| 145 | #ifndef MULTIPLE_PAD_SIZES | ||
| 146 | |||
| 147 | #ifdef CONFIG_CPU_HAS_WB | ||
| 148 | #include <asm/wbflush.h> | ||
| 149 | #define esp_write(__reg, __val) do{(__reg) = (__val); wbflush();} while(0) | ||
| 150 | #else | ||
| 151 | #define esp_write(__reg, __val) ((__reg) = (__val)) | ||
| 152 | #endif | ||
| 153 | #define esp_read(__reg) (__reg) | ||
| 154 | |||
| 155 | struct ESP_regs { | ||
| 156 | /* Access Description Offset */ | ||
| 157 | volatile unchar esp_tclow; /* rw Low bits of the transfer count 0x00 */ | ||
| 158 | EREGS_PAD(tlpad1); | ||
| 159 | volatile unchar esp_tcmed; /* rw Mid bits of the transfer count 0x04 */ | ||
| 160 | EREGS_PAD(fdpad); | ||
| 161 | volatile unchar esp_fdata; /* rw FIFO data bits 0x08 */ | ||
| 162 | EREGS_PAD(cbpad); | ||
| 163 | volatile unchar esp_cmnd; /* rw SCSI command bits 0x0c */ | ||
| 164 | EREGS_PAD(stpad); | ||
| 165 | volatile unchar esp_status; /* ro ESP status register 0x10 */ | ||
| 166 | #define esp_busid esp_status /* wo Bus ID for select/reselect 0x10 */ | ||
| 167 | EREGS_PAD(irqpd); | ||
| 168 | volatile unchar esp_intrpt; /* ro Kind of interrupt 0x14 */ | ||
| 169 | #define esp_timeo esp_intrpt /* wo Timeout value for select/resel 0x14 */ | ||
| 170 | EREGS_PAD(sspad); | ||
| 171 | volatile unchar esp_sstep; /* ro Sequence step register 0x18 */ | ||
| 172 | #define esp_stp esp_sstep /* wo Transfer period per sync 0x18 */ | ||
| 173 | EREGS_PAD(ffpad); | ||
| 174 | volatile unchar esp_fflags; /* ro Bits of current FIFO info 0x1c */ | ||
| 175 | #define esp_soff esp_fflags /* wo Sync offset 0x1c */ | ||
| 176 | EREGS_PAD(cf1pd); | ||
| 177 | volatile unchar esp_cfg1; /* rw First configuration register 0x20 */ | ||
| 178 | EREGS_PAD(cfpad); | ||
| 179 | volatile unchar esp_cfact; /* wo Clock conversion factor 0x24 */ | ||
| 180 | EREGS_PAD(ctpad); | ||
| 181 | volatile unchar esp_ctest; /* wo Chip test register 0x28 */ | ||
| 182 | EREGS_PAD(cf2pd); | ||
| 183 | volatile unchar esp_cfg2; /* rw Second configuration register 0x2c */ | ||
| 184 | EREGS_PAD(cf3pd); | ||
| 185 | |||
| 186 | /* The following is only found on the 53C9X series SCSI chips */ | ||
| 187 | volatile unchar esp_cfg3; /* rw Third configuration register 0x30 */ | ||
| 188 | EREGS_PAD(cf4pd); | ||
| 189 | volatile unchar esp_cfg4; /* rw Fourth configuration register 0x34 */ | ||
| 190 | EREGS_PAD(thpd); | ||
| 191 | /* The following is found on all chips except the NCR53C90 (ESP100) */ | ||
| 192 | volatile unchar esp_tchi; /* rw High bits of transfer count 0x38 */ | ||
| 193 | #define esp_uid esp_tchi /* ro Unique ID code 0x38 */ | ||
| 194 | EREGS_PAD(fgpad); | ||
| 195 | volatile unchar esp_fgrnd; /* rw Data base for fifo 0x3c */ | ||
| 196 | }; | ||
| 197 | |||
| 198 | #else /* MULTIPLE_PAD_SIZES */ | ||
| 199 | |||
| 200 | #define esp_write(__reg, __val) (*(__reg) = (__val)) | ||
| 201 | #define esp_read(__reg) (*(__reg)) | ||
| 202 | |||
| 203 | struct ESP_regs { | ||
| 204 | unsigned char io_addr[64]; /* dummy */ | ||
| 205 | /* Access Description Offset */ | ||
| 206 | #define esp_tclow io_addr /* rw Low bits of the transfer count 0x00 */ | ||
| 207 | #define esp_tcmed io_addr + (1<<(esp->shift)) /* rw Mid bits of the transfer count 0x04 */ | ||
| 208 | #define esp_fdata io_addr + (2<<(esp->shift)) /* rw FIFO data bits 0x08 */ | ||
| 209 | #define esp_cmnd io_addr + (3<<(esp->shift)) /* rw SCSI command bits 0x0c */ | ||
| 210 | #define esp_status io_addr + (4<<(esp->shift)) /* ro ESP status register 0x10 */ | ||
| 211 | #define esp_busid esp_status /* wo Bus ID for select/reselect 0x10 */ | ||
| 212 | #define esp_intrpt io_addr + (5<<(esp->shift)) /* ro Kind of interrupt 0x14 */ | ||
| 213 | #define esp_timeo esp_intrpt /* wo Timeout value for select/resel 0x14 */ | ||
| 214 | #define esp_sstep io_addr + (6<<(esp->shift)) /* ro Sequence step register 0x18 */ | ||
| 215 | #define esp_stp esp_sstep /* wo Transfer period per sync 0x18 */ | ||
| 216 | #define esp_fflags io_addr + (7<<(esp->shift)) /* ro Bits of current FIFO info 0x1c */ | ||
| 217 | #define esp_soff esp_fflags /* wo Sync offset 0x1c */ | ||
| 218 | #define esp_cfg1 io_addr + (8<<(esp->shift)) /* rw First configuration register 0x20 */ | ||
| 219 | #define esp_cfact io_addr + (9<<(esp->shift)) /* wo Clock conversion factor 0x24 */ | ||
| 220 | #define esp_ctest io_addr + (10<<(esp->shift)) /* wo Chip test register 0x28 */ | ||
| 221 | #define esp_cfg2 io_addr + (11<<(esp->shift)) /* rw Second configuration register 0x2c */ | ||
| 222 | |||
| 223 | /* The following is only found on the 53C9X series SCSI chips */ | ||
| 224 | #define esp_cfg3 io_addr + (12<<(esp->shift)) /* rw Third configuration register 0x30 */ | ||
| 225 | #define esp_cfg4 io_addr + (13<<(esp->shift)) /* rw Fourth configuration register 0x34 */ | ||
| 226 | |||
| 227 | /* The following is found on all chips except the NCR53C90 (ESP100) */ | ||
| 228 | #define esp_tchi io_addr + (14<<(esp->shift)) /* rw High bits of transfer count 0x38 */ | ||
| 229 | #define esp_uid esp_tchi /* ro Unique ID code 0x38 */ | ||
| 230 | #define esp_fgrnd io_addr + (15<<(esp->shift)) /* rw Data base for fifo 0x3c */ | ||
| 231 | }; | ||
| 232 | |||
| 233 | #endif | ||
| 234 | |||
| 235 | #else /* !defined(__i386__) && !defined(__x86_64__) */ | ||
| 236 | |||
| 237 | #define esp_write(__reg, __val) outb((__val), (__reg)) | ||
| 238 | #define esp_read(__reg) inb((__reg)) | ||
| 239 | |||
| 240 | struct ESP_regs { | ||
| 241 | unsigned int io_addr; | ||
| 242 | /* Access Description Offset */ | ||
| 243 | #define esp_tclow io_addr /* rw Low bits of the transfer count 0x00 */ | ||
| 244 | #define esp_tcmed io_addr + 1 /* rw Mid bits of the transfer count 0x04 */ | ||
| 245 | #define esp_fdata io_addr + 2 /* rw FIFO data bits 0x08 */ | ||
| 246 | #define esp_cmnd io_addr + 3 /* rw SCSI command bits 0x0c */ | ||
| 247 | #define esp_status io_addr + 4 /* ro ESP status register 0x10 */ | ||
| 248 | #define esp_busid esp_status /* wo Bus ID for select/reselect 0x10 */ | ||
| 249 | #define esp_intrpt io_addr + 5 /* ro Kind of interrupt 0x14 */ | ||
| 250 | #define esp_timeo esp_intrpt /* wo Timeout value for select/resel 0x14 */ | ||
| 251 | #define esp_sstep io_addr + 6 /* ro Sequence step register 0x18 */ | ||
| 252 | #define esp_stp esp_sstep /* wo Transfer period per sync 0x18 */ | ||
| 253 | #define esp_fflags io_addr + 7 /* ro Bits of current FIFO info 0x1c */ | ||
| 254 | #define esp_soff esp_fflags /* wo Sync offset 0x1c */ | ||
| 255 | #define esp_cfg1 io_addr + 8 /* rw First configuration register 0x20 */ | ||
| 256 | #define esp_cfact io_addr + 9 /* wo Clock conversion factor 0x24 */ | ||
| 257 | #define esp_ctest io_addr + 10 /* wo Chip test register 0x28 */ | ||
| 258 | #define esp_cfg2 io_addr + 11 /* rw Second configuration register 0x2c */ | ||
| 259 | |||
| 260 | /* The following is only found on the 53C9X series SCSI chips */ | ||
| 261 | #define esp_cfg3 io_addr + 12 /* rw Third configuration register 0x30 */ | ||
| 262 | #define esp_cfg4 io_addr + 13 /* rw Fourth configuration register 0x34 */ | ||
| 263 | |||
| 264 | /* The following is found on all chips except the NCR53C90 (ESP100) */ | ||
| 265 | #define esp_tchi io_addr + 14 /* rw High bits of transfer count 0x38 */ | ||
| 266 | #define esp_uid esp_tchi /* ro Unique ID code 0x38 */ | ||
| 267 | #define esp_fgrnd io_addr + 15 /* rw Data base for fifo 0x3c */ | ||
| 268 | }; | ||
| 269 | |||
| 270 | #endif /* !defined(__i386__) && !defined(__x86_64__) */ | ||
| 271 | |||
| 272 | /* Various revisions of the ESP board. */ | ||
| 273 | enum esp_rev { | ||
| 274 | esp100 = 0x00, /* NCR53C90 - very broken */ | ||
| 275 | esp100a = 0x01, /* NCR53C90A */ | ||
| 276 | esp236 = 0x02, | ||
| 277 | fas236 = 0x03, | ||
| 278 | fas100a = 0x04, | ||
| 279 | fast = 0x05, | ||
| 280 | fas366 = 0x06, | ||
| 281 | fas216 = 0x07, | ||
| 282 | fsc = 0x08, /* SYM53C94-2 */ | ||
| 283 | espunknown = 0x09 | ||
| 284 | }; | ||
| 285 | |||
| 286 | /* We allocate one of these for each scsi device and attach it to | ||
| 287 | * SDptr->hostdata for use in the driver | ||
| 288 | */ | ||
| 289 | struct esp_device { | ||
| 290 | unsigned char sync_min_period; | ||
| 291 | unsigned char sync_max_offset; | ||
| 292 | unsigned sync:1; | ||
| 293 | unsigned wide:1; | ||
| 294 | unsigned disconnect:1; | ||
| 295 | }; | ||
| 296 | |||
| 297 | /* We get one of these for each ESP probed. */ | ||
| 298 | struct NCR_ESP { | ||
| 299 | struct NCR_ESP *next; /* Next ESP on probed or NULL */ | ||
| 300 | struct ESP_regs *eregs; /* All esp registers */ | ||
| 301 | int dma; /* Who I do transfers with. */ | ||
| 302 | void *dregs; /* And his registers. */ | ||
| 303 | struct Scsi_Host *ehost; /* Backpointer to SCSI Host */ | ||
| 304 | |||
| 305 | void *edev; /* Pointer to controller base/SBus */ | ||
| 306 | int esp_id; /* Unique per-ESP ID number */ | ||
| 307 | |||
| 308 | /* ESP Configuration Registers */ | ||
| 309 | unsigned char config1; /* Copy of the 1st config register */ | ||
| 310 | unsigned char config2; /* Copy of the 2nd config register */ | ||
| 311 | unsigned char config3[16]; /* Copy of the 3rd config register */ | ||
| 312 | |||
| 313 | /* The current command we are sending to the ESP chip. This esp_command | ||
| 314 | * ptr needs to be mapped in DVMA area so we can send commands and read | ||
| 315 | * from the ESP fifo without burning precious CPU cycles. Programmed I/O | ||
| 316 | * sucks when we have the DVMA to do it for us. The ESP is stupid and will | ||
| 317 | * only send out 6, 10, and 12 byte SCSI commands, others we need to send | ||
| 318 | * one byte at a time. esp_slowcmd being set says that we are doing one | ||
| 319 | * of the command types ESP doesn't understand, esp_scmdp keeps track of | ||
| 320 | * which byte we are sending, esp_scmdleft says how many bytes to go. | ||
| 321 | */ | ||
| 322 | volatile unchar *esp_command; /* Location of command (CPU view) */ | ||
| 323 | __u32 esp_command_dvma; /* Location of command (DVMA view) */ | ||
| 324 | unsigned char esp_clen; /* Length of this command */ | ||
| 325 | unsigned char esp_slowcmd; | ||
| 326 | unsigned char *esp_scmdp; | ||
| 327 | unsigned char esp_scmdleft; | ||
| 328 | |||
| 329 | /* The following are used to determine the cause of an IRQ. Upon every | ||
| 330 | * IRQ entry we synchronize these with the hardware registers. | ||
| 331 | */ | ||
| 332 | unchar ireg; /* Copy of ESP interrupt register */ | ||
| 333 | unchar sreg; /* Same for ESP status register */ | ||
| 334 | unchar seqreg; /* The ESP sequence register */ | ||
| 335 | |||
| 336 | /* The following is set when a premature interrupt condition is detected | ||
| 337 | * in some FAS revisions. | ||
| 338 | */ | ||
| 339 | unchar fas_premature_intr_workaround; | ||
| 340 | |||
| 341 | /* To save register writes to the ESP, which can be expensive, we | ||
| 342 | * keep track of the previous value that various registers had for | ||
| 343 | * the last target we connected to. If they are the same for the | ||
| 344 | * current target, we skip the register writes as they are not needed. | ||
| 345 | */ | ||
| 346 | unchar prev_soff, prev_stp, prev_cfg3; | ||
| 347 | |||
| 348 | /* For each target we keep track of save/restore data | ||
| 349 | * pointer information. This needs to be updated majorly | ||
| 350 | * when we add support for tagged queueing. -DaveM | ||
| 351 | */ | ||
| 352 | struct esp_pointers { | ||
| 353 | char *saved_ptr; | ||
| 354 | struct scatterlist *saved_buffer; | ||
| 355 | int saved_this_residual; | ||
| 356 | int saved_buffers_residual; | ||
| 357 | } data_pointers[16] /*XXX [MAX_TAGS_PER_TARGET]*/; | ||
| 358 | |||
| 359 | /* Clock periods, frequencies, synchronization, etc. */ | ||
| 360 | unsigned int cfreq; /* Clock frequency in HZ */ | ||
| 361 | unsigned int cfact; /* Clock conversion factor */ | ||
| 362 | unsigned int ccycle; /* One ESP clock cycle */ | ||
| 363 | unsigned int ctick; /* One ESP clock time */ | ||
| 364 | unsigned int radelay; /* FAST chip req/ack delay */ | ||
| 365 | unsigned int neg_defp; /* Default negotiation period */ | ||
| 366 | unsigned int sync_defp; /* Default sync transfer period */ | ||
| 367 | unsigned int max_period; /* longest our period can be */ | ||
| 368 | unsigned int min_period; /* shortest period we can withstand */ | ||
| 369 | /* For slow to medium speed input clock rates we shoot for 5mb/s, | ||
| 370 | * but for high input clock rates we try to do 10mb/s although I | ||
| 371 | * don't think a transfer can even run that fast with an ESP even | ||
| 372 | * with DMA2 scatter gather pipelining. | ||
| 373 | */ | ||
| 374 | #define SYNC_DEFP_SLOW 0x32 /* 5mb/s */ | ||
| 375 | #define SYNC_DEFP_FAST 0x19 /* 10mb/s */ | ||
| 376 | |||
| 377 | unsigned int snip; /* Sync. negotiation in progress */ | ||
| 378 | unsigned int wnip; /* WIDE negotiation in progress */ | ||
| 379 | unsigned int targets_present; /* targets spoken to before */ | ||
| 380 | |||
| 381 | int current_transfer_size; /* Set at beginning of data dma */ | ||
| 382 | |||
| 383 | unchar espcmdlog[32]; /* Log of current esp cmds sent. */ | ||
| 384 | unchar espcmdent; /* Current entry in esp cmd log. */ | ||
| 385 | |||
| 386 | /* Misc. info about this ESP */ | ||
| 387 | enum esp_rev erev; /* ESP revision */ | ||
| 388 | int irq; /* IRQ for this ESP */ | ||
| 389 | int scsi_id; /* Who am I as initiator? */ | ||
| 390 | int scsi_id_mask; /* Bitmask of 'me'. */ | ||
| 391 | int diff; /* Differential SCSI bus? */ | ||
| 392 | int slot; /* Slot the adapter occupies */ | ||
| 393 | |||
| 394 | /* Our command queues, only one cmd lives in the current_SC queue. */ | ||
| 395 | Scsi_Cmnd *issue_SC; /* Commands to be issued */ | ||
| 396 | Scsi_Cmnd *current_SC; /* Who is currently working the bus */ | ||
| 397 | Scsi_Cmnd *disconnected_SC; /* Commands disconnected from the bus */ | ||
| 398 | |||
| 399 | /* Message goo */ | ||
| 400 | unchar cur_msgout[16]; | ||
| 401 | unchar cur_msgin[16]; | ||
| 402 | unchar prevmsgout, prevmsgin; | ||
| 403 | unchar msgout_len, msgin_len; | ||
| 404 | unchar msgout_ctr, msgin_ctr; | ||
| 405 | |||
| 406 | /* States that we cannot keep in the per cmd structure because they | ||
| 407 | * cannot be assosciated with any specific command. | ||
| 408 | */ | ||
| 409 | unchar resetting_bus; | ||
| 410 | wait_queue_head_t reset_queue; | ||
| 411 | |||
| 412 | unchar do_pio_cmds; /* Do command transfer with pio */ | ||
| 413 | |||
| 414 | /* How much bits do we have to shift the registers */ | ||
| 415 | unsigned char shift; | ||
| 416 | |||
| 417 | /* Functions handling DMA | ||
| 418 | */ | ||
| 419 | /* Required functions */ | ||
| 420 | int (*dma_bytes_sent)(struct NCR_ESP *, int); | ||
| 421 | int (*dma_can_transfer)(struct NCR_ESP *, Scsi_Cmnd *); | ||
| 422 | void (*dma_dump_state)(struct NCR_ESP *); | ||
| 423 | void (*dma_init_read)(struct NCR_ESP *, __u32, int); | ||
| 424 | void (*dma_init_write)(struct NCR_ESP *, __u32, int); | ||
| 425 | void (*dma_ints_off)(struct NCR_ESP *); | ||
| 426 | void (*dma_ints_on)(struct NCR_ESP *); | ||
| 427 | int (*dma_irq_p)(struct NCR_ESP *); | ||
| 428 | int (*dma_ports_p)(struct NCR_ESP *); | ||
| 429 | void (*dma_setup)(struct NCR_ESP *, __u32, int, int); | ||
| 430 | |||
| 431 | /* Optional functions (i.e. may be initialized to 0) */ | ||
| 432 | void (*dma_barrier)(struct NCR_ESP *); | ||
| 433 | void (*dma_drain)(struct NCR_ESP *); | ||
| 434 | void (*dma_invalidate)(struct NCR_ESP *); | ||
| 435 | void (*dma_irq_entry)(struct NCR_ESP *); | ||
| 436 | void (*dma_irq_exit)(struct NCR_ESP *); | ||
| 437 | void (*dma_led_off)(struct NCR_ESP *); | ||
| 438 | void (*dma_led_on)(struct NCR_ESP *); | ||
| 439 | void (*dma_poll)(struct NCR_ESP *, unsigned char *); | ||
| 440 | void (*dma_reset)(struct NCR_ESP *); | ||
| 441 | |||
| 442 | /* Optional virtual DMA functions */ | ||
| 443 | void (*dma_mmu_get_scsi_one)(struct NCR_ESP *, Scsi_Cmnd *); | ||
| 444 | void (*dma_mmu_get_scsi_sgl)(struct NCR_ESP *, Scsi_Cmnd *); | ||
| 445 | void (*dma_mmu_release_scsi_one)(struct NCR_ESP *, Scsi_Cmnd *); | ||
| 446 | void (*dma_mmu_release_scsi_sgl)(struct NCR_ESP *, Scsi_Cmnd *); | ||
| 447 | void (*dma_advance_sg)(Scsi_Cmnd *); | ||
| 448 | }; | ||
| 449 | |||
| 450 | /* Bitfield meanings for the above registers. */ | ||
| 451 | |||
| 452 | /* ESP config reg 1, read-write, found on all ESP chips */ | ||
| 453 | #define ESP_CONFIG1_ID 0x07 /* My BUS ID bits */ | ||
| 454 | #define ESP_CONFIG1_CHTEST 0x08 /* Enable ESP chip tests */ | ||
| 455 | #define ESP_CONFIG1_PENABLE 0x10 /* Enable parity checks */ | ||
| 456 | #define ESP_CONFIG1_PARTEST 0x20 /* Parity test mode enabled? */ | ||
| 457 | #define ESP_CONFIG1_SRRDISAB 0x40 /* Disable SCSI reset reports */ | ||
| 458 | #define ESP_CONFIG1_SLCABLE 0x80 /* Enable slow cable mode */ | ||
| 459 | |||
| 460 | /* ESP config reg 2, read-write, found only on esp100a+esp200+esp236+fsc chips */ | ||
| 461 | #define ESP_CONFIG2_DMAPARITY 0x01 /* enable DMA Parity (200,236,fsc) */ | ||
| 462 | #define ESP_CONFIG2_REGPARITY 0x02 /* enable reg Parity (200,236,fsc) */ | ||
| 463 | #define ESP_CONFIG2_BADPARITY 0x04 /* Bad parity target abort */ | ||
| 464 | #define ESP_CONFIG2_SCSI2ENAB 0x08 /* Enable SCSI-2 features (tmode only) */ | ||
| 465 | #define ESP_CONFIG2_HI 0x10 /* High Impedance DREQ ??? */ | ||
| 466 | #define ESP_CONFIG2_HMEFENAB 0x10 /* HME features enable */ | ||
| 467 | #define ESP_CONFIG2_BCM 0x20 /* Enable byte-ctrl (236,fsc) */ | ||
| 468 | #define ESP_CONFIG2_FENAB 0x40 /* Enable features (fas100,esp216,fsc) */ | ||
| 469 | #define ESP_CONFIG2_SPL 0x40 /* Enable status-phase latch (esp236) */ | ||
| 470 | #define ESP_CONFIG2_RFB 0x80 /* Reserve FIFO byte (fsc) */ | ||
| 471 | #define ESP_CONFIG2_MAGIC 0xe0 /* Invalid bits... */ | ||
| 472 | |||
| 473 | /* ESP config register 3 read-write, found only esp236+fas236+fas100a+fsc chips */ | ||
| 474 | #define ESP_CONFIG3_FCLOCK 0x01 /* FAST SCSI clock rate (esp100a/fas366) */ | ||
| 475 | #define ESP_CONFIG3_TEM 0x01 /* Enable thresh-8 mode (esp/fas236/fsc) */ | ||
| 476 | #define ESP_CONFIG3_FAST 0x02 /* Enable FAST SCSI (esp100a) */ | ||
| 477 | #define ESP_CONFIG3_ADMA 0x02 /* Enable alternate-dma (esp/fas236/fsc) */ | ||
| 478 | #define ESP_CONFIG3_TENB 0x04 /* group2 SCSI2 support (esp100a) */ | ||
| 479 | #define ESP_CONFIG3_SRB 0x04 /* Save residual byte (esp/fas236/fsc) */ | ||
| 480 | #define ESP_CONFIG3_TMS 0x08 /* Three-byte msg's ok (esp100a) */ | ||
| 481 | #define ESP_CONFIG3_FCLK 0x08 /* Fast SCSI clock rate (esp/fas236/fsc) */ | ||
| 482 | #define ESP_CONFIG3_IDMSG 0x10 /* ID message checking (esp100a) */ | ||
| 483 | #define ESP_CONFIG3_FSCSI 0x10 /* Enable FAST SCSI (esp/fas236/fsc) */ | ||
| 484 | #define ESP_CONFIG3_GTM 0x20 /* group2 SCSI2 support (esp/fas236/fsc) */ | ||
| 485 | #define ESP_CONFIG3_TBMS 0x40 /* Three-byte msg's ok (esp/fas236/fsc) */ | ||
| 486 | #define ESP_CONFIG3_IMS 0x80 /* ID msg chk'ng (esp/fas236/fsc) */ | ||
| 487 | |||
| 488 | /* ESP config register 4 read-write, found only on fsc chips */ | ||
| 489 | #define ESP_CONFIG4_BBTE 0x01 /* Back-to-Back transfer enable */ | ||
| 490 | #define ESP_CONFIG4_TEST 0x02 /* Transfer counter test mode */ | ||
| 491 | #define ESP_CONFIG4_EAN 0x04 /* Enable Active Negotiation */ | ||
| 492 | |||
| 493 | /* ESP command register read-write */ | ||
| 494 | /* Group 1 commands: These may be sent at any point in time to the ESP | ||
| 495 | * chip. None of them can generate interrupts 'cept | ||
| 496 | * the "SCSI bus reset" command if you have not disabled | ||
| 497 | * SCSI reset interrupts in the config1 ESP register. | ||
| 498 | */ | ||
| 499 | #define ESP_CMD_NULL 0x00 /* Null command, ie. a nop */ | ||
| 500 | #define ESP_CMD_FLUSH 0x01 /* FIFO Flush */ | ||
| 501 | #define ESP_CMD_RC 0x02 /* Chip reset */ | ||
| 502 | #define ESP_CMD_RS 0x03 /* SCSI bus reset */ | ||
| 503 | |||
| 504 | /* Group 2 commands: ESP must be an initiator and connected to a target | ||
| 505 | * for these commands to work. | ||
| 506 | */ | ||
| 507 | #define ESP_CMD_TI 0x10 /* Transfer Information */ | ||
| 508 | #define ESP_CMD_ICCSEQ 0x11 /* Initiator cmd complete sequence */ | ||
| 509 | #define ESP_CMD_MOK 0x12 /* Message okie-dokie */ | ||
| 510 | #define ESP_CMD_TPAD 0x18 /* Transfer Pad */ | ||
| 511 | #define ESP_CMD_SATN 0x1a /* Set ATN */ | ||
| 512 | #define ESP_CMD_RATN 0x1b /* De-assert ATN */ | ||
| 513 | |||
| 514 | /* Group 3 commands: ESP must be in the MSGOUT or MSGIN state and be connected | ||
| 515 | * to a target as the initiator for these commands to work. | ||
| 516 | */ | ||
| 517 | #define ESP_CMD_SMSG 0x20 /* Send message */ | ||
| 518 | #define ESP_CMD_SSTAT 0x21 /* Send status */ | ||
| 519 | #define ESP_CMD_SDATA 0x22 /* Send data */ | ||
| 520 | #define ESP_CMD_DSEQ 0x23 /* Discontinue Sequence */ | ||
| 521 | #define ESP_CMD_TSEQ 0x24 /* Terminate Sequence */ | ||
| 522 | #define ESP_CMD_TCCSEQ 0x25 /* Target cmd cmplt sequence */ | ||
| 523 | #define ESP_CMD_DCNCT 0x27 /* Disconnect */ | ||
| 524 | #define ESP_CMD_RMSG 0x28 /* Receive Message */ | ||
| 525 | #define ESP_CMD_RCMD 0x29 /* Receive Command */ | ||
| 526 | #define ESP_CMD_RDATA 0x2a /* Receive Data */ | ||
| 527 | #define ESP_CMD_RCSEQ 0x2b /* Receive cmd sequence */ | ||
| 528 | |||
| 529 | /* Group 4 commands: The ESP must be in the disconnected state and must | ||
| 530 | * not be connected to any targets as initiator for | ||
| 531 | * these commands to work. | ||
| 532 | */ | ||
| 533 | #define ESP_CMD_RSEL 0x40 /* Reselect */ | ||
| 534 | #define ESP_CMD_SEL 0x41 /* Select w/o ATN */ | ||
| 535 | #define ESP_CMD_SELA 0x42 /* Select w/ATN */ | ||
| 536 | #define ESP_CMD_SELAS 0x43 /* Select w/ATN & STOP */ | ||
| 537 | #define ESP_CMD_ESEL 0x44 /* Enable selection */ | ||
| 538 | #define ESP_CMD_DSEL 0x45 /* Disable selections */ | ||
| 539 | #define ESP_CMD_SA3 0x46 /* Select w/ATN3 */ | ||
| 540 | #define ESP_CMD_RSEL3 0x47 /* Reselect3 */ | ||
| 541 | |||
| 542 | /* This bit enables the ESP's DMA */ | ||
| 543 | #define ESP_CMD_DMA 0x80 /* Do DMA? */ | ||
| 544 | |||
| 545 | /* ESP status register read-only */ | ||
| 546 | #define ESP_STAT_PIO 0x01 /* IO phase bit */ | ||
| 547 | #define ESP_STAT_PCD 0x02 /* CD phase bit */ | ||
| 548 | #define ESP_STAT_PMSG 0x04 /* MSG phase bit */ | ||
| 549 | #define ESP_STAT_PMASK 0x07 /* Mask of phase bits */ | ||
| 550 | #define ESP_STAT_TDONE 0x08 /* Transfer Completed */ | ||
| 551 | #define ESP_STAT_TCNT 0x10 /* Transfer Counter Is Zero */ | ||
| 552 | #define ESP_STAT_PERR 0x20 /* Parity error */ | ||
| 553 | #define ESP_STAT_SPAM 0x40 /* Real bad error */ | ||
| 554 | /* This indicates the 'interrupt pending' condition, it is a reserved | ||
| 555 | * bit on old revs of the ESP (ESP100, ESP100A, FAS100A). | ||
| 556 | */ | ||
| 557 | #define ESP_STAT_INTR 0x80 /* Interrupt */ | ||
| 558 | |||
| 559 | /* The status register can be masked with ESP_STAT_PMASK and compared | ||
| 560 | * with the following values to determine the current phase the ESP | ||
| 561 | * (at least thinks it) is in. For our purposes we also add our own | ||
| 562 | * software 'done' bit for our phase management engine. | ||
| 563 | */ | ||
| 564 | #define ESP_DOP (0) /* Data Out */ | ||
| 565 | #define ESP_DIP (ESP_STAT_PIO) /* Data In */ | ||
| 566 | #define ESP_CMDP (ESP_STAT_PCD) /* Command */ | ||
| 567 | #define ESP_STATP (ESP_STAT_PCD|ESP_STAT_PIO) /* Status */ | ||
| 568 | #define ESP_MOP (ESP_STAT_PMSG|ESP_STAT_PCD) /* Message Out */ | ||
| 569 | #define ESP_MIP (ESP_STAT_PMSG|ESP_STAT_PCD|ESP_STAT_PIO) /* Message In */ | ||
| 570 | |||
| 571 | /* ESP interrupt register read-only */ | ||
| 572 | #define ESP_INTR_S 0x01 /* Select w/o ATN */ | ||
| 573 | #define ESP_INTR_SATN 0x02 /* Select w/ATN */ | ||
| 574 | #define ESP_INTR_RSEL 0x04 /* Reselected */ | ||
| 575 | #define ESP_INTR_FDONE 0x08 /* Function done */ | ||
| 576 | #define ESP_INTR_BSERV 0x10 /* Bus service */ | ||
| 577 | #define ESP_INTR_DC 0x20 /* Disconnect */ | ||
| 578 | #define ESP_INTR_IC 0x40 /* Illegal command given */ | ||
| 579 | #define ESP_INTR_SR 0x80 /* SCSI bus reset detected */ | ||
| 580 | |||
| 581 | /* Interrupt status macros */ | ||
| 582 | #define ESP_SRESET_IRQ(esp) ((esp)->intreg & (ESP_INTR_SR)) | ||
| 583 | #define ESP_ILLCMD_IRQ(esp) ((esp)->intreg & (ESP_INTR_IC)) | ||
| 584 | #define ESP_SELECT_WITH_ATN_IRQ(esp) ((esp)->intreg & (ESP_INTR_SATN)) | ||
| 585 | #define ESP_SELECT_WITHOUT_ATN_IRQ(esp) ((esp)->intreg & (ESP_INTR_S)) | ||
| 586 | #define ESP_SELECTION_IRQ(esp) ((ESP_SELECT_WITH_ATN_IRQ(esp)) || \ | ||
| 587 | (ESP_SELECT_WITHOUT_ATN_IRQ(esp))) | ||
| 588 | #define ESP_RESELECTION_IRQ(esp) ((esp)->intreg & (ESP_INTR_RSEL)) | ||
| 589 | |||
| 590 | /* ESP sequence step register read-only */ | ||
| 591 | #define ESP_STEP_VBITS 0x07 /* Valid bits */ | ||
| 592 | #define ESP_STEP_ASEL 0x00 /* Selection&Arbitrate cmplt */ | ||
| 593 | #define ESP_STEP_SID 0x01 /* One msg byte sent */ | ||
| 594 | #define ESP_STEP_NCMD 0x02 /* Was not in command phase */ | ||
| 595 | #define ESP_STEP_PPC 0x03 /* Early phase chg caused cmnd | ||
| 596 | * bytes to be lost | ||
| 597 | */ | ||
| 598 | #define ESP_STEP_FINI4 0x04 /* Command was sent ok */ | ||
| 599 | |||
| 600 | /* Ho hum, some ESP's set the step register to this as well... */ | ||
| 601 | #define ESP_STEP_FINI5 0x05 | ||
| 602 | #define ESP_STEP_FINI6 0x06 | ||
| 603 | #define ESP_STEP_FINI7 0x07 | ||
| 604 | #define ESP_STEP_SOM 0x08 /* Synchronous Offset Max */ | ||
| 605 | |||
| 606 | /* ESP chip-test register read-write */ | ||
| 607 | #define ESP_TEST_TARG 0x01 /* Target test mode */ | ||
| 608 | #define ESP_TEST_INI 0x02 /* Initiator test mode */ | ||
| 609 | #define ESP_TEST_TS 0x04 /* Tristate test mode */ | ||
| 610 | |||
| 611 | /* ESP unique ID register read-only, found on fas236+fas100a+fsc only */ | ||
| 612 | #define ESP_UID_F100A 0x00 /* FAS100A */ | ||
| 613 | #define ESP_UID_F236 0x02 /* FAS236 */ | ||
| 614 | #define ESP_UID_FSC 0xa2 /* NCR53CF9x-2 */ | ||
| 615 | #define ESP_UID_REV 0x07 /* ESP revision */ | ||
| 616 | #define ESP_UID_FAM 0xf8 /* ESP family */ | ||
| 617 | |||
| 618 | /* ESP fifo flags register read-only */ | ||
| 619 | /* Note that the following implies a 16 byte FIFO on the ESP. */ | ||
| 620 | #define ESP_FF_FBYTES 0x1f /* Num bytes in FIFO */ | ||
| 621 | #define ESP_FF_ONOTZERO 0x20 /* offset ctr not zero (esp100,fsc) */ | ||
| 622 | #define ESP_FF_SSTEP 0xe0 /* Sequence step */ | ||
| 623 | |||
| 624 | /* ESP clock conversion factor register write-only */ | ||
| 625 | #define ESP_CCF_F0 0x00 /* 35.01MHz - 40MHz */ | ||
| 626 | #define ESP_CCF_NEVER 0x01 /* Set it to this and die */ | ||
| 627 | #define ESP_CCF_F2 0x02 /* 10MHz */ | ||
| 628 | #define ESP_CCF_F3 0x03 /* 10.01MHz - 15MHz */ | ||
| 629 | #define ESP_CCF_F4 0x04 /* 15.01MHz - 20MHz */ | ||
| 630 | #define ESP_CCF_F5 0x05 /* 20.01MHz - 25MHz */ | ||
| 631 | #define ESP_CCF_F6 0x06 /* 25.01MHz - 30MHz */ | ||
| 632 | #define ESP_CCF_F7 0x07 /* 30.01MHz - 35MHz */ | ||
| 633 | |||
| 634 | #define ESP_BUS_TIMEOUT 275 /* In milli-seconds */ | ||
| 635 | #define ESP_TIMEO_CONST 8192 | ||
| 636 | #define FSC_TIMEO_CONST 7668 | ||
| 637 | #define ESP_NEG_DEFP(mhz, cfact) \ | ||
| 638 | ((ESP_BUS_TIMEOUT * ((mhz) / 1000)) / (8192 * (cfact))) | ||
| 639 | #define FSC_NEG_DEFP(mhz, cfact) \ | ||
| 640 | ((ESP_BUS_TIMEOUT * ((mhz) / 1000)) / (7668 * (cfact))) | ||
| 641 | #define ESP_MHZ_TO_CYCLE(mhertz) ((1000000000) / ((mhertz) / 1000)) | ||
| 642 | #define ESP_TICK(ccf, cycle) ((7682 * (ccf) * (cycle) / 1000)) | ||
| 643 | |||
| 644 | |||
| 645 | /* UGLY, UGLY, UGLY! */ | ||
| 646 | extern int nesps, esps_in_use, esps_running; | ||
| 647 | |||
| 648 | /* For our interrupt engine. */ | ||
| 649 | #define for_each_esp(esp) \ | ||
| 650 | for((esp) = espchain; (esp); (esp) = (esp)->next) | ||
| 651 | |||
| 652 | |||
| 653 | /* External functions */ | ||
| 654 | extern void esp_bootup_reset(struct NCR_ESP *esp, struct ESP_regs *eregs); | ||
| 655 | extern struct NCR_ESP *esp_allocate(struct scsi_host_template *, void *, int); | ||
| 656 | extern void esp_deallocate(struct NCR_ESP *); | ||
| 657 | extern void esp_release(void); | ||
| 658 | extern void esp_initialize(struct NCR_ESP *); | ||
| 659 | extern irqreturn_t esp_intr(int, void *); | ||
| 660 | extern const char *esp_info(struct Scsi_Host *); | ||
| 661 | extern int esp_queue(Scsi_Cmnd *, void (*done)(Scsi_Cmnd *)); | ||
| 662 | extern int esp_abort(Scsi_Cmnd *); | ||
| 663 | extern int esp_reset(Scsi_Cmnd *); | ||
| 664 | extern int esp_proc_info(struct Scsi_Host *shost, char *buffer, char **start, off_t offset, int length, | ||
| 665 | int inout); | ||
| 666 | extern int esp_slave_alloc(struct scsi_device *); | ||
| 667 | extern void esp_slave_destroy(struct scsi_device *); | ||
| 668 | #endif /* !(NCR53C9X_H) */ | ||
diff --git a/drivers/scsi/aacraid/aachba.c b/drivers/scsi/aacraid/aachba.c index d7235f42cf5f..bfd0e64964ac 100644 --- a/drivers/scsi/aacraid/aachba.c +++ b/drivers/scsi/aacraid/aachba.c | |||
| @@ -859,44 +859,31 @@ static int setinqserial(struct aac_dev *dev, void *data, int cid) | |||
| 859 | le32_to_cpu(dev->adapter_info.serial[0]), cid); | 859 | le32_to_cpu(dev->adapter_info.serial[0]), cid); |
| 860 | } | 860 | } |
| 861 | 861 | ||
| 862 | static void set_sense(u8 *sense_buf, u8 sense_key, u8 sense_code, | 862 | static inline void set_sense(struct sense_data *sense_data, u8 sense_key, |
| 863 | u8 a_sense_code, u8 incorrect_length, | 863 | u8 sense_code, u8 a_sense_code, u8 bit_pointer, u16 field_pointer) |
| 864 | u8 bit_pointer, u16 field_pointer, | ||
| 865 | u32 residue) | ||
| 866 | { | 864 | { |
| 867 | sense_buf[0] = 0xF0; /* Sense data valid, err code 70h (current error) */ | 865 | u8 *sense_buf = (u8 *)sense_data; |
| 866 | /* Sense data valid, err code 70h */ | ||
| 867 | sense_buf[0] = 0x70; /* No info field */ | ||
| 868 | sense_buf[1] = 0; /* Segment number, always zero */ | 868 | sense_buf[1] = 0; /* Segment number, always zero */ |
| 869 | 869 | ||
| 870 | if (incorrect_length) { | 870 | sense_buf[2] = sense_key; /* Sense key */ |
| 871 | sense_buf[2] = sense_key | 0x20;/* Set ILI bit | sense key */ | ||
| 872 | sense_buf[3] = BYTE3(residue); | ||
| 873 | sense_buf[4] = BYTE2(residue); | ||
| 874 | sense_buf[5] = BYTE1(residue); | ||
| 875 | sense_buf[6] = BYTE0(residue); | ||
| 876 | } else | ||
| 877 | sense_buf[2] = sense_key; /* Sense key */ | ||
| 878 | |||
| 879 | if (sense_key == ILLEGAL_REQUEST) | ||
| 880 | sense_buf[7] = 10; /* Additional sense length */ | ||
| 881 | else | ||
| 882 | sense_buf[7] = 6; /* Additional sense length */ | ||
| 883 | 871 | ||
| 884 | sense_buf[12] = sense_code; /* Additional sense code */ | 872 | sense_buf[12] = sense_code; /* Additional sense code */ |
| 885 | sense_buf[13] = a_sense_code; /* Additional sense code qualifier */ | 873 | sense_buf[13] = a_sense_code; /* Additional sense code qualifier */ |
| 874 | |||
| 886 | if (sense_key == ILLEGAL_REQUEST) { | 875 | if (sense_key == ILLEGAL_REQUEST) { |
| 887 | sense_buf[15] = 0; | 876 | sense_buf[7] = 10; /* Additional sense length */ |
| 888 | 877 | ||
| 889 | if (sense_code == SENCODE_INVALID_PARAM_FIELD) | 878 | sense_buf[15] = bit_pointer; |
| 890 | sense_buf[15] = 0x80;/* Std sense key specific field */ | ||
| 891 | /* Illegal parameter is in the parameter block */ | 879 | /* Illegal parameter is in the parameter block */ |
| 892 | |||
| 893 | if (sense_code == SENCODE_INVALID_CDB_FIELD) | 880 | if (sense_code == SENCODE_INVALID_CDB_FIELD) |
| 894 | sense_buf[15] = 0xc0;/* Std sense key specific field */ | 881 | sense_buf[15] |= 0xc0;/* Std sense key specific field */ |
| 895 | /* Illegal parameter is in the CDB block */ | 882 | /* Illegal parameter is in the CDB block */ |
| 896 | sense_buf[15] |= bit_pointer; | ||
| 897 | sense_buf[16] = field_pointer >> 8; /* MSB */ | 883 | sense_buf[16] = field_pointer >> 8; /* MSB */ |
| 898 | sense_buf[17] = field_pointer; /* LSB */ | 884 | sense_buf[17] = field_pointer; /* LSB */ |
| 899 | } | 885 | } else |
| 886 | sense_buf[7] = 6; /* Additional sense length */ | ||
| 900 | } | 887 | } |
| 901 | 888 | ||
| 902 | static int aac_bounds_32(struct aac_dev * dev, struct scsi_cmnd * cmd, u64 lba) | 889 | static int aac_bounds_32(struct aac_dev * dev, struct scsi_cmnd * cmd, u64 lba) |
| @@ -906,11 +893,9 @@ static int aac_bounds_32(struct aac_dev * dev, struct scsi_cmnd * cmd, u64 lba) | |||
| 906 | dprintk((KERN_DEBUG "aacraid: Illegal lba\n")); | 893 | dprintk((KERN_DEBUG "aacraid: Illegal lba\n")); |
| 907 | cmd->result = DID_OK << 16 | COMMAND_COMPLETE << 8 | | 894 | cmd->result = DID_OK << 16 | COMMAND_COMPLETE << 8 | |
| 908 | SAM_STAT_CHECK_CONDITION; | 895 | SAM_STAT_CHECK_CONDITION; |
| 909 | set_sense((u8 *) &dev->fsa_dev[cid].sense_data, | 896 | set_sense(&dev->fsa_dev[cid].sense_data, |
| 910 | HARDWARE_ERROR, | 897 | HARDWARE_ERROR, SENCODE_INTERNAL_TARGET_FAILURE, |
| 911 | SENCODE_INTERNAL_TARGET_FAILURE, | 898 | ASENCODE_INTERNAL_TARGET_FAILURE, 0, 0); |
| 912 | ASENCODE_INTERNAL_TARGET_FAILURE, 0, 0, | ||
| 913 | 0, 0); | ||
| 914 | memcpy(cmd->sense_buffer, &dev->fsa_dev[cid].sense_data, | 899 | memcpy(cmd->sense_buffer, &dev->fsa_dev[cid].sense_data, |
| 915 | min_t(size_t, sizeof(dev->fsa_dev[cid].sense_data), | 900 | min_t(size_t, sizeof(dev->fsa_dev[cid].sense_data), |
| 916 | SCSI_SENSE_BUFFERSIZE)); | 901 | SCSI_SENSE_BUFFERSIZE)); |
| @@ -1520,11 +1505,9 @@ static void io_callback(void *context, struct fib * fibptr) | |||
| 1520 | le32_to_cpu(readreply->status)); | 1505 | le32_to_cpu(readreply->status)); |
| 1521 | #endif | 1506 | #endif |
| 1522 | scsicmd->result = DID_OK << 16 | COMMAND_COMPLETE << 8 | SAM_STAT_CHECK_CONDITION; | 1507 | scsicmd->result = DID_OK << 16 | COMMAND_COMPLETE << 8 | SAM_STAT_CHECK_CONDITION; |
| 1523 | set_sense((u8 *) &dev->fsa_dev[cid].sense_data, | 1508 | set_sense(&dev->fsa_dev[cid].sense_data, |
| 1524 | HARDWARE_ERROR, | 1509 | HARDWARE_ERROR, SENCODE_INTERNAL_TARGET_FAILURE, |
| 1525 | SENCODE_INTERNAL_TARGET_FAILURE, | 1510 | ASENCODE_INTERNAL_TARGET_FAILURE, 0, 0); |
| 1526 | ASENCODE_INTERNAL_TARGET_FAILURE, 0, 0, | ||
| 1527 | 0, 0); | ||
| 1528 | memcpy(scsicmd->sense_buffer, &dev->fsa_dev[cid].sense_data, | 1511 | memcpy(scsicmd->sense_buffer, &dev->fsa_dev[cid].sense_data, |
| 1529 | min_t(size_t, sizeof(dev->fsa_dev[cid].sense_data), | 1512 | min_t(size_t, sizeof(dev->fsa_dev[cid].sense_data), |
| 1530 | SCSI_SENSE_BUFFERSIZE)); | 1513 | SCSI_SENSE_BUFFERSIZE)); |
| @@ -1733,11 +1716,9 @@ static void synchronize_callback(void *context, struct fib *fibptr) | |||
| 1733 | le32_to_cpu(synchronizereply->status)); | 1716 | le32_to_cpu(synchronizereply->status)); |
| 1734 | cmd->result = DID_OK << 16 | | 1717 | cmd->result = DID_OK << 16 | |
| 1735 | COMMAND_COMPLETE << 8 | SAM_STAT_CHECK_CONDITION; | 1718 | COMMAND_COMPLETE << 8 | SAM_STAT_CHECK_CONDITION; |
| 1736 | set_sense((u8 *)&dev->fsa_dev[cid].sense_data, | 1719 | set_sense(&dev->fsa_dev[cid].sense_data, |
| 1737 | HARDWARE_ERROR, | 1720 | HARDWARE_ERROR, SENCODE_INTERNAL_TARGET_FAILURE, |
| 1738 | SENCODE_INTERNAL_TARGET_FAILURE, | 1721 | ASENCODE_INTERNAL_TARGET_FAILURE, 0, 0); |
| 1739 | ASENCODE_INTERNAL_TARGET_FAILURE, 0, 0, | ||
| 1740 | 0, 0); | ||
| 1741 | memcpy(cmd->sense_buffer, &dev->fsa_dev[cid].sense_data, | 1722 | memcpy(cmd->sense_buffer, &dev->fsa_dev[cid].sense_data, |
| 1742 | min_t(size_t, sizeof(dev->fsa_dev[cid].sense_data), | 1723 | min_t(size_t, sizeof(dev->fsa_dev[cid].sense_data), |
| 1743 | SCSI_SENSE_BUFFERSIZE)); | 1724 | SCSI_SENSE_BUFFERSIZE)); |
| @@ -1945,10 +1926,9 @@ int aac_scsi_cmd(struct scsi_cmnd * scsicmd) | |||
| 1945 | { | 1926 | { |
| 1946 | dprintk((KERN_WARNING "Only INQUIRY & TUR command supported for controller, rcvd = 0x%x.\n", scsicmd->cmnd[0])); | 1927 | dprintk((KERN_WARNING "Only INQUIRY & TUR command supported for controller, rcvd = 0x%x.\n", scsicmd->cmnd[0])); |
| 1947 | scsicmd->result = DID_OK << 16 | COMMAND_COMPLETE << 8 | SAM_STAT_CHECK_CONDITION; | 1928 | scsicmd->result = DID_OK << 16 | COMMAND_COMPLETE << 8 | SAM_STAT_CHECK_CONDITION; |
| 1948 | set_sense((u8 *) &dev->fsa_dev[cid].sense_data, | 1929 | set_sense(&dev->fsa_dev[cid].sense_data, |
| 1949 | ILLEGAL_REQUEST, | 1930 | ILLEGAL_REQUEST, SENCODE_INVALID_COMMAND, |
| 1950 | SENCODE_INVALID_COMMAND, | 1931 | ASENCODE_INVALID_COMMAND, 0, 0); |
| 1951 | ASENCODE_INVALID_COMMAND, 0, 0, 0, 0); | ||
| 1952 | memcpy(scsicmd->sense_buffer, &dev->fsa_dev[cid].sense_data, | 1932 | memcpy(scsicmd->sense_buffer, &dev->fsa_dev[cid].sense_data, |
| 1953 | min_t(size_t, sizeof(dev->fsa_dev[cid].sense_data), | 1933 | min_t(size_t, sizeof(dev->fsa_dev[cid].sense_data), |
| 1954 | SCSI_SENSE_BUFFERSIZE)); | 1934 | SCSI_SENSE_BUFFERSIZE)); |
| @@ -1995,10 +1975,9 @@ int aac_scsi_cmd(struct scsi_cmnd * scsicmd) | |||
| 1995 | scsicmd->result = DID_OK << 16 | | 1975 | scsicmd->result = DID_OK << 16 | |
| 1996 | COMMAND_COMPLETE << 8 | | 1976 | COMMAND_COMPLETE << 8 | |
| 1997 | SAM_STAT_CHECK_CONDITION; | 1977 | SAM_STAT_CHECK_CONDITION; |
| 1998 | set_sense((u8 *) &dev->fsa_dev[cid].sense_data, | 1978 | set_sense(&dev->fsa_dev[cid].sense_data, |
| 1999 | ILLEGAL_REQUEST, | 1979 | ILLEGAL_REQUEST, SENCODE_INVALID_CDB_FIELD, |
| 2000 | SENCODE_INVALID_CDB_FIELD, | 1980 | ASENCODE_NO_SENSE, 7, 2); |
| 2001 | ASENCODE_NO_SENSE, 0, 7, 2, 0); | ||
| 2002 | memcpy(scsicmd->sense_buffer, | 1981 | memcpy(scsicmd->sense_buffer, |
| 2003 | &dev->fsa_dev[cid].sense_data, | 1982 | &dev->fsa_dev[cid].sense_data, |
| 2004 | min_t(size_t, | 1983 | min_t(size_t, |
| @@ -2254,9 +2233,9 @@ int aac_scsi_cmd(struct scsi_cmnd * scsicmd) | |||
| 2254 | */ | 2233 | */ |
| 2255 | dprintk((KERN_WARNING "Unhandled SCSI Command: 0x%x.\n", scsicmd->cmnd[0])); | 2234 | dprintk((KERN_WARNING "Unhandled SCSI Command: 0x%x.\n", scsicmd->cmnd[0])); |
| 2256 | scsicmd->result = DID_OK << 16 | COMMAND_COMPLETE << 8 | SAM_STAT_CHECK_CONDITION; | 2235 | scsicmd->result = DID_OK << 16 | COMMAND_COMPLETE << 8 | SAM_STAT_CHECK_CONDITION; |
| 2257 | set_sense((u8 *) &dev->fsa_dev[cid].sense_data, | 2236 | set_sense(&dev->fsa_dev[cid].sense_data, |
| 2258 | ILLEGAL_REQUEST, SENCODE_INVALID_COMMAND, | 2237 | ILLEGAL_REQUEST, SENCODE_INVALID_COMMAND, |
| 2259 | ASENCODE_INVALID_COMMAND, 0, 0, 0, 0); | 2238 | ASENCODE_INVALID_COMMAND, 0, 0); |
| 2260 | memcpy(scsicmd->sense_buffer, &dev->fsa_dev[cid].sense_data, | 2239 | memcpy(scsicmd->sense_buffer, &dev->fsa_dev[cid].sense_data, |
| 2261 | min_t(size_t, | 2240 | min_t(size_t, |
| 2262 | sizeof(dev->fsa_dev[cid].sense_data), | 2241 | sizeof(dev->fsa_dev[cid].sense_data), |
diff --git a/drivers/scsi/aacraid/commctrl.c b/drivers/scsi/aacraid/commctrl.c index f8afa358b6b6..abef05146d75 100644 --- a/drivers/scsi/aacraid/commctrl.c +++ b/drivers/scsi/aacraid/commctrl.c | |||
| @@ -243,6 +243,7 @@ static int next_getadapter_fib(struct aac_dev * dev, void __user *arg) | |||
| 243 | * Search the list of AdapterFibContext addresses on the adapter | 243 | * Search the list of AdapterFibContext addresses on the adapter |
| 244 | * to be sure this is a valid address | 244 | * to be sure this is a valid address |
| 245 | */ | 245 | */ |
| 246 | spin_lock_irqsave(&dev->fib_lock, flags); | ||
| 246 | entry = dev->fib_list.next; | 247 | entry = dev->fib_list.next; |
| 247 | fibctx = NULL; | 248 | fibctx = NULL; |
| 248 | 249 | ||
| @@ -251,24 +252,25 @@ static int next_getadapter_fib(struct aac_dev * dev, void __user *arg) | |||
| 251 | /* | 252 | /* |
| 252 | * Extract the AdapterFibContext from the Input parameters. | 253 | * Extract the AdapterFibContext from the Input parameters. |
| 253 | */ | 254 | */ |
| 254 | if (fibctx->unique == f.fibctx) { /* We found a winner */ | 255 | if (fibctx->unique == f.fibctx) { /* We found a winner */ |
| 255 | break; | 256 | break; |
| 256 | } | 257 | } |
| 257 | entry = entry->next; | 258 | entry = entry->next; |
| 258 | fibctx = NULL; | 259 | fibctx = NULL; |
| 259 | } | 260 | } |
| 260 | if (!fibctx) { | 261 | if (!fibctx) { |
| 262 | spin_unlock_irqrestore(&dev->fib_lock, flags); | ||
| 261 | dprintk ((KERN_INFO "Fib Context not found\n")); | 263 | dprintk ((KERN_INFO "Fib Context not found\n")); |
| 262 | return -EINVAL; | 264 | return -EINVAL; |
| 263 | } | 265 | } |
| 264 | 266 | ||
| 265 | if((fibctx->type != FSAFS_NTC_GET_ADAPTER_FIB_CONTEXT) || | 267 | if((fibctx->type != FSAFS_NTC_GET_ADAPTER_FIB_CONTEXT) || |
| 266 | (fibctx->size != sizeof(struct aac_fib_context))) { | 268 | (fibctx->size != sizeof(struct aac_fib_context))) { |
| 269 | spin_unlock_irqrestore(&dev->fib_lock, flags); | ||
| 267 | dprintk ((KERN_INFO "Fib Context corrupt?\n")); | 270 | dprintk ((KERN_INFO "Fib Context corrupt?\n")); |
| 268 | return -EINVAL; | 271 | return -EINVAL; |
| 269 | } | 272 | } |
| 270 | status = 0; | 273 | status = 0; |
| 271 | spin_lock_irqsave(&dev->fib_lock, flags); | ||
| 272 | /* | 274 | /* |
| 273 | * If there are no fibs to send back, then either wait or return | 275 | * If there are no fibs to send back, then either wait or return |
| 274 | * -EAGAIN | 276 | * -EAGAIN |
| @@ -414,8 +416,8 @@ static int close_getadapter_fib(struct aac_dev * dev, void __user *arg) | |||
| 414 | * @arg: ioctl arguments | 416 | * @arg: ioctl arguments |
| 415 | * | 417 | * |
| 416 | * This routine returns the driver version. | 418 | * This routine returns the driver version. |
| 417 | * Under Linux, there have been no version incompatibilities, so this is | 419 | * Under Linux, there have been no version incompatibilities, so this is |
| 418 | * simple! | 420 | * simple! |
| 419 | */ | 421 | */ |
| 420 | 422 | ||
| 421 | static int check_revision(struct aac_dev *dev, void __user *arg) | 423 | static int check_revision(struct aac_dev *dev, void __user *arg) |
| @@ -463,7 +465,7 @@ static int aac_send_raw_srb(struct aac_dev* dev, void __user * arg) | |||
| 463 | u32 data_dir; | 465 | u32 data_dir; |
| 464 | void __user *sg_user[32]; | 466 | void __user *sg_user[32]; |
| 465 | void *sg_list[32]; | 467 | void *sg_list[32]; |
| 466 | u32 sg_indx = 0; | 468 | u32 sg_indx = 0; |
| 467 | u32 byte_count = 0; | 469 | u32 byte_count = 0; |
| 468 | u32 actual_fibsize64, actual_fibsize = 0; | 470 | u32 actual_fibsize64, actual_fibsize = 0; |
| 469 | int i; | 471 | int i; |
| @@ -517,11 +519,11 @@ static int aac_send_raw_srb(struct aac_dev* dev, void __user * arg) | |||
| 517 | // Fix up srb for endian and force some values | 519 | // Fix up srb for endian and force some values |
| 518 | 520 | ||
| 519 | srbcmd->function = cpu_to_le32(SRBF_ExecuteScsi); // Force this | 521 | srbcmd->function = cpu_to_le32(SRBF_ExecuteScsi); // Force this |
| 520 | srbcmd->channel = cpu_to_le32(user_srbcmd->channel); | 522 | srbcmd->channel = cpu_to_le32(user_srbcmd->channel); |
| 521 | srbcmd->id = cpu_to_le32(user_srbcmd->id); | 523 | srbcmd->id = cpu_to_le32(user_srbcmd->id); |
| 522 | srbcmd->lun = cpu_to_le32(user_srbcmd->lun); | 524 | srbcmd->lun = cpu_to_le32(user_srbcmd->lun); |
| 523 | srbcmd->timeout = cpu_to_le32(user_srbcmd->timeout); | 525 | srbcmd->timeout = cpu_to_le32(user_srbcmd->timeout); |
| 524 | srbcmd->flags = cpu_to_le32(flags); | 526 | srbcmd->flags = cpu_to_le32(flags); |
| 525 | srbcmd->retry_limit = 0; // Obsolete parameter | 527 | srbcmd->retry_limit = 0; // Obsolete parameter |
| 526 | srbcmd->cdb_size = cpu_to_le32(user_srbcmd->cdb_size); | 528 | srbcmd->cdb_size = cpu_to_le32(user_srbcmd->cdb_size); |
| 527 | memcpy(srbcmd->cdb, user_srbcmd->cdb, sizeof(srbcmd->cdb)); | 529 | memcpy(srbcmd->cdb, user_srbcmd->cdb, sizeof(srbcmd->cdb)); |
| @@ -786,9 +788,9 @@ static int aac_get_pci_info(struct aac_dev* dev, void __user *arg) | |||
| 786 | pci_info.bus = dev->pdev->bus->number; | 788 | pci_info.bus = dev->pdev->bus->number; |
| 787 | pci_info.slot = PCI_SLOT(dev->pdev->devfn); | 789 | pci_info.slot = PCI_SLOT(dev->pdev->devfn); |
| 788 | 790 | ||
| 789 | if (copy_to_user(arg, &pci_info, sizeof(struct aac_pci_info))) { | 791 | if (copy_to_user(arg, &pci_info, sizeof(struct aac_pci_info))) { |
| 790 | dprintk((KERN_DEBUG "aacraid: Could not copy pci info\n")); | 792 | dprintk((KERN_DEBUG "aacraid: Could not copy pci info\n")); |
| 791 | return -EFAULT; | 793 | return -EFAULT; |
| 792 | } | 794 | } |
| 793 | return 0; | 795 | return 0; |
| 794 | } | 796 | } |
diff --git a/drivers/scsi/aacraid/linit.c b/drivers/scsi/aacraid/linit.c index fb0886140dd7..e80d2a0c46af 100644 --- a/drivers/scsi/aacraid/linit.c +++ b/drivers/scsi/aacraid/linit.c | |||
| @@ -1130,31 +1130,29 @@ static int __devinit aac_probe_one(struct pci_dev *pdev, | |||
| 1130 | if (error < 0) | 1130 | if (error < 0) |
| 1131 | goto out_deinit; | 1131 | goto out_deinit; |
| 1132 | 1132 | ||
| 1133 | if (!(aac->adapter_info.options & AAC_OPT_NEW_COMM)) { | ||
| 1134 | error = pci_set_dma_max_seg_size(pdev, 65536); | ||
| 1135 | if (error) | ||
| 1136 | goto out_deinit; | ||
| 1137 | } | ||
| 1138 | |||
| 1139 | /* | 1133 | /* |
| 1140 | * Lets override negotiations and drop the maximum SG limit to 34 | 1134 | * Lets override negotiations and drop the maximum SG limit to 34 |
| 1141 | */ | 1135 | */ |
| 1142 | if ((aac_drivers[index].quirks & AAC_QUIRK_34SG) && | 1136 | if ((aac_drivers[index].quirks & AAC_QUIRK_34SG) && |
| 1143 | (aac->scsi_host_ptr->sg_tablesize > 34)) { | 1137 | (shost->sg_tablesize > 34)) { |
| 1144 | aac->scsi_host_ptr->sg_tablesize = 34; | 1138 | shost->sg_tablesize = 34; |
| 1145 | aac->scsi_host_ptr->max_sectors | 1139 | shost->max_sectors = (shost->sg_tablesize * 8) + 112; |
| 1146 | = (aac->scsi_host_ptr->sg_tablesize * 8) + 112; | ||
| 1147 | } | 1140 | } |
| 1148 | 1141 | ||
| 1149 | if ((aac_drivers[index].quirks & AAC_QUIRK_17SG) && | 1142 | if ((aac_drivers[index].quirks & AAC_QUIRK_17SG) && |
| 1150 | (aac->scsi_host_ptr->sg_tablesize > 17)) { | 1143 | (shost->sg_tablesize > 17)) { |
| 1151 | aac->scsi_host_ptr->sg_tablesize = 17; | 1144 | shost->sg_tablesize = 17; |
| 1152 | aac->scsi_host_ptr->max_sectors | 1145 | shost->max_sectors = (shost->sg_tablesize * 8) + 112; |
| 1153 | = (aac->scsi_host_ptr->sg_tablesize * 8) + 112; | ||
| 1154 | } | 1146 | } |
| 1155 | 1147 | ||
| 1148 | error = pci_set_dma_max_seg_size(pdev, | ||
| 1149 | (aac->adapter_info.options & AAC_OPT_NEW_COMM) ? | ||
| 1150 | (shost->max_sectors << 9) : 65536); | ||
| 1151 | if (error) | ||
| 1152 | goto out_deinit; | ||
| 1153 | |||
| 1156 | /* | 1154 | /* |
| 1157 | * Firware printf works only with older firmware. | 1155 | * Firmware printf works only with older firmware. |
| 1158 | */ | 1156 | */ |
| 1159 | if (aac_drivers[index].quirks & AAC_QUIRK_34SG) | 1157 | if (aac_drivers[index].quirks & AAC_QUIRK_34SG) |
| 1160 | aac->printf_enabled = 1; | 1158 | aac->printf_enabled = 1; |
diff --git a/drivers/scsi/advansys.c b/drivers/scsi/advansys.c index 374ed025dc5a..ccef891d642f 100644 --- a/drivers/scsi/advansys.c +++ b/drivers/scsi/advansys.c | |||
| @@ -12261,7 +12261,7 @@ static ushort __devinit AdvReadEEPWord(AdvPortAddr iop_base, int eep_word_addr) | |||
| 12261 | /* | 12261 | /* |
| 12262 | * Write the EEPROM from 'cfg_buf'. | 12262 | * Write the EEPROM from 'cfg_buf'. |
| 12263 | */ | 12263 | */ |
| 12264 | void __devinit | 12264 | static void __devinit |
| 12265 | AdvSet3550EEPConfig(AdvPortAddr iop_base, ADVEEP_3550_CONFIG *cfg_buf) | 12265 | AdvSet3550EEPConfig(AdvPortAddr iop_base, ADVEEP_3550_CONFIG *cfg_buf) |
| 12266 | { | 12266 | { |
| 12267 | ushort *wbuf; | 12267 | ushort *wbuf; |
| @@ -12328,7 +12328,7 @@ AdvSet3550EEPConfig(AdvPortAddr iop_base, ADVEEP_3550_CONFIG *cfg_buf) | |||
| 12328 | /* | 12328 | /* |
| 12329 | * Write the EEPROM from 'cfg_buf'. | 12329 | * Write the EEPROM from 'cfg_buf'. |
| 12330 | */ | 12330 | */ |
| 12331 | void __devinit | 12331 | static void __devinit |
| 12332 | AdvSet38C0800EEPConfig(AdvPortAddr iop_base, ADVEEP_38C0800_CONFIG *cfg_buf) | 12332 | AdvSet38C0800EEPConfig(AdvPortAddr iop_base, ADVEEP_38C0800_CONFIG *cfg_buf) |
| 12333 | { | 12333 | { |
| 12334 | ushort *wbuf; | 12334 | ushort *wbuf; |
| @@ -12395,7 +12395,7 @@ AdvSet38C0800EEPConfig(AdvPortAddr iop_base, ADVEEP_38C0800_CONFIG *cfg_buf) | |||
| 12395 | /* | 12395 | /* |
| 12396 | * Write the EEPROM from 'cfg_buf'. | 12396 | * Write the EEPROM from 'cfg_buf'. |
| 12397 | */ | 12397 | */ |
| 12398 | void __devinit | 12398 | static void __devinit |
| 12399 | AdvSet38C1600EEPConfig(AdvPortAddr iop_base, ADVEEP_38C1600_CONFIG *cfg_buf) | 12399 | AdvSet38C1600EEPConfig(AdvPortAddr iop_base, ADVEEP_38C1600_CONFIG *cfg_buf) |
| 12400 | { | 12400 | { |
| 12401 | ushort *wbuf; | 12401 | ushort *wbuf; |
diff --git a/drivers/scsi/arcmsr/arcmsr.h b/drivers/scsi/arcmsr/arcmsr.h index a67e29f83ae5..57786502e3ec 100644 --- a/drivers/scsi/arcmsr/arcmsr.h +++ b/drivers/scsi/arcmsr/arcmsr.h | |||
| @@ -48,7 +48,7 @@ struct class_device_attribute; | |||
| 48 | /*The limit of outstanding scsi command that firmware can handle*/ | 48 | /*The limit of outstanding scsi command that firmware can handle*/ |
| 49 | #define ARCMSR_MAX_OUTSTANDING_CMD 256 | 49 | #define ARCMSR_MAX_OUTSTANDING_CMD 256 |
| 50 | #define ARCMSR_MAX_FREECCB_NUM 320 | 50 | #define ARCMSR_MAX_FREECCB_NUM 320 |
| 51 | #define ARCMSR_DRIVER_VERSION "Driver Version 1.20.00.15 2007/08/30" | 51 | #define ARCMSR_DRIVER_VERSION "Driver Version 1.20.00.15 2007/12/24" |
| 52 | #define ARCMSR_SCSI_INITIATOR_ID 255 | 52 | #define ARCMSR_SCSI_INITIATOR_ID 255 |
| 53 | #define ARCMSR_MAX_XFER_SECTORS 512 | 53 | #define ARCMSR_MAX_XFER_SECTORS 512 |
| 54 | #define ARCMSR_MAX_XFER_SECTORS_B 4096 | 54 | #define ARCMSR_MAX_XFER_SECTORS_B 4096 |
| @@ -248,6 +248,7 @@ struct FIRMWARE_INFO | |||
| 248 | #define ARCMSR_MESSAGE_START_BGRB 0x00060008 | 248 | #define ARCMSR_MESSAGE_START_BGRB 0x00060008 |
| 249 | #define ARCMSR_MESSAGE_START_DRIVER_MODE 0x000E0008 | 249 | #define ARCMSR_MESSAGE_START_DRIVER_MODE 0x000E0008 |
| 250 | #define ARCMSR_MESSAGE_SET_POST_WINDOW 0x000F0008 | 250 | #define ARCMSR_MESSAGE_SET_POST_WINDOW 0x000F0008 |
| 251 | #define ARCMSR_MESSAGE_ACTIVE_EOI_MODE 0x00100008 | ||
| 251 | /* ARCMSR_OUTBOUND_MESG1_FIRMWARE_OK */ | 252 | /* ARCMSR_OUTBOUND_MESG1_FIRMWARE_OK */ |
| 252 | #define ARCMSR_MESSAGE_FIRMWARE_OK 0x80000000 | 253 | #define ARCMSR_MESSAGE_FIRMWARE_OK 0x80000000 |
| 253 | /* ioctl transfer */ | 254 | /* ioctl transfer */ |
| @@ -256,6 +257,7 @@ struct FIRMWARE_INFO | |||
| 256 | #define ARCMSR_DRV2IOP_DATA_READ_OK 0x00000002 | 257 | #define ARCMSR_DRV2IOP_DATA_READ_OK 0x00000002 |
| 257 | #define ARCMSR_DRV2IOP_CDB_POSTED 0x00000004 | 258 | #define ARCMSR_DRV2IOP_CDB_POSTED 0x00000004 |
| 258 | #define ARCMSR_DRV2IOP_MESSAGE_CMD_POSTED 0x00000008 | 259 | #define ARCMSR_DRV2IOP_MESSAGE_CMD_POSTED 0x00000008 |
| 260 | #define ARCMSR_DRV2IOP_END_OF_INTERRUPT 0x00000010 | ||
| 259 | 261 | ||
| 260 | /* data tunnel buffer between user space program and its firmware */ | 262 | /* data tunnel buffer between user space program and its firmware */ |
| 261 | /* user space data to iop 128bytes */ | 263 | /* user space data to iop 128bytes */ |
diff --git a/drivers/scsi/arcmsr/arcmsr_hba.c b/drivers/scsi/arcmsr/arcmsr_hba.c index f4a202e8df26..4f9ff32cfed0 100644 --- a/drivers/scsi/arcmsr/arcmsr_hba.c +++ b/drivers/scsi/arcmsr/arcmsr_hba.c | |||
| @@ -315,9 +315,6 @@ static int arcmsr_alloc_ccb_pool(struct AdapterControlBlock *acb) | |||
| 315 | (0x20 - ((unsigned long)dma_coherent_handle & 0x1F)); | 315 | (0x20 - ((unsigned long)dma_coherent_handle & 0x1F)); |
| 316 | } | 316 | } |
| 317 | 317 | ||
| 318 | reg = (struct MessageUnit_B *)(dma_coherent + | ||
| 319 | ARCMSR_MAX_FREECCB_NUM * sizeof(struct CommandControlBlock)); | ||
| 320 | |||
| 321 | dma_addr = dma_coherent_handle; | 318 | dma_addr = dma_coherent_handle; |
| 322 | ccb_tmp = (struct CommandControlBlock *)dma_coherent; | 319 | ccb_tmp = (struct CommandControlBlock *)dma_coherent; |
| 323 | for (i = 0; i < ARCMSR_MAX_FREECCB_NUM; i++) { | 320 | for (i = 0; i < ARCMSR_MAX_FREECCB_NUM; i++) { |
| @@ -371,8 +368,8 @@ static int arcmsr_alloc_ccb_pool(struct AdapterControlBlock *acb) | |||
| 371 | 368 | ||
| 372 | out: | 369 | out: |
| 373 | dma_free_coherent(&acb->pdev->dev, | 370 | dma_free_coherent(&acb->pdev->dev, |
| 374 | ARCMSR_MAX_FREECCB_NUM * sizeof(struct CommandControlBlock) + 0x20, | 371 | (ARCMSR_MAX_FREECCB_NUM * sizeof(struct CommandControlBlock) + 0x20 + |
| 375 | acb->dma_coherent, acb->dma_coherent_handle); | 372 | sizeof(struct MessageUnit_B)), acb->dma_coherent, acb->dma_coherent_handle); |
| 376 | return -ENOMEM; | 373 | return -ENOMEM; |
| 377 | } | 374 | } |
| 378 | 375 | ||
| @@ -509,6 +506,7 @@ static uint8_t arcmsr_hbb_wait_msgint_ready(struct AdapterControlBlock *acb) | |||
| 509 | & ARCMSR_IOP2DRV_MESSAGE_CMD_DONE) { | 506 | & ARCMSR_IOP2DRV_MESSAGE_CMD_DONE) { |
| 510 | writel(ARCMSR_MESSAGE_INT_CLEAR_PATTERN | 507 | writel(ARCMSR_MESSAGE_INT_CLEAR_PATTERN |
| 511 | , reg->iop2drv_doorbell_reg); | 508 | , reg->iop2drv_doorbell_reg); |
| 509 | writel(ARCMSR_DRV2IOP_END_OF_INTERRUPT, reg->drv2iop_doorbell_reg); | ||
| 512 | return 0x00; | 510 | return 0x00; |
| 513 | } | 511 | } |
| 514 | msleep(10); | 512 | msleep(10); |
| @@ -748,6 +746,7 @@ static void arcmsr_drain_donequeue(struct AdapterControlBlock *acb, uint32_t fla | |||
| 748 | , ccb->startdone | 746 | , ccb->startdone |
| 749 | , atomic_read(&acb->ccboutstandingcount)); | 747 | , atomic_read(&acb->ccboutstandingcount)); |
| 750 | } | 748 | } |
| 749 | else | ||
| 751 | arcmsr_report_ccb_state(acb, ccb, flag_ccb); | 750 | arcmsr_report_ccb_state(acb, ccb, flag_ccb); |
| 752 | } | 751 | } |
| 753 | 752 | ||
| @@ -886,7 +885,7 @@ static void arcmsr_enable_outbound_ints(struct AdapterControlBlock *acb, \ | |||
| 886 | } | 885 | } |
| 887 | } | 886 | } |
| 888 | 887 | ||
| 889 | static void arcmsr_build_ccb(struct AdapterControlBlock *acb, | 888 | static int arcmsr_build_ccb(struct AdapterControlBlock *acb, |
| 890 | struct CommandControlBlock *ccb, struct scsi_cmnd *pcmd) | 889 | struct CommandControlBlock *ccb, struct scsi_cmnd *pcmd) |
| 891 | { | 890 | { |
| 892 | struct ARCMSR_CDB *arcmsr_cdb = (struct ARCMSR_CDB *)&ccb->arcmsr_cdb; | 891 | struct ARCMSR_CDB *arcmsr_cdb = (struct ARCMSR_CDB *)&ccb->arcmsr_cdb; |
| @@ -906,6 +905,8 @@ static void arcmsr_build_ccb(struct AdapterControlBlock *acb, | |||
| 906 | memcpy(arcmsr_cdb->Cdb, pcmd->cmnd, pcmd->cmd_len); | 905 | memcpy(arcmsr_cdb->Cdb, pcmd->cmnd, pcmd->cmd_len); |
| 907 | 906 | ||
| 908 | nseg = scsi_dma_map(pcmd); | 907 | nseg = scsi_dma_map(pcmd); |
| 908 | if (nseg > ARCMSR_MAX_SG_ENTRIES) | ||
| 909 | return FAILED; | ||
| 909 | BUG_ON(nseg < 0); | 910 | BUG_ON(nseg < 0); |
| 910 | 911 | ||
| 911 | if (nseg) { | 912 | if (nseg) { |
| @@ -946,6 +947,7 @@ static void arcmsr_build_ccb(struct AdapterControlBlock *acb, | |||
| 946 | arcmsr_cdb->Flags |= ARCMSR_CDB_FLAG_WRITE; | 947 | arcmsr_cdb->Flags |= ARCMSR_CDB_FLAG_WRITE; |
| 947 | ccb->ccb_flags |= CCB_FLAG_WRITE; | 948 | ccb->ccb_flags |= CCB_FLAG_WRITE; |
| 948 | } | 949 | } |
| 950 | return SUCCESS; | ||
| 949 | } | 951 | } |
| 950 | 952 | ||
| 951 | static void arcmsr_post_ccb(struct AdapterControlBlock *acb, struct CommandControlBlock *ccb) | 953 | static void arcmsr_post_ccb(struct AdapterControlBlock *acb, struct CommandControlBlock *ccb) |
| @@ -1036,18 +1038,22 @@ static void arcmsr_free_ccb_pool(struct AdapterControlBlock *acb) | |||
| 1036 | switch (acb->adapter_type) { | 1038 | switch (acb->adapter_type) { |
| 1037 | case ACB_ADAPTER_TYPE_A: { | 1039 | case ACB_ADAPTER_TYPE_A: { |
| 1038 | iounmap(acb->pmuA); | 1040 | iounmap(acb->pmuA); |
| 1041 | dma_free_coherent(&acb->pdev->dev, | ||
| 1042 | ARCMSR_MAX_FREECCB_NUM * sizeof (struct CommandControlBlock) + 0x20, | ||
| 1043 | acb->dma_coherent, | ||
| 1044 | acb->dma_coherent_handle); | ||
| 1039 | break; | 1045 | break; |
| 1040 | } | 1046 | } |
| 1041 | case ACB_ADAPTER_TYPE_B: { | 1047 | case ACB_ADAPTER_TYPE_B: { |
| 1042 | struct MessageUnit_B *reg = acb->pmuB; | 1048 | struct MessageUnit_B *reg = acb->pmuB; |
| 1043 | iounmap(reg->drv2iop_doorbell_reg - ARCMSR_DRV2IOP_DOORBELL); | 1049 | iounmap(reg->drv2iop_doorbell_reg - ARCMSR_DRV2IOP_DOORBELL); |
| 1044 | iounmap(reg->ioctl_wbuffer_reg - ARCMSR_IOCTL_WBUFFER); | 1050 | iounmap(reg->ioctl_wbuffer_reg - ARCMSR_IOCTL_WBUFFER); |
| 1051 | dma_free_coherent(&acb->pdev->dev, | ||
| 1052 | (ARCMSR_MAX_FREECCB_NUM * sizeof(struct CommandControlBlock) + 0x20 + | ||
| 1053 | sizeof(struct MessageUnit_B)), acb->dma_coherent, acb->dma_coherent_handle); | ||
| 1045 | } | 1054 | } |
| 1046 | } | 1055 | } |
| 1047 | dma_free_coherent(&acb->pdev->dev, | 1056 | |
| 1048 | ARCMSR_MAX_FREECCB_NUM * sizeof (struct CommandControlBlock) + 0x20, | ||
| 1049 | acb->dma_coherent, | ||
| 1050 | acb->dma_coherent_handle); | ||
| 1051 | } | 1057 | } |
| 1052 | 1058 | ||
| 1053 | void arcmsr_iop_message_read(struct AdapterControlBlock *acb) | 1059 | void arcmsr_iop_message_read(struct AdapterControlBlock *acb) |
| @@ -1273,7 +1279,9 @@ static int arcmsr_handle_hbb_isr(struct AdapterControlBlock *acb) | |||
| 1273 | return 1; | 1279 | return 1; |
| 1274 | 1280 | ||
| 1275 | writel(~outbound_doorbell, reg->iop2drv_doorbell_reg); | 1281 | writel(~outbound_doorbell, reg->iop2drv_doorbell_reg); |
| 1276 | 1282 | /*in case the last action of doorbell interrupt clearance is cached, this action can push HW to write down the clear bit*/ | |
| 1283 | readl(reg->iop2drv_doorbell_reg); | ||
| 1284 | writel(ARCMSR_DRV2IOP_END_OF_INTERRUPT, reg->drv2iop_doorbell_reg); | ||
| 1277 | if (outbound_doorbell & ARCMSR_IOP2DRV_DATA_WRITE_OK) { | 1285 | if (outbound_doorbell & ARCMSR_IOP2DRV_DATA_WRITE_OK) { |
| 1278 | arcmsr_iop2drv_data_wrote_handle(acb); | 1286 | arcmsr_iop2drv_data_wrote_handle(acb); |
| 1279 | } | 1287 | } |
| @@ -1380,12 +1388,13 @@ static int arcmsr_iop_message_xfer(struct AdapterControlBlock *acb, \ | |||
| 1380 | 1388 | ||
| 1381 | case ARCMSR_MESSAGE_READ_RQBUFFER: { | 1389 | case ARCMSR_MESSAGE_READ_RQBUFFER: { |
| 1382 | unsigned long *ver_addr; | 1390 | unsigned long *ver_addr; |
| 1383 | dma_addr_t buf_handle; | ||
| 1384 | uint8_t *pQbuffer, *ptmpQbuffer; | 1391 | uint8_t *pQbuffer, *ptmpQbuffer; |
| 1385 | int32_t allxfer_len = 0; | 1392 | int32_t allxfer_len = 0; |
| 1393 | void *tmp; | ||
| 1386 | 1394 | ||
| 1387 | ver_addr = pci_alloc_consistent(acb->pdev, 1032, &buf_handle); | 1395 | tmp = kmalloc(1032, GFP_KERNEL|GFP_DMA); |
| 1388 | if (!ver_addr) { | 1396 | ver_addr = (unsigned long *)tmp; |
| 1397 | if (!tmp) { | ||
| 1389 | retvalue = ARCMSR_MESSAGE_FAIL; | 1398 | retvalue = ARCMSR_MESSAGE_FAIL; |
| 1390 | goto message_out; | 1399 | goto message_out; |
| 1391 | } | 1400 | } |
| @@ -1421,18 +1430,19 @@ static int arcmsr_iop_message_xfer(struct AdapterControlBlock *acb, \ | |||
| 1421 | memcpy(pcmdmessagefld->messagedatabuffer, (uint8_t *)ver_addr, allxfer_len); | 1430 | memcpy(pcmdmessagefld->messagedatabuffer, (uint8_t *)ver_addr, allxfer_len); |
| 1422 | pcmdmessagefld->cmdmessage.Length = allxfer_len; | 1431 | pcmdmessagefld->cmdmessage.Length = allxfer_len; |
| 1423 | pcmdmessagefld->cmdmessage.ReturnCode = ARCMSR_MESSAGE_RETURNCODE_OK; | 1432 | pcmdmessagefld->cmdmessage.ReturnCode = ARCMSR_MESSAGE_RETURNCODE_OK; |
| 1424 | pci_free_consistent(acb->pdev, 1032, ver_addr, buf_handle); | 1433 | kfree(tmp); |
| 1425 | } | 1434 | } |
| 1426 | break; | 1435 | break; |
| 1427 | 1436 | ||
| 1428 | case ARCMSR_MESSAGE_WRITE_WQBUFFER: { | 1437 | case ARCMSR_MESSAGE_WRITE_WQBUFFER: { |
| 1429 | unsigned long *ver_addr; | 1438 | unsigned long *ver_addr; |
| 1430 | dma_addr_t buf_handle; | ||
| 1431 | int32_t my_empty_len, user_len, wqbuf_firstindex, wqbuf_lastindex; | 1439 | int32_t my_empty_len, user_len, wqbuf_firstindex, wqbuf_lastindex; |
| 1432 | uint8_t *pQbuffer, *ptmpuserbuffer; | 1440 | uint8_t *pQbuffer, *ptmpuserbuffer; |
| 1441 | void *tmp; | ||
| 1433 | 1442 | ||
| 1434 | ver_addr = pci_alloc_consistent(acb->pdev, 1032, &buf_handle); | 1443 | tmp = kmalloc(1032, GFP_KERNEL|GFP_DMA); |
| 1435 | if (!ver_addr) { | 1444 | ver_addr = (unsigned long *)tmp; |
| 1445 | if (!tmp) { | ||
| 1436 | retvalue = ARCMSR_MESSAGE_FAIL; | 1446 | retvalue = ARCMSR_MESSAGE_FAIL; |
| 1437 | goto message_out; | 1447 | goto message_out; |
| 1438 | } | 1448 | } |
| @@ -1482,7 +1492,7 @@ static int arcmsr_iop_message_xfer(struct AdapterControlBlock *acb, \ | |||
| 1482 | retvalue = ARCMSR_MESSAGE_FAIL; | 1492 | retvalue = ARCMSR_MESSAGE_FAIL; |
| 1483 | } | 1493 | } |
| 1484 | } | 1494 | } |
| 1485 | pci_free_consistent(acb->pdev, 1032, ver_addr, buf_handle); | 1495 | kfree(tmp); |
| 1486 | } | 1496 | } |
| 1487 | break; | 1497 | break; |
| 1488 | 1498 | ||
| @@ -1682,8 +1692,11 @@ static int arcmsr_queue_command(struct scsi_cmnd *cmd, | |||
| 1682 | ccb = arcmsr_get_freeccb(acb); | 1692 | ccb = arcmsr_get_freeccb(acb); |
| 1683 | if (!ccb) | 1693 | if (!ccb) |
| 1684 | return SCSI_MLQUEUE_HOST_BUSY; | 1694 | return SCSI_MLQUEUE_HOST_BUSY; |
| 1685 | 1695 | if ( arcmsr_build_ccb( acb, ccb, cmd ) == FAILED ) { | |
| 1686 | arcmsr_build_ccb(acb, ccb, cmd); | 1696 | cmd->result = (DID_ERROR << 16) | (RESERVATION_CONFLICT << 1); |
| 1697 | cmd->scsi_done(cmd); | ||
| 1698 | return 0; | ||
| 1699 | } | ||
| 1687 | arcmsr_post_ccb(acb, ccb); | 1700 | arcmsr_post_ccb(acb, ccb); |
| 1688 | return 0; | 1701 | return 0; |
| 1689 | } | 1702 | } |
| @@ -1844,7 +1857,7 @@ static void arcmsr_polling_hba_ccbdone(struct AdapterControlBlock *acb, | |||
| 1844 | } | 1857 | } |
| 1845 | } | 1858 | } |
| 1846 | 1859 | ||
| 1847 | static void arcmsr_polling_hbb_ccbdone(struct AdapterControlBlock *acb, \ | 1860 | static void arcmsr_polling_hbb_ccbdone(struct AdapterControlBlock *acb, |
| 1848 | struct CommandControlBlock *poll_ccb) | 1861 | struct CommandControlBlock *poll_ccb) |
| 1849 | { | 1862 | { |
| 1850 | struct MessageUnit_B *reg = acb->pmuB; | 1863 | struct MessageUnit_B *reg = acb->pmuB; |
| @@ -1878,7 +1891,7 @@ static void arcmsr_polling_hbb_ccbdone(struct AdapterControlBlock *acb, \ | |||
| 1878 | (acb->vir2phy_offset + (flag_ccb << 5));/*frame must be 32 bytes aligned*/ | 1891 | (acb->vir2phy_offset + (flag_ccb << 5));/*frame must be 32 bytes aligned*/ |
| 1879 | poll_ccb_done = (ccb == poll_ccb) ? 1:0; | 1892 | poll_ccb_done = (ccb == poll_ccb) ? 1:0; |
| 1880 | if ((ccb->acb != acb) || (ccb->startdone != ARCMSR_CCB_START)) { | 1893 | if ((ccb->acb != acb) || (ccb->startdone != ARCMSR_CCB_START)) { |
| 1881 | if (ccb->startdone == ARCMSR_CCB_ABORTED) { | 1894 | if ((ccb->startdone == ARCMSR_CCB_ABORTED) || (ccb == poll_ccb)) { |
| 1882 | printk(KERN_NOTICE "arcmsr%d: \ | 1895 | printk(KERN_NOTICE "arcmsr%d: \ |
| 1883 | scsi id = %d lun = %d ccb = '0x%p' poll command abort successfully \n" | 1896 | scsi id = %d lun = %d ccb = '0x%p' poll command abort successfully \n" |
| 1884 | ,acb->host->host_no | 1897 | ,acb->host->host_no |
| @@ -1901,7 +1914,7 @@ static void arcmsr_polling_hbb_ccbdone(struct AdapterControlBlock *acb, \ | |||
| 1901 | } /*drain reply FIFO*/ | 1914 | } /*drain reply FIFO*/ |
| 1902 | } | 1915 | } |
| 1903 | 1916 | ||
| 1904 | static void arcmsr_polling_ccbdone(struct AdapterControlBlock *acb, \ | 1917 | static void arcmsr_polling_ccbdone(struct AdapterControlBlock *acb, |
| 1905 | struct CommandControlBlock *poll_ccb) | 1918 | struct CommandControlBlock *poll_ccb) |
| 1906 | { | 1919 | { |
| 1907 | switch (acb->adapter_type) { | 1920 | switch (acb->adapter_type) { |
| @@ -2026,6 +2039,7 @@ static void arcmsr_wait_firmware_ready(struct AdapterControlBlock *acb) | |||
| 2026 | do { | 2039 | do { |
| 2027 | firmware_state = readl(reg->iop2drv_doorbell_reg); | 2040 | firmware_state = readl(reg->iop2drv_doorbell_reg); |
| 2028 | } while ((firmware_state & ARCMSR_MESSAGE_FIRMWARE_OK) == 0); | 2041 | } while ((firmware_state & ARCMSR_MESSAGE_FIRMWARE_OK) == 0); |
| 2042 | writel(ARCMSR_DRV2IOP_END_OF_INTERRUPT, reg->drv2iop_doorbell_reg); | ||
| 2029 | } | 2043 | } |
| 2030 | break; | 2044 | break; |
| 2031 | } | 2045 | } |
| @@ -2090,19 +2104,39 @@ static void arcmsr_clear_doorbell_queue_buffer(struct AdapterControlBlock *acb) | |||
| 2090 | } | 2104 | } |
| 2091 | } | 2105 | } |
| 2092 | 2106 | ||
| 2107 | static void arcmsr_enable_eoi_mode(struct AdapterControlBlock *acb) | ||
| 2108 | { | ||
| 2109 | switch (acb->adapter_type) { | ||
| 2110 | case ACB_ADAPTER_TYPE_A: | ||
| 2111 | return; | ||
| 2112 | case ACB_ADAPTER_TYPE_B: | ||
| 2113 | { | ||
| 2114 | struct MessageUnit_B *reg = acb->pmuB; | ||
| 2115 | writel(ARCMSR_MESSAGE_ACTIVE_EOI_MODE, reg->drv2iop_doorbell_reg); | ||
| 2116 | if(arcmsr_hbb_wait_msgint_ready(acb)) { | ||
| 2117 | printk(KERN_NOTICE "ARCMSR IOP enables EOI_MODE TIMEOUT"); | ||
| 2118 | return; | ||
| 2119 | } | ||
| 2120 | } | ||
| 2121 | break; | ||
| 2122 | } | ||
| 2123 | return; | ||
| 2124 | } | ||
| 2125 | |||
| 2093 | static void arcmsr_iop_init(struct AdapterControlBlock *acb) | 2126 | static void arcmsr_iop_init(struct AdapterControlBlock *acb) |
| 2094 | { | 2127 | { |
| 2095 | uint32_t intmask_org; | 2128 | uint32_t intmask_org; |
| 2096 | 2129 | ||
| 2097 | arcmsr_wait_firmware_ready(acb); | ||
| 2098 | arcmsr_iop_confirm(acb); | ||
| 2099 | /* disable all outbound interrupt */ | 2130 | /* disable all outbound interrupt */ |
| 2100 | intmask_org = arcmsr_disable_outbound_ints(acb); | 2131 | intmask_org = arcmsr_disable_outbound_ints(acb); |
| 2132 | arcmsr_wait_firmware_ready(acb); | ||
| 2133 | arcmsr_iop_confirm(acb); | ||
| 2101 | arcmsr_get_firmware_spec(acb); | 2134 | arcmsr_get_firmware_spec(acb); |
| 2102 | /*start background rebuild*/ | 2135 | /*start background rebuild*/ |
| 2103 | arcmsr_start_adapter_bgrb(acb); | 2136 | arcmsr_start_adapter_bgrb(acb); |
| 2104 | /* empty doorbell Qbuffer if door bell ringed */ | 2137 | /* empty doorbell Qbuffer if door bell ringed */ |
| 2105 | arcmsr_clear_doorbell_queue_buffer(acb); | 2138 | arcmsr_clear_doorbell_queue_buffer(acb); |
| 2139 | arcmsr_enable_eoi_mode(acb); | ||
| 2106 | /* enable outbound Post Queue,outbound doorbell Interrupt */ | 2140 | /* enable outbound Post Queue,outbound doorbell Interrupt */ |
| 2107 | arcmsr_enable_outbound_ints(acb, intmask_org); | 2141 | arcmsr_enable_outbound_ints(acb, intmask_org); |
| 2108 | acb->acb_flags |= ACB_F_IOP_INITED; | 2142 | acb->acb_flags |= ACB_F_IOP_INITED; |
| @@ -2275,6 +2309,7 @@ static pci_ers_result_t arcmsr_pci_slot_reset(struct pci_dev *pdev) | |||
| 2275 | arcmsr_start_adapter_bgrb(acb); | 2309 | arcmsr_start_adapter_bgrb(acb); |
| 2276 | /* empty doorbell Qbuffer if door bell ringed */ | 2310 | /* empty doorbell Qbuffer if door bell ringed */ |
| 2277 | arcmsr_clear_doorbell_queue_buffer(acb); | 2311 | arcmsr_clear_doorbell_queue_buffer(acb); |
| 2312 | arcmsr_enable_eoi_mode(acb); | ||
| 2278 | /* enable outbound Post Queue,outbound doorbell Interrupt */ | 2313 | /* enable outbound Post Queue,outbound doorbell Interrupt */ |
| 2279 | arcmsr_enable_outbound_ints(acb, intmask_org); | 2314 | arcmsr_enable_outbound_ints(acb, intmask_org); |
| 2280 | acb->acb_flags |= ACB_F_IOP_INITED; | 2315 | acb->acb_flags |= ACB_F_IOP_INITED; |
diff --git a/drivers/scsi/arm/acornscsi.c b/drivers/scsi/arm/acornscsi.c index eceacf6d49ea..3bedf2466bd1 100644 --- a/drivers/scsi/arm/acornscsi.c +++ b/drivers/scsi/arm/acornscsi.c | |||
| @@ -1790,7 +1790,7 @@ int acornscsi_starttransfer(AS_Host *host) | |||
| 1790 | return 0; | 1790 | return 0; |
| 1791 | } | 1791 | } |
| 1792 | 1792 | ||
| 1793 | residual = host->SCpnt->request_bufflen - host->scsi.SCp.scsi_xferred; | 1793 | residual = scsi_bufflen(host->SCpnt) - host->scsi.SCp.scsi_xferred; |
| 1794 | 1794 | ||
| 1795 | sbic_arm_write(host->scsi.io_port, SBIC_SYNCHTRANSFER, host->device[host->SCpnt->device->id].sync_xfer); | 1795 | sbic_arm_write(host->scsi.io_port, SBIC_SYNCHTRANSFER, host->device[host->SCpnt->device->id].sync_xfer); |
| 1796 | sbic_arm_writenext(host->scsi.io_port, residual >> 16); | 1796 | sbic_arm_writenext(host->scsi.io_port, residual >> 16); |
| @@ -2270,7 +2270,7 @@ intr_ret_t acornscsi_sbicintr(AS_Host *host, int in_irq) | |||
| 2270 | case 0x4b: /* -> PHASE_STATUSIN */ | 2270 | case 0x4b: /* -> PHASE_STATUSIN */ |
| 2271 | case 0x8b: /* -> PHASE_STATUSIN */ | 2271 | case 0x8b: /* -> PHASE_STATUSIN */ |
| 2272 | /* DATA IN -> STATUS */ | 2272 | /* DATA IN -> STATUS */ |
| 2273 | host->scsi.SCp.scsi_xferred = host->SCpnt->request_bufflen - | 2273 | host->scsi.SCp.scsi_xferred = scsi_bufflen(host->SCpnt) - |
| 2274 | acornscsi_sbic_xfcount(host); | 2274 | acornscsi_sbic_xfcount(host); |
| 2275 | acornscsi_dma_stop(host); | 2275 | acornscsi_dma_stop(host); |
| 2276 | acornscsi_readstatusbyte(host); | 2276 | acornscsi_readstatusbyte(host); |
| @@ -2281,7 +2281,7 @@ intr_ret_t acornscsi_sbicintr(AS_Host *host, int in_irq) | |||
| 2281 | case 0x4e: /* -> PHASE_MSGOUT */ | 2281 | case 0x4e: /* -> PHASE_MSGOUT */ |
| 2282 | case 0x8e: /* -> PHASE_MSGOUT */ | 2282 | case 0x8e: /* -> PHASE_MSGOUT */ |
| 2283 | /* DATA IN -> MESSAGE OUT */ | 2283 | /* DATA IN -> MESSAGE OUT */ |
| 2284 | host->scsi.SCp.scsi_xferred = host->SCpnt->request_bufflen - | 2284 | host->scsi.SCp.scsi_xferred = scsi_bufflen(host->SCpnt) - |
| 2285 | acornscsi_sbic_xfcount(host); | 2285 | acornscsi_sbic_xfcount(host); |
| 2286 | acornscsi_dma_stop(host); | 2286 | acornscsi_dma_stop(host); |
| 2287 | acornscsi_sendmessage(host); | 2287 | acornscsi_sendmessage(host); |
| @@ -2291,7 +2291,7 @@ intr_ret_t acornscsi_sbicintr(AS_Host *host, int in_irq) | |||
| 2291 | case 0x4f: /* message in */ | 2291 | case 0x4f: /* message in */ |
| 2292 | case 0x8f: /* message in */ | 2292 | case 0x8f: /* message in */ |
| 2293 | /* DATA IN -> MESSAGE IN */ | 2293 | /* DATA IN -> MESSAGE IN */ |
| 2294 | host->scsi.SCp.scsi_xferred = host->SCpnt->request_bufflen - | 2294 | host->scsi.SCp.scsi_xferred = scsi_bufflen(host->SCpnt) - |
| 2295 | acornscsi_sbic_xfcount(host); | 2295 | acornscsi_sbic_xfcount(host); |
| 2296 | acornscsi_dma_stop(host); | 2296 | acornscsi_dma_stop(host); |
| 2297 | acornscsi_message(host); /* -> PHASE_MSGIN, PHASE_DISCONNECT */ | 2297 | acornscsi_message(host); /* -> PHASE_MSGIN, PHASE_DISCONNECT */ |
| @@ -2319,7 +2319,7 @@ intr_ret_t acornscsi_sbicintr(AS_Host *host, int in_irq) | |||
| 2319 | case 0x4b: /* -> PHASE_STATUSIN */ | 2319 | case 0x4b: /* -> PHASE_STATUSIN */ |
| 2320 | case 0x8b: /* -> PHASE_STATUSIN */ | 2320 | case 0x8b: /* -> PHASE_STATUSIN */ |
| 2321 | /* DATA OUT -> STATUS */ | 2321 | /* DATA OUT -> STATUS */ |
| 2322 | host->scsi.SCp.scsi_xferred = host->SCpnt->request_bufflen - | 2322 | host->scsi.SCp.scsi_xferred = scsi_bufflen(host->SCpnt) - |
| 2323 | acornscsi_sbic_xfcount(host); | 2323 | acornscsi_sbic_xfcount(host); |
| 2324 | acornscsi_dma_stop(host); | 2324 | acornscsi_dma_stop(host); |
| 2325 | acornscsi_dma_adjust(host); | 2325 | acornscsi_dma_adjust(host); |
| @@ -2331,7 +2331,7 @@ intr_ret_t acornscsi_sbicintr(AS_Host *host, int in_irq) | |||
| 2331 | case 0x4e: /* -> PHASE_MSGOUT */ | 2331 | case 0x4e: /* -> PHASE_MSGOUT */ |
| 2332 | case 0x8e: /* -> PHASE_MSGOUT */ | 2332 | case 0x8e: /* -> PHASE_MSGOUT */ |
| 2333 | /* DATA OUT -> MESSAGE OUT */ | 2333 | /* DATA OUT -> MESSAGE OUT */ |
| 2334 | host->scsi.SCp.scsi_xferred = host->SCpnt->request_bufflen - | 2334 | host->scsi.SCp.scsi_xferred = scsi_bufflen(host->SCpnt) - |
| 2335 | acornscsi_sbic_xfcount(host); | 2335 | acornscsi_sbic_xfcount(host); |
| 2336 | acornscsi_dma_stop(host); | 2336 | acornscsi_dma_stop(host); |
| 2337 | acornscsi_dma_adjust(host); | 2337 | acornscsi_dma_adjust(host); |
| @@ -2342,7 +2342,7 @@ intr_ret_t acornscsi_sbicintr(AS_Host *host, int in_irq) | |||
| 2342 | case 0x4f: /* message in */ | 2342 | case 0x4f: /* message in */ |
| 2343 | case 0x8f: /* message in */ | 2343 | case 0x8f: /* message in */ |
| 2344 | /* DATA OUT -> MESSAGE IN */ | 2344 | /* DATA OUT -> MESSAGE IN */ |
| 2345 | host->scsi.SCp.scsi_xferred = host->SCpnt->request_bufflen - | 2345 | host->scsi.SCp.scsi_xferred = scsi_bufflen(host->SCpnt) - |
| 2346 | acornscsi_sbic_xfcount(host); | 2346 | acornscsi_sbic_xfcount(host); |
| 2347 | acornscsi_dma_stop(host); | 2347 | acornscsi_dma_stop(host); |
| 2348 | acornscsi_dma_adjust(host); | 2348 | acornscsi_dma_adjust(host); |
diff --git a/drivers/scsi/arm/scsi.h b/drivers/scsi/arm/scsi.h index bb6550e31926..138a521ba1a8 100644 --- a/drivers/scsi/arm/scsi.h +++ b/drivers/scsi/arm/scsi.h | |||
| @@ -18,17 +18,32 @@ | |||
| 18 | * The scatter-gather list handling. This contains all | 18 | * The scatter-gather list handling. This contains all |
| 19 | * the yucky stuff that needs to be fixed properly. | 19 | * the yucky stuff that needs to be fixed properly. |
| 20 | */ | 20 | */ |
| 21 | |||
| 22 | /* | ||
| 23 | * copy_SCp_to_sg() Assumes contiguous allocation at @sg of at-most @max | ||
| 24 | * entries of uninitialized memory. SCp is from scsi-ml and has a valid | ||
| 25 | * (possibly chained) sg-list | ||
| 26 | */ | ||
| 21 | static inline int copy_SCp_to_sg(struct scatterlist *sg, struct scsi_pointer *SCp, int max) | 27 | static inline int copy_SCp_to_sg(struct scatterlist *sg, struct scsi_pointer *SCp, int max) |
| 22 | { | 28 | { |
| 23 | int bufs = SCp->buffers_residual; | 29 | int bufs = SCp->buffers_residual; |
| 24 | 30 | ||
| 31 | /* FIXME: It should be easy for drivers to loop on copy_SCp_to_sg(). | ||
| 32 | * and to remove this BUG_ON. Use min() in-its-place | ||
| 33 | */ | ||
| 25 | BUG_ON(bufs + 1 > max); | 34 | BUG_ON(bufs + 1 > max); |
| 26 | 35 | ||
| 27 | sg_set_buf(sg, SCp->ptr, SCp->this_residual); | 36 | sg_set_buf(sg, SCp->ptr, SCp->this_residual); |
| 28 | 37 | ||
| 29 | if (bufs) | 38 | if (bufs) { |
| 30 | memcpy(sg + 1, SCp->buffer + 1, | 39 | struct scatterlist *src_sg; |
| 31 | sizeof(struct scatterlist) * bufs); | 40 | unsigned i; |
| 41 | |||
| 42 | for_each_sg(sg_next(SCp->buffer), src_sg, bufs, i) | ||
| 43 | *(++sg) = *src_sg; | ||
| 44 | sg_mark_end(sg); | ||
| 45 | } | ||
| 46 | |||
| 32 | return bufs + 1; | 47 | return bufs + 1; |
| 33 | } | 48 | } |
| 34 | 49 | ||
| @@ -36,7 +51,7 @@ static inline int next_SCp(struct scsi_pointer *SCp) | |||
| 36 | { | 51 | { |
| 37 | int ret = SCp->buffers_residual; | 52 | int ret = SCp->buffers_residual; |
| 38 | if (ret) { | 53 | if (ret) { |
| 39 | SCp->buffer++; | 54 | SCp->buffer = sg_next(SCp->buffer); |
| 40 | SCp->buffers_residual--; | 55 | SCp->buffers_residual--; |
| 41 | SCp->ptr = sg_virt(SCp->buffer); | 56 | SCp->ptr = sg_virt(SCp->buffer); |
| 42 | SCp->this_residual = SCp->buffer->length; | 57 | SCp->this_residual = SCp->buffer->length; |
| @@ -68,46 +83,46 @@ static inline void init_SCp(struct scsi_cmnd *SCpnt) | |||
| 68 | { | 83 | { |
| 69 | memset(&SCpnt->SCp, 0, sizeof(struct scsi_pointer)); | 84 | memset(&SCpnt->SCp, 0, sizeof(struct scsi_pointer)); |
| 70 | 85 | ||
| 71 | if (SCpnt->use_sg) { | 86 | if (scsi_bufflen(SCpnt)) { |
| 72 | unsigned long len = 0; | 87 | unsigned long len = 0; |
| 73 | int buf; | ||
| 74 | 88 | ||
| 75 | SCpnt->SCp.buffer = (struct scatterlist *) SCpnt->request_buffer; | 89 | SCpnt->SCp.buffer = scsi_sglist(SCpnt); |
| 76 | SCpnt->SCp.buffers_residual = SCpnt->use_sg - 1; | 90 | SCpnt->SCp.buffers_residual = scsi_sg_count(SCpnt) - 1; |
| 77 | SCpnt->SCp.ptr = sg_virt(SCpnt->SCp.buffer); | 91 | SCpnt->SCp.ptr = sg_virt(SCpnt->SCp.buffer); |
| 78 | SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length; | 92 | SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length; |
| 79 | SCpnt->SCp.phase = SCpnt->request_bufflen; | 93 | SCpnt->SCp.phase = scsi_bufflen(SCpnt); |
| 80 | 94 | ||
| 81 | #ifdef BELT_AND_BRACES | 95 | #ifdef BELT_AND_BRACES |
| 82 | /* | 96 | { /* |
| 83 | * Calculate correct buffer length. Some commands | 97 | * Calculate correct buffer length. Some commands |
| 84 | * come in with the wrong request_bufflen. | 98 | * come in with the wrong scsi_bufflen. |
| 85 | */ | 99 | */ |
| 86 | for (buf = 0; buf <= SCpnt->SCp.buffers_residual; buf++) | 100 | struct scatterlist *sg; |
| 87 | len += SCpnt->SCp.buffer[buf].length; | 101 | unsigned i, sg_count = scsi_sg_count(SCpnt); |
| 88 | 102 | ||
| 89 | if (SCpnt->request_bufflen != len) | 103 | scsi_for_each_sg(SCpnt, sg, sg_count, i) |
| 90 | printk(KERN_WARNING "scsi%d.%c: bad request buffer " | 104 | len += sg->length; |
| 91 | "length %d, should be %ld\n", SCpnt->device->host->host_no, | 105 | |
| 92 | '0' + SCpnt->device->id, SCpnt->request_bufflen, len); | 106 | if (scsi_bufflen(SCpnt) != len) { |
| 93 | SCpnt->request_bufflen = len; | 107 | printk(KERN_WARNING |
| 108 | "scsi%d.%c: bad request buffer " | ||
| 109 | "length %d, should be %ld\n", | ||
| 110 | SCpnt->device->host->host_no, | ||
| 111 | '0' + SCpnt->device->id, | ||
| 112 | scsi_bufflen(SCpnt), len); | ||
| 113 | /* | ||
| 114 | * FIXME: Totaly naive fixup. We should abort | ||
| 115 | * with error | ||
| 116 | */ | ||
| 117 | SCpnt->SCp.phase = | ||
| 118 | min_t(unsigned long, len, | ||
| 119 | scsi_bufflen(SCpnt)); | ||
| 120 | } | ||
| 121 | } | ||
| 94 | #endif | 122 | #endif |
| 95 | } else { | 123 | } else { |
| 96 | SCpnt->SCp.ptr = (unsigned char *)SCpnt->request_buffer; | ||
| 97 | SCpnt->SCp.this_residual = SCpnt->request_bufflen; | ||
| 98 | SCpnt->SCp.phase = SCpnt->request_bufflen; | ||
| 99 | } | ||
| 100 | |||
| 101 | /* | ||
| 102 | * If the upper SCSI layers pass a buffer, but zero length, | ||
| 103 | * we aren't interested in the buffer pointer. | ||
| 104 | */ | ||
| 105 | if (SCpnt->SCp.this_residual == 0 && SCpnt->SCp.ptr) { | ||
| 106 | #if 0 //def BELT_AND_BRACES | ||
| 107 | printk(KERN_WARNING "scsi%d.%c: zero length buffer passed for " | ||
| 108 | "command ", SCpnt->host->host_no, '0' + SCpnt->target); | ||
| 109 | __scsi_print_command(SCpnt->cmnd); | ||
| 110 | #endif | ||
| 111 | SCpnt->SCp.ptr = NULL; | 124 | SCpnt->SCp.ptr = NULL; |
| 125 | SCpnt->SCp.this_residual = 0; | ||
| 126 | SCpnt->SCp.phase = 0; | ||
| 112 | } | 127 | } |
| 113 | } | 128 | } |
diff --git a/drivers/scsi/blz1230.c b/drivers/scsi/blz1230.c deleted file mode 100644 index 23f7c24ab809..000000000000 --- a/drivers/scsi/blz1230.c +++ /dev/null | |||
| @@ -1,353 +0,0 @@ | |||
| 1 | /* blz1230.c: Driver for Blizzard 1230 SCSI IV Controller. | ||
| 2 | * | ||
| 3 | * Copyright (C) 1996 Jesper Skov (jskov@cygnus.co.uk) | ||
| 4 | * | ||
| 5 | * This driver is based on the CyberStorm driver, hence the occasional | ||
| 6 | * reference to CyberStorm. | ||
| 7 | */ | ||
| 8 | |||
| 9 | /* TODO: | ||
| 10 | * | ||
| 11 | * 1) Figure out how to make a cleaner merge with the sparc driver with regard | ||
| 12 | * to the caches and the Sparc MMU mapping. | ||
| 13 | * 2) Make as few routines required outside the generic driver. A lot of the | ||
| 14 | * routines in this file used to be inline! | ||
| 15 | */ | ||
| 16 | |||
| 17 | #include <linux/module.h> | ||
| 18 | |||
| 19 | #include <linux/init.h> | ||
| 20 | #include <linux/kernel.h> | ||
| 21 | #include <linux/delay.h> | ||
| 22 | #include <linux/types.h> | ||
| 23 | #include <linux/string.h> | ||
| 24 | #include <linux/slab.h> | ||
| 25 | #include <linux/blkdev.h> | ||
| 26 | #include <linux/proc_fs.h> | ||
| 27 | #include <linux/stat.h> | ||
| 28 | #include <linux/interrupt.h> | ||
| 29 | |||
| 30 | #include "scsi.h" | ||
| 31 | #include <scsi/scsi_host.h> | ||
| 32 | #include "NCR53C9x.h" | ||
| 33 | |||
| 34 | #include <linux/zorro.h> | ||
| 35 | #include <asm/irq.h> | ||
| 36 | #include <asm/amigaints.h> | ||
| 37 | #include <asm/amigahw.h> | ||
| 38 | |||
| 39 | #include <asm/pgtable.h> | ||
| 40 | |||
| 41 | #define MKIV 1 | ||
| 42 | |||
| 43 | /* The controller registers can be found in the Z2 config area at these | ||
| 44 | * offsets: | ||
| 45 | */ | ||
| 46 | #define BLZ1230_ESP_ADDR 0x8000 | ||
| 47 | #define BLZ1230_DMA_ADDR 0x10000 | ||
| 48 | #define BLZ1230II_ESP_ADDR 0x10000 | ||
| 49 | #define BLZ1230II_DMA_ADDR 0x10021 | ||
| 50 | |||
| 51 | |||
| 52 | /* The Blizzard 1230 DMA interface | ||
| 53 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
| 54 | * Only two things can be programmed in the Blizzard DMA: | ||
| 55 | * 1) The data direction is controlled by the status of bit 31 (1 = write) | ||
| 56 | * 2) The source/dest address (word aligned, shifted one right) in bits 30-0 | ||
| 57 | * | ||
| 58 | * Program DMA by first latching the highest byte of the address/direction | ||
| 59 | * (i.e. bits 31-24 of the long word constructed as described in steps 1+2 | ||
| 60 | * above). Then write each byte of the address/direction (starting with the | ||
| 61 | * top byte, working down) to the DMA address register. | ||
| 62 | * | ||
| 63 | * Figure out interrupt status by reading the ESP status byte. | ||
| 64 | */ | ||
| 65 | struct blz1230_dma_registers { | ||
| 66 | volatile unsigned char dma_addr; /* DMA address [0x0000] */ | ||
| 67 | unsigned char dmapad2[0x7fff]; | ||
| 68 | volatile unsigned char dma_latch; /* DMA latch [0x8000] */ | ||
| 69 | }; | ||
| 70 | |||
| 71 | struct blz1230II_dma_registers { | ||
| 72 | volatile unsigned char dma_addr; /* DMA address [0x0000] */ | ||
| 73 | unsigned char dmapad2[0xf]; | ||
| 74 | volatile unsigned char dma_latch; /* DMA latch [0x0010] */ | ||
| 75 | }; | ||
| 76 | |||
| 77 | #define BLZ1230_DMA_WRITE 0x80000000 | ||
| 78 | |||
| 79 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count); | ||
| 80 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 81 | static void dma_dump_state(struct NCR_ESP *esp); | ||
| 82 | static void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length); | ||
| 83 | static void dma_init_write(struct NCR_ESP *esp, __u32 addr, int length); | ||
| 84 | static void dma_ints_off(struct NCR_ESP *esp); | ||
| 85 | static void dma_ints_on(struct NCR_ESP *esp); | ||
| 86 | static int dma_irq_p(struct NCR_ESP *esp); | ||
| 87 | static int dma_ports_p(struct NCR_ESP *esp); | ||
| 88 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write); | ||
| 89 | |||
| 90 | static volatile unsigned char cmd_buffer[16]; | ||
| 91 | /* This is where all commands are put | ||
| 92 | * before they are transferred to the ESP chip | ||
| 93 | * via PIO. | ||
| 94 | */ | ||
| 95 | |||
| 96 | /***************************************************************** Detection */ | ||
| 97 | int __init blz1230_esp_detect(struct scsi_host_template *tpnt) | ||
| 98 | { | ||
| 99 | struct NCR_ESP *esp; | ||
| 100 | struct zorro_dev *z = NULL; | ||
| 101 | unsigned long address; | ||
| 102 | struct ESP_regs *eregs; | ||
| 103 | unsigned long board; | ||
| 104 | |||
| 105 | #if MKIV | ||
| 106 | #define REAL_BLZ1230_ID ZORRO_PROD_PHASE5_BLIZZARD_1230_IV_1260 | ||
| 107 | #define REAL_BLZ1230_ESP_ADDR BLZ1230_ESP_ADDR | ||
| 108 | #define REAL_BLZ1230_DMA_ADDR BLZ1230_DMA_ADDR | ||
| 109 | #else | ||
| 110 | #define REAL_BLZ1230_ID ZORRO_PROD_PHASE5_BLIZZARD_1230_II_FASTLANE_Z3_CYBERSCSI_CYBERSTORM060 | ||
| 111 | #define REAL_BLZ1230_ESP_ADDR BLZ1230II_ESP_ADDR | ||
| 112 | #define REAL_BLZ1230_DMA_ADDR BLZ1230II_DMA_ADDR | ||
| 113 | #endif | ||
| 114 | |||
| 115 | if ((z = zorro_find_device(REAL_BLZ1230_ID, z))) { | ||
| 116 | board = z->resource.start; | ||
| 117 | if (request_mem_region(board+REAL_BLZ1230_ESP_ADDR, | ||
| 118 | sizeof(struct ESP_regs), "NCR53C9x")) { | ||
| 119 | /* Do some magic to figure out if the blizzard is | ||
| 120 | * equipped with a SCSI controller | ||
| 121 | */ | ||
| 122 | address = ZTWO_VADDR(board); | ||
| 123 | eregs = (struct ESP_regs *)(address + REAL_BLZ1230_ESP_ADDR); | ||
| 124 | esp = esp_allocate(tpnt, (void *)board + REAL_BLZ1230_ESP_ADDR, | ||
| 125 | 0); | ||
| 126 | |||
| 127 | esp_write(eregs->esp_cfg1, (ESP_CONFIG1_PENABLE | 7)); | ||
| 128 | udelay(5); | ||
| 129 | if(esp_read(eregs->esp_cfg1) != (ESP_CONFIG1_PENABLE | 7)) | ||
| 130 | goto err_out; | ||
| 131 | |||
| 132 | /* Do command transfer with programmed I/O */ | ||
| 133 | esp->do_pio_cmds = 1; | ||
| 134 | |||
| 135 | /* Required functions */ | ||
| 136 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 137 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 138 | esp->dma_dump_state = &dma_dump_state; | ||
| 139 | esp->dma_init_read = &dma_init_read; | ||
| 140 | esp->dma_init_write = &dma_init_write; | ||
| 141 | esp->dma_ints_off = &dma_ints_off; | ||
| 142 | esp->dma_ints_on = &dma_ints_on; | ||
| 143 | esp->dma_irq_p = &dma_irq_p; | ||
| 144 | esp->dma_ports_p = &dma_ports_p; | ||
| 145 | esp->dma_setup = &dma_setup; | ||
| 146 | |||
| 147 | /* Optional functions */ | ||
| 148 | esp->dma_barrier = 0; | ||
| 149 | esp->dma_drain = 0; | ||
| 150 | esp->dma_invalidate = 0; | ||
| 151 | esp->dma_irq_entry = 0; | ||
| 152 | esp->dma_irq_exit = 0; | ||
| 153 | esp->dma_led_on = 0; | ||
| 154 | esp->dma_led_off = 0; | ||
| 155 | esp->dma_poll = 0; | ||
| 156 | esp->dma_reset = 0; | ||
| 157 | |||
| 158 | /* SCSI chip speed */ | ||
| 159 | esp->cfreq = 40000000; | ||
| 160 | |||
| 161 | /* The DMA registers on the Blizzard are mapped | ||
| 162 | * relative to the device (i.e. in the same Zorro | ||
| 163 | * I/O block). | ||
| 164 | */ | ||
| 165 | esp->dregs = (void *)(address + REAL_BLZ1230_DMA_ADDR); | ||
| 166 | |||
| 167 | /* ESP register base */ | ||
| 168 | esp->eregs = eregs; | ||
| 169 | |||
| 170 | /* Set the command buffer */ | ||
| 171 | esp->esp_command = cmd_buffer; | ||
| 172 | esp->esp_command_dvma = virt_to_bus((void *)cmd_buffer); | ||
| 173 | |||
| 174 | esp->irq = IRQ_AMIGA_PORTS; | ||
| 175 | esp->slot = board+REAL_BLZ1230_ESP_ADDR; | ||
| 176 | if (request_irq(IRQ_AMIGA_PORTS, esp_intr, IRQF_SHARED, | ||
| 177 | "Blizzard 1230 SCSI IV", esp->ehost)) | ||
| 178 | goto err_out; | ||
| 179 | |||
| 180 | /* Figure out our scsi ID on the bus */ | ||
| 181 | esp->scsi_id = 7; | ||
| 182 | |||
| 183 | /* We don't have a differential SCSI-bus. */ | ||
| 184 | esp->diff = 0; | ||
| 185 | |||
| 186 | esp_initialize(esp); | ||
| 187 | |||
| 188 | printk("ESP: Total of %d ESP hosts found, %d actually in use.\n", nesps, esps_in_use); | ||
| 189 | esps_running = esps_in_use; | ||
| 190 | return esps_in_use; | ||
| 191 | } | ||
| 192 | } | ||
| 193 | return 0; | ||
| 194 | |||
| 195 | err_out: | ||
| 196 | scsi_unregister(esp->ehost); | ||
| 197 | esp_deallocate(esp); | ||
| 198 | release_mem_region(board+REAL_BLZ1230_ESP_ADDR, | ||
| 199 | sizeof(struct ESP_regs)); | ||
| 200 | return 0; | ||
| 201 | } | ||
| 202 | |||
| 203 | /************************************************************* DMA Functions */ | ||
| 204 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count) | ||
| 205 | { | ||
| 206 | /* Since the Blizzard DMA is fully dedicated to the ESP chip, | ||
| 207 | * the number of bytes sent (to the ESP chip) equals the number | ||
| 208 | * of bytes in the FIFO - there is no buffering in the DMA controller. | ||
| 209 | * XXXX Do I read this right? It is from host to ESP, right? | ||
| 210 | */ | ||
| 211 | return fifo_count; | ||
| 212 | } | ||
| 213 | |||
| 214 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 215 | { | ||
| 216 | /* I don't think there's any limit on the Blizzard DMA. So we use what | ||
| 217 | * the ESP chip can handle (24 bit). | ||
| 218 | */ | ||
| 219 | unsigned long sz = sp->SCp.this_residual; | ||
| 220 | if(sz > 0x1000000) | ||
| 221 | sz = 0x1000000; | ||
| 222 | return sz; | ||
| 223 | } | ||
| 224 | |||
| 225 | static void dma_dump_state(struct NCR_ESP *esp) | ||
| 226 | { | ||
| 227 | ESPLOG(("intreq:<%04x>, intena:<%04x>\n", | ||
| 228 | amiga_custom.intreqr, amiga_custom.intenar)); | ||
| 229 | } | ||
| 230 | |||
| 231 | void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 232 | { | ||
| 233 | #if MKIV | ||
| 234 | struct blz1230_dma_registers *dregs = | ||
| 235 | (struct blz1230_dma_registers *) (esp->dregs); | ||
| 236 | #else | ||
| 237 | struct blz1230II_dma_registers *dregs = | ||
| 238 | (struct blz1230II_dma_registers *) (esp->dregs); | ||
| 239 | #endif | ||
| 240 | |||
| 241 | cache_clear(addr, length); | ||
| 242 | |||
| 243 | addr >>= 1; | ||
| 244 | addr &= ~(BLZ1230_DMA_WRITE); | ||
| 245 | |||
| 246 | /* First set latch */ | ||
| 247 | dregs->dma_latch = (addr >> 24) & 0xff; | ||
| 248 | |||
| 249 | /* Then pump the address to the DMA address register */ | ||
| 250 | #if MKIV | ||
| 251 | dregs->dma_addr = (addr >> 24) & 0xff; | ||
| 252 | #endif | ||
| 253 | dregs->dma_addr = (addr >> 16) & 0xff; | ||
| 254 | dregs->dma_addr = (addr >> 8) & 0xff; | ||
| 255 | dregs->dma_addr = (addr ) & 0xff; | ||
| 256 | } | ||
| 257 | |||
| 258 | void dma_init_write(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 259 | { | ||
| 260 | #if MKIV | ||
| 261 | struct blz1230_dma_registers *dregs = | ||
| 262 | (struct blz1230_dma_registers *) (esp->dregs); | ||
| 263 | #else | ||
| 264 | struct blz1230II_dma_registers *dregs = | ||
| 265 | (struct blz1230II_dma_registers *) (esp->dregs); | ||
| 266 | #endif | ||
| 267 | |||
| 268 | cache_push(addr, length); | ||
| 269 | |||
| 270 | addr >>= 1; | ||
| 271 | addr |= BLZ1230_DMA_WRITE; | ||
| 272 | |||
| 273 | /* First set latch */ | ||
| 274 | dregs->dma_latch = (addr >> 24) & 0xff; | ||
| 275 | |||
| 276 | /* Then pump the address to the DMA address register */ | ||
| 277 | #if MKIV | ||
| 278 | dregs->dma_addr = (addr >> 24) & 0xff; | ||
| 279 | #endif | ||
| 280 | dregs->dma_addr = (addr >> 16) & 0xff; | ||
| 281 | dregs->dma_addr = (addr >> 8) & 0xff; | ||
| 282 | dregs->dma_addr = (addr ) & 0xff; | ||
| 283 | } | ||
| 284 | |||
| 285 | static void dma_ints_off(struct NCR_ESP *esp) | ||
| 286 | { | ||
| 287 | disable_irq(esp->irq); | ||
| 288 | } | ||
| 289 | |||
| 290 | static void dma_ints_on(struct NCR_ESP *esp) | ||
| 291 | { | ||
| 292 | enable_irq(esp->irq); | ||
| 293 | } | ||
| 294 | |||
| 295 | static int dma_irq_p(struct NCR_ESP *esp) | ||
| 296 | { | ||
| 297 | return (esp_read(esp->eregs->esp_status) & ESP_STAT_INTR); | ||
| 298 | } | ||
| 299 | |||
| 300 | static int dma_ports_p(struct NCR_ESP *esp) | ||
| 301 | { | ||
| 302 | return ((amiga_custom.intenar) & IF_PORTS); | ||
| 303 | } | ||
| 304 | |||
| 305 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write) | ||
| 306 | { | ||
| 307 | /* On the Sparc, DMA_ST_WRITE means "move data from device to memory" | ||
| 308 | * so when (write) is true, it actually means READ! | ||
| 309 | */ | ||
| 310 | if(write){ | ||
| 311 | dma_init_read(esp, addr, count); | ||
| 312 | } else { | ||
| 313 | dma_init_write(esp, addr, count); | ||
| 314 | } | ||
| 315 | } | ||
| 316 | |||
| 317 | #define HOSTS_C | ||
| 318 | |||
| 319 | int blz1230_esp_release(struct Scsi_Host *instance) | ||
| 320 | { | ||
| 321 | #ifdef MODULE | ||
| 322 | unsigned long address = (unsigned long)((struct NCR_ESP *)instance->hostdata)->edev; | ||
| 323 | esp_deallocate((struct NCR_ESP *)instance->hostdata); | ||
| 324 | esp_release(); | ||
| 325 | release_mem_region(address, sizeof(struct ESP_regs)); | ||
| 326 | free_irq(IRQ_AMIGA_PORTS, esp_intr); | ||
| 327 | #endif | ||
| 328 | return 1; | ||
| 329 | } | ||
| 330 | |||
| 331 | |||
| 332 | static struct scsi_host_template driver_template = { | ||
| 333 | .proc_name = "esp-blz1230", | ||
| 334 | .proc_info = esp_proc_info, | ||
| 335 | .name = "Blizzard1230 SCSI IV", | ||
| 336 | .detect = blz1230_esp_detect, | ||
| 337 | .slave_alloc = esp_slave_alloc, | ||
| 338 | .slave_destroy = esp_slave_destroy, | ||
| 339 | .release = blz1230_esp_release, | ||
| 340 | .queuecommand = esp_queue, | ||
| 341 | .eh_abort_handler = esp_abort, | ||
| 342 | .eh_bus_reset_handler = esp_reset, | ||
| 343 | .can_queue = 7, | ||
| 344 | .this_id = 7, | ||
| 345 | .sg_tablesize = SG_ALL, | ||
| 346 | .cmd_per_lun = 1, | ||
| 347 | .use_clustering = ENABLE_CLUSTERING | ||
| 348 | }; | ||
| 349 | |||
| 350 | |||
| 351 | #include "scsi_module.c" | ||
| 352 | |||
| 353 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/scsi/blz2060.c b/drivers/scsi/blz2060.c deleted file mode 100644 index b6203ec00961..000000000000 --- a/drivers/scsi/blz2060.c +++ /dev/null | |||
| @@ -1,306 +0,0 @@ | |||
| 1 | /* blz2060.c: Driver for Blizzard 2060 SCSI Controller. | ||
| 2 | * | ||
| 3 | * Copyright (C) 1996 Jesper Skov (jskov@cygnus.co.uk) | ||
| 4 | * | ||
| 5 | * This driver is based on the CyberStorm driver, hence the occasional | ||
| 6 | * reference to CyberStorm. | ||
| 7 | */ | ||
| 8 | |||
| 9 | /* TODO: | ||
| 10 | * | ||
| 11 | * 1) Figure out how to make a cleaner merge with the sparc driver with regard | ||
| 12 | * to the caches and the Sparc MMU mapping. | ||
| 13 | * 2) Make as few routines required outside the generic driver. A lot of the | ||
| 14 | * routines in this file used to be inline! | ||
| 15 | */ | ||
| 16 | |||
| 17 | #include <linux/module.h> | ||
| 18 | |||
| 19 | #include <linux/init.h> | ||
| 20 | #include <linux/kernel.h> | ||
| 21 | #include <linux/delay.h> | ||
| 22 | #include <linux/types.h> | ||
| 23 | #include <linux/string.h> | ||
| 24 | #include <linux/slab.h> | ||
| 25 | #include <linux/blkdev.h> | ||
| 26 | #include <linux/proc_fs.h> | ||
| 27 | #include <linux/stat.h> | ||
| 28 | #include <linux/interrupt.h> | ||
| 29 | |||
| 30 | #include "scsi.h" | ||
| 31 | #include <scsi/scsi_host.h> | ||
| 32 | #include "NCR53C9x.h" | ||
| 33 | |||
| 34 | #include <linux/zorro.h> | ||
| 35 | #include <asm/irq.h> | ||
| 36 | #include <asm/amigaints.h> | ||
| 37 | #include <asm/amigahw.h> | ||
| 38 | |||
| 39 | #include <asm/pgtable.h> | ||
| 40 | |||
| 41 | /* The controller registers can be found in the Z2 config area at these | ||
| 42 | * offsets: | ||
| 43 | */ | ||
| 44 | #define BLZ2060_ESP_ADDR 0x1ff00 | ||
| 45 | #define BLZ2060_DMA_ADDR 0x1ffe0 | ||
| 46 | |||
| 47 | |||
| 48 | /* The Blizzard 2060 DMA interface | ||
| 49 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
| 50 | * Only two things can be programmed in the Blizzard DMA: | ||
| 51 | * 1) The data direction is controlled by the status of bit 31 (1 = write) | ||
| 52 | * 2) The source/dest address (word aligned, shifted one right) in bits 30-0 | ||
| 53 | * | ||
| 54 | * Figure out interrupt status by reading the ESP status byte. | ||
| 55 | */ | ||
| 56 | struct blz2060_dma_registers { | ||
| 57 | volatile unsigned char dma_led_ctrl; /* DMA led control [0x000] */ | ||
| 58 | unsigned char dmapad1[0x0f]; | ||
| 59 | volatile unsigned char dma_addr0; /* DMA address (MSB) [0x010] */ | ||
| 60 | unsigned char dmapad2[0x03]; | ||
| 61 | volatile unsigned char dma_addr1; /* DMA address [0x014] */ | ||
| 62 | unsigned char dmapad3[0x03]; | ||
| 63 | volatile unsigned char dma_addr2; /* DMA address [0x018] */ | ||
| 64 | unsigned char dmapad4[0x03]; | ||
| 65 | volatile unsigned char dma_addr3; /* DMA address (LSB) [0x01c] */ | ||
| 66 | }; | ||
| 67 | |||
| 68 | #define BLZ2060_DMA_WRITE 0x80000000 | ||
| 69 | |||
| 70 | /* DMA control bits */ | ||
| 71 | #define BLZ2060_DMA_LED 0x02 /* HD led control 1 = off */ | ||
| 72 | |||
| 73 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count); | ||
| 74 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 75 | static void dma_dump_state(struct NCR_ESP *esp); | ||
| 76 | static void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length); | ||
| 77 | static void dma_init_write(struct NCR_ESP *esp, __u32 addr, int length); | ||
| 78 | static void dma_ints_off(struct NCR_ESP *esp); | ||
| 79 | static void dma_ints_on(struct NCR_ESP *esp); | ||
| 80 | static int dma_irq_p(struct NCR_ESP *esp); | ||
| 81 | static void dma_led_off(struct NCR_ESP *esp); | ||
| 82 | static void dma_led_on(struct NCR_ESP *esp); | ||
| 83 | static int dma_ports_p(struct NCR_ESP *esp); | ||
| 84 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write); | ||
| 85 | |||
| 86 | static volatile unsigned char cmd_buffer[16]; | ||
| 87 | /* This is where all commands are put | ||
| 88 | * before they are transferred to the ESP chip | ||
| 89 | * via PIO. | ||
| 90 | */ | ||
| 91 | |||
| 92 | /***************************************************************** Detection */ | ||
| 93 | int __init blz2060_esp_detect(struct scsi_host_template *tpnt) | ||
| 94 | { | ||
| 95 | struct NCR_ESP *esp; | ||
| 96 | struct zorro_dev *z = NULL; | ||
| 97 | unsigned long address; | ||
| 98 | |||
| 99 | if ((z = zorro_find_device(ZORRO_PROD_PHASE5_BLIZZARD_2060, z))) { | ||
| 100 | unsigned long board = z->resource.start; | ||
| 101 | if (request_mem_region(board+BLZ2060_ESP_ADDR, | ||
| 102 | sizeof(struct ESP_regs), "NCR53C9x")) { | ||
| 103 | esp = esp_allocate(tpnt, (void *)board + BLZ2060_ESP_ADDR, 0); | ||
| 104 | |||
| 105 | /* Do command transfer with programmed I/O */ | ||
| 106 | esp->do_pio_cmds = 1; | ||
| 107 | |||
| 108 | /* Required functions */ | ||
| 109 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 110 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 111 | esp->dma_dump_state = &dma_dump_state; | ||
| 112 | esp->dma_init_read = &dma_init_read; | ||
| 113 | esp->dma_init_write = &dma_init_write; | ||
| 114 | esp->dma_ints_off = &dma_ints_off; | ||
| 115 | esp->dma_ints_on = &dma_ints_on; | ||
| 116 | esp->dma_irq_p = &dma_irq_p; | ||
| 117 | esp->dma_ports_p = &dma_ports_p; | ||
| 118 | esp->dma_setup = &dma_setup; | ||
| 119 | |||
| 120 | /* Optional functions */ | ||
| 121 | esp->dma_barrier = 0; | ||
| 122 | esp->dma_drain = 0; | ||
| 123 | esp->dma_invalidate = 0; | ||
| 124 | esp->dma_irq_entry = 0; | ||
| 125 | esp->dma_irq_exit = 0; | ||
| 126 | esp->dma_led_on = &dma_led_on; | ||
| 127 | esp->dma_led_off = &dma_led_off; | ||
| 128 | esp->dma_poll = 0; | ||
| 129 | esp->dma_reset = 0; | ||
| 130 | |||
| 131 | /* SCSI chip speed */ | ||
| 132 | esp->cfreq = 40000000; | ||
| 133 | |||
| 134 | /* The DMA registers on the Blizzard are mapped | ||
| 135 | * relative to the device (i.e. in the same Zorro | ||
| 136 | * I/O block). | ||
| 137 | */ | ||
| 138 | address = (unsigned long)ZTWO_VADDR(board); | ||
| 139 | esp->dregs = (void *)(address + BLZ2060_DMA_ADDR); | ||
| 140 | |||
| 141 | /* ESP register base */ | ||
| 142 | esp->eregs = (struct ESP_regs *)(address + BLZ2060_ESP_ADDR); | ||
| 143 | |||
| 144 | /* Set the command buffer */ | ||
| 145 | esp->esp_command = cmd_buffer; | ||
| 146 | esp->esp_command_dvma = virt_to_bus((void *)cmd_buffer); | ||
| 147 | |||
| 148 | esp->irq = IRQ_AMIGA_PORTS; | ||
| 149 | request_irq(IRQ_AMIGA_PORTS, esp_intr, IRQF_SHARED, | ||
| 150 | "Blizzard 2060 SCSI", esp->ehost); | ||
| 151 | |||
| 152 | /* Figure out our scsi ID on the bus */ | ||
| 153 | esp->scsi_id = 7; | ||
| 154 | |||
| 155 | /* We don't have a differential SCSI-bus. */ | ||
| 156 | esp->diff = 0; | ||
| 157 | |||
| 158 | esp_initialize(esp); | ||
| 159 | |||
| 160 | printk("ESP: Total of %d ESP hosts found, %d actually in use.\n", nesps, esps_in_use); | ||
| 161 | esps_running = esps_in_use; | ||
| 162 | return esps_in_use; | ||
| 163 | } | ||
| 164 | } | ||
| 165 | return 0; | ||
| 166 | } | ||
| 167 | |||
| 168 | /************************************************************* DMA Functions */ | ||
| 169 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count) | ||
| 170 | { | ||
| 171 | /* Since the Blizzard DMA is fully dedicated to the ESP chip, | ||
| 172 | * the number of bytes sent (to the ESP chip) equals the number | ||
| 173 | * of bytes in the FIFO - there is no buffering in the DMA controller. | ||
| 174 | * XXXX Do I read this right? It is from host to ESP, right? | ||
| 175 | */ | ||
| 176 | return fifo_count; | ||
| 177 | } | ||
| 178 | |||
| 179 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 180 | { | ||
| 181 | /* I don't think there's any limit on the Blizzard DMA. So we use what | ||
| 182 | * the ESP chip can handle (24 bit). | ||
| 183 | */ | ||
| 184 | unsigned long sz = sp->SCp.this_residual; | ||
| 185 | if(sz > 0x1000000) | ||
| 186 | sz = 0x1000000; | ||
| 187 | return sz; | ||
| 188 | } | ||
| 189 | |||
| 190 | static void dma_dump_state(struct NCR_ESP *esp) | ||
| 191 | { | ||
| 192 | ESPLOG(("intreq:<%04x>, intena:<%04x>\n", | ||
| 193 | amiga_custom.intreqr, amiga_custom.intenar)); | ||
| 194 | } | ||
| 195 | |||
| 196 | static void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 197 | { | ||
| 198 | struct blz2060_dma_registers *dregs = | ||
| 199 | (struct blz2060_dma_registers *) (esp->dregs); | ||
| 200 | |||
| 201 | cache_clear(addr, length); | ||
| 202 | |||
| 203 | addr >>= 1; | ||
| 204 | addr &= ~(BLZ2060_DMA_WRITE); | ||
| 205 | dregs->dma_addr3 = (addr ) & 0xff; | ||
| 206 | dregs->dma_addr2 = (addr >> 8) & 0xff; | ||
| 207 | dregs->dma_addr1 = (addr >> 16) & 0xff; | ||
| 208 | dregs->dma_addr0 = (addr >> 24) & 0xff; | ||
| 209 | } | ||
| 210 | |||
| 211 | static void dma_init_write(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 212 | { | ||
| 213 | struct blz2060_dma_registers *dregs = | ||
| 214 | (struct blz2060_dma_registers *) (esp->dregs); | ||
| 215 | |||
| 216 | cache_push(addr, length); | ||
| 217 | |||
| 218 | addr >>= 1; | ||
| 219 | addr |= BLZ2060_DMA_WRITE; | ||
| 220 | dregs->dma_addr3 = (addr ) & 0xff; | ||
| 221 | dregs->dma_addr2 = (addr >> 8) & 0xff; | ||
| 222 | dregs->dma_addr1 = (addr >> 16) & 0xff; | ||
| 223 | dregs->dma_addr0 = (addr >> 24) & 0xff; | ||
| 224 | } | ||
| 225 | |||
| 226 | static void dma_ints_off(struct NCR_ESP *esp) | ||
| 227 | { | ||
| 228 | disable_irq(esp->irq); | ||
| 229 | } | ||
| 230 | |||
| 231 | static void dma_ints_on(struct NCR_ESP *esp) | ||
| 232 | { | ||
| 233 | enable_irq(esp->irq); | ||
| 234 | } | ||
| 235 | |||
| 236 | static int dma_irq_p(struct NCR_ESP *esp) | ||
| 237 | { | ||
| 238 | return (esp_read(esp->eregs->esp_status) & ESP_STAT_INTR); | ||
| 239 | } | ||
| 240 | |||
| 241 | static void dma_led_off(struct NCR_ESP *esp) | ||
| 242 | { | ||
| 243 | ((struct blz2060_dma_registers *) (esp->dregs))->dma_led_ctrl = | ||
| 244 | BLZ2060_DMA_LED; | ||
| 245 | } | ||
| 246 | |||
| 247 | static void dma_led_on(struct NCR_ESP *esp) | ||
| 248 | { | ||
| 249 | ((struct blz2060_dma_registers *) (esp->dregs))->dma_led_ctrl = 0; | ||
| 250 | } | ||
| 251 | |||
| 252 | static int dma_ports_p(struct NCR_ESP *esp) | ||
| 253 | { | ||
| 254 | return ((amiga_custom.intenar) & IF_PORTS); | ||
| 255 | } | ||
| 256 | |||
| 257 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write) | ||
| 258 | { | ||
| 259 | /* On the Sparc, DMA_ST_WRITE means "move data from device to memory" | ||
| 260 | * so when (write) is true, it actually means READ! | ||
| 261 | */ | ||
| 262 | if(write){ | ||
| 263 | dma_init_read(esp, addr, count); | ||
| 264 | } else { | ||
| 265 | dma_init_write(esp, addr, count); | ||
| 266 | } | ||
| 267 | } | ||
| 268 | |||
| 269 | #define HOSTS_C | ||
| 270 | |||
| 271 | int blz2060_esp_release(struct Scsi_Host *instance) | ||
| 272 | { | ||
| 273 | #ifdef MODULE | ||
| 274 | unsigned long address = (unsigned long)((struct NCR_ESP *)instance->hostdata)->edev; | ||
| 275 | |||
| 276 | esp_deallocate((struct NCR_ESP *)instance->hostdata); | ||
| 277 | esp_release(); | ||
| 278 | release_mem_region(address, sizeof(struct ESP_regs)); | ||
| 279 | free_irq(IRQ_AMIGA_PORTS, esp_intr); | ||
| 280 | #endif | ||
| 281 | return 1; | ||
| 282 | } | ||
| 283 | |||
| 284 | |||
| 285 | static struct scsi_host_template driver_template = { | ||
| 286 | .proc_name = "esp-blz2060", | ||
| 287 | .proc_info = esp_proc_info, | ||
| 288 | .name = "Blizzard2060 SCSI", | ||
| 289 | .detect = blz2060_esp_detect, | ||
| 290 | .slave_alloc = esp_slave_alloc, | ||
| 291 | .slave_destroy = esp_slave_destroy, | ||
| 292 | .release = blz2060_esp_release, | ||
| 293 | .queuecommand = esp_queue, | ||
| 294 | .eh_abort_handler = esp_abort, | ||
| 295 | .eh_bus_reset_handler = esp_reset, | ||
| 296 | .can_queue = 7, | ||
| 297 | .this_id = 7, | ||
| 298 | .sg_tablesize = SG_ALL, | ||
| 299 | .cmd_per_lun = 1, | ||
| 300 | .use_clustering = ENABLE_CLUSTERING | ||
| 301 | }; | ||
| 302 | |||
| 303 | |||
| 304 | #include "scsi_module.c" | ||
| 305 | |||
| 306 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/scsi/cyberstorm.c b/drivers/scsi/cyberstorm.c deleted file mode 100644 index c6b98a42e89d..000000000000 --- a/drivers/scsi/cyberstorm.c +++ /dev/null | |||
| @@ -1,377 +0,0 @@ | |||
| 1 | /* cyberstorm.c: Driver for CyberStorm SCSI Controller. | ||
| 2 | * | ||
| 3 | * Copyright (C) 1996 Jesper Skov (jskov@cygnus.co.uk) | ||
| 4 | * | ||
| 5 | * The CyberStorm SCSI driver is based on David S. Miller's ESP driver | ||
| 6 | * for the Sparc computers. | ||
| 7 | * | ||
| 8 | * This work was made possible by Phase5 who willingly (and most generously) | ||
| 9 | * supported me with hardware and all the information I needed. | ||
| 10 | */ | ||
| 11 | |||
| 12 | /* TODO: | ||
| 13 | * | ||
| 14 | * 1) Figure out how to make a cleaner merge with the sparc driver with regard | ||
| 15 | * to the caches and the Sparc MMU mapping. | ||
| 16 | * 2) Make as few routines required outside the generic driver. A lot of the | ||
| 17 | * routines in this file used to be inline! | ||
| 18 | */ | ||
| 19 | |||
| 20 | #include <linux/module.h> | ||
| 21 | |||
| 22 | #include <linux/init.h> | ||
| 23 | #include <linux/kernel.h> | ||
| 24 | #include <linux/delay.h> | ||
| 25 | #include <linux/types.h> | ||
| 26 | #include <linux/string.h> | ||
| 27 | #include <linux/slab.h> | ||
| 28 | #include <linux/blkdev.h> | ||
| 29 | #include <linux/proc_fs.h> | ||
| 30 | #include <linux/stat.h> | ||
| 31 | #include <linux/interrupt.h> | ||
| 32 | |||
| 33 | #include "scsi.h" | ||
| 34 | #include <scsi/scsi_host.h> | ||
| 35 | #include "NCR53C9x.h" | ||
| 36 | |||
| 37 | #include <linux/zorro.h> | ||
| 38 | #include <asm/irq.h> | ||
| 39 | #include <asm/amigaints.h> | ||
| 40 | #include <asm/amigahw.h> | ||
| 41 | |||
| 42 | #include <asm/pgtable.h> | ||
| 43 | |||
| 44 | /* The controller registers can be found in the Z2 config area at these | ||
| 45 | * offsets: | ||
| 46 | */ | ||
| 47 | #define CYBER_ESP_ADDR 0xf400 | ||
| 48 | #define CYBER_DMA_ADDR 0xf800 | ||
| 49 | |||
| 50 | |||
| 51 | /* The CyberStorm DMA interface */ | ||
| 52 | struct cyber_dma_registers { | ||
| 53 | volatile unsigned char dma_addr0; /* DMA address (MSB) [0x000] */ | ||
| 54 | unsigned char dmapad1[1]; | ||
| 55 | volatile unsigned char dma_addr1; /* DMA address [0x002] */ | ||
| 56 | unsigned char dmapad2[1]; | ||
| 57 | volatile unsigned char dma_addr2; /* DMA address [0x004] */ | ||
| 58 | unsigned char dmapad3[1]; | ||
| 59 | volatile unsigned char dma_addr3; /* DMA address (LSB) [0x006] */ | ||
| 60 | unsigned char dmapad4[0x3fb]; | ||
| 61 | volatile unsigned char cond_reg; /* DMA cond (ro) [0x402] */ | ||
| 62 | #define ctrl_reg cond_reg /* DMA control (wo) [0x402] */ | ||
| 63 | }; | ||
| 64 | |||
| 65 | /* DMA control bits */ | ||
| 66 | #define CYBER_DMA_LED 0x80 /* HD led control 1 = on */ | ||
| 67 | #define CYBER_DMA_WRITE 0x40 /* DMA direction. 1 = write */ | ||
| 68 | #define CYBER_DMA_Z3 0x20 /* 16 (Z2) or 32 (CHIP/Z3) bit DMA transfer */ | ||
| 69 | |||
| 70 | /* DMA status bits */ | ||
| 71 | #define CYBER_DMA_HNDL_INTR 0x80 /* DMA IRQ pending? */ | ||
| 72 | |||
| 73 | /* The bits below appears to be Phase5 Debug bits only; they were not | ||
| 74 | * described by Phase5 so using them may seem a bit stupid... | ||
| 75 | */ | ||
| 76 | #define CYBER_HOST_ID 0x02 /* If set, host ID should be 7, otherwise | ||
| 77 | * it should be 6. | ||
| 78 | */ | ||
| 79 | #define CYBER_SLOW_CABLE 0x08 /* If *not* set, assume SLOW_CABLE */ | ||
| 80 | |||
| 81 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count); | ||
| 82 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 83 | static void dma_dump_state(struct NCR_ESP *esp); | ||
| 84 | static void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length); | ||
| 85 | static void dma_init_write(struct NCR_ESP *esp, __u32 addr, int length); | ||
| 86 | static void dma_ints_off(struct NCR_ESP *esp); | ||
| 87 | static void dma_ints_on(struct NCR_ESP *esp); | ||
| 88 | static int dma_irq_p(struct NCR_ESP *esp); | ||
| 89 | static void dma_led_off(struct NCR_ESP *esp); | ||
| 90 | static void dma_led_on(struct NCR_ESP *esp); | ||
| 91 | static int dma_ports_p(struct NCR_ESP *esp); | ||
| 92 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write); | ||
| 93 | |||
| 94 | static unsigned char ctrl_data = 0; /* Keep backup of the stuff written | ||
| 95 | * to ctrl_reg. Always write a copy | ||
| 96 | * to this register when writing to | ||
| 97 | * the hardware register! | ||
| 98 | */ | ||
| 99 | |||
| 100 | static volatile unsigned char cmd_buffer[16]; | ||
| 101 | /* This is where all commands are put | ||
| 102 | * before they are transferred to the ESP chip | ||
| 103 | * via PIO. | ||
| 104 | */ | ||
| 105 | |||
| 106 | /***************************************************************** Detection */ | ||
| 107 | int __init cyber_esp_detect(struct scsi_host_template *tpnt) | ||
| 108 | { | ||
| 109 | struct NCR_ESP *esp; | ||
| 110 | struct zorro_dev *z = NULL; | ||
| 111 | unsigned long address; | ||
| 112 | |||
| 113 | while ((z = zorro_find_device(ZORRO_WILDCARD, z))) { | ||
| 114 | unsigned long board = z->resource.start; | ||
| 115 | if ((z->id == ZORRO_PROD_PHASE5_BLIZZARD_1220_CYBERSTORM || | ||
| 116 | z->id == ZORRO_PROD_PHASE5_BLIZZARD_1230_II_FASTLANE_Z3_CYBERSCSI_CYBERSTORM060) && | ||
| 117 | request_mem_region(board+CYBER_ESP_ADDR, | ||
| 118 | sizeof(struct ESP_regs), "NCR53C9x")) { | ||
| 119 | /* Figure out if this is a CyberStorm or really a | ||
| 120 | * Fastlane/Blizzard Mk II by looking at the board size. | ||
| 121 | * CyberStorm maps 64kB | ||
| 122 | * (ZORRO_PROD_PHASE5_BLIZZARD_1220_CYBERSTORM does anyway) | ||
| 123 | */ | ||
| 124 | if(z->resource.end-board != 0xffff) { | ||
| 125 | release_mem_region(board+CYBER_ESP_ADDR, | ||
| 126 | sizeof(struct ESP_regs)); | ||
| 127 | return 0; | ||
| 128 | } | ||
| 129 | esp = esp_allocate(tpnt, (void *)board + CYBER_ESP_ADDR, 0); | ||
| 130 | |||
| 131 | /* Do command transfer with programmed I/O */ | ||
| 132 | esp->do_pio_cmds = 1; | ||
| 133 | |||
| 134 | /* Required functions */ | ||
| 135 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 136 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 137 | esp->dma_dump_state = &dma_dump_state; | ||
| 138 | esp->dma_init_read = &dma_init_read; | ||
| 139 | esp->dma_init_write = &dma_init_write; | ||
| 140 | esp->dma_ints_off = &dma_ints_off; | ||
| 141 | esp->dma_ints_on = &dma_ints_on; | ||
| 142 | esp->dma_irq_p = &dma_irq_p; | ||
| 143 | esp->dma_ports_p = &dma_ports_p; | ||
| 144 | esp->dma_setup = &dma_setup; | ||
| 145 | |||
| 146 | /* Optional functions */ | ||
| 147 | esp->dma_barrier = 0; | ||
| 148 | esp->dma_drain = 0; | ||
| 149 | esp->dma_invalidate = 0; | ||
| 150 | esp->dma_irq_entry = 0; | ||
| 151 | esp->dma_irq_exit = 0; | ||
| 152 | esp->dma_led_on = &dma_led_on; | ||
| 153 | esp->dma_led_off = &dma_led_off; | ||
| 154 | esp->dma_poll = 0; | ||
| 155 | esp->dma_reset = 0; | ||
| 156 | |||
| 157 | /* SCSI chip speed */ | ||
| 158 | esp->cfreq = 40000000; | ||
| 159 | |||
| 160 | /* The DMA registers on the CyberStorm are mapped | ||
| 161 | * relative to the device (i.e. in the same Zorro | ||
| 162 | * I/O block). | ||
| 163 | */ | ||
| 164 | address = (unsigned long)ZTWO_VADDR(board); | ||
| 165 | esp->dregs = (void *)(address + CYBER_DMA_ADDR); | ||
| 166 | |||
| 167 | /* ESP register base */ | ||
| 168 | esp->eregs = (struct ESP_regs *)(address + CYBER_ESP_ADDR); | ||
| 169 | |||
| 170 | /* Set the command buffer */ | ||
| 171 | esp->esp_command = cmd_buffer; | ||
| 172 | esp->esp_command_dvma = virt_to_bus((void *)cmd_buffer); | ||
| 173 | |||
| 174 | esp->irq = IRQ_AMIGA_PORTS; | ||
| 175 | request_irq(IRQ_AMIGA_PORTS, esp_intr, IRQF_SHARED, | ||
| 176 | "CyberStorm SCSI", esp->ehost); | ||
| 177 | /* Figure out our scsi ID on the bus */ | ||
| 178 | /* The DMA cond flag contains a hardcoded jumper bit | ||
| 179 | * which can be used to select host number 6 or 7. | ||
| 180 | * However, even though it may change, we use a hardcoded | ||
| 181 | * value of 7. | ||
| 182 | */ | ||
| 183 | esp->scsi_id = 7; | ||
| 184 | |||
| 185 | /* We don't have a differential SCSI-bus. */ | ||
| 186 | esp->diff = 0; | ||
| 187 | |||
| 188 | esp_initialize(esp); | ||
| 189 | |||
| 190 | printk("ESP: Total of %d ESP hosts found, %d actually in use.\n", nesps, esps_in_use); | ||
| 191 | esps_running = esps_in_use; | ||
| 192 | return esps_in_use; | ||
| 193 | } | ||
| 194 | } | ||
| 195 | return 0; | ||
| 196 | } | ||
| 197 | |||
| 198 | /************************************************************* DMA Functions */ | ||
| 199 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count) | ||
| 200 | { | ||
| 201 | /* Since the CyberStorm DMA is fully dedicated to the ESP chip, | ||
| 202 | * the number of bytes sent (to the ESP chip) equals the number | ||
| 203 | * of bytes in the FIFO - there is no buffering in the DMA controller. | ||
| 204 | * XXXX Do I read this right? It is from host to ESP, right? | ||
| 205 | */ | ||
| 206 | return fifo_count; | ||
| 207 | } | ||
| 208 | |||
| 209 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 210 | { | ||
| 211 | /* I don't think there's any limit on the CyberDMA. So we use what | ||
| 212 | * the ESP chip can handle (24 bit). | ||
| 213 | */ | ||
| 214 | unsigned long sz = sp->SCp.this_residual; | ||
| 215 | if(sz > 0x1000000) | ||
| 216 | sz = 0x1000000; | ||
| 217 | return sz; | ||
| 218 | } | ||
| 219 | |||
| 220 | static void dma_dump_state(struct NCR_ESP *esp) | ||
| 221 | { | ||
| 222 | ESPLOG(("esp%d: dma -- cond_reg<%02x>\n", | ||
| 223 | esp->esp_id, ((struct cyber_dma_registers *) | ||
| 224 | (esp->dregs))->cond_reg)); | ||
| 225 | ESPLOG(("intreq:<%04x>, intena:<%04x>\n", | ||
| 226 | amiga_custom.intreqr, amiga_custom.intenar)); | ||
| 227 | } | ||
| 228 | |||
| 229 | static void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 230 | { | ||
| 231 | struct cyber_dma_registers *dregs = | ||
| 232 | (struct cyber_dma_registers *) esp->dregs; | ||
| 233 | |||
| 234 | cache_clear(addr, length); | ||
| 235 | |||
| 236 | addr &= ~(1); | ||
| 237 | dregs->dma_addr0 = (addr >> 24) & 0xff; | ||
| 238 | dregs->dma_addr1 = (addr >> 16) & 0xff; | ||
| 239 | dregs->dma_addr2 = (addr >> 8) & 0xff; | ||
| 240 | dregs->dma_addr3 = (addr ) & 0xff; | ||
| 241 | ctrl_data &= ~(CYBER_DMA_WRITE); | ||
| 242 | |||
| 243 | /* Check if physical address is outside Z2 space and of | ||
| 244 | * block length/block aligned in memory. If this is the | ||
| 245 | * case, enable 32 bit transfer. In all other cases, fall back | ||
| 246 | * to 16 bit transfer. | ||
| 247 | * Obviously 32 bit transfer should be enabled if the DMA address | ||
| 248 | * and length are 32 bit aligned. However, this leads to some | ||
| 249 | * strange behavior. Even 64 bit aligned addr/length fails. | ||
| 250 | * Until I've found a reason for this, 32 bit transfer is only | ||
| 251 | * used for full-block transfers (1kB). | ||
| 252 | * -jskov | ||
| 253 | */ | ||
| 254 | #if 0 | ||
| 255 | if((addr & 0x3fc) || length & 0x3ff || ((addr > 0x200000) && | ||
| 256 | (addr < 0xff0000))) | ||
| 257 | ctrl_data &= ~(CYBER_DMA_Z3); /* Z2, do 16 bit DMA */ | ||
| 258 | else | ||
| 259 | ctrl_data |= CYBER_DMA_Z3; /* CHIP/Z3, do 32 bit DMA */ | ||
| 260 | #else | ||
| 261 | ctrl_data &= ~(CYBER_DMA_Z3); /* Z2, do 16 bit DMA */ | ||
| 262 | #endif | ||
| 263 | dregs->ctrl_reg = ctrl_data; | ||
| 264 | } | ||
| 265 | |||
| 266 | static void dma_init_write(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 267 | { | ||
| 268 | struct cyber_dma_registers *dregs = | ||
| 269 | (struct cyber_dma_registers *) esp->dregs; | ||
| 270 | |||
| 271 | cache_push(addr, length); | ||
| 272 | |||
| 273 | addr |= 1; | ||
| 274 | dregs->dma_addr0 = (addr >> 24) & 0xff; | ||
| 275 | dregs->dma_addr1 = (addr >> 16) & 0xff; | ||
| 276 | dregs->dma_addr2 = (addr >> 8) & 0xff; | ||
| 277 | dregs->dma_addr3 = (addr ) & 0xff; | ||
| 278 | ctrl_data |= CYBER_DMA_WRITE; | ||
| 279 | |||
| 280 | /* See comment above */ | ||
| 281 | #if 0 | ||
| 282 | if((addr & 0x3fc) || length & 0x3ff || ((addr > 0x200000) && | ||
| 283 | (addr < 0xff0000))) | ||
| 284 | ctrl_data &= ~(CYBER_DMA_Z3); /* Z2, do 16 bit DMA */ | ||
| 285 | else | ||
| 286 | ctrl_data |= CYBER_DMA_Z3; /* CHIP/Z3, do 32 bit DMA */ | ||
| 287 | #else | ||
| 288 | ctrl_data &= ~(CYBER_DMA_Z3); /* Z2, do 16 bit DMA */ | ||
| 289 | #endif | ||
| 290 | dregs->ctrl_reg = ctrl_data; | ||
| 291 | } | ||
| 292 | |||
| 293 | static void dma_ints_off(struct NCR_ESP *esp) | ||
| 294 | { | ||
| 295 | disable_irq(esp->irq); | ||
| 296 | } | ||
| 297 | |||
| 298 | static void dma_ints_on(struct NCR_ESP *esp) | ||
| 299 | { | ||
| 300 | enable_irq(esp->irq); | ||
| 301 | } | ||
| 302 | |||
| 303 | static int dma_irq_p(struct NCR_ESP *esp) | ||
| 304 | { | ||
| 305 | /* It's important to check the DMA IRQ bit in the correct way! */ | ||
| 306 | return ((esp_read(esp->eregs->esp_status) & ESP_STAT_INTR) && | ||
| 307 | ((((struct cyber_dma_registers *)(esp->dregs))->cond_reg) & | ||
| 308 | CYBER_DMA_HNDL_INTR)); | ||
| 309 | } | ||
| 310 | |||
| 311 | static void dma_led_off(struct NCR_ESP *esp) | ||
| 312 | { | ||
| 313 | ctrl_data &= ~CYBER_DMA_LED; | ||
| 314 | ((struct cyber_dma_registers *)(esp->dregs))->ctrl_reg = ctrl_data; | ||
| 315 | } | ||
| 316 | |||
| 317 | static void dma_led_on(struct NCR_ESP *esp) | ||
| 318 | { | ||
| 319 | ctrl_data |= CYBER_DMA_LED; | ||
| 320 | ((struct cyber_dma_registers *)(esp->dregs))->ctrl_reg = ctrl_data; | ||
| 321 | } | ||
| 322 | |||
| 323 | static int dma_ports_p(struct NCR_ESP *esp) | ||
| 324 | { | ||
| 325 | return ((amiga_custom.intenar) & IF_PORTS); | ||
| 326 | } | ||
| 327 | |||
| 328 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write) | ||
| 329 | { | ||
| 330 | /* On the Sparc, DMA_ST_WRITE means "move data from device to memory" | ||
| 331 | * so when (write) is true, it actually means READ! | ||
| 332 | */ | ||
| 333 | if(write){ | ||
| 334 | dma_init_read(esp, addr, count); | ||
| 335 | } else { | ||
| 336 | dma_init_write(esp, addr, count); | ||
| 337 | } | ||
| 338 | } | ||
| 339 | |||
| 340 | #define HOSTS_C | ||
| 341 | |||
| 342 | int cyber_esp_release(struct Scsi_Host *instance) | ||
| 343 | { | ||
| 344 | #ifdef MODULE | ||
| 345 | unsigned long address = (unsigned long)((struct NCR_ESP *)instance->hostdata)->edev; | ||
| 346 | |||
| 347 | esp_deallocate((struct NCR_ESP *)instance->hostdata); | ||
| 348 | esp_release(); | ||
| 349 | release_mem_region(address, sizeof(struct ESP_regs)); | ||
| 350 | free_irq(IRQ_AMIGA_PORTS, esp_intr); | ||
| 351 | #endif | ||
| 352 | return 1; | ||
| 353 | } | ||
| 354 | |||
| 355 | |||
| 356 | static struct scsi_host_template driver_template = { | ||
| 357 | .proc_name = "esp-cyberstorm", | ||
| 358 | .proc_info = esp_proc_info, | ||
| 359 | .name = "CyberStorm SCSI", | ||
| 360 | .detect = cyber_esp_detect, | ||
| 361 | .slave_alloc = esp_slave_alloc, | ||
| 362 | .slave_destroy = esp_slave_destroy, | ||
| 363 | .release = cyber_esp_release, | ||
| 364 | .queuecommand = esp_queue, | ||
| 365 | .eh_abort_handler = esp_abort, | ||
| 366 | .eh_bus_reset_handler = esp_reset, | ||
| 367 | .can_queue = 7, | ||
| 368 | .this_id = 7, | ||
| 369 | .sg_tablesize = SG_ALL, | ||
| 370 | .cmd_per_lun = 1, | ||
| 371 | .use_clustering = ENABLE_CLUSTERING | ||
| 372 | }; | ||
| 373 | |||
| 374 | |||
| 375 | #include "scsi_module.c" | ||
| 376 | |||
| 377 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/scsi/cyberstormII.c b/drivers/scsi/cyberstormII.c deleted file mode 100644 index e336e853e66f..000000000000 --- a/drivers/scsi/cyberstormII.c +++ /dev/null | |||
| @@ -1,314 +0,0 @@ | |||
| 1 | /* cyberstormII.c: Driver for CyberStorm SCSI Mk II | ||
| 2 | * | ||
| 3 | * Copyright (C) 1996 Jesper Skov (jskov@cygnus.co.uk) | ||
| 4 | * | ||
| 5 | * This driver is based on cyberstorm.c | ||
| 6 | */ | ||
| 7 | |||
| 8 | /* TODO: | ||
| 9 | * | ||
| 10 | * 1) Figure out how to make a cleaner merge with the sparc driver with regard | ||
| 11 | * to the caches and the Sparc MMU mapping. | ||
| 12 | * 2) Make as few routines required outside the generic driver. A lot of the | ||
| 13 | * routines in this file used to be inline! | ||
| 14 | */ | ||
| 15 | |||
| 16 | #include <linux/module.h> | ||
| 17 | |||
| 18 | #include <linux/init.h> | ||
| 19 | #include <linux/kernel.h> | ||
| 20 | #include <linux/delay.h> | ||
| 21 | #include <linux/types.h> | ||
| 22 | #include <linux/string.h> | ||
| 23 | #include <linux/slab.h> | ||
| 24 | #include <linux/blkdev.h> | ||
| 25 | #include <linux/proc_fs.h> | ||
| 26 | #include <linux/stat.h> | ||
| 27 | #include <linux/interrupt.h> | ||
| 28 | |||
| 29 | #include "scsi.h" | ||
| 30 | #include <scsi/scsi_host.h> | ||
| 31 | #include "NCR53C9x.h" | ||
| 32 | |||
| 33 | #include <linux/zorro.h> | ||
| 34 | #include <asm/irq.h> | ||
| 35 | #include <asm/amigaints.h> | ||
| 36 | #include <asm/amigahw.h> | ||
| 37 | |||
| 38 | #include <asm/pgtable.h> | ||
| 39 | |||
| 40 | /* The controller registers can be found in the Z2 config area at these | ||
| 41 | * offsets: | ||
| 42 | */ | ||
| 43 | #define CYBERII_ESP_ADDR 0x1ff03 | ||
| 44 | #define CYBERII_DMA_ADDR 0x1ff43 | ||
| 45 | |||
| 46 | |||
| 47 | /* The CyberStorm II DMA interface */ | ||
| 48 | struct cyberII_dma_registers { | ||
| 49 | volatile unsigned char cond_reg; /* DMA cond (ro) [0x000] */ | ||
| 50 | #define ctrl_reg cond_reg /* DMA control (wo) [0x000] */ | ||
| 51 | unsigned char dmapad4[0x3f]; | ||
| 52 | volatile unsigned char dma_addr0; /* DMA address (MSB) [0x040] */ | ||
| 53 | unsigned char dmapad1[3]; | ||
| 54 | volatile unsigned char dma_addr1; /* DMA address [0x044] */ | ||
| 55 | unsigned char dmapad2[3]; | ||
| 56 | volatile unsigned char dma_addr2; /* DMA address [0x048] */ | ||
| 57 | unsigned char dmapad3[3]; | ||
| 58 | volatile unsigned char dma_addr3; /* DMA address (LSB) [0x04c] */ | ||
| 59 | }; | ||
| 60 | |||
| 61 | /* DMA control bits */ | ||
| 62 | #define CYBERII_DMA_LED 0x02 /* HD led control 1 = on */ | ||
| 63 | |||
| 64 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count); | ||
| 65 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 66 | static void dma_dump_state(struct NCR_ESP *esp); | ||
| 67 | static void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length); | ||
| 68 | static void dma_init_write(struct NCR_ESP *esp, __u32 addr, int length); | ||
| 69 | static void dma_ints_off(struct NCR_ESP *esp); | ||
| 70 | static void dma_ints_on(struct NCR_ESP *esp); | ||
| 71 | static int dma_irq_p(struct NCR_ESP *esp); | ||
| 72 | static void dma_led_off(struct NCR_ESP *esp); | ||
| 73 | static void dma_led_on(struct NCR_ESP *esp); | ||
| 74 | static int dma_ports_p(struct NCR_ESP *esp); | ||
| 75 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write); | ||
| 76 | |||
| 77 | static volatile unsigned char cmd_buffer[16]; | ||
| 78 | /* This is where all commands are put | ||
| 79 | * before they are transferred to the ESP chip | ||
| 80 | * via PIO. | ||
| 81 | */ | ||
| 82 | |||
| 83 | /***************************************************************** Detection */ | ||
| 84 | int __init cyberII_esp_detect(struct scsi_host_template *tpnt) | ||
| 85 | { | ||
| 86 | struct NCR_ESP *esp; | ||
| 87 | struct zorro_dev *z = NULL; | ||
| 88 | unsigned long address; | ||
| 89 | struct ESP_regs *eregs; | ||
| 90 | |||
| 91 | if ((z = zorro_find_device(ZORRO_PROD_PHASE5_CYBERSTORM_MK_II, z))) { | ||
| 92 | unsigned long board = z->resource.start; | ||
| 93 | if (request_mem_region(board+CYBERII_ESP_ADDR, | ||
| 94 | sizeof(struct ESP_regs), "NCR53C9x")) { | ||
| 95 | /* Do some magic to figure out if the CyberStorm Mk II | ||
| 96 | * is equipped with a SCSI controller | ||
| 97 | */ | ||
| 98 | address = (unsigned long)ZTWO_VADDR(board); | ||
| 99 | eregs = (struct ESP_regs *)(address + CYBERII_ESP_ADDR); | ||
| 100 | |||
| 101 | esp = esp_allocate(tpnt, (void *)board + CYBERII_ESP_ADDR, 0); | ||
| 102 | |||
| 103 | esp_write(eregs->esp_cfg1, (ESP_CONFIG1_PENABLE | 7)); | ||
| 104 | udelay(5); | ||
| 105 | if(esp_read(eregs->esp_cfg1) != (ESP_CONFIG1_PENABLE | 7)) { | ||
| 106 | esp_deallocate(esp); | ||
| 107 | scsi_unregister(esp->ehost); | ||
| 108 | release_mem_region(board+CYBERII_ESP_ADDR, | ||
| 109 | sizeof(struct ESP_regs)); | ||
| 110 | return 0; /* Bail out if address did not hold data */ | ||
| 111 | } | ||
| 112 | |||
| 113 | /* Do command transfer with programmed I/O */ | ||
| 114 | esp->do_pio_cmds = 1; | ||
| 115 | |||
| 116 | /* Required functions */ | ||
| 117 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 118 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 119 | esp->dma_dump_state = &dma_dump_state; | ||
| 120 | esp->dma_init_read = &dma_init_read; | ||
| 121 | esp->dma_init_write = &dma_init_write; | ||
| 122 | esp->dma_ints_off = &dma_ints_off; | ||
| 123 | esp->dma_ints_on = &dma_ints_on; | ||
| 124 | esp->dma_irq_p = &dma_irq_p; | ||
| 125 | esp->dma_ports_p = &dma_ports_p; | ||
| 126 | esp->dma_setup = &dma_setup; | ||
| 127 | |||
| 128 | /* Optional functions */ | ||
| 129 | esp->dma_barrier = 0; | ||
| 130 | esp->dma_drain = 0; | ||
| 131 | esp->dma_invalidate = 0; | ||
| 132 | esp->dma_irq_entry = 0; | ||
| 133 | esp->dma_irq_exit = 0; | ||
| 134 | esp->dma_led_on = &dma_led_on; | ||
| 135 | esp->dma_led_off = &dma_led_off; | ||
| 136 | esp->dma_poll = 0; | ||
| 137 | esp->dma_reset = 0; | ||
| 138 | |||
| 139 | /* SCSI chip speed */ | ||
| 140 | esp->cfreq = 40000000; | ||
| 141 | |||
| 142 | /* The DMA registers on the CyberStorm are mapped | ||
| 143 | * relative to the device (i.e. in the same Zorro | ||
| 144 | * I/O block). | ||
| 145 | */ | ||
| 146 | esp->dregs = (void *)(address + CYBERII_DMA_ADDR); | ||
| 147 | |||
| 148 | /* ESP register base */ | ||
| 149 | esp->eregs = eregs; | ||
| 150 | |||
| 151 | /* Set the command buffer */ | ||
| 152 | esp->esp_command = cmd_buffer; | ||
| 153 | esp->esp_command_dvma = virt_to_bus((void *)cmd_buffer); | ||
| 154 | |||
| 155 | esp->irq = IRQ_AMIGA_PORTS; | ||
| 156 | request_irq(IRQ_AMIGA_PORTS, esp_intr, IRQF_SHARED, | ||
| 157 | "CyberStorm SCSI Mk II", esp->ehost); | ||
| 158 | |||
| 159 | /* Figure out our scsi ID on the bus */ | ||
| 160 | esp->scsi_id = 7; | ||
| 161 | |||
| 162 | /* We don't have a differential SCSI-bus. */ | ||
| 163 | esp->diff = 0; | ||
| 164 | |||
| 165 | esp_initialize(esp); | ||
| 166 | |||
| 167 | printk("ESP: Total of %d ESP hosts found, %d actually in use.\n", nesps, esps_in_use); | ||
| 168 | esps_running = esps_in_use; | ||
| 169 | return esps_in_use; | ||
| 170 | } | ||
| 171 | } | ||
| 172 | return 0; | ||
| 173 | } | ||
| 174 | |||
| 175 | /************************************************************* DMA Functions */ | ||
| 176 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count) | ||
| 177 | { | ||
| 178 | /* Since the CyberStorm DMA is fully dedicated to the ESP chip, | ||
| 179 | * the number of bytes sent (to the ESP chip) equals the number | ||
| 180 | * of bytes in the FIFO - there is no buffering in the DMA controller. | ||
| 181 | * XXXX Do I read this right? It is from host to ESP, right? | ||
| 182 | */ | ||
| 183 | return fifo_count; | ||
| 184 | } | ||
| 185 | |||
| 186 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 187 | { | ||
| 188 | /* I don't think there's any limit on the CyberDMA. So we use what | ||
| 189 | * the ESP chip can handle (24 bit). | ||
| 190 | */ | ||
| 191 | unsigned long sz = sp->SCp.this_residual; | ||
| 192 | if(sz > 0x1000000) | ||
| 193 | sz = 0x1000000; | ||
| 194 | return sz; | ||
| 195 | } | ||
| 196 | |||
| 197 | static void dma_dump_state(struct NCR_ESP *esp) | ||
| 198 | { | ||
| 199 | ESPLOG(("esp%d: dma -- cond_reg<%02x>\n", | ||
| 200 | esp->esp_id, ((struct cyberII_dma_registers *) | ||
| 201 | (esp->dregs))->cond_reg)); | ||
| 202 | ESPLOG(("intreq:<%04x>, intena:<%04x>\n", | ||
| 203 | amiga_custom.intreqr, amiga_custom.intenar)); | ||
| 204 | } | ||
| 205 | |||
| 206 | static void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 207 | { | ||
| 208 | struct cyberII_dma_registers *dregs = | ||
| 209 | (struct cyberII_dma_registers *) esp->dregs; | ||
| 210 | |||
| 211 | cache_clear(addr, length); | ||
| 212 | |||
| 213 | addr &= ~(1); | ||
| 214 | dregs->dma_addr0 = (addr >> 24) & 0xff; | ||
| 215 | dregs->dma_addr1 = (addr >> 16) & 0xff; | ||
| 216 | dregs->dma_addr2 = (addr >> 8) & 0xff; | ||
| 217 | dregs->dma_addr3 = (addr ) & 0xff; | ||
| 218 | } | ||
| 219 | |||
| 220 | static void dma_init_write(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 221 | { | ||
| 222 | struct cyberII_dma_registers *dregs = | ||
| 223 | (struct cyberII_dma_registers *) esp->dregs; | ||
| 224 | |||
| 225 | cache_push(addr, length); | ||
| 226 | |||
| 227 | addr |= 1; | ||
| 228 | dregs->dma_addr0 = (addr >> 24) & 0xff; | ||
| 229 | dregs->dma_addr1 = (addr >> 16) & 0xff; | ||
| 230 | dregs->dma_addr2 = (addr >> 8) & 0xff; | ||
| 231 | dregs->dma_addr3 = (addr ) & 0xff; | ||
| 232 | } | ||
| 233 | |||
| 234 | static void dma_ints_off(struct NCR_ESP *esp) | ||
| 235 | { | ||
| 236 | disable_irq(esp->irq); | ||
| 237 | } | ||
| 238 | |||
| 239 | static void dma_ints_on(struct NCR_ESP *esp) | ||
| 240 | { | ||
| 241 | enable_irq(esp->irq); | ||
| 242 | } | ||
| 243 | |||
| 244 | static int dma_irq_p(struct NCR_ESP *esp) | ||
| 245 | { | ||
| 246 | /* It's important to check the DMA IRQ bit in the correct way! */ | ||
| 247 | return (esp_read(esp->eregs->esp_status) & ESP_STAT_INTR); | ||
| 248 | } | ||
| 249 | |||
| 250 | static void dma_led_off(struct NCR_ESP *esp) | ||
| 251 | { | ||
| 252 | ((struct cyberII_dma_registers *)(esp->dregs))->ctrl_reg &= ~CYBERII_DMA_LED; | ||
| 253 | } | ||
| 254 | |||
| 255 | static void dma_led_on(struct NCR_ESP *esp) | ||
| 256 | { | ||
| 257 | ((struct cyberII_dma_registers *)(esp->dregs))->ctrl_reg |= CYBERII_DMA_LED; | ||
| 258 | } | ||
| 259 | |||
| 260 | static int dma_ports_p(struct NCR_ESP *esp) | ||
| 261 | { | ||
| 262 | return ((amiga_custom.intenar) & IF_PORTS); | ||
| 263 | } | ||
| 264 | |||
| 265 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write) | ||
| 266 | { | ||
| 267 | /* On the Sparc, DMA_ST_WRITE means "move data from device to memory" | ||
| 268 | * so when (write) is true, it actually means READ! | ||
| 269 | */ | ||
| 270 | if(write){ | ||
| 271 | dma_init_read(esp, addr, count); | ||
| 272 | } else { | ||
| 273 | dma_init_write(esp, addr, count); | ||
| 274 | } | ||
| 275 | } | ||
| 276 | |||
| 277 | #define HOSTS_C | ||
| 278 | |||
| 279 | int cyberII_esp_release(struct Scsi_Host *instance) | ||
| 280 | { | ||
| 281 | #ifdef MODULE | ||
| 282 | unsigned long address = (unsigned long)((struct NCR_ESP *)instance->hostdata)->edev; | ||
| 283 | |||
| 284 | esp_deallocate((struct NCR_ESP *)instance->hostdata); | ||
| 285 | esp_release(); | ||
| 286 | release_mem_region(address, sizeof(struct ESP_regs)); | ||
| 287 | free_irq(IRQ_AMIGA_PORTS, esp_intr); | ||
| 288 | #endif | ||
| 289 | return 1; | ||
| 290 | } | ||
| 291 | |||
| 292 | |||
| 293 | static struct scsi_host_template driver_template = { | ||
| 294 | .proc_name = "esp-cyberstormII", | ||
| 295 | .proc_info = esp_proc_info, | ||
| 296 | .name = "CyberStorm Mk II SCSI", | ||
| 297 | .detect = cyberII_esp_detect, | ||
| 298 | .slave_alloc = esp_slave_alloc, | ||
| 299 | .slave_destroy = esp_slave_destroy, | ||
| 300 | .release = cyberII_esp_release, | ||
| 301 | .queuecommand = esp_queue, | ||
| 302 | .eh_abort_handler = esp_abort, | ||
| 303 | .eh_bus_reset_handler = esp_reset, | ||
| 304 | .can_queue = 7, | ||
| 305 | .this_id = 7, | ||
| 306 | .sg_tablesize = SG_ALL, | ||
| 307 | .cmd_per_lun = 1, | ||
| 308 | .use_clustering = ENABLE_CLUSTERING | ||
| 309 | }; | ||
| 310 | |||
| 311 | |||
| 312 | #include "scsi_module.c" | ||
| 313 | |||
| 314 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/scsi/dc395x.c b/drivers/scsi/dc395x.c index 22ef3716e786..e351db6c0077 100644 --- a/drivers/scsi/dc395x.c +++ b/drivers/scsi/dc395x.c | |||
| @@ -4267,7 +4267,7 @@ static int __devinit adapter_sg_tables_alloc(struct AdapterCtlBlk *acb) | |||
| 4267 | const unsigned srbs_per_page = PAGE_SIZE/SEGMENTX_LEN; | 4267 | const unsigned srbs_per_page = PAGE_SIZE/SEGMENTX_LEN; |
| 4268 | int srb_idx = 0; | 4268 | int srb_idx = 0; |
| 4269 | unsigned i = 0; | 4269 | unsigned i = 0; |
| 4270 | struct SGentry *ptr; | 4270 | struct SGentry *uninitialized_var(ptr); |
| 4271 | 4271 | ||
| 4272 | for (i = 0; i < DC395x_MAX_SRB_CNT; i++) | 4272 | for (i = 0; i < DC395x_MAX_SRB_CNT; i++) |
| 4273 | acb->srb_array[i].segment_x = NULL; | 4273 | acb->srb_array[i].segment_x = NULL; |
diff --git a/drivers/scsi/dec_esp.c b/drivers/scsi/dec_esp.c deleted file mode 100644 index d42ad663ffee..000000000000 --- a/drivers/scsi/dec_esp.c +++ /dev/null | |||
| @@ -1,687 +0,0 @@ | |||
| 1 | /* | ||
| 2 | * dec_esp.c: Driver for SCSI chips on IOASIC based TURBOchannel DECstations | ||
| 3 | * and TURBOchannel PMAZ-A cards | ||
| 4 | * | ||
| 5 | * TURBOchannel changes by Harald Koerfgen | ||
| 6 | * PMAZ-A support by David Airlie | ||
| 7 | * | ||
| 8 | * based on jazz_esp.c: | ||
| 9 | * Copyright (C) 1997 Thomas Bogendoerfer (tsbogend@alpha.franken.de) | ||
| 10 | * | ||
| 11 | * jazz_esp is based on David S. Miller's ESP driver and cyber_esp | ||
| 12 | * | ||
| 13 | * 20000819 - Small PMAZ-AA fixes by Florian Lohoff <flo@rfc822.org> | ||
| 14 | * Be warned the PMAZ-AA works currently as a single card. | ||
| 15 | * Dont try to put multiple cards in one machine - They are | ||
| 16 | * both detected but it may crash under high load garbling your | ||
| 17 | * data. | ||
| 18 | * 20001005 - Initialization fixes for 2.4.0-test9 | ||
| 19 | * Florian Lohoff <flo@rfc822.org> | ||
| 20 | * | ||
| 21 | * Copyright (C) 2002, 2003, 2005, 2006 Maciej W. Rozycki | ||
| 22 | */ | ||
| 23 | |||
| 24 | #include <linux/kernel.h> | ||
| 25 | #include <linux/delay.h> | ||
| 26 | #include <linux/types.h> | ||
| 27 | #include <linux/string.h> | ||
| 28 | #include <linux/slab.h> | ||
| 29 | #include <linux/blkdev.h> | ||
| 30 | #include <linux/proc_fs.h> | ||
| 31 | #include <linux/spinlock.h> | ||
| 32 | #include <linux/stat.h> | ||
| 33 | #include <linux/tc.h> | ||
| 34 | |||
| 35 | #include <asm/dma.h> | ||
| 36 | #include <asm/irq.h> | ||
| 37 | #include <asm/pgtable.h> | ||
| 38 | #include <asm/system.h> | ||
| 39 | |||
| 40 | #include <asm/dec/interrupts.h> | ||
| 41 | #include <asm/dec/ioasic.h> | ||
| 42 | #include <asm/dec/ioasic_addrs.h> | ||
| 43 | #include <asm/dec/ioasic_ints.h> | ||
| 44 | #include <asm/dec/machtype.h> | ||
| 45 | #include <asm/dec/system.h> | ||
| 46 | |||
| 47 | #define DEC_SCSI_SREG 0 | ||
| 48 | #define DEC_SCSI_DMAREG 0x40000 | ||
| 49 | #define DEC_SCSI_SRAM 0x80000 | ||
| 50 | #define DEC_SCSI_DIAG 0xC0000 | ||
| 51 | |||
| 52 | #include "scsi.h" | ||
| 53 | #include <scsi/scsi_host.h> | ||
| 54 | #include "NCR53C9x.h" | ||
| 55 | |||
| 56 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count); | ||
| 57 | static void dma_drain(struct NCR_ESP *esp); | ||
| 58 | static int dma_can_transfer(struct NCR_ESP *esp, struct scsi_cmnd *sp); | ||
| 59 | static void dma_dump_state(struct NCR_ESP *esp); | ||
| 60 | static void dma_init_read(struct NCR_ESP *esp, u32 vaddress, int length); | ||
| 61 | static void dma_init_write(struct NCR_ESP *esp, u32 vaddress, int length); | ||
| 62 | static void dma_ints_off(struct NCR_ESP *esp); | ||
| 63 | static void dma_ints_on(struct NCR_ESP *esp); | ||
| 64 | static int dma_irq_p(struct NCR_ESP *esp); | ||
| 65 | static int dma_ports_p(struct NCR_ESP *esp); | ||
| 66 | static void dma_setup(struct NCR_ESP *esp, u32 addr, int count, int write); | ||
| 67 | static void dma_mmu_get_scsi_one(struct NCR_ESP *esp, struct scsi_cmnd * sp); | ||
| 68 | static void dma_mmu_get_scsi_sgl(struct NCR_ESP *esp, struct scsi_cmnd * sp); | ||
| 69 | static void dma_advance_sg(struct scsi_cmnd * sp); | ||
| 70 | |||
| 71 | static void pmaz_dma_drain(struct NCR_ESP *esp); | ||
| 72 | static void pmaz_dma_init_read(struct NCR_ESP *esp, u32 vaddress, int length); | ||
| 73 | static void pmaz_dma_init_write(struct NCR_ESP *esp, u32 vaddress, int length); | ||
| 74 | static void pmaz_dma_ints_off(struct NCR_ESP *esp); | ||
| 75 | static void pmaz_dma_ints_on(struct NCR_ESP *esp); | ||
| 76 | static void pmaz_dma_setup(struct NCR_ESP *esp, u32 addr, int count, int write); | ||
| 77 | static void pmaz_dma_mmu_get_scsi_one(struct NCR_ESP *esp, struct scsi_cmnd * sp); | ||
| 78 | |||
| 79 | #define TC_ESP_RAM_SIZE 0x20000 | ||
| 80 | #define ESP_TGT_DMA_SIZE ((TC_ESP_RAM_SIZE/7) & ~(sizeof(int)-1)) | ||
| 81 | #define ESP_NCMD 7 | ||
| 82 | |||
| 83 | #define TC_ESP_DMAR_MASK 0x1ffff | ||
| 84 | #define TC_ESP_DMAR_WRITE 0x80000000 | ||
| 85 | #define TC_ESP_DMA_ADDR(x) ((unsigned)(x) & TC_ESP_DMAR_MASK) | ||
| 86 | |||
| 87 | u32 esp_virt_buffer; | ||
| 88 | int scsi_current_length; | ||
| 89 | |||
| 90 | volatile unsigned char cmd_buffer[16]; | ||
| 91 | volatile unsigned char pmaz_cmd_buffer[16]; | ||
| 92 | /* This is where all commands are put | ||
| 93 | * before they are trasfered to the ESP chip | ||
| 94 | * via PIO. | ||
| 95 | */ | ||
| 96 | |||
| 97 | static irqreturn_t scsi_dma_merr_int(int, void *); | ||
| 98 | static irqreturn_t scsi_dma_err_int(int, void *); | ||
| 99 | static irqreturn_t scsi_dma_int(int, void *); | ||
| 100 | |||
| 101 | static struct scsi_host_template dec_esp_template = { | ||
| 102 | .module = THIS_MODULE, | ||
| 103 | .name = "NCR53C94", | ||
| 104 | .info = esp_info, | ||
| 105 | .queuecommand = esp_queue, | ||
| 106 | .eh_abort_handler = esp_abort, | ||
| 107 | .eh_bus_reset_handler = esp_reset, | ||
| 108 | .slave_alloc = esp_slave_alloc, | ||
| 109 | .slave_destroy = esp_slave_destroy, | ||
| 110 | .proc_info = esp_proc_info, | ||
| 111 | .proc_name = "dec_esp", | ||
| 112 | .can_queue = 7, | ||
| 113 | .sg_tablesize = SG_ALL, | ||
| 114 | .cmd_per_lun = 1, | ||
| 115 | .use_clustering = DISABLE_CLUSTERING, | ||
| 116 | }; | ||
| 117 | |||
| 118 | static struct NCR_ESP *dec_esp_platform; | ||
| 119 | |||
| 120 | /***************************************************************** Detection */ | ||
| 121 | static int dec_esp_platform_probe(void) | ||
| 122 | { | ||
| 123 | struct NCR_ESP *esp; | ||
| 124 | int err = 0; | ||
| 125 | |||
| 126 | if (IOASIC) { | ||
| 127 | esp = esp_allocate(&dec_esp_template, NULL, 1); | ||
| 128 | |||
| 129 | /* Do command transfer with programmed I/O */ | ||
| 130 | esp->do_pio_cmds = 1; | ||
| 131 | |||
| 132 | /* Required functions */ | ||
| 133 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 134 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 135 | esp->dma_dump_state = &dma_dump_state; | ||
| 136 | esp->dma_init_read = &dma_init_read; | ||
| 137 | esp->dma_init_write = &dma_init_write; | ||
| 138 | esp->dma_ints_off = &dma_ints_off; | ||
| 139 | esp->dma_ints_on = &dma_ints_on; | ||
| 140 | esp->dma_irq_p = &dma_irq_p; | ||
| 141 | esp->dma_ports_p = &dma_ports_p; | ||
| 142 | esp->dma_setup = &dma_setup; | ||
| 143 | |||
| 144 | /* Optional functions */ | ||
| 145 | esp->dma_barrier = 0; | ||
| 146 | esp->dma_drain = &dma_drain; | ||
| 147 | esp->dma_invalidate = 0; | ||
| 148 | esp->dma_irq_entry = 0; | ||
| 149 | esp->dma_irq_exit = 0; | ||
| 150 | esp->dma_poll = 0; | ||
| 151 | esp->dma_reset = 0; | ||
| 152 | esp->dma_led_off = 0; | ||
| 153 | esp->dma_led_on = 0; | ||
| 154 | |||
| 155 | /* virtual DMA functions */ | ||
| 156 | esp->dma_mmu_get_scsi_one = &dma_mmu_get_scsi_one; | ||
| 157 | esp->dma_mmu_get_scsi_sgl = &dma_mmu_get_scsi_sgl; | ||
| 158 | esp->dma_mmu_release_scsi_one = 0; | ||
| 159 | esp->dma_mmu_release_scsi_sgl = 0; | ||
| 160 | esp->dma_advance_sg = &dma_advance_sg; | ||
| 161 | |||
| 162 | |||
| 163 | /* SCSI chip speed */ | ||
| 164 | esp->cfreq = 25000000; | ||
| 165 | |||
| 166 | esp->dregs = 0; | ||
| 167 | |||
| 168 | /* ESP register base */ | ||
| 169 | esp->eregs = (void *)CKSEG1ADDR(dec_kn_slot_base + | ||
| 170 | IOASIC_SCSI); | ||
| 171 | |||
| 172 | /* Set the command buffer */ | ||
| 173 | esp->esp_command = (volatile unsigned char *) cmd_buffer; | ||
| 174 | |||
| 175 | /* get virtual dma address for command buffer */ | ||
| 176 | esp->esp_command_dvma = virt_to_phys(cmd_buffer); | ||
| 177 | |||
| 178 | esp->irq = dec_interrupt[DEC_IRQ_ASC]; | ||
| 179 | |||
| 180 | esp->scsi_id = 7; | ||
| 181 | |||
| 182 | /* Check for differential SCSI-bus */ | ||
| 183 | esp->diff = 0; | ||
| 184 | |||
| 185 | err = request_irq(esp->irq, esp_intr, IRQF_DISABLED, | ||
| 186 | "ncr53c94", esp->ehost); | ||
| 187 | if (err) | ||
| 188 | goto err_alloc; | ||
| 189 | err = request_irq(dec_interrupt[DEC_IRQ_ASC_MERR], | ||
| 190 | scsi_dma_merr_int, IRQF_DISABLED, | ||
| 191 | "ncr53c94 error", esp->ehost); | ||
| 192 | if (err) | ||
| 193 | goto err_irq; | ||
| 194 | err = request_irq(dec_interrupt[DEC_IRQ_ASC_ERR], | ||
| 195 | scsi_dma_err_int, IRQF_DISABLED, | ||
| 196 | "ncr53c94 overrun", esp->ehost); | ||
| 197 | if (err) | ||
| 198 | goto err_irq_merr; | ||
| 199 | err = request_irq(dec_interrupt[DEC_IRQ_ASC_DMA], scsi_dma_int, | ||
| 200 | IRQF_DISABLED, "ncr53c94 dma", esp->ehost); | ||
| 201 | if (err) | ||
| 202 | goto err_irq_err; | ||
| 203 | |||
| 204 | esp_initialize(esp); | ||
| 205 | |||
| 206 | err = scsi_add_host(esp->ehost, NULL); | ||
| 207 | if (err) { | ||
| 208 | printk(KERN_ERR "ESP: Unable to register adapter\n"); | ||
| 209 | goto err_irq_dma; | ||
| 210 | } | ||
| 211 | |||
| 212 | scsi_scan_host(esp->ehost); | ||
| 213 | |||
| 214 | dec_esp_platform = esp; | ||
| 215 | } | ||
| 216 | |||
| 217 | return 0; | ||
| 218 | |||
| 219 | err_irq_dma: | ||
| 220 | free_irq(dec_interrupt[DEC_IRQ_ASC_DMA], esp->ehost); | ||
| 221 | err_irq_err: | ||
| 222 | free_irq(dec_interrupt[DEC_IRQ_ASC_ERR], esp->ehost); | ||
| 223 | err_irq_merr: | ||
| 224 | free_irq(dec_interrupt[DEC_IRQ_ASC_MERR], esp->ehost); | ||
| 225 | err_irq: | ||
| 226 | free_irq(esp->irq, esp->ehost); | ||
| 227 | err_alloc: | ||
| 228 | esp_deallocate(esp); | ||
| 229 | scsi_host_put(esp->ehost); | ||
| 230 | return err; | ||
| 231 | } | ||
| 232 | |||
| 233 | static int __init dec_esp_probe(struct device *dev) | ||
| 234 | { | ||
| 235 | struct NCR_ESP *esp; | ||
| 236 | resource_size_t start, len; | ||
| 237 | int err; | ||
| 238 | |||
| 239 | esp = esp_allocate(&dec_esp_template, NULL, 1); | ||
| 240 | |||
| 241 | dev_set_drvdata(dev, esp); | ||
| 242 | |||
| 243 | start = to_tc_dev(dev)->resource.start; | ||
| 244 | len = to_tc_dev(dev)->resource.end - start + 1; | ||
| 245 | |||
| 246 | if (!request_mem_region(start, len, dev->bus_id)) { | ||
| 247 | printk(KERN_ERR "%s: Unable to reserve MMIO resource\n", | ||
| 248 | dev->bus_id); | ||
| 249 | err = -EBUSY; | ||
| 250 | goto err_alloc; | ||
| 251 | } | ||
| 252 | |||
| 253 | /* Store base addr into esp struct. */ | ||
| 254 | esp->slot = start; | ||
| 255 | |||
| 256 | esp->dregs = 0; | ||
| 257 | esp->eregs = (void *)CKSEG1ADDR(start + DEC_SCSI_SREG); | ||
| 258 | esp->do_pio_cmds = 1; | ||
| 259 | |||
| 260 | /* Set the command buffer. */ | ||
| 261 | esp->esp_command = (volatile unsigned char *)pmaz_cmd_buffer; | ||
| 262 | |||
| 263 | /* Get virtual dma address for command buffer. */ | ||
| 264 | esp->esp_command_dvma = virt_to_phys(pmaz_cmd_buffer); | ||
| 265 | |||
| 266 | esp->cfreq = tc_get_speed(to_tc_dev(dev)->bus); | ||
| 267 | |||
| 268 | esp->irq = to_tc_dev(dev)->interrupt; | ||
| 269 | |||
| 270 | /* Required functions. */ | ||
| 271 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 272 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 273 | esp->dma_dump_state = &dma_dump_state; | ||
| 274 | esp->dma_init_read = &pmaz_dma_init_read; | ||
| 275 | esp->dma_init_write = &pmaz_dma_init_write; | ||
| 276 | esp->dma_ints_off = &pmaz_dma_ints_off; | ||
| 277 | esp->dma_ints_on = &pmaz_dma_ints_on; | ||
| 278 | esp->dma_irq_p = &dma_irq_p; | ||
| 279 | esp->dma_ports_p = &dma_ports_p; | ||
| 280 | esp->dma_setup = &pmaz_dma_setup; | ||
| 281 | |||
| 282 | /* Optional functions. */ | ||
| 283 | esp->dma_barrier = 0; | ||
| 284 | esp->dma_drain = &pmaz_dma_drain; | ||
| 285 | esp->dma_invalidate = 0; | ||
| 286 | esp->dma_irq_entry = 0; | ||
| 287 | esp->dma_irq_exit = 0; | ||
| 288 | esp->dma_poll = 0; | ||
| 289 | esp->dma_reset = 0; | ||
| 290 | esp->dma_led_off = 0; | ||
| 291 | esp->dma_led_on = 0; | ||
| 292 | |||
| 293 | esp->dma_mmu_get_scsi_one = pmaz_dma_mmu_get_scsi_one; | ||
| 294 | esp->dma_mmu_get_scsi_sgl = 0; | ||
| 295 | esp->dma_mmu_release_scsi_one = 0; | ||
| 296 | esp->dma_mmu_release_scsi_sgl = 0; | ||
| 297 | esp->dma_advance_sg = 0; | ||
| 298 | |||
| 299 | err = request_irq(esp->irq, esp_intr, IRQF_DISABLED, "PMAZ_AA", | ||
| 300 | esp->ehost); | ||
| 301 | if (err) { | ||
| 302 | printk(KERN_ERR "%s: Unable to get IRQ %d\n", | ||
| 303 | dev->bus_id, esp->irq); | ||
| 304 | goto err_resource; | ||
| 305 | } | ||
| 306 | |||
| 307 | esp->scsi_id = 7; | ||
| 308 | esp->diff = 0; | ||
| 309 | esp_initialize(esp); | ||
| 310 | |||
| 311 | err = scsi_add_host(esp->ehost, dev); | ||
| 312 | if (err) { | ||
| 313 | printk(KERN_ERR "%s: Unable to register adapter\n", | ||
| 314 | dev->bus_id); | ||
| 315 | goto err_irq; | ||
| 316 | } | ||
| 317 | |||
| 318 | scsi_scan_host(esp->ehost); | ||
| 319 | |||
| 320 | return 0; | ||
| 321 | |||
| 322 | err_irq: | ||
| 323 | free_irq(esp->irq, esp->ehost); | ||
| 324 | |||
| 325 | err_resource: | ||
| 326 | release_mem_region(start, len); | ||
| 327 | |||
| 328 | err_alloc: | ||
| 329 | esp_deallocate(esp); | ||
| 330 | scsi_host_put(esp->ehost); | ||
| 331 | return err; | ||
| 332 | } | ||
| 333 | |||
| 334 | static void __exit dec_esp_platform_remove(void) | ||
| 335 | { | ||
| 336 | struct NCR_ESP *esp = dec_esp_platform; | ||
| 337 | |||
| 338 | free_irq(esp->irq, esp->ehost); | ||
| 339 | esp_deallocate(esp); | ||
| 340 | scsi_host_put(esp->ehost); | ||
| 341 | dec_esp_platform = NULL; | ||
| 342 | } | ||
| 343 | |||
| 344 | static void __exit dec_esp_remove(struct device *dev) | ||
| 345 | { | ||
| 346 | struct NCR_ESP *esp = dev_get_drvdata(dev); | ||
| 347 | |||
| 348 | free_irq(esp->irq, esp->ehost); | ||
| 349 | esp_deallocate(esp); | ||
| 350 | scsi_host_put(esp->ehost); | ||
| 351 | } | ||
| 352 | |||
| 353 | |||
| 354 | /************************************************************* DMA Functions */ | ||
| 355 | static irqreturn_t scsi_dma_merr_int(int irq, void *dev_id) | ||
| 356 | { | ||
| 357 | printk("Got unexpected SCSI DMA Interrupt! < "); | ||
| 358 | printk("SCSI_DMA_MEMRDERR "); | ||
| 359 | printk(">\n"); | ||
| 360 | |||
| 361 | return IRQ_HANDLED; | ||
| 362 | } | ||
| 363 | |||
| 364 | static irqreturn_t scsi_dma_err_int(int irq, void *dev_id) | ||
| 365 | { | ||
| 366 | /* empty */ | ||
| 367 | |||
| 368 | return IRQ_HANDLED; | ||
| 369 | } | ||
| 370 | |||
| 371 | static irqreturn_t scsi_dma_int(int irq, void *dev_id) | ||
| 372 | { | ||
| 373 | u32 scsi_next_ptr; | ||
| 374 | |||
| 375 | scsi_next_ptr = ioasic_read(IO_REG_SCSI_DMA_P); | ||
| 376 | |||
| 377 | /* next page */ | ||
| 378 | scsi_next_ptr = (((scsi_next_ptr >> 3) + PAGE_SIZE) & PAGE_MASK) << 3; | ||
| 379 | ioasic_write(IO_REG_SCSI_DMA_BP, scsi_next_ptr); | ||
| 380 | fast_iob(); | ||
| 381 | |||
| 382 | return IRQ_HANDLED; | ||
| 383 | } | ||
| 384 | |||
| 385 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count) | ||
| 386 | { | ||
| 387 | return fifo_count; | ||
| 388 | } | ||
| 389 | |||
| 390 | static void dma_drain(struct NCR_ESP *esp) | ||
| 391 | { | ||
| 392 | u32 nw, data0, data1, scsi_data_ptr; | ||
| 393 | u16 *p; | ||
| 394 | |||
| 395 | nw = ioasic_read(IO_REG_SCSI_SCR); | ||
| 396 | |||
| 397 | /* | ||
| 398 | * Is there something in the dma buffers left? | ||
| 399 | */ | ||
| 400 | if (nw) { | ||
| 401 | scsi_data_ptr = ioasic_read(IO_REG_SCSI_DMA_P) >> 3; | ||
| 402 | p = phys_to_virt(scsi_data_ptr); | ||
| 403 | switch (nw) { | ||
| 404 | case 1: | ||
| 405 | data0 = ioasic_read(IO_REG_SCSI_SDR0); | ||
| 406 | p[0] = data0 & 0xffff; | ||
| 407 | break; | ||
| 408 | case 2: | ||
| 409 | data0 = ioasic_read(IO_REG_SCSI_SDR0); | ||
| 410 | p[0] = data0 & 0xffff; | ||
| 411 | p[1] = (data0 >> 16) & 0xffff; | ||
| 412 | break; | ||
| 413 | case 3: | ||
| 414 | data0 = ioasic_read(IO_REG_SCSI_SDR0); | ||
| 415 | data1 = ioasic_read(IO_REG_SCSI_SDR1); | ||
| 416 | p[0] = data0 & 0xffff; | ||
| 417 | p[1] = (data0 >> 16) & 0xffff; | ||
| 418 | p[2] = data1 & 0xffff; | ||
| 419 | break; | ||
| 420 | default: | ||
| 421 | printk("Strange: %d words in dma buffer left\n", nw); | ||
| 422 | break; | ||
| 423 | } | ||
| 424 | } | ||
| 425 | } | ||
| 426 | |||
| 427 | static int dma_can_transfer(struct NCR_ESP *esp, struct scsi_cmnd * sp) | ||
| 428 | { | ||
| 429 | return sp->SCp.this_residual; | ||
| 430 | } | ||
| 431 | |||
| 432 | static void dma_dump_state(struct NCR_ESP *esp) | ||
| 433 | { | ||
| 434 | } | ||
| 435 | |||
| 436 | static void dma_init_read(struct NCR_ESP *esp, u32 vaddress, int length) | ||
| 437 | { | ||
| 438 | u32 scsi_next_ptr, ioasic_ssr; | ||
| 439 | unsigned long flags; | ||
| 440 | |||
| 441 | if (vaddress & 3) | ||
| 442 | panic("dec_esp.c: unable to handle partial word transfers, yet..."); | ||
| 443 | |||
| 444 | dma_cache_wback_inv((unsigned long) phys_to_virt(vaddress), length); | ||
| 445 | |||
| 446 | spin_lock_irqsave(&ioasic_ssr_lock, flags); | ||
| 447 | |||
| 448 | fast_mb(); | ||
| 449 | ioasic_ssr = ioasic_read(IO_REG_SSR); | ||
| 450 | |||
| 451 | ioasic_ssr &= ~IO_SSR_SCSI_DMA_EN; | ||
| 452 | ioasic_write(IO_REG_SSR, ioasic_ssr); | ||
| 453 | |||
| 454 | fast_wmb(); | ||
| 455 | ioasic_write(IO_REG_SCSI_SCR, 0); | ||
| 456 | ioasic_write(IO_REG_SCSI_DMA_P, vaddress << 3); | ||
| 457 | |||
| 458 | /* prepare for next page */ | ||
| 459 | scsi_next_ptr = ((vaddress + PAGE_SIZE) & PAGE_MASK) << 3; | ||
| 460 | ioasic_write(IO_REG_SCSI_DMA_BP, scsi_next_ptr); | ||
| 461 | |||
| 462 | ioasic_ssr |= (IO_SSR_SCSI_DMA_DIR | IO_SSR_SCSI_DMA_EN); | ||
| 463 | fast_wmb(); | ||
| 464 | ioasic_write(IO_REG_SSR, ioasic_ssr); | ||
| 465 | |||
| 466 | fast_iob(); | ||
| 467 | spin_unlock_irqrestore(&ioasic_ssr_lock, flags); | ||
| 468 | } | ||
| 469 | |||
| 470 | static void dma_init_write(struct NCR_ESP *esp, u32 vaddress, int length) | ||
| 471 | { | ||
| 472 | u32 scsi_next_ptr, ioasic_ssr; | ||
| 473 | unsigned long flags; | ||
| 474 | |||
| 475 | if (vaddress & 3) | ||
| 476 | panic("dec_esp.c: unable to handle partial word transfers, yet..."); | ||
| 477 | |||
| 478 | dma_cache_wback_inv((unsigned long) phys_to_virt(vaddress), length); | ||
| 479 | |||
| 480 | spin_lock_irqsave(&ioasic_ssr_lock, flags); | ||
| 481 | |||
| 482 | fast_mb(); | ||
| 483 | ioasic_ssr = ioasic_read(IO_REG_SSR); | ||
| 484 | |||
| 485 | ioasic_ssr &= ~(IO_SSR_SCSI_DMA_DIR | IO_SSR_SCSI_DMA_EN); | ||
| 486 | ioasic_write(IO_REG_SSR, ioasic_ssr); | ||
| 487 | |||
| 488 | fast_wmb(); | ||
| 489 | ioasic_write(IO_REG_SCSI_SCR, 0); | ||
| 490 | ioasic_write(IO_REG_SCSI_DMA_P, vaddress << 3); | ||
| 491 | |||
| 492 | /* prepare for next page */ | ||
| 493 | scsi_next_ptr = ((vaddress + PAGE_SIZE) & PAGE_MASK) << 3; | ||
| 494 | ioasic_write(IO_REG_SCSI_DMA_BP, scsi_next_ptr); | ||
| 495 | |||
| 496 | ioasic_ssr |= IO_SSR_SCSI_DMA_EN; | ||
| 497 | fast_wmb(); | ||
| 498 | ioasic_write(IO_REG_SSR, ioasic_ssr); | ||
| 499 | |||
| 500 | fast_iob(); | ||
| 501 | spin_unlock_irqrestore(&ioasic_ssr_lock, flags); | ||
| 502 | } | ||
| 503 | |||
| 504 | static void dma_ints_off(struct NCR_ESP *esp) | ||
| 505 | { | ||
| 506 | disable_irq(dec_interrupt[DEC_IRQ_ASC_DMA]); | ||
| 507 | } | ||
| 508 | |||
| 509 | static void dma_ints_on(struct NCR_ESP *esp) | ||
| 510 | { | ||
| 511 | enable_irq(dec_interrupt[DEC_IRQ_ASC_DMA]); | ||
| 512 | } | ||
| 513 | |||
| 514 | static int dma_irq_p(struct NCR_ESP *esp) | ||
| 515 | { | ||
| 516 | return (esp->eregs->esp_status & ESP_STAT_INTR); | ||
| 517 | } | ||
| 518 | |||
| 519 | static int dma_ports_p(struct NCR_ESP *esp) | ||
| 520 | { | ||
| 521 | /* | ||
| 522 | * FIXME: what's this good for? | ||
| 523 | */ | ||
| 524 | return 1; | ||
| 525 | } | ||
| 526 | |||
| 527 | static void dma_setup(struct NCR_ESP *esp, u32 addr, int count, int write) | ||
| 528 | { | ||
| 529 | /* | ||
| 530 | * DMA_ST_WRITE means "move data from device to memory" | ||
| 531 | * so when (write) is true, it actually means READ! | ||
| 532 | */ | ||
| 533 | if (write) | ||
| 534 | dma_init_read(esp, addr, count); | ||
| 535 | else | ||
| 536 | dma_init_write(esp, addr, count); | ||
| 537 | } | ||
| 538 | |||
| 539 | static void dma_mmu_get_scsi_one(struct NCR_ESP *esp, struct scsi_cmnd * sp) | ||
| 540 | { | ||
| 541 | sp->SCp.ptr = (char *)virt_to_phys(sp->request_buffer); | ||
| 542 | } | ||
| 543 | |||
| 544 | static void dma_mmu_get_scsi_sgl(struct NCR_ESP *esp, struct scsi_cmnd * sp) | ||
| 545 | { | ||
| 546 | int sz = sp->SCp.buffers_residual; | ||
| 547 | struct scatterlist *sg = sp->SCp.buffer; | ||
| 548 | |||
| 549 | while (sz >= 0) { | ||
| 550 | sg[sz].dma_address = page_to_phys(sg[sz].page) + sg[sz].offset; | ||
| 551 | sz--; | ||
| 552 | } | ||
| 553 | sp->SCp.ptr = (char *)(sp->SCp.buffer->dma_address); | ||
| 554 | } | ||
| 555 | |||
| 556 | static void dma_advance_sg(struct scsi_cmnd * sp) | ||
| 557 | { | ||
| 558 | sp->SCp.ptr = (char *)(sp->SCp.buffer->dma_address); | ||
| 559 | } | ||
| 560 | |||
| 561 | static void pmaz_dma_drain(struct NCR_ESP *esp) | ||
| 562 | { | ||
| 563 | memcpy(phys_to_virt(esp_virt_buffer), | ||
| 564 | (void *)CKSEG1ADDR(esp->slot + DEC_SCSI_SRAM + | ||
| 565 | ESP_TGT_DMA_SIZE), | ||
| 566 | scsi_current_length); | ||
| 567 | } | ||
| 568 | |||
| 569 | static void pmaz_dma_init_read(struct NCR_ESP *esp, u32 vaddress, int length) | ||
| 570 | { | ||
| 571 | volatile u32 *dmareg = | ||
| 572 | (volatile u32 *)CKSEG1ADDR(esp->slot + DEC_SCSI_DMAREG); | ||
| 573 | |||
| 574 | if (length > ESP_TGT_DMA_SIZE) | ||
| 575 | length = ESP_TGT_DMA_SIZE; | ||
| 576 | |||
| 577 | *dmareg = TC_ESP_DMA_ADDR(ESP_TGT_DMA_SIZE); | ||
| 578 | |||
| 579 | iob(); | ||
| 580 | |||
| 581 | esp_virt_buffer = vaddress; | ||
| 582 | scsi_current_length = length; | ||
| 583 | } | ||
| 584 | |||
| 585 | static void pmaz_dma_init_write(struct NCR_ESP *esp, u32 vaddress, int length) | ||
| 586 | { | ||
| 587 | volatile u32 *dmareg = | ||
| 588 | (volatile u32 *)CKSEG1ADDR(esp->slot + DEC_SCSI_DMAREG); | ||
| 589 | |||
| 590 | memcpy((void *)CKSEG1ADDR(esp->slot + DEC_SCSI_SRAM + | ||
| 591 | ESP_TGT_DMA_SIZE), | ||
| 592 | phys_to_virt(vaddress), length); | ||
| 593 | |||
| 594 | wmb(); | ||
| 595 | *dmareg = TC_ESP_DMAR_WRITE | TC_ESP_DMA_ADDR(ESP_TGT_DMA_SIZE); | ||
| 596 | |||
| 597 | iob(); | ||
| 598 | } | ||
| 599 | |||
| 600 | static void pmaz_dma_ints_off(struct NCR_ESP *esp) | ||
| 601 | { | ||
| 602 | } | ||
| 603 | |||
| 604 | static void pmaz_dma_ints_on(struct NCR_ESP *esp) | ||
| 605 | { | ||
| 606 | } | ||
| 607 | |||
| 608 | static void pmaz_dma_setup(struct NCR_ESP *esp, u32 addr, int count, int write) | ||
| 609 | { | ||
| 610 | /* | ||
| 611 | * DMA_ST_WRITE means "move data from device to memory" | ||
| 612 | * so when (write) is true, it actually means READ! | ||
| 613 | */ | ||
| 614 | if (write) | ||
| 615 | pmaz_dma_init_read(esp, addr, count); | ||
| 616 | else | ||
| 617 | pmaz_dma_init_write(esp, addr, count); | ||
| 618 | } | ||
| 619 | |||
| 620 | static void pmaz_dma_mmu_get_scsi_one(struct NCR_ESP *esp, struct scsi_cmnd * sp) | ||
| 621 | { | ||
| 622 | sp->SCp.ptr = (char *)virt_to_phys(sp->request_buffer); | ||
| 623 | } | ||
| 624 | |||
| 625 | |||
| 626 | #ifdef CONFIG_TC | ||
| 627 | static int __init dec_esp_tc_probe(struct device *dev); | ||
| 628 | static int __exit dec_esp_tc_remove(struct device *dev); | ||
| 629 | |||
| 630 | static const struct tc_device_id dec_esp_tc_table[] = { | ||
| 631 | { "DEC ", "PMAZ-AA " }, | ||
| 632 | { } | ||
| 633 | }; | ||
| 634 | MODULE_DEVICE_TABLE(tc, dec_esp_tc_table); | ||
| 635 | |||
| 636 | static struct tc_driver dec_esp_tc_driver = { | ||
| 637 | .id_table = dec_esp_tc_table, | ||
| 638 | .driver = { | ||
| 639 | .name = "dec_esp", | ||
| 640 | .bus = &tc_bus_type, | ||
| 641 | .probe = dec_esp_tc_probe, | ||
| 642 | .remove = __exit_p(dec_esp_tc_remove), | ||
| 643 | }, | ||
| 644 | }; | ||
| 645 | |||
| 646 | static int __init dec_esp_tc_probe(struct device *dev) | ||
| 647 | { | ||
| 648 | int status = dec_esp_probe(dev); | ||
| 649 | if (!status) | ||
| 650 | get_device(dev); | ||
| 651 | return status; | ||
| 652 | } | ||
| 653 | |||
| 654 | static int __exit dec_esp_tc_remove(struct device *dev) | ||
| 655 | { | ||
| 656 | put_device(dev); | ||
| 657 | dec_esp_remove(dev); | ||
| 658 | return 0; | ||
| 659 | } | ||
| 660 | #endif | ||
| 661 | |||
| 662 | static int __init dec_esp_init(void) | ||
| 663 | { | ||
| 664 | int status; | ||
| 665 | |||
| 666 | status = tc_register_driver(&dec_esp_tc_driver); | ||
| 667 | if (!status) | ||
| 668 | dec_esp_platform_probe(); | ||
| 669 | |||
| 670 | if (nesps) { | ||
| 671 | pr_info("ESP: Total of %d ESP hosts found, " | ||
| 672 | "%d actually in use.\n", nesps, esps_in_use); | ||
| 673 | esps_running = esps_in_use; | ||
| 674 | } | ||
| 675 | |||
| 676 | return status; | ||
| 677 | } | ||
| 678 | |||
| 679 | static void __exit dec_esp_exit(void) | ||
| 680 | { | ||
| 681 | dec_esp_platform_remove(); | ||
| 682 | tc_unregister_driver(&dec_esp_tc_driver); | ||
| 683 | } | ||
| 684 | |||
| 685 | |||
| 686 | module_init(dec_esp_init); | ||
| 687 | module_exit(dec_esp_exit); | ||
diff --git a/drivers/scsi/fastlane.c b/drivers/scsi/fastlane.c deleted file mode 100644 index 4266a2139b5f..000000000000 --- a/drivers/scsi/fastlane.c +++ /dev/null | |||
| @@ -1,421 +0,0 @@ | |||
| 1 | /* fastlane.c: Driver for Phase5's Fastlane SCSI Controller. | ||
| 2 | * | ||
| 3 | * Copyright (C) 1996 Jesper Skov (jskov@cygnus.co.uk) | ||
| 4 | * | ||
| 5 | * This driver is based on the CyberStorm driver, hence the occasional | ||
| 6 | * reference to CyberStorm. | ||
| 7 | * | ||
| 8 | * Betatesting & crucial adjustments by | ||
| 9 | * Patrik Rak (prak3264@ss1000.ms.mff.cuni.cz) | ||
| 10 | * | ||
| 11 | */ | ||
| 12 | |||
| 13 | /* TODO: | ||
| 14 | * | ||
| 15 | * o According to the doc from laire, it is required to reset the DMA when | ||
| 16 | * the transfer is done. ATM we reset DMA just before every new | ||
| 17 | * dma_init_(read|write). | ||
| 18 | * | ||
| 19 | * 1) Figure out how to make a cleaner merge with the sparc driver with regard | ||
| 20 | * to the caches and the Sparc MMU mapping. | ||
| 21 | * 2) Make as few routines required outside the generic driver. A lot of the | ||
| 22 | * routines in this file used to be inline! | ||
| 23 | */ | ||
| 24 | |||
| 25 | #include <linux/module.h> | ||
| 26 | |||
| 27 | #include <linux/init.h> | ||
| 28 | #include <linux/kernel.h> | ||
| 29 | #include <linux/delay.h> | ||
| 30 | #include <linux/types.h> | ||
| 31 | #include <linux/string.h> | ||
| 32 | #include <linux/slab.h> | ||
| 33 | #include <linux/blkdev.h> | ||
| 34 | #include <linux/proc_fs.h> | ||
| 35 | #include <linux/stat.h> | ||
| 36 | #include <linux/interrupt.h> | ||
| 37 | |||
| 38 | #include "scsi.h" | ||
| 39 | #include <scsi/scsi_host.h> | ||
| 40 | #include "NCR53C9x.h" | ||
| 41 | |||
| 42 | #include <linux/zorro.h> | ||
| 43 | #include <asm/irq.h> | ||
| 44 | |||
| 45 | #include <asm/amigaints.h> | ||
| 46 | #include <asm/amigahw.h> | ||
| 47 | |||
| 48 | #include <asm/pgtable.h> | ||
| 49 | |||
| 50 | /* Such day has just come... */ | ||
| 51 | #if 0 | ||
| 52 | /* Let this defined unless you really need to enable DMA IRQ one day */ | ||
| 53 | #define NODMAIRQ | ||
| 54 | #endif | ||
| 55 | |||
| 56 | /* The controller registers can be found in the Z2 config area at these | ||
| 57 | * offsets: | ||
| 58 | */ | ||
| 59 | #define FASTLANE_ESP_ADDR 0x1000001 | ||
| 60 | #define FASTLANE_DMA_ADDR 0x1000041 | ||
| 61 | |||
| 62 | |||
| 63 | /* The Fastlane DMA interface */ | ||
| 64 | struct fastlane_dma_registers { | ||
| 65 | volatile unsigned char cond_reg; /* DMA status (ro) [0x0000] */ | ||
| 66 | #define ctrl_reg cond_reg /* DMA control (wo) [0x0000] */ | ||
| 67 | unsigned char dmapad1[0x3f]; | ||
| 68 | volatile unsigned char clear_strobe; /* DMA clear (wo) [0x0040] */ | ||
| 69 | }; | ||
| 70 | |||
| 71 | |||
| 72 | /* DMA status bits */ | ||
| 73 | #define FASTLANE_DMA_MINT 0x80 | ||
| 74 | #define FASTLANE_DMA_IACT 0x40 | ||
| 75 | #define FASTLANE_DMA_CREQ 0x20 | ||
| 76 | |||
| 77 | /* DMA control bits */ | ||
| 78 | #define FASTLANE_DMA_FCODE 0xa0 | ||
| 79 | #define FASTLANE_DMA_MASK 0xf3 | ||
| 80 | #define FASTLANE_DMA_LED 0x10 /* HD led control 1 = on */ | ||
| 81 | #define FASTLANE_DMA_WRITE 0x08 /* 1 = write */ | ||
| 82 | #define FASTLANE_DMA_ENABLE 0x04 /* Enable DMA */ | ||
| 83 | #define FASTLANE_DMA_EDI 0x02 /* Enable DMA IRQ ? */ | ||
| 84 | #define FASTLANE_DMA_ESI 0x01 /* Enable SCSI IRQ */ | ||
| 85 | |||
| 86 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count); | ||
| 87 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 88 | static void dma_dump_state(struct NCR_ESP *esp); | ||
| 89 | static void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length); | ||
| 90 | static void dma_init_write(struct NCR_ESP *esp, __u32 vaddr, int length); | ||
| 91 | static void dma_ints_off(struct NCR_ESP *esp); | ||
| 92 | static void dma_ints_on(struct NCR_ESP *esp); | ||
| 93 | static int dma_irq_p(struct NCR_ESP *esp); | ||
| 94 | static void dma_irq_exit(struct NCR_ESP *esp); | ||
| 95 | static void dma_led_off(struct NCR_ESP *esp); | ||
| 96 | static void dma_led_on(struct NCR_ESP *esp); | ||
| 97 | static int dma_ports_p(struct NCR_ESP *esp); | ||
| 98 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write); | ||
| 99 | |||
| 100 | static unsigned char ctrl_data = 0; /* Keep backup of the stuff written | ||
| 101 | * to ctrl_reg. Always write a copy | ||
| 102 | * to this register when writing to | ||
| 103 | * the hardware register! | ||
| 104 | */ | ||
| 105 | |||
| 106 | static volatile unsigned char cmd_buffer[16]; | ||
| 107 | /* This is where all commands are put | ||
| 108 | * before they are transferred to the ESP chip | ||
| 109 | * via PIO. | ||
| 110 | */ | ||
| 111 | |||
| 112 | static inline void dma_clear(struct NCR_ESP *esp) | ||
| 113 | { | ||
| 114 | struct fastlane_dma_registers *dregs = | ||
| 115 | (struct fastlane_dma_registers *) (esp->dregs); | ||
| 116 | unsigned long *t; | ||
| 117 | |||
| 118 | ctrl_data = (ctrl_data & FASTLANE_DMA_MASK); | ||
| 119 | dregs->ctrl_reg = ctrl_data; | ||
| 120 | |||
| 121 | t = (unsigned long *)(esp->edev); | ||
| 122 | |||
| 123 | dregs->clear_strobe = 0; | ||
| 124 | *t = 0 ; | ||
| 125 | } | ||
| 126 | |||
| 127 | /***************************************************************** Detection */ | ||
| 128 | int __init fastlane_esp_detect(struct scsi_host_template *tpnt) | ||
| 129 | { | ||
| 130 | struct NCR_ESP *esp; | ||
| 131 | struct zorro_dev *z = NULL; | ||
| 132 | unsigned long address; | ||
| 133 | |||
| 134 | if ((z = zorro_find_device(ZORRO_PROD_PHASE5_BLIZZARD_1230_II_FASTLANE_Z3_CYBERSCSI_CYBERSTORM060, z))) { | ||
| 135 | unsigned long board = z->resource.start; | ||
| 136 | if (request_mem_region(board+FASTLANE_ESP_ADDR, | ||
| 137 | sizeof(struct ESP_regs), "NCR53C9x")) { | ||
| 138 | /* Check if this is really a fastlane controller. The problem | ||
| 139 | * is that also the cyberstorm and blizzard controllers use | ||
| 140 | * this ID value. Fortunately only Fastlane maps in Z3 space | ||
| 141 | */ | ||
| 142 | if (board < 0x1000000) { | ||
| 143 | goto err_release; | ||
| 144 | } | ||
| 145 | esp = esp_allocate(tpnt, (void *)board + FASTLANE_ESP_ADDR, 0); | ||
| 146 | |||
| 147 | /* Do command transfer with programmed I/O */ | ||
| 148 | esp->do_pio_cmds = 1; | ||
| 149 | |||
| 150 | /* Required functions */ | ||
| 151 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 152 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 153 | esp->dma_dump_state = &dma_dump_state; | ||
| 154 | esp->dma_init_read = &dma_init_read; | ||
| 155 | esp->dma_init_write = &dma_init_write; | ||
| 156 | esp->dma_ints_off = &dma_ints_off; | ||
| 157 | esp->dma_ints_on = &dma_ints_on; | ||
| 158 | esp->dma_irq_p = &dma_irq_p; | ||
| 159 | esp->dma_ports_p = &dma_ports_p; | ||
| 160 | esp->dma_setup = &dma_setup; | ||
| 161 | |||
| 162 | /* Optional functions */ | ||
| 163 | esp->dma_barrier = 0; | ||
| 164 | esp->dma_drain = 0; | ||
| 165 | esp->dma_invalidate = 0; | ||
| 166 | esp->dma_irq_entry = 0; | ||
| 167 | esp->dma_irq_exit = &dma_irq_exit; | ||
| 168 | esp->dma_led_on = &dma_led_on; | ||
| 169 | esp->dma_led_off = &dma_led_off; | ||
| 170 | esp->dma_poll = 0; | ||
| 171 | esp->dma_reset = 0; | ||
| 172 | |||
| 173 | /* Initialize the portBits (enable IRQs) */ | ||
| 174 | ctrl_data = (FASTLANE_DMA_FCODE | | ||
| 175 | #ifndef NODMAIRQ | ||
| 176 | FASTLANE_DMA_EDI | | ||
| 177 | #endif | ||
| 178 | FASTLANE_DMA_ESI); | ||
| 179 | |||
| 180 | |||
| 181 | /* SCSI chip clock */ | ||
| 182 | esp->cfreq = 40000000; | ||
| 183 | |||
| 184 | |||
| 185 | /* Map the physical address space into virtual kernel space */ | ||
| 186 | address = (unsigned long) | ||
| 187 | z_ioremap(board, z->resource.end-board+1); | ||
| 188 | |||
| 189 | if(!address){ | ||
| 190 | printk("Could not remap Fastlane controller memory!"); | ||
| 191 | goto err_unregister; | ||
| 192 | } | ||
| 193 | |||
| 194 | |||
| 195 | /* The DMA registers on the Fastlane are mapped | ||
| 196 | * relative to the device (i.e. in the same Zorro | ||
| 197 | * I/O block). | ||
| 198 | */ | ||
| 199 | esp->dregs = (void *)(address + FASTLANE_DMA_ADDR); | ||
| 200 | |||
| 201 | /* ESP register base */ | ||
| 202 | esp->eregs = (struct ESP_regs *)(address + FASTLANE_ESP_ADDR); | ||
| 203 | |||
| 204 | /* Board base */ | ||
| 205 | esp->edev = (void *) address; | ||
| 206 | |||
| 207 | /* Set the command buffer */ | ||
| 208 | esp->esp_command = cmd_buffer; | ||
| 209 | esp->esp_command_dvma = virt_to_bus((void *)cmd_buffer); | ||
| 210 | |||
| 211 | esp->irq = IRQ_AMIGA_PORTS; | ||
| 212 | esp->slot = board+FASTLANE_ESP_ADDR; | ||
| 213 | if (request_irq(IRQ_AMIGA_PORTS, esp_intr, IRQF_SHARED, | ||
| 214 | "Fastlane SCSI", esp->ehost)) { | ||
| 215 | printk(KERN_WARNING "Fastlane: Could not get IRQ%d, aborting.\n", IRQ_AMIGA_PORTS); | ||
| 216 | goto err_unmap; | ||
| 217 | } | ||
| 218 | |||
| 219 | /* Controller ID */ | ||
| 220 | esp->scsi_id = 7; | ||
| 221 | |||
| 222 | /* We don't have a differential SCSI-bus. */ | ||
| 223 | esp->diff = 0; | ||
| 224 | |||
| 225 | dma_clear(esp); | ||
| 226 | esp_initialize(esp); | ||
| 227 | |||
| 228 | printk("ESP: Total of %d ESP hosts found, %d actually in use.\n", nesps, esps_in_use); | ||
| 229 | esps_running = esps_in_use; | ||
| 230 | return esps_in_use; | ||
| 231 | } | ||
| 232 | } | ||
| 233 | return 0; | ||
| 234 | |||
| 235 | err_unmap: | ||
| 236 | z_iounmap((void *)address); | ||
| 237 | err_unregister: | ||
| 238 | scsi_unregister (esp->ehost); | ||
| 239 | err_release: | ||
| 240 | release_mem_region(z->resource.start+FASTLANE_ESP_ADDR, | ||
| 241 | sizeof(struct ESP_regs)); | ||
| 242 | return 0; | ||
| 243 | } | ||
| 244 | |||
| 245 | |||
| 246 | /************************************************************* DMA Functions */ | ||
| 247 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count) | ||
| 248 | { | ||
| 249 | /* Since the Fastlane DMA is fully dedicated to the ESP chip, | ||
| 250 | * the number of bytes sent (to the ESP chip) equals the number | ||
| 251 | * of bytes in the FIFO - there is no buffering in the DMA controller. | ||
| 252 | * XXXX Do I read this right? It is from host to ESP, right? | ||
| 253 | */ | ||
| 254 | return fifo_count; | ||
| 255 | } | ||
| 256 | |||
| 257 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 258 | { | ||
| 259 | unsigned long sz = sp->SCp.this_residual; | ||
| 260 | if(sz > 0xfffc) | ||
| 261 | sz = 0xfffc; | ||
| 262 | return sz; | ||
| 263 | } | ||
| 264 | |||
| 265 | static void dma_dump_state(struct NCR_ESP *esp) | ||
| 266 | { | ||
| 267 | ESPLOG(("esp%d: dma -- cond_reg<%02x>\n", | ||
| 268 | esp->esp_id, ((struct fastlane_dma_registers *) | ||
| 269 | (esp->dregs))->cond_reg)); | ||
| 270 | ESPLOG(("intreq:<%04x>, intena:<%04x>\n", | ||
| 271 | amiga_custom.intreqr, amiga_custom.intenar)); | ||
| 272 | } | ||
| 273 | |||
| 274 | static void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 275 | { | ||
| 276 | struct fastlane_dma_registers *dregs = | ||
| 277 | (struct fastlane_dma_registers *) (esp->dregs); | ||
| 278 | unsigned long *t; | ||
| 279 | |||
| 280 | cache_clear(addr, length); | ||
| 281 | |||
| 282 | dma_clear(esp); | ||
| 283 | |||
| 284 | t = (unsigned long *)((addr & 0x00ffffff) + esp->edev); | ||
| 285 | |||
| 286 | dregs->clear_strobe = 0; | ||
| 287 | *t = addr; | ||
| 288 | |||
| 289 | ctrl_data = (ctrl_data & FASTLANE_DMA_MASK) | FASTLANE_DMA_ENABLE; | ||
| 290 | dregs->ctrl_reg = ctrl_data; | ||
| 291 | } | ||
| 292 | |||
| 293 | static void dma_init_write(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 294 | { | ||
| 295 | struct fastlane_dma_registers *dregs = | ||
| 296 | (struct fastlane_dma_registers *) (esp->dregs); | ||
| 297 | unsigned long *t; | ||
| 298 | |||
| 299 | cache_push(addr, length); | ||
| 300 | |||
| 301 | dma_clear(esp); | ||
| 302 | |||
| 303 | t = (unsigned long *)((addr & 0x00ffffff) + (esp->edev)); | ||
| 304 | |||
| 305 | dregs->clear_strobe = 0; | ||
| 306 | *t = addr; | ||
| 307 | |||
| 308 | ctrl_data = ((ctrl_data & FASTLANE_DMA_MASK) | | ||
| 309 | FASTLANE_DMA_ENABLE | | ||
| 310 | FASTLANE_DMA_WRITE); | ||
| 311 | dregs->ctrl_reg = ctrl_data; | ||
| 312 | } | ||
| 313 | |||
| 314 | |||
| 315 | static void dma_ints_off(struct NCR_ESP *esp) | ||
| 316 | { | ||
| 317 | disable_irq(esp->irq); | ||
| 318 | } | ||
| 319 | |||
| 320 | static void dma_ints_on(struct NCR_ESP *esp) | ||
| 321 | { | ||
| 322 | enable_irq(esp->irq); | ||
| 323 | } | ||
| 324 | |||
| 325 | static void dma_irq_exit(struct NCR_ESP *esp) | ||
| 326 | { | ||
| 327 | struct fastlane_dma_registers *dregs = | ||
| 328 | (struct fastlane_dma_registers *) (esp->dregs); | ||
| 329 | |||
| 330 | dregs->ctrl_reg = ctrl_data & ~(FASTLANE_DMA_EDI|FASTLANE_DMA_ESI); | ||
| 331 | #ifdef __mc68000__ | ||
| 332 | nop(); | ||
| 333 | #endif | ||
| 334 | dregs->ctrl_reg = ctrl_data; | ||
| 335 | } | ||
| 336 | |||
| 337 | static int dma_irq_p(struct NCR_ESP *esp) | ||
| 338 | { | ||
| 339 | struct fastlane_dma_registers *dregs = | ||
| 340 | (struct fastlane_dma_registers *) (esp->dregs); | ||
| 341 | unsigned char dma_status; | ||
| 342 | |||
| 343 | dma_status = dregs->cond_reg; | ||
| 344 | |||
| 345 | if(dma_status & FASTLANE_DMA_IACT) | ||
| 346 | return 0; /* not our IRQ */ | ||
| 347 | |||
| 348 | /* Return non-zero if ESP requested IRQ */ | ||
| 349 | return ( | ||
| 350 | #ifndef NODMAIRQ | ||
| 351 | (dma_status & FASTLANE_DMA_CREQ) && | ||
| 352 | #endif | ||
| 353 | (!(dma_status & FASTLANE_DMA_MINT)) && | ||
| 354 | (esp_read(((struct ESP_regs *) (esp->eregs))->esp_status) & ESP_STAT_INTR)); | ||
| 355 | } | ||
| 356 | |||
| 357 | static void dma_led_off(struct NCR_ESP *esp) | ||
| 358 | { | ||
| 359 | ctrl_data &= ~FASTLANE_DMA_LED; | ||
| 360 | ((struct fastlane_dma_registers *)(esp->dregs))->ctrl_reg = ctrl_data; | ||
| 361 | } | ||
| 362 | |||
| 363 | static void dma_led_on(struct NCR_ESP *esp) | ||
| 364 | { | ||
| 365 | ctrl_data |= FASTLANE_DMA_LED; | ||
| 366 | ((struct fastlane_dma_registers *)(esp->dregs))->ctrl_reg = ctrl_data; | ||
| 367 | } | ||
| 368 | |||
| 369 | static int dma_ports_p(struct NCR_ESP *esp) | ||
| 370 | { | ||
| 371 | return ((amiga_custom.intenar) & IF_PORTS); | ||
| 372 | } | ||
| 373 | |||
| 374 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write) | ||
| 375 | { | ||
| 376 | /* On the Sparc, DMA_ST_WRITE means "move data from device to memory" | ||
| 377 | * so when (write) is true, it actually means READ! | ||
| 378 | */ | ||
| 379 | if(write){ | ||
| 380 | dma_init_read(esp, addr, count); | ||
| 381 | } else { | ||
| 382 | dma_init_write(esp, addr, count); | ||
| 383 | } | ||
| 384 | } | ||
| 385 | |||
| 386 | #define HOSTS_C | ||
| 387 | |||
| 388 | int fastlane_esp_release(struct Scsi_Host *instance) | ||
| 389 | { | ||
| 390 | #ifdef MODULE | ||
| 391 | unsigned long address = (unsigned long)((struct NCR_ESP *)instance->hostdata)->edev; | ||
| 392 | esp_deallocate((struct NCR_ESP *)instance->hostdata); | ||
| 393 | esp_release(); | ||
| 394 | release_mem_region(address, sizeof(struct ESP_regs)); | ||
| 395 | free_irq(IRQ_AMIGA_PORTS, esp_intr); | ||
| 396 | #endif | ||
| 397 | return 1; | ||
| 398 | } | ||
| 399 | |||
| 400 | |||
| 401 | static struct scsi_host_template driver_template = { | ||
| 402 | .proc_name = "esp-fastlane", | ||
| 403 | .proc_info = esp_proc_info, | ||
| 404 | .name = "Fastlane SCSI", | ||
| 405 | .detect = fastlane_esp_detect, | ||
| 406 | .slave_alloc = esp_slave_alloc, | ||
| 407 | .slave_destroy = esp_slave_destroy, | ||
| 408 | .release = fastlane_esp_release, | ||
| 409 | .queuecommand = esp_queue, | ||
| 410 | .eh_abort_handler = esp_abort, | ||
| 411 | .eh_bus_reset_handler = esp_reset, | ||
| 412 | .can_queue = 7, | ||
| 413 | .this_id = 7, | ||
| 414 | .sg_tablesize = SG_ALL, | ||
| 415 | .cmd_per_lun = 1, | ||
| 416 | .use_clustering = ENABLE_CLUSTERING | ||
| 417 | }; | ||
| 418 | |||
| 419 | #include "scsi_module.c" | ||
| 420 | |||
| 421 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/scsi/iscsi_tcp.c b/drivers/scsi/iscsi_tcp.c index b6f99dfbb038..8a178674cb18 100644 --- a/drivers/scsi/iscsi_tcp.c +++ b/drivers/scsi/iscsi_tcp.c | |||
| @@ -629,8 +629,9 @@ iscsi_r2t_rsp(struct iscsi_conn *conn, struct iscsi_cmd_task *ctask) | |||
| 629 | int rc; | 629 | int rc; |
| 630 | 630 | ||
| 631 | if (tcp_conn->in.datalen) { | 631 | if (tcp_conn->in.datalen) { |
| 632 | printk(KERN_ERR "iscsi_tcp: invalid R2t with datalen %d\n", | 632 | iscsi_conn_printk(KERN_ERR, conn, |
| 633 | tcp_conn->in.datalen); | 633 | "invalid R2t with datalen %d\n", |
| 634 | tcp_conn->in.datalen); | ||
| 634 | return ISCSI_ERR_DATALEN; | 635 | return ISCSI_ERR_DATALEN; |
| 635 | } | 636 | } |
| 636 | 637 | ||
| @@ -644,8 +645,9 @@ iscsi_r2t_rsp(struct iscsi_conn *conn, struct iscsi_cmd_task *ctask) | |||
| 644 | iscsi_update_cmdsn(session, (struct iscsi_nopin*)rhdr); | 645 | iscsi_update_cmdsn(session, (struct iscsi_nopin*)rhdr); |
| 645 | 646 | ||
| 646 | if (!ctask->sc || session->state != ISCSI_STATE_LOGGED_IN) { | 647 | if (!ctask->sc || session->state != ISCSI_STATE_LOGGED_IN) { |
| 647 | printk(KERN_INFO "iscsi_tcp: dropping R2T itt %d in " | 648 | iscsi_conn_printk(KERN_INFO, conn, |
| 648 | "recovery...\n", ctask->itt); | 649 | "dropping R2T itt %d in recovery.\n", |
| 650 | ctask->itt); | ||
| 649 | return 0; | 651 | return 0; |
| 650 | } | 652 | } |
| 651 | 653 | ||
| @@ -655,7 +657,8 @@ iscsi_r2t_rsp(struct iscsi_conn *conn, struct iscsi_cmd_task *ctask) | |||
| 655 | r2t->exp_statsn = rhdr->statsn; | 657 | r2t->exp_statsn = rhdr->statsn; |
| 656 | r2t->data_length = be32_to_cpu(rhdr->data_length); | 658 | r2t->data_length = be32_to_cpu(rhdr->data_length); |
| 657 | if (r2t->data_length == 0) { | 659 | if (r2t->data_length == 0) { |
| 658 | printk(KERN_ERR "iscsi_tcp: invalid R2T with zero data len\n"); | 660 | iscsi_conn_printk(KERN_ERR, conn, |
| 661 | "invalid R2T with zero data len\n"); | ||
| 659 | __kfifo_put(tcp_ctask->r2tpool.queue, (void*)&r2t, | 662 | __kfifo_put(tcp_ctask->r2tpool.queue, (void*)&r2t, |
| 660 | sizeof(void*)); | 663 | sizeof(void*)); |
| 661 | return ISCSI_ERR_DATALEN; | 664 | return ISCSI_ERR_DATALEN; |
| @@ -668,9 +671,10 @@ iscsi_r2t_rsp(struct iscsi_conn *conn, struct iscsi_cmd_task *ctask) | |||
| 668 | 671 | ||
| 669 | r2t->data_offset = be32_to_cpu(rhdr->data_offset); | 672 | r2t->data_offset = be32_to_cpu(rhdr->data_offset); |
| 670 | if (r2t->data_offset + r2t->data_length > scsi_bufflen(ctask->sc)) { | 673 | if (r2t->data_offset + r2t->data_length > scsi_bufflen(ctask->sc)) { |
| 671 | printk(KERN_ERR "iscsi_tcp: invalid R2T with data len %u at " | 674 | iscsi_conn_printk(KERN_ERR, conn, |
| 672 | "offset %u and total length %d\n", r2t->data_length, | 675 | "invalid R2T with data len %u at offset %u " |
| 673 | r2t->data_offset, scsi_bufflen(ctask->sc)); | 676 | "and total length %d\n", r2t->data_length, |
| 677 | r2t->data_offset, scsi_bufflen(ctask->sc)); | ||
| 674 | __kfifo_put(tcp_ctask->r2tpool.queue, (void*)&r2t, | 678 | __kfifo_put(tcp_ctask->r2tpool.queue, (void*)&r2t, |
| 675 | sizeof(void*)); | 679 | sizeof(void*)); |
| 676 | return ISCSI_ERR_DATALEN; | 680 | return ISCSI_ERR_DATALEN; |
| @@ -736,8 +740,9 @@ iscsi_tcp_hdr_dissect(struct iscsi_conn *conn, struct iscsi_hdr *hdr) | |||
| 736 | /* verify PDU length */ | 740 | /* verify PDU length */ |
| 737 | tcp_conn->in.datalen = ntoh24(hdr->dlength); | 741 | tcp_conn->in.datalen = ntoh24(hdr->dlength); |
| 738 | if (tcp_conn->in.datalen > conn->max_recv_dlength) { | 742 | if (tcp_conn->in.datalen > conn->max_recv_dlength) { |
| 739 | printk(KERN_ERR "iscsi_tcp: datalen %d > %d\n", | 743 | iscsi_conn_printk(KERN_ERR, conn, |
| 740 | tcp_conn->in.datalen, conn->max_recv_dlength); | 744 | "iscsi_tcp: datalen %d > %d\n", |
| 745 | tcp_conn->in.datalen, conn->max_recv_dlength); | ||
| 741 | return ISCSI_ERR_DATALEN; | 746 | return ISCSI_ERR_DATALEN; |
| 742 | } | 747 | } |
| 743 | 748 | ||
| @@ -819,10 +824,12 @@ iscsi_tcp_hdr_dissect(struct iscsi_conn *conn, struct iscsi_hdr *hdr) | |||
| 819 | * For now we fail until we find a vendor that needs it | 824 | * For now we fail until we find a vendor that needs it |
| 820 | */ | 825 | */ |
| 821 | if (ISCSI_DEF_MAX_RECV_SEG_LEN < tcp_conn->in.datalen) { | 826 | if (ISCSI_DEF_MAX_RECV_SEG_LEN < tcp_conn->in.datalen) { |
| 822 | printk(KERN_ERR "iscsi_tcp: received buffer of len %u " | 827 | iscsi_conn_printk(KERN_ERR, conn, |
| 823 | "but conn buffer is only %u (opcode %0x)\n", | 828 | "iscsi_tcp: received buffer of " |
| 824 | tcp_conn->in.datalen, | 829 | "len %u but conn buffer is only %u " |
| 825 | ISCSI_DEF_MAX_RECV_SEG_LEN, opcode); | 830 | "(opcode %0x)\n", |
| 831 | tcp_conn->in.datalen, | ||
| 832 | ISCSI_DEF_MAX_RECV_SEG_LEN, opcode); | ||
| 826 | rc = ISCSI_ERR_PROTO; | 833 | rc = ISCSI_ERR_PROTO; |
| 827 | break; | 834 | break; |
| 828 | } | 835 | } |
| @@ -1496,30 +1503,25 @@ iscsi_tcp_conn_create(struct iscsi_cls_session *cls_session, uint32_t conn_idx) | |||
| 1496 | tcp_conn->tx_hash.tfm = crypto_alloc_hash("crc32c", 0, | 1503 | tcp_conn->tx_hash.tfm = crypto_alloc_hash("crc32c", 0, |
| 1497 | CRYPTO_ALG_ASYNC); | 1504 | CRYPTO_ALG_ASYNC); |
| 1498 | tcp_conn->tx_hash.flags = 0; | 1505 | tcp_conn->tx_hash.flags = 0; |
| 1499 | if (IS_ERR(tcp_conn->tx_hash.tfm)) { | 1506 | if (IS_ERR(tcp_conn->tx_hash.tfm)) |
| 1500 | printk(KERN_ERR "Could not create connection due to crc32c " | ||
| 1501 | "loading error %ld. Make sure the crc32c module is " | ||
| 1502 | "built as a module or into the kernel\n", | ||
| 1503 | PTR_ERR(tcp_conn->tx_hash.tfm)); | ||
| 1504 | goto free_tcp_conn; | 1507 | goto free_tcp_conn; |
| 1505 | } | ||
| 1506 | 1508 | ||
| 1507 | tcp_conn->rx_hash.tfm = crypto_alloc_hash("crc32c", 0, | 1509 | tcp_conn->rx_hash.tfm = crypto_alloc_hash("crc32c", 0, |
| 1508 | CRYPTO_ALG_ASYNC); | 1510 | CRYPTO_ALG_ASYNC); |
| 1509 | tcp_conn->rx_hash.flags = 0; | 1511 | tcp_conn->rx_hash.flags = 0; |
| 1510 | if (IS_ERR(tcp_conn->rx_hash.tfm)) { | 1512 | if (IS_ERR(tcp_conn->rx_hash.tfm)) |
| 1511 | printk(KERN_ERR "Could not create connection due to crc32c " | ||
| 1512 | "loading error %ld. Make sure the crc32c module is " | ||
| 1513 | "built as a module or into the kernel\n", | ||
| 1514 | PTR_ERR(tcp_conn->rx_hash.tfm)); | ||
| 1515 | goto free_tx_tfm; | 1513 | goto free_tx_tfm; |
| 1516 | } | ||
| 1517 | 1514 | ||
| 1518 | return cls_conn; | 1515 | return cls_conn; |
| 1519 | 1516 | ||
| 1520 | free_tx_tfm: | 1517 | free_tx_tfm: |
| 1521 | crypto_free_hash(tcp_conn->tx_hash.tfm); | 1518 | crypto_free_hash(tcp_conn->tx_hash.tfm); |
| 1522 | free_tcp_conn: | 1519 | free_tcp_conn: |
| 1520 | iscsi_conn_printk(KERN_ERR, conn, | ||
| 1521 | "Could not create connection due to crc32c " | ||
| 1522 | "loading error. Make sure the crc32c " | ||
| 1523 | "module is built as a module or into the " | ||
| 1524 | "kernel\n"); | ||
| 1523 | kfree(tcp_conn); | 1525 | kfree(tcp_conn); |
| 1524 | tcp_conn_alloc_fail: | 1526 | tcp_conn_alloc_fail: |
| 1525 | iscsi_conn_teardown(cls_conn); | 1527 | iscsi_conn_teardown(cls_conn); |
| @@ -1627,7 +1629,8 @@ iscsi_tcp_conn_bind(struct iscsi_cls_session *cls_session, | |||
| 1627 | /* lookup for existing socket */ | 1629 | /* lookup for existing socket */ |
| 1628 | sock = sockfd_lookup((int)transport_eph, &err); | 1630 | sock = sockfd_lookup((int)transport_eph, &err); |
| 1629 | if (!sock) { | 1631 | if (!sock) { |
| 1630 | printk(KERN_ERR "iscsi_tcp: sockfd_lookup failed %d\n", err); | 1632 | iscsi_conn_printk(KERN_ERR, conn, |
| 1633 | "sockfd_lookup failed %d\n", err); | ||
| 1631 | return -EEXIST; | 1634 | return -EEXIST; |
| 1632 | } | 1635 | } |
| 1633 | /* | 1636 | /* |
diff --git a/drivers/scsi/libiscsi.c b/drivers/scsi/libiscsi.c index 553168ae44f1..59f8445eab0d 100644 --- a/drivers/scsi/libiscsi.c +++ b/drivers/scsi/libiscsi.c | |||
| @@ -160,7 +160,7 @@ static int iscsi_prep_scsi_cmd_pdu(struct iscsi_cmd_task *ctask) | |||
| 160 | hdr->opcode = ISCSI_OP_SCSI_CMD; | 160 | hdr->opcode = ISCSI_OP_SCSI_CMD; |
| 161 | hdr->flags = ISCSI_ATTR_SIMPLE; | 161 | hdr->flags = ISCSI_ATTR_SIMPLE; |
| 162 | int_to_scsilun(sc->device->lun, (struct scsi_lun *)hdr->lun); | 162 | int_to_scsilun(sc->device->lun, (struct scsi_lun *)hdr->lun); |
| 163 | hdr->itt = build_itt(ctask->itt, conn->id, session->age); | 163 | hdr->itt = build_itt(ctask->itt, session->age); |
| 164 | hdr->data_length = cpu_to_be32(scsi_bufflen(sc)); | 164 | hdr->data_length = cpu_to_be32(scsi_bufflen(sc)); |
| 165 | hdr->cmdsn = cpu_to_be32(session->cmdsn); | 165 | hdr->cmdsn = cpu_to_be32(session->cmdsn); |
| 166 | session->cmdsn++; | 166 | session->cmdsn++; |
| @@ -416,8 +416,9 @@ static void iscsi_scsi_cmd_rsp(struct iscsi_conn *conn, struct iscsi_hdr *hdr, | |||
| 416 | 416 | ||
| 417 | if (datalen < 2) { | 417 | if (datalen < 2) { |
| 418 | invalid_datalen: | 418 | invalid_datalen: |
| 419 | printk(KERN_ERR "iscsi: Got CHECK_CONDITION but " | 419 | iscsi_conn_printk(KERN_ERR, conn, |
| 420 | "invalid data buffer size of %d\n", datalen); | 420 | "Got CHECK_CONDITION but invalid data " |
| 421 | "buffer size of %d\n", datalen); | ||
| 421 | sc->result = DID_BAD_TARGET << 16; | 422 | sc->result = DID_BAD_TARGET << 16; |
| 422 | goto out; | 423 | goto out; |
| 423 | } | 424 | } |
| @@ -494,7 +495,7 @@ static void iscsi_send_nopout(struct iscsi_conn *conn, struct iscsi_nopin *rhdr) | |||
| 494 | 495 | ||
| 495 | mtask = __iscsi_conn_send_pdu(conn, (struct iscsi_hdr *)&hdr, NULL, 0); | 496 | mtask = __iscsi_conn_send_pdu(conn, (struct iscsi_hdr *)&hdr, NULL, 0); |
| 496 | if (!mtask) { | 497 | if (!mtask) { |
| 497 | printk(KERN_ERR "Could not send nopout\n"); | 498 | iscsi_conn_printk(KERN_ERR, conn, "Could not send nopout\n"); |
| 498 | return; | 499 | return; |
| 499 | } | 500 | } |
| 500 | 501 | ||
| @@ -522,9 +523,10 @@ static int iscsi_handle_reject(struct iscsi_conn *conn, struct iscsi_hdr *hdr, | |||
| 522 | if (ntoh24(reject->dlength) >= sizeof(struct iscsi_hdr)) { | 523 | if (ntoh24(reject->dlength) >= sizeof(struct iscsi_hdr)) { |
| 523 | memcpy(&rejected_pdu, data, sizeof(struct iscsi_hdr)); | 524 | memcpy(&rejected_pdu, data, sizeof(struct iscsi_hdr)); |
| 524 | itt = get_itt(rejected_pdu.itt); | 525 | itt = get_itt(rejected_pdu.itt); |
| 525 | printk(KERN_ERR "itt 0x%x had pdu (op 0x%x) rejected " | 526 | iscsi_conn_printk(KERN_ERR, conn, |
| 526 | "due to DataDigest error.\n", itt, | 527 | "itt 0x%x had pdu (op 0x%x) rejected " |
| 527 | rejected_pdu.opcode); | 528 | "due to DataDigest error.\n", itt, |
| 529 | rejected_pdu.opcode); | ||
| 528 | } | 530 | } |
| 529 | } | 531 | } |
| 530 | return 0; | 532 | return 0; |
| @@ -541,8 +543,8 @@ static int iscsi_handle_reject(struct iscsi_conn *conn, struct iscsi_hdr *hdr, | |||
| 541 | * queuecommand or send generic. session lock must be held and verify | 543 | * queuecommand or send generic. session lock must be held and verify |
| 542 | * itt must have been called. | 544 | * itt must have been called. |
| 543 | */ | 545 | */ |
| 544 | int __iscsi_complete_pdu(struct iscsi_conn *conn, struct iscsi_hdr *hdr, | 546 | static int __iscsi_complete_pdu(struct iscsi_conn *conn, struct iscsi_hdr *hdr, |
| 545 | char *data, int datalen) | 547 | char *data, int datalen) |
| 546 | { | 548 | { |
| 547 | struct iscsi_session *session = conn->session; | 549 | struct iscsi_session *session = conn->session; |
| 548 | int opcode = hdr->opcode & ISCSI_OPCODE_MASK, rc = 0; | 550 | int opcode = hdr->opcode & ISCSI_OPCODE_MASK, rc = 0; |
| @@ -672,7 +674,6 @@ int __iscsi_complete_pdu(struct iscsi_conn *conn, struct iscsi_hdr *hdr, | |||
| 672 | 674 | ||
| 673 | return rc; | 675 | return rc; |
| 674 | } | 676 | } |
| 675 | EXPORT_SYMBOL_GPL(__iscsi_complete_pdu); | ||
| 676 | 677 | ||
| 677 | int iscsi_complete_pdu(struct iscsi_conn *conn, struct iscsi_hdr *hdr, | 678 | int iscsi_complete_pdu(struct iscsi_conn *conn, struct iscsi_hdr *hdr, |
| 678 | char *data, int datalen) | 679 | char *data, int datalen) |
| @@ -697,18 +698,13 @@ int iscsi_verify_itt(struct iscsi_conn *conn, struct iscsi_hdr *hdr, | |||
| 697 | if (hdr->itt != RESERVED_ITT) { | 698 | if (hdr->itt != RESERVED_ITT) { |
| 698 | if (((__force u32)hdr->itt & ISCSI_AGE_MASK) != | 699 | if (((__force u32)hdr->itt & ISCSI_AGE_MASK) != |
| 699 | (session->age << ISCSI_AGE_SHIFT)) { | 700 | (session->age << ISCSI_AGE_SHIFT)) { |
| 700 | printk(KERN_ERR "iscsi: received itt %x expected " | 701 | iscsi_conn_printk(KERN_ERR, conn, |
| 701 | "session age (%x)\n", (__force u32)hdr->itt, | 702 | "received itt %x expected session " |
| 702 | session->age & ISCSI_AGE_MASK); | 703 | "age (%x)\n", (__force u32)hdr->itt, |
| 704 | session->age & ISCSI_AGE_MASK); | ||
| 703 | return ISCSI_ERR_BAD_ITT; | 705 | return ISCSI_ERR_BAD_ITT; |
| 704 | } | 706 | } |
| 705 | 707 | ||
| 706 | if (((__force u32)hdr->itt & ISCSI_CID_MASK) != | ||
| 707 | (conn->id << ISCSI_CID_SHIFT)) { | ||
| 708 | printk(KERN_ERR "iscsi: received itt %x, expected " | ||
| 709 | "CID (%x)\n", (__force u32)hdr->itt, conn->id); | ||
| 710 | return ISCSI_ERR_BAD_ITT; | ||
| 711 | } | ||
| 712 | itt = get_itt(hdr->itt); | 708 | itt = get_itt(hdr->itt); |
| 713 | } else | 709 | } else |
| 714 | itt = ~0U; | 710 | itt = ~0U; |
| @@ -717,16 +713,17 @@ int iscsi_verify_itt(struct iscsi_conn *conn, struct iscsi_hdr *hdr, | |||
| 717 | ctask = session->cmds[itt]; | 713 | ctask = session->cmds[itt]; |
| 718 | 714 | ||
| 719 | if (!ctask->sc) { | 715 | if (!ctask->sc) { |
| 720 | printk(KERN_INFO "iscsi: dropping ctask with " | 716 | iscsi_conn_printk(KERN_INFO, conn, "dropping ctask " |
| 721 | "itt 0x%x\n", ctask->itt); | 717 | "with itt 0x%x\n", ctask->itt); |
| 722 | /* force drop */ | 718 | /* force drop */ |
| 723 | return ISCSI_ERR_NO_SCSI_CMD; | 719 | return ISCSI_ERR_NO_SCSI_CMD; |
| 724 | } | 720 | } |
| 725 | 721 | ||
| 726 | if (ctask->sc->SCp.phase != session->age) { | 722 | if (ctask->sc->SCp.phase != session->age) { |
| 727 | printk(KERN_ERR "iscsi: ctask's session age %d, " | 723 | iscsi_conn_printk(KERN_ERR, conn, |
| 728 | "expected %d\n", ctask->sc->SCp.phase, | 724 | "iscsi: ctask's session age %d, " |
| 729 | session->age); | 725 | "expected %d\n", ctask->sc->SCp.phase, |
| 726 | session->age); | ||
| 730 | return ISCSI_ERR_SESSION_FAILED; | 727 | return ISCSI_ERR_SESSION_FAILED; |
| 731 | } | 728 | } |
| 732 | } | 729 | } |
| @@ -771,7 +768,7 @@ static void iscsi_prep_mtask(struct iscsi_conn *conn, | |||
| 771 | */ | 768 | */ |
| 772 | nop->cmdsn = cpu_to_be32(session->cmdsn); | 769 | nop->cmdsn = cpu_to_be32(session->cmdsn); |
| 773 | if (hdr->itt != RESERVED_ITT) { | 770 | if (hdr->itt != RESERVED_ITT) { |
| 774 | hdr->itt = build_itt(mtask->itt, conn->id, session->age); | 771 | hdr->itt = build_itt(mtask->itt, session->age); |
| 775 | /* | 772 | /* |
| 776 | * TODO: We always use immediate, so we never hit this. | 773 | * TODO: We always use immediate, so we never hit this. |
| 777 | * If we start to send tmfs or nops as non-immediate then | 774 | * If we start to send tmfs or nops as non-immediate then |
| @@ -997,6 +994,7 @@ enum { | |||
| 997 | FAILURE_SESSION_IN_RECOVERY, | 994 | FAILURE_SESSION_IN_RECOVERY, |
| 998 | FAILURE_SESSION_RECOVERY_TIMEOUT, | 995 | FAILURE_SESSION_RECOVERY_TIMEOUT, |
| 999 | FAILURE_SESSION_LOGGING_OUT, | 996 | FAILURE_SESSION_LOGGING_OUT, |
| 997 | FAILURE_SESSION_NOT_READY, | ||
| 1000 | }; | 998 | }; |
| 1001 | 999 | ||
| 1002 | int iscsi_queuecommand(struct scsi_cmnd *sc, void (*done)(struct scsi_cmnd *)) | 1000 | int iscsi_queuecommand(struct scsi_cmnd *sc, void (*done)(struct scsi_cmnd *)) |
| @@ -1017,6 +1015,12 @@ int iscsi_queuecommand(struct scsi_cmnd *sc, void (*done)(struct scsi_cmnd *)) | |||
| 1017 | session = iscsi_hostdata(host->hostdata); | 1015 | session = iscsi_hostdata(host->hostdata); |
| 1018 | spin_lock(&session->lock); | 1016 | spin_lock(&session->lock); |
| 1019 | 1017 | ||
| 1018 | reason = iscsi_session_chkready(session_to_cls(session)); | ||
| 1019 | if (reason) { | ||
| 1020 | sc->result = reason; | ||
| 1021 | goto fault; | ||
| 1022 | } | ||
| 1023 | |||
| 1020 | /* | 1024 | /* |
| 1021 | * ISCSI_STATE_FAILED is a temp. state. The recovery | 1025 | * ISCSI_STATE_FAILED is a temp. state. The recovery |
| 1022 | * code will decide what is best to do with command queued | 1026 | * code will decide what is best to do with command queued |
| @@ -1033,18 +1037,23 @@ int iscsi_queuecommand(struct scsi_cmnd *sc, void (*done)(struct scsi_cmnd *)) | |||
| 1033 | switch (session->state) { | 1037 | switch (session->state) { |
| 1034 | case ISCSI_STATE_IN_RECOVERY: | 1038 | case ISCSI_STATE_IN_RECOVERY: |
| 1035 | reason = FAILURE_SESSION_IN_RECOVERY; | 1039 | reason = FAILURE_SESSION_IN_RECOVERY; |
| 1036 | goto reject; | 1040 | sc->result = DID_IMM_RETRY << 16; |
| 1041 | break; | ||
| 1037 | case ISCSI_STATE_LOGGING_OUT: | 1042 | case ISCSI_STATE_LOGGING_OUT: |
| 1038 | reason = FAILURE_SESSION_LOGGING_OUT; | 1043 | reason = FAILURE_SESSION_LOGGING_OUT; |
| 1039 | goto reject; | 1044 | sc->result = DID_IMM_RETRY << 16; |
| 1045 | break; | ||
| 1040 | case ISCSI_STATE_RECOVERY_FAILED: | 1046 | case ISCSI_STATE_RECOVERY_FAILED: |
| 1041 | reason = FAILURE_SESSION_RECOVERY_TIMEOUT; | 1047 | reason = FAILURE_SESSION_RECOVERY_TIMEOUT; |
| 1048 | sc->result = DID_NO_CONNECT << 16; | ||
| 1042 | break; | 1049 | break; |
| 1043 | case ISCSI_STATE_TERMINATE: | 1050 | case ISCSI_STATE_TERMINATE: |
| 1044 | reason = FAILURE_SESSION_TERMINATE; | 1051 | reason = FAILURE_SESSION_TERMINATE; |
| 1052 | sc->result = DID_NO_CONNECT << 16; | ||
| 1045 | break; | 1053 | break; |
| 1046 | default: | 1054 | default: |
| 1047 | reason = FAILURE_SESSION_FREED; | 1055 | reason = FAILURE_SESSION_FREED; |
| 1056 | sc->result = DID_NO_CONNECT << 16; | ||
| 1048 | } | 1057 | } |
| 1049 | goto fault; | 1058 | goto fault; |
| 1050 | } | 1059 | } |
| @@ -1052,6 +1061,7 @@ int iscsi_queuecommand(struct scsi_cmnd *sc, void (*done)(struct scsi_cmnd *)) | |||
| 1052 | conn = session->leadconn; | 1061 | conn = session->leadconn; |
| 1053 | if (!conn) { | 1062 | if (!conn) { |
| 1054 | reason = FAILURE_SESSION_FREED; | 1063 | reason = FAILURE_SESSION_FREED; |
| 1064 | sc->result = DID_NO_CONNECT << 16; | ||
| 1055 | goto fault; | 1065 | goto fault; |
| 1056 | } | 1066 | } |
| 1057 | 1067 | ||
| @@ -1091,9 +1101,7 @@ reject: | |||
| 1091 | 1101 | ||
| 1092 | fault: | 1102 | fault: |
| 1093 | spin_unlock(&session->lock); | 1103 | spin_unlock(&session->lock); |
| 1094 | printk(KERN_ERR "iscsi: cmd 0x%x is not queued (%d)\n", | 1104 | debug_scsi("iscsi: cmd 0x%x is not queued (%d)\n", sc->cmnd[0], reason); |
| 1095 | sc->cmnd[0], reason); | ||
| 1096 | sc->result = (DID_NO_CONNECT << 16); | ||
| 1097 | scsi_set_resid(sc, scsi_bufflen(sc)); | 1105 | scsi_set_resid(sc, scsi_bufflen(sc)); |
| 1098 | sc->scsi_done(sc); | 1106 | sc->scsi_done(sc); |
| 1099 | spin_lock(host->host_lock); | 1107 | spin_lock(host->host_lock); |
| @@ -1160,7 +1168,8 @@ failed: | |||
| 1160 | mutex_lock(&session->eh_mutex); | 1168 | mutex_lock(&session->eh_mutex); |
| 1161 | spin_lock_bh(&session->lock); | 1169 | spin_lock_bh(&session->lock); |
| 1162 | if (session->state == ISCSI_STATE_LOGGED_IN) | 1170 | if (session->state == ISCSI_STATE_LOGGED_IN) |
| 1163 | printk(KERN_INFO "iscsi: host reset succeeded\n"); | 1171 | iscsi_session_printk(KERN_INFO, session, |
| 1172 | "host reset succeeded\n"); | ||
| 1164 | else | 1173 | else |
| 1165 | goto failed; | 1174 | goto failed; |
| 1166 | spin_unlock_bh(&session->lock); | 1175 | spin_unlock_bh(&session->lock); |
| @@ -1239,7 +1248,8 @@ static int iscsi_exec_task_mgmt_fn(struct iscsi_conn *conn, | |||
| 1239 | * Fail commands. session lock held and recv side suspended and xmit | 1248 | * Fail commands. session lock held and recv side suspended and xmit |
| 1240 | * thread flushed | 1249 | * thread flushed |
| 1241 | */ | 1250 | */ |
| 1242 | static void fail_all_commands(struct iscsi_conn *conn, unsigned lun) | 1251 | static void fail_all_commands(struct iscsi_conn *conn, unsigned lun, |
| 1252 | int error) | ||
| 1243 | { | 1253 | { |
| 1244 | struct iscsi_cmd_task *ctask, *tmp; | 1254 | struct iscsi_cmd_task *ctask, *tmp; |
| 1245 | 1255 | ||
| @@ -1251,7 +1261,7 @@ static void fail_all_commands(struct iscsi_conn *conn, unsigned lun) | |||
| 1251 | if (lun == ctask->sc->device->lun || lun == -1) { | 1261 | if (lun == ctask->sc->device->lun || lun == -1) { |
| 1252 | debug_scsi("failing pending sc %p itt 0x%x\n", | 1262 | debug_scsi("failing pending sc %p itt 0x%x\n", |
| 1253 | ctask->sc, ctask->itt); | 1263 | ctask->sc, ctask->itt); |
| 1254 | fail_command(conn, ctask, DID_BUS_BUSY << 16); | 1264 | fail_command(conn, ctask, error << 16); |
| 1255 | } | 1265 | } |
| 1256 | } | 1266 | } |
| 1257 | 1267 | ||
| @@ -1259,7 +1269,7 @@ static void fail_all_commands(struct iscsi_conn *conn, unsigned lun) | |||
| 1259 | if (lun == ctask->sc->device->lun || lun == -1) { | 1269 | if (lun == ctask->sc->device->lun || lun == -1) { |
| 1260 | debug_scsi("failing requeued sc %p itt 0x%x\n", | 1270 | debug_scsi("failing requeued sc %p itt 0x%x\n", |
| 1261 | ctask->sc, ctask->itt); | 1271 | ctask->sc, ctask->itt); |
| 1262 | fail_command(conn, ctask, DID_BUS_BUSY << 16); | 1272 | fail_command(conn, ctask, error << 16); |
| 1263 | } | 1273 | } |
| 1264 | } | 1274 | } |
| 1265 | 1275 | ||
| @@ -1357,10 +1367,10 @@ static void iscsi_check_transport_timeouts(unsigned long data) | |||
| 1357 | last_recv = conn->last_recv; | 1367 | last_recv = conn->last_recv; |
| 1358 | if (time_before_eq(last_recv + timeout + (conn->ping_timeout * HZ), | 1368 | if (time_before_eq(last_recv + timeout + (conn->ping_timeout * HZ), |
| 1359 | jiffies)) { | 1369 | jiffies)) { |
| 1360 | printk(KERN_ERR "ping timeout of %d secs expired, " | 1370 | iscsi_conn_printk(KERN_ERR, conn, "ping timeout of %d secs " |
| 1361 | "last rx %lu, last ping %lu, now %lu\n", | 1371 | "expired, last rx %lu, last ping %lu, " |
| 1362 | conn->ping_timeout, last_recv, | 1372 | "now %lu\n", conn->ping_timeout, last_recv, |
| 1363 | conn->last_ping, jiffies); | 1373 | conn->last_ping, jiffies); |
| 1364 | spin_unlock(&session->lock); | 1374 | spin_unlock(&session->lock); |
| 1365 | iscsi_conn_failure(conn, ISCSI_ERR_CONN_FAILED); | 1375 | iscsi_conn_failure(conn, ISCSI_ERR_CONN_FAILED); |
| 1366 | return; | 1376 | return; |
| @@ -1373,14 +1383,11 @@ static void iscsi_check_transport_timeouts(unsigned long data) | |||
| 1373 | iscsi_send_nopout(conn, NULL); | 1383 | iscsi_send_nopout(conn, NULL); |
| 1374 | } | 1384 | } |
| 1375 | next_timeout = last_recv + timeout + (conn->ping_timeout * HZ); | 1385 | next_timeout = last_recv + timeout + (conn->ping_timeout * HZ); |
| 1376 | } else { | 1386 | } else |
| 1377 | next_timeout = last_recv + timeout; | 1387 | next_timeout = last_recv + timeout; |
| 1378 | } | ||
| 1379 | 1388 | ||
| 1380 | if (next_timeout) { | 1389 | debug_scsi("Setting next tmo %lu\n", next_timeout); |
| 1381 | debug_scsi("Setting next tmo %lu\n", next_timeout); | 1390 | mod_timer(&conn->transport_timer, next_timeout); |
| 1382 | mod_timer(&conn->transport_timer, next_timeout); | ||
| 1383 | } | ||
| 1384 | done: | 1391 | done: |
| 1385 | spin_unlock(&session->lock); | 1392 | spin_unlock(&session->lock); |
| 1386 | } | 1393 | } |
| @@ -1573,7 +1580,7 @@ int iscsi_eh_device_reset(struct scsi_cmnd *sc) | |||
| 1573 | /* need to grab the recv lock then session lock */ | 1580 | /* need to grab the recv lock then session lock */ |
| 1574 | write_lock_bh(conn->recv_lock); | 1581 | write_lock_bh(conn->recv_lock); |
| 1575 | spin_lock(&session->lock); | 1582 | spin_lock(&session->lock); |
| 1576 | fail_all_commands(conn, sc->device->lun); | 1583 | fail_all_commands(conn, sc->device->lun, DID_ERROR); |
| 1577 | conn->tmf_state = TMF_INITIAL; | 1584 | conn->tmf_state = TMF_INITIAL; |
| 1578 | spin_unlock(&session->lock); | 1585 | spin_unlock(&session->lock); |
| 1579 | write_unlock_bh(conn->recv_lock); | 1586 | write_unlock_bh(conn->recv_lock); |
| @@ -1944,9 +1951,10 @@ void iscsi_conn_teardown(struct iscsi_cls_conn *cls_conn) | |||
| 1944 | } | 1951 | } |
| 1945 | spin_unlock_irqrestore(session->host->host_lock, flags); | 1952 | spin_unlock_irqrestore(session->host->host_lock, flags); |
| 1946 | msleep_interruptible(500); | 1953 | msleep_interruptible(500); |
| 1947 | printk(KERN_INFO "iscsi: scsi conn_destroy(): host_busy %d " | 1954 | iscsi_conn_printk(KERN_INFO, conn, "iscsi conn_destroy(): " |
| 1948 | "host_failed %d\n", session->host->host_busy, | 1955 | "host_busy %d host_failed %d\n", |
| 1949 | session->host->host_failed); | 1956 | session->host->host_busy, |
| 1957 | session->host->host_failed); | ||
| 1950 | /* | 1958 | /* |
| 1951 | * force eh_abort() to unblock | 1959 | * force eh_abort() to unblock |
| 1952 | */ | 1960 | */ |
| @@ -1975,27 +1983,28 @@ int iscsi_conn_start(struct iscsi_cls_conn *cls_conn) | |||
| 1975 | struct iscsi_session *session = conn->session; | 1983 | struct iscsi_session *session = conn->session; |
| 1976 | 1984 | ||
| 1977 | if (!session) { | 1985 | if (!session) { |
| 1978 | printk(KERN_ERR "iscsi: can't start unbound connection\n"); | 1986 | iscsi_conn_printk(KERN_ERR, conn, |
| 1987 | "can't start unbound connection\n"); | ||
| 1979 | return -EPERM; | 1988 | return -EPERM; |
| 1980 | } | 1989 | } |
| 1981 | 1990 | ||
| 1982 | if ((session->imm_data_en || !session->initial_r2t_en) && | 1991 | if ((session->imm_data_en || !session->initial_r2t_en) && |
| 1983 | session->first_burst > session->max_burst) { | 1992 | session->first_burst > session->max_burst) { |
| 1984 | printk("iscsi: invalid burst lengths: " | 1993 | iscsi_conn_printk(KERN_INFO, conn, "invalid burst lengths: " |
| 1985 | "first_burst %d max_burst %d\n", | 1994 | "first_burst %d max_burst %d\n", |
| 1986 | session->first_burst, session->max_burst); | 1995 | session->first_burst, session->max_burst); |
| 1987 | return -EINVAL; | 1996 | return -EINVAL; |
| 1988 | } | 1997 | } |
| 1989 | 1998 | ||
| 1990 | if (conn->ping_timeout && !conn->recv_timeout) { | 1999 | if (conn->ping_timeout && !conn->recv_timeout) { |
| 1991 | printk(KERN_ERR "iscsi: invalid recv timeout of zero " | 2000 | iscsi_conn_printk(KERN_ERR, conn, "invalid recv timeout of " |
| 1992 | "Using 5 seconds\n."); | 2001 | "zero. Using 5 seconds\n."); |
| 1993 | conn->recv_timeout = 5; | 2002 | conn->recv_timeout = 5; |
| 1994 | } | 2003 | } |
| 1995 | 2004 | ||
| 1996 | if (conn->recv_timeout && !conn->ping_timeout) { | 2005 | if (conn->recv_timeout && !conn->ping_timeout) { |
| 1997 | printk(KERN_ERR "iscsi: invalid ping timeout of zero " | 2006 | iscsi_conn_printk(KERN_ERR, conn, "invalid ping timeout of " |
| 1998 | "Using 5 seconds.\n"); | 2007 | "zero. Using 5 seconds.\n"); |
| 1999 | conn->ping_timeout = 5; | 2008 | conn->ping_timeout = 5; |
| 2000 | } | 2009 | } |
| 2001 | 2010 | ||
| @@ -2019,11 +2028,9 @@ int iscsi_conn_start(struct iscsi_cls_conn *cls_conn) | |||
| 2019 | conn->stop_stage = 0; | 2028 | conn->stop_stage = 0; |
| 2020 | conn->tmf_state = TMF_INITIAL; | 2029 | conn->tmf_state = TMF_INITIAL; |
| 2021 | session->age++; | 2030 | session->age++; |
| 2022 | spin_unlock_bh(&session->lock); | 2031 | if (session->age == 16) |
| 2023 | 2032 | session->age = 0; | |
| 2024 | iscsi_unblock_session(session_to_cls(session)); | 2033 | break; |
| 2025 | wake_up(&conn->ehwait); | ||
| 2026 | return 0; | ||
| 2027 | case STOP_CONN_TERM: | 2034 | case STOP_CONN_TERM: |
| 2028 | conn->stop_stage = 0; | 2035 | conn->stop_stage = 0; |
| 2029 | break; | 2036 | break; |
| @@ -2032,6 +2039,8 @@ int iscsi_conn_start(struct iscsi_cls_conn *cls_conn) | |||
| 2032 | } | 2039 | } |
| 2033 | spin_unlock_bh(&session->lock); | 2040 | spin_unlock_bh(&session->lock); |
| 2034 | 2041 | ||
| 2042 | iscsi_unblock_session(session_to_cls(session)); | ||
| 2043 | wake_up(&conn->ehwait); | ||
| 2035 | return 0; | 2044 | return 0; |
| 2036 | } | 2045 | } |
| 2037 | EXPORT_SYMBOL_GPL(iscsi_conn_start); | 2046 | EXPORT_SYMBOL_GPL(iscsi_conn_start); |
| @@ -2123,7 +2132,8 @@ static void iscsi_start_session_recovery(struct iscsi_session *session, | |||
| 2123 | * flush queues. | 2132 | * flush queues. |
| 2124 | */ | 2133 | */ |
| 2125 | spin_lock_bh(&session->lock); | 2134 | spin_lock_bh(&session->lock); |
| 2126 | fail_all_commands(conn, -1); | 2135 | fail_all_commands(conn, -1, |
| 2136 | STOP_CONN_RECOVER ? DID_BUS_BUSY : DID_ERROR); | ||
| 2127 | flush_control_queues(session, conn); | 2137 | flush_control_queues(session, conn); |
| 2128 | spin_unlock_bh(&session->lock); | 2138 | spin_unlock_bh(&session->lock); |
| 2129 | mutex_unlock(&session->eh_mutex); | 2139 | mutex_unlock(&session->eh_mutex); |
| @@ -2140,7 +2150,8 @@ void iscsi_conn_stop(struct iscsi_cls_conn *cls_conn, int flag) | |||
| 2140 | iscsi_start_session_recovery(session, conn, flag); | 2150 | iscsi_start_session_recovery(session, conn, flag); |
| 2141 | break; | 2151 | break; |
| 2142 | default: | 2152 | default: |
| 2143 | printk(KERN_ERR "iscsi: invalid stop flag %d\n", flag); | 2153 | iscsi_conn_printk(KERN_ERR, conn, |
| 2154 | "invalid stop flag %d\n", flag); | ||
| 2144 | } | 2155 | } |
| 2145 | } | 2156 | } |
| 2146 | EXPORT_SYMBOL_GPL(iscsi_conn_stop); | 2157 | EXPORT_SYMBOL_GPL(iscsi_conn_stop); |
diff --git a/drivers/scsi/mac_esp.c b/drivers/scsi/mac_esp.c deleted file mode 100644 index bcb49021b7e2..000000000000 --- a/drivers/scsi/mac_esp.c +++ /dev/null | |||
| @@ -1,751 +0,0 @@ | |||
| 1 | /* | ||
| 2 | * 68k mac 53c9[46] scsi driver | ||
| 3 | * | ||
| 4 | * copyright (c) 1998, David Weis weisd3458@uni.edu | ||
| 5 | * | ||
| 6 | * debugging on Quadra 800 and 660AV Michael Schmitz, Dave Kilzer 7/98 | ||
| 7 | * | ||
| 8 | * based loosely on cyber_esp.c | ||
| 9 | */ | ||
| 10 | |||
| 11 | /* these are unused for now */ | ||
| 12 | #define myreadl(addr) (*(volatile unsigned int *) (addr)) | ||
| 13 | #define mywritel(b, addr) ((*(volatile unsigned int *) (addr)) = (b)) | ||
| 14 | |||
| 15 | |||
| 16 | #include <linux/kernel.h> | ||
| 17 | #include <linux/delay.h> | ||
| 18 | #include <linux/types.h> | ||
| 19 | #include <linux/ctype.h> | ||
| 20 | #include <linux/string.h> | ||
| 21 | #include <linux/slab.h> | ||
| 22 | #include <linux/blkdev.h> | ||
| 23 | #include <linux/proc_fs.h> | ||
| 24 | #include <linux/stat.h> | ||
| 25 | #include <linux/init.h> | ||
| 26 | #include <linux/interrupt.h> | ||
| 27 | |||
| 28 | #include "scsi.h" | ||
| 29 | #include <scsi/scsi_host.h> | ||
| 30 | #include "NCR53C9x.h" | ||
| 31 | |||
| 32 | #include <asm/io.h> | ||
| 33 | |||
| 34 | #include <asm/setup.h> | ||
| 35 | #include <asm/irq.h> | ||
| 36 | #include <asm/macints.h> | ||
| 37 | #include <asm/machw.h> | ||
| 38 | #include <asm/mac_via.h> | ||
| 39 | |||
| 40 | #include <asm/pgtable.h> | ||
| 41 | |||
| 42 | #include <asm/macintosh.h> | ||
| 43 | |||
| 44 | /* #define DEBUG_MAC_ESP */ | ||
| 45 | |||
| 46 | extern void esp_handle(struct NCR_ESP *esp); | ||
| 47 | extern void mac_esp_intr(int irq, void *dev_id); | ||
| 48 | |||
| 49 | static int dma_bytes_sent(struct NCR_ESP * esp, int fifo_count); | ||
| 50 | static int dma_can_transfer(struct NCR_ESP * esp, Scsi_Cmnd *sp); | ||
| 51 | static void dma_dump_state(struct NCR_ESP * esp); | ||
| 52 | static void dma_init_read(struct NCR_ESP * esp, char * vaddress, int length); | ||
| 53 | static void dma_init_write(struct NCR_ESP * esp, char * vaddress, int length); | ||
| 54 | static void dma_ints_off(struct NCR_ESP * esp); | ||
| 55 | static void dma_ints_on(struct NCR_ESP * esp); | ||
| 56 | static int dma_irq_p(struct NCR_ESP * esp); | ||
| 57 | static int dma_irq_p_quick(struct NCR_ESP * esp); | ||
| 58 | static void dma_led_off(struct NCR_ESP * esp); | ||
| 59 | static void dma_led_on(struct NCR_ESP *esp); | ||
| 60 | static int dma_ports_p(struct NCR_ESP *esp); | ||
| 61 | static void dma_setup(struct NCR_ESP * esp, __u32 addr, int count, int write); | ||
| 62 | static void dma_setup_quick(struct NCR_ESP * esp, __u32 addr, int count, int write); | ||
| 63 | |||
| 64 | static int esp_dafb_dma_irq_p(struct NCR_ESP * espdev); | ||
| 65 | static int esp_iosb_dma_irq_p(struct NCR_ESP * espdev); | ||
| 66 | |||
| 67 | static volatile unsigned char cmd_buffer[16]; | ||
| 68 | /* This is where all commands are put | ||
| 69 | * before they are transferred to the ESP chip | ||
| 70 | * via PIO. | ||
| 71 | */ | ||
| 72 | |||
| 73 | static int esp_initialized = 0; | ||
| 74 | |||
| 75 | static int setup_num_esps = -1; | ||
| 76 | static int setup_disconnect = -1; | ||
| 77 | static int setup_nosync = -1; | ||
| 78 | static int setup_can_queue = -1; | ||
| 79 | static int setup_cmd_per_lun = -1; | ||
| 80 | static int setup_sg_tablesize = -1; | ||
| 81 | #ifdef SUPPORT_TAGS | ||
| 82 | static int setup_use_tagged_queuing = -1; | ||
| 83 | #endif | ||
| 84 | static int setup_hostid = -1; | ||
| 85 | |||
| 86 | /* | ||
| 87 | * Experimental ESP inthandler; check macints.c to make sure dev_id is | ||
| 88 | * set up properly! | ||
| 89 | */ | ||
| 90 | |||
| 91 | void mac_esp_intr(int irq, void *dev_id) | ||
| 92 | { | ||
| 93 | struct NCR_ESP *esp = (struct NCR_ESP *) dev_id; | ||
| 94 | int irq_p = 0; | ||
| 95 | |||
| 96 | /* Handle the one ESP interrupt showing at this IRQ level. */ | ||
| 97 | if(((esp)->irq & 0xff) == irq) { | ||
| 98 | /* | ||
| 99 | * Debug .. | ||
| 100 | */ | ||
| 101 | irq_p = esp->dma_irq_p(esp); | ||
| 102 | printk("mac_esp: irq_p %x current %p disconnected %p\n", | ||
| 103 | irq_p, esp->current_SC, esp->disconnected_SC); | ||
| 104 | |||
| 105 | /* | ||
| 106 | * Mac: if we're here, it's an ESP interrupt for sure! | ||
| 107 | */ | ||
| 108 | if((esp->current_SC || esp->disconnected_SC)) { | ||
| 109 | esp->dma_ints_off(esp); | ||
| 110 | |||
| 111 | ESPIRQ(("I%d(", esp->esp_id)); | ||
| 112 | esp_handle(esp); | ||
| 113 | ESPIRQ((")")); | ||
| 114 | |||
| 115 | esp->dma_ints_on(esp); | ||
| 116 | } | ||
| 117 | } | ||
| 118 | } | ||
| 119 | |||
| 120 | /* | ||
| 121 | * Debug hooks; use for playing with the interrupt flag testing and interrupt | ||
| 122 | * acknowledge on the various machines | ||
| 123 | */ | ||
| 124 | |||
| 125 | void scsi_esp_polled(int irq, void *dev_id) | ||
| 126 | { | ||
| 127 | if (esp_initialized == 0) | ||
| 128 | return; | ||
| 129 | |||
| 130 | mac_esp_intr(irq, dev_id); | ||
| 131 | } | ||
| 132 | |||
| 133 | void fake_intr(int irq, void *dev_id) | ||
| 134 | { | ||
| 135 | #ifdef DEBUG_MAC_ESP | ||
| 136 | printk("mac_esp: got irq\n"); | ||
| 137 | #endif | ||
| 138 | |||
| 139 | mac_esp_intr(irq, dev_id); | ||
| 140 | } | ||
| 141 | |||
| 142 | irqreturn_t fake_drq(int irq, void *dev_id) | ||
| 143 | { | ||
| 144 | printk("mac_esp: got drq\n"); | ||
| 145 | return IRQ_HANDLED; | ||
| 146 | } | ||
| 147 | |||
| 148 | #define DRIVER_SETUP | ||
| 149 | |||
| 150 | /* | ||
| 151 | * Function : mac_esp_setup(char *str) | ||
| 152 | * | ||
| 153 | * Purpose : booter command line initialization of the overrides array, | ||
| 154 | * | ||
| 155 | * Inputs : str - parameters, separated by commas. | ||
| 156 | * | ||
| 157 | * Currently unused in the new driver; need to add settable parameters to the | ||
| 158 | * detect function. | ||
| 159 | * | ||
| 160 | */ | ||
| 161 | |||
| 162 | static int __init mac_esp_setup(char *str) { | ||
| 163 | #ifdef DRIVER_SETUP | ||
| 164 | /* Format of mac53c9x parameter is: | ||
| 165 | * mac53c9x=<num_esps>,<disconnect>,<nosync>,<can_queue>,<cmd_per_lun>,<sg_tablesize>,<hostid>,<use_tags> | ||
| 166 | * Negative values mean don't change. | ||
| 167 | */ | ||
| 168 | |||
| 169 | char *this_opt; | ||
| 170 | long opt; | ||
| 171 | |||
| 172 | this_opt = strsep (&str, ","); | ||
| 173 | if(this_opt) { | ||
| 174 | opt = simple_strtol( this_opt, NULL, 0 ); | ||
| 175 | |||
| 176 | if (opt >= 0 && opt <= 2) | ||
| 177 | setup_num_esps = opt; | ||
| 178 | else if (opt > 2) | ||
| 179 | printk( "mac_esp_setup: invalid number of hosts %ld !\n", opt ); | ||
| 180 | |||
| 181 | this_opt = strsep (&str, ","); | ||
| 182 | } | ||
| 183 | if(this_opt) { | ||
| 184 | opt = simple_strtol( this_opt, NULL, 0 ); | ||
| 185 | |||
| 186 | if (opt > 0) | ||
| 187 | setup_disconnect = opt; | ||
| 188 | |||
| 189 | this_opt = strsep (&str, ","); | ||
| 190 | } | ||
| 191 | if(this_opt) { | ||
| 192 | opt = simple_strtol( this_opt, NULL, 0 ); | ||
| 193 | |||
| 194 | if (opt >= 0) | ||
| 195 | setup_nosync = opt; | ||
| 196 | |||
| 197 | this_opt = strsep (&str, ","); | ||
| 198 | } | ||
| 199 | if(this_opt) { | ||
| 200 | opt = simple_strtol( this_opt, NULL, 0 ); | ||
| 201 | |||
| 202 | if (opt > 0) | ||
| 203 | setup_can_queue = opt; | ||
| 204 | |||
| 205 | this_opt = strsep (&str, ","); | ||
| 206 | } | ||
| 207 | if(this_opt) { | ||
| 208 | opt = simple_strtol( this_opt, NULL, 0 ); | ||
| 209 | |||
| 210 | if (opt > 0) | ||
| 211 | setup_cmd_per_lun = opt; | ||
| 212 | |||
| 213 | this_opt = strsep (&str, ","); | ||
| 214 | } | ||
| 215 | if(this_opt) { | ||
| 216 | opt = simple_strtol( this_opt, NULL, 0 ); | ||
| 217 | |||
| 218 | if (opt >= 0) { | ||
| 219 | setup_sg_tablesize = opt; | ||
| 220 | /* Must be <= SG_ALL (255) */ | ||
| 221 | if (setup_sg_tablesize > SG_ALL) | ||
| 222 | setup_sg_tablesize = SG_ALL; | ||
| 223 | } | ||
| 224 | |||
| 225 | this_opt = strsep (&str, ","); | ||
| 226 | } | ||
| 227 | if(this_opt) { | ||
| 228 | opt = simple_strtol( this_opt, NULL, 0 ); | ||
| 229 | |||
| 230 | /* Must be between 0 and 7 */ | ||
| 231 | if (opt >= 0 && opt <= 7) | ||
| 232 | setup_hostid = opt; | ||
| 233 | else if (opt > 7) | ||
| 234 | printk( "mac_esp_setup: invalid host ID %ld !\n", opt); | ||
| 235 | |||
| 236 | this_opt = strsep (&str, ","); | ||
| 237 | } | ||
| 238 | #ifdef SUPPORT_TAGS | ||
| 239 | if(this_opt) { | ||
| 240 | opt = simple_strtol( this_opt, NULL, 0 ); | ||
| 241 | if (opt >= 0) | ||
| 242 | setup_use_tagged_queuing = !!opt; | ||
| 243 | } | ||
| 244 | #endif | ||
| 245 | #endif | ||
| 246 | return 1; | ||
| 247 | } | ||
| 248 | |||
| 249 | __setup("mac53c9x=", mac_esp_setup); | ||
| 250 | |||
| 251 | |||
| 252 | /* | ||
| 253 | * ESP address 'detection' | ||
| 254 | */ | ||
| 255 | |||
| 256 | unsigned long get_base(int chip_num) | ||
| 257 | { | ||
| 258 | /* | ||
| 259 | * using the chip_num and mac model, figure out where the | ||
| 260 | * chips are mapped | ||
| 261 | */ | ||
| 262 | |||
| 263 | unsigned long io_base = 0x50f00000; | ||
| 264 | unsigned int second_offset = 0x402; | ||
| 265 | unsigned long scsi_loc = 0; | ||
| 266 | |||
| 267 | switch (macintosh_config->scsi_type) { | ||
| 268 | |||
| 269 | /* 950, 900, 700 */ | ||
| 270 | case MAC_SCSI_QUADRA2: | ||
| 271 | scsi_loc = io_base + 0xf000 + ((chip_num == 0) ? 0 : second_offset); | ||
| 272 | break; | ||
| 273 | |||
| 274 | /* av's */ | ||
| 275 | case MAC_SCSI_QUADRA3: | ||
| 276 | scsi_loc = io_base + 0x18000 + ((chip_num == 0) ? 0 : second_offset); | ||
| 277 | break; | ||
| 278 | |||
| 279 | /* most quadra/centris models are like this */ | ||
| 280 | case MAC_SCSI_QUADRA: | ||
| 281 | scsi_loc = io_base + 0x10000; | ||
| 282 | break; | ||
| 283 | |||
| 284 | default: | ||
| 285 | printk("mac_esp: get_base: hit default!\n"); | ||
| 286 | scsi_loc = io_base + 0x10000; | ||
| 287 | break; | ||
| 288 | |||
| 289 | } /* switch */ | ||
| 290 | |||
| 291 | printk("mac_esp: io base at 0x%lx\n", scsi_loc); | ||
| 292 | |||
| 293 | return scsi_loc; | ||
| 294 | } | ||
| 295 | |||
| 296 | /* | ||
| 297 | * Model dependent ESP setup | ||
| 298 | */ | ||
| 299 | |||
| 300 | int mac_esp_detect(struct scsi_host_template * tpnt) | ||
| 301 | { | ||
| 302 | int quick = 0; | ||
| 303 | int chipnum, chipspresent = 0; | ||
| 304 | #if 0 | ||
| 305 | unsigned long timeout; | ||
| 306 | #endif | ||
| 307 | |||
| 308 | if (esp_initialized > 0) | ||
| 309 | return -ENODEV; | ||
| 310 | |||
| 311 | /* what do we have in this machine... */ | ||
| 312 | if (MACHW_PRESENT(MAC_SCSI_96)) { | ||
| 313 | chipspresent ++; | ||
| 314 | } | ||
| 315 | |||
| 316 | if (MACHW_PRESENT(MAC_SCSI_96_2)) { | ||
| 317 | chipspresent ++; | ||
| 318 | } | ||
| 319 | |||
| 320 | /* number of ESPs present ? */ | ||
| 321 | if (setup_num_esps >= 0) { | ||
| 322 | if (chipspresent >= setup_num_esps) | ||
| 323 | chipspresent = setup_num_esps; | ||
| 324 | else | ||
| 325 | printk("mac_esp_detect: num_hosts detected %d setup %d \n", | ||
| 326 | chipspresent, setup_num_esps); | ||
| 327 | } | ||
| 328 | |||
| 329 | /* TODO: add disconnect / nosync flags */ | ||
| 330 | |||
| 331 | /* setup variables */ | ||
| 332 | tpnt->can_queue = | ||
| 333 | (setup_can_queue > 0) ? setup_can_queue : 7; | ||
| 334 | tpnt->cmd_per_lun = | ||
| 335 | (setup_cmd_per_lun > 0) ? setup_cmd_per_lun : 1; | ||
| 336 | tpnt->sg_tablesize = | ||
| 337 | (setup_sg_tablesize >= 0) ? setup_sg_tablesize : SG_ALL; | ||
| 338 | |||
| 339 | if (setup_hostid >= 0) | ||
| 340 | tpnt->this_id = setup_hostid; | ||
| 341 | else { | ||
| 342 | /* use 7 as default */ | ||
| 343 | tpnt->this_id = 7; | ||
| 344 | } | ||
| 345 | |||
| 346 | #ifdef SUPPORT_TAGS | ||
| 347 | if (setup_use_tagged_queuing < 0) | ||
| 348 | setup_use_tagged_queuing = DEFAULT_USE_TAGGED_QUEUING; | ||
| 349 | #endif | ||
| 350 | |||
| 351 | for (chipnum = 0; chipnum < chipspresent; chipnum ++) { | ||
| 352 | struct NCR_ESP * esp; | ||
| 353 | |||
| 354 | esp = esp_allocate(tpnt, NULL, 0); | ||
| 355 | esp->eregs = (struct ESP_regs *) get_base(chipnum); | ||
| 356 | |||
| 357 | esp->dma_irq_p = &esp_dafb_dma_irq_p; | ||
| 358 | if (chipnum == 0) { | ||
| 359 | |||
| 360 | if (macintosh_config->scsi_type == MAC_SCSI_QUADRA) { | ||
| 361 | /* most machines except those below :-) */ | ||
| 362 | quick = 1; | ||
| 363 | esp->dma_irq_p = &esp_iosb_dma_irq_p; | ||
| 364 | } else if (macintosh_config->scsi_type == MAC_SCSI_QUADRA3) { | ||
| 365 | /* mostly av's */ | ||
| 366 | quick = 0; | ||
| 367 | } else { | ||
| 368 | /* q950, 900, 700 */ | ||
| 369 | quick = 1; | ||
| 370 | out_be32(0xf9800024, 0x1d1); | ||
| 371 | esp->dregs = (void *) 0xf9800024; | ||
| 372 | } | ||
| 373 | |||
| 374 | } else { /* chipnum */ | ||
| 375 | |||
| 376 | quick = 1; | ||
| 377 | out_be32(0xf9800028, 0x1d1); | ||
| 378 | esp->dregs = (void *) 0xf9800028; | ||
| 379 | |||
| 380 | } /* chipnum == 0 */ | ||
| 381 | |||
| 382 | /* use pio for command bytes; pio for message/data: TBI */ | ||
| 383 | esp->do_pio_cmds = 1; | ||
| 384 | |||
| 385 | /* Set the command buffer */ | ||
| 386 | esp->esp_command = (volatile unsigned char*) cmd_buffer; | ||
| 387 | esp->esp_command_dvma = (__u32) cmd_buffer; | ||
| 388 | |||
| 389 | /* various functions */ | ||
| 390 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 391 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 392 | esp->dma_dump_state = &dma_dump_state; | ||
| 393 | esp->dma_init_read = NULL; | ||
| 394 | esp->dma_init_write = NULL; | ||
| 395 | esp->dma_ints_off = &dma_ints_off; | ||
| 396 | esp->dma_ints_on = &dma_ints_on; | ||
| 397 | |||
| 398 | esp->dma_ports_p = &dma_ports_p; | ||
| 399 | |||
| 400 | |||
| 401 | /* Optional functions */ | ||
| 402 | esp->dma_barrier = NULL; | ||
| 403 | esp->dma_drain = NULL; | ||
| 404 | esp->dma_invalidate = NULL; | ||
| 405 | esp->dma_irq_entry = NULL; | ||
| 406 | esp->dma_irq_exit = NULL; | ||
| 407 | esp->dma_led_on = NULL; | ||
| 408 | esp->dma_led_off = NULL; | ||
| 409 | esp->dma_poll = NULL; | ||
| 410 | esp->dma_reset = NULL; | ||
| 411 | |||
| 412 | /* SCSI chip speed */ | ||
| 413 | /* below esp->cfreq = 40000000; */ | ||
| 414 | |||
| 415 | |||
| 416 | if (quick) { | ||
| 417 | /* 'quick' means there's handshake glue logic like in the 5380 case */ | ||
| 418 | esp->dma_setup = &dma_setup_quick; | ||
| 419 | } else { | ||
| 420 | esp->dma_setup = &dma_setup; | ||
| 421 | } | ||
| 422 | |||
| 423 | if (chipnum == 0) { | ||
| 424 | |||
| 425 | esp->irq = IRQ_MAC_SCSI; | ||
| 426 | |||
| 427 | request_irq(IRQ_MAC_SCSI, esp_intr, 0, "Mac ESP SCSI", esp->ehost); | ||
| 428 | #if 0 /* conflicts with IOP ADB */ | ||
| 429 | request_irq(IRQ_MAC_SCSIDRQ, fake_drq, 0, "Mac ESP DRQ", esp->ehost); | ||
| 430 | #endif | ||
| 431 | |||
| 432 | if (macintosh_config->scsi_type == MAC_SCSI_QUADRA) { | ||
| 433 | esp->cfreq = 16500000; | ||
| 434 | } else { | ||
| 435 | esp->cfreq = 25000000; | ||
| 436 | } | ||
| 437 | |||
| 438 | |||
| 439 | } else { /* chipnum == 1 */ | ||
| 440 | |||
| 441 | esp->irq = IRQ_MAC_SCSIDRQ; | ||
| 442 | #if 0 /* conflicts with IOP ADB */ | ||
| 443 | request_irq(IRQ_MAC_SCSIDRQ, esp_intr, 0, "Mac ESP SCSI 2", esp->ehost); | ||
| 444 | #endif | ||
| 445 | |||
| 446 | esp->cfreq = 25000000; | ||
| 447 | |||
| 448 | } | ||
| 449 | |||
| 450 | if (quick) { | ||
| 451 | printk("esp: using quick version\n"); | ||
| 452 | } | ||
| 453 | |||
| 454 | printk("esp: addr at 0x%p\n", esp->eregs); | ||
| 455 | |||
| 456 | esp->scsi_id = 7; | ||
| 457 | esp->diff = 0; | ||
| 458 | |||
| 459 | esp_initialize(esp); | ||
| 460 | |||
| 461 | } /* for chipnum */ | ||
| 462 | |||
| 463 | if (chipspresent) | ||
| 464 | printk("\nmac_esp: %d esp controllers found\n", chipspresent); | ||
| 465 | |||
| 466 | esp_initialized = chipspresent; | ||
| 467 | |||
| 468 | return chipspresent; | ||
| 469 | } | ||
| 470 | |||
| 471 | static int mac_esp_release(struct Scsi_Host *shost) | ||
| 472 | { | ||
| 473 | if (shost->irq) | ||
| 474 | free_irq(shost->irq, NULL); | ||
| 475 | if (shost->io_port && shost->n_io_port) | ||
| 476 | release_region(shost->io_port, shost->n_io_port); | ||
| 477 | scsi_unregister(shost); | ||
| 478 | return 0; | ||
| 479 | } | ||
| 480 | |||
| 481 | /* | ||
| 482 | * I've been wondering what this is supposed to do, for some time. Talking | ||
| 483 | * to Allen Briggs: These machines have an extra register someplace where the | ||
| 484 | * DRQ pin of the ESP can be monitored. That isn't useful for determining | ||
| 485 | * anything else (such as reselect interrupt or other magic) though. | ||
| 486 | * Maybe make the semantics should be changed like | ||
| 487 | * if (esp->current_SC) | ||
| 488 | * ... check DRQ flag ... | ||
| 489 | * else | ||
| 490 | * ... disconnected, check pending VIA interrupt ... | ||
| 491 | * | ||
| 492 | * There's a problem with using the dabf flag or mac_irq_pending() here: both | ||
| 493 | * seem to return 1 even though no interrupt is currently pending, resulting | ||
| 494 | * in esp_exec_cmd() holding off the next command, and possibly infinite loops | ||
| 495 | * in esp_intr(). | ||
| 496 | * Short term fix: just use esp_status & ESP_STAT_INTR here, as long as we | ||
| 497 | * use simple PIO. The DRQ status will be important when implementing pseudo | ||
| 498 | * DMA mode (set up ESP transfer count, return, do a batch of bytes in PIO or | ||
| 499 | * 'hardware handshake' mode upon DRQ). | ||
| 500 | * If you plan on changing this (i.e. to save the esp_status register access in | ||
| 501 | * favor of a VIA register access or a shadow register for the IFR), make sure | ||
| 502 | * to try a debug version of this first to monitor what registers would be a good | ||
| 503 | * indicator of the ESP interrupt. | ||
| 504 | */ | ||
| 505 | |||
| 506 | static int esp_dafb_dma_irq_p(struct NCR_ESP * esp) | ||
| 507 | { | ||
| 508 | unsigned int ret; | ||
| 509 | int sreg = esp_read(esp->eregs->esp_status); | ||
| 510 | |||
| 511 | #ifdef DEBUG_MAC_ESP | ||
| 512 | printk("mac_esp: esp_dafb_dma_irq_p dafb %d irq %d\n", | ||
| 513 | readl(esp->dregs), mac_irq_pending(IRQ_MAC_SCSI)); | ||
| 514 | #endif | ||
| 515 | |||
| 516 | sreg &= ESP_STAT_INTR; | ||
| 517 | |||
| 518 | /* | ||
| 519 | * maybe working; this is essentially what's used for iosb_dma_irq_p | ||
| 520 | */ | ||
| 521 | if (sreg) | ||
| 522 | return 1; | ||
| 523 | else | ||
| 524 | return 0; | ||
| 525 | |||
| 526 | /* | ||
| 527 | * didn't work ... | ||
| 528 | */ | ||
| 529 | #if 0 | ||
| 530 | if (esp->current_SC) | ||
| 531 | ret = readl(esp->dregs) & 0x200; | ||
| 532 | else if (esp->disconnected_SC) | ||
| 533 | ret = 1; /* sreg ?? */ | ||
| 534 | else | ||
| 535 | ret = mac_irq_pending(IRQ_MAC_SCSI); | ||
| 536 | |||
| 537 | return(ret); | ||
| 538 | #endif | ||
| 539 | |||
| 540 | } | ||
| 541 | |||
| 542 | /* | ||
| 543 | * See above: testing mac_irq_pending always returned 8 (SCSI IRQ) regardless | ||
| 544 | * of the actual ESP status. | ||
| 545 | */ | ||
| 546 | |||
| 547 | static int esp_iosb_dma_irq_p(struct NCR_ESP * esp) | ||
| 548 | { | ||
| 549 | int ret = mac_irq_pending(IRQ_MAC_SCSI) || mac_irq_pending(IRQ_MAC_SCSIDRQ); | ||
| 550 | int sreg = esp_read(esp->eregs->esp_status); | ||
| 551 | |||
| 552 | #ifdef DEBUG_MAC_ESP | ||
| 553 | printk("mac_esp: dma_irq_p drq %d irq %d sreg %x curr %p disc %p\n", | ||
| 554 | mac_irq_pending(IRQ_MAC_SCSIDRQ), mac_irq_pending(IRQ_MAC_SCSI), | ||
| 555 | sreg, esp->current_SC, esp->disconnected_SC); | ||
| 556 | #endif | ||
| 557 | |||
| 558 | sreg &= ESP_STAT_INTR; | ||
| 559 | |||
| 560 | if (sreg) | ||
| 561 | return (sreg); | ||
| 562 | else | ||
| 563 | return 0; | ||
| 564 | } | ||
| 565 | |||
| 566 | /* | ||
| 567 | * This seems to be OK for PIO at least ... usually 0 after PIO. | ||
| 568 | */ | ||
| 569 | |||
| 570 | static int dma_bytes_sent(struct NCR_ESP * esp, int fifo_count) | ||
| 571 | { | ||
| 572 | |||
| 573 | #ifdef DEBUG_MAC_ESP | ||
| 574 | printk("mac_esp: dma bytes sent = %x\n", fifo_count); | ||
| 575 | #endif | ||
| 576 | |||
| 577 | return fifo_count; | ||
| 578 | } | ||
| 579 | |||
| 580 | /* | ||
| 581 | * dma_can_transfer is used to switch between DMA and PIO, if DMA (pseudo) | ||
| 582 | * is ever implemented. Returning 0 here will use PIO. | ||
| 583 | */ | ||
| 584 | |||
| 585 | static int dma_can_transfer(struct NCR_ESP * esp, Scsi_Cmnd * sp) | ||
| 586 | { | ||
| 587 | unsigned long sz = sp->SCp.this_residual; | ||
| 588 | #if 0 /* no DMA yet; make conditional */ | ||
| 589 | if (sz > 0x10000000) { | ||
| 590 | sz = 0x10000000; | ||
| 591 | } | ||
| 592 | printk("mac_esp: dma can transfer = 0lx%x\n", sz); | ||
| 593 | #else | ||
| 594 | |||
| 595 | #ifdef DEBUG_MAC_ESP | ||
| 596 | printk("mac_esp: pio to transfer = %ld\n", sz); | ||
| 597 | #endif | ||
| 598 | |||
| 599 | sz = 0; | ||
| 600 | #endif | ||
| 601 | return sz; | ||
| 602 | } | ||
| 603 | |||
| 604 | /* | ||
| 605 | * Not yet ... | ||
| 606 | */ | ||
| 607 | |||
| 608 | static void dma_dump_state(struct NCR_ESP * esp) | ||
| 609 | { | ||
| 610 | #ifdef DEBUG_MAC_ESP | ||
| 611 | printk("mac_esp: dma_dump_state: called\n"); | ||
| 612 | #endif | ||
| 613 | #if 0 | ||
| 614 | ESPLOG(("esp%d: dma -- cond_reg<%02x>\n", | ||
| 615 | esp->esp_id, ((struct mac_dma_registers *) | ||
| 616 | (esp->dregs))->cond_reg)); | ||
| 617 | #endif | ||
| 618 | } | ||
| 619 | |||
| 620 | /* | ||
| 621 | * DMA setup: should be used to set up the ESP transfer count for pseudo | ||
| 622 | * DMA transfers; need a DRQ transfer function to do the actual transfer | ||
| 623 | */ | ||
| 624 | |||
| 625 | static void dma_init_read(struct NCR_ESP * esp, char * vaddress, int length) | ||
| 626 | { | ||
| 627 | printk("mac_esp: dma_init_read\n"); | ||
| 628 | } | ||
| 629 | |||
| 630 | |||
| 631 | static void dma_init_write(struct NCR_ESP * esp, char * vaddress, int length) | ||
| 632 | { | ||
| 633 | printk("mac_esp: dma_init_write\n"); | ||
| 634 | } | ||
| 635 | |||
| 636 | |||
| 637 | static void dma_ints_off(struct NCR_ESP * esp) | ||
| 638 | { | ||
| 639 | disable_irq(esp->irq); | ||
| 640 | } | ||
| 641 | |||
| 642 | |||
| 643 | static void dma_ints_on(struct NCR_ESP * esp) | ||
| 644 | { | ||
| 645 | enable_irq(esp->irq); | ||
| 646 | } | ||
| 647 | |||
| 648 | /* | ||
| 649 | * generic dma_irq_p(), unused | ||
| 650 | */ | ||
| 651 | |||
| 652 | static int dma_irq_p(struct NCR_ESP * esp) | ||
| 653 | { | ||
| 654 | int i = esp_read(esp->eregs->esp_status); | ||
| 655 | |||
| 656 | #ifdef DEBUG_MAC_ESP | ||
| 657 | printk("mac_esp: dma_irq_p status %d\n", i); | ||
| 658 | #endif | ||
| 659 | |||
| 660 | return (i & ESP_STAT_INTR); | ||
| 661 | } | ||
| 662 | |||
| 663 | static int dma_irq_p_quick(struct NCR_ESP * esp) | ||
| 664 | { | ||
| 665 | /* | ||
| 666 | * Copied from iosb_dma_irq_p() | ||
| 667 | */ | ||
| 668 | int ret = mac_irq_pending(IRQ_MAC_SCSI) || mac_irq_pending(IRQ_MAC_SCSIDRQ); | ||
| 669 | int sreg = esp_read(esp->eregs->esp_status); | ||
| 670 | |||
| 671 | #ifdef DEBUG_MAC_ESP | ||
| 672 | printk("mac_esp: dma_irq_p drq %d irq %d sreg %x curr %p disc %p\n", | ||
| 673 | mac_irq_pending(IRQ_MAC_SCSIDRQ), mac_irq_pending(IRQ_MAC_SCSI), | ||
| 674 | sreg, esp->current_SC, esp->disconnected_SC); | ||
| 675 | #endif | ||
| 676 | |||
| 677 | sreg &= ESP_STAT_INTR; | ||
| 678 | |||
| 679 | if (sreg) | ||
| 680 | return (sreg); | ||
| 681 | else | ||
| 682 | return 0; | ||
| 683 | |||
| 684 | } | ||
| 685 | |||
| 686 | static void dma_led_off(struct NCR_ESP * esp) | ||
| 687 | { | ||
| 688 | #ifdef DEBUG_MAC_ESP | ||
| 689 | printk("mac_esp: dma_led_off: called\n"); | ||
| 690 | #endif | ||
| 691 | } | ||
| 692 | |||
| 693 | |||
| 694 | static void dma_led_on(struct NCR_ESP * esp) | ||
| 695 | { | ||
| 696 | #ifdef DEBUG_MAC_ESP | ||
| 697 | printk("mac_esp: dma_led_on: called\n"); | ||
| 698 | #endif | ||
| 699 | } | ||
| 700 | |||
| 701 | |||
| 702 | static int dma_ports_p(struct NCR_ESP * esp) | ||
| 703 | { | ||
| 704 | return 0; | ||
| 705 | } | ||
| 706 | |||
| 707 | |||
| 708 | static void dma_setup(struct NCR_ESP * esp, __u32 addr, int count, int write) | ||
| 709 | { | ||
| 710 | |||
| 711 | #ifdef DEBUG_MAC_ESP | ||
| 712 | printk("mac_esp: dma_setup\n"); | ||
| 713 | #endif | ||
| 714 | |||
| 715 | if (write) { | ||
| 716 | dma_init_read(esp, (char *) addr, count); | ||
| 717 | } else { | ||
| 718 | dma_init_write(esp, (char *) addr, count); | ||
| 719 | } | ||
| 720 | } | ||
| 721 | |||
| 722 | |||
| 723 | static void dma_setup_quick(struct NCR_ESP * esp, __u32 addr, int count, int write) | ||
| 724 | { | ||
| 725 | #ifdef DEBUG_MAC_ESP | ||
| 726 | printk("mac_esp: dma_setup_quick\n"); | ||
| 727 | #endif | ||
| 728 | } | ||
| 729 | |||
| 730 | static struct scsi_host_template driver_template = { | ||
| 731 | .proc_name = "mac_esp", | ||
| 732 | .name = "Mac 53C9x SCSI", | ||
| 733 | .detect = mac_esp_detect, | ||
| 734 | .slave_alloc = esp_slave_alloc, | ||
| 735 | .slave_destroy = esp_slave_destroy, | ||
| 736 | .release = mac_esp_release, | ||
| 737 | .info = esp_info, | ||
| 738 | .queuecommand = esp_queue, | ||
| 739 | .eh_abort_handler = esp_abort, | ||
| 740 | .eh_bus_reset_handler = esp_reset, | ||
| 741 | .can_queue = 7, | ||
| 742 | .this_id = 7, | ||
| 743 | .sg_tablesize = SG_ALL, | ||
| 744 | .cmd_per_lun = 1, | ||
| 745 | .use_clustering = DISABLE_CLUSTERING | ||
| 746 | }; | ||
| 747 | |||
| 748 | |||
| 749 | #include "scsi_module.c" | ||
| 750 | |||
| 751 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/scsi/mca_53c9x.c b/drivers/scsi/mca_53c9x.c deleted file mode 100644 index d693d0f21395..000000000000 --- a/drivers/scsi/mca_53c9x.c +++ /dev/null | |||
| @@ -1,520 +0,0 @@ | |||
| 1 | /* mca_53c9x.c: Driver for the SCSI adapter found on NCR 35xx | ||
| 2 | * (and maybe some other) Microchannel machines | ||
| 3 | * | ||
| 4 | * Code taken mostly from Cyberstorm SCSI drivers | ||
| 5 | * Copyright (C) 1996 Jesper Skov (jskov@cygnus.co.uk) | ||
| 6 | * | ||
| 7 | * Hacked to work with the NCR MCA stuff by Tymm Twillman (tymm@computer.org) | ||
| 8 | * | ||
| 9 | * The CyberStorm SCSI driver (and this driver) is based on David S. Miller's | ||
| 10 | * ESP driver * for the Sparc computers. | ||
| 11 | * | ||
| 12 | * Special thanks to Ken Stewart at Symbios (LSI) for helping with info on | ||
| 13 | * the 86C01. I was on the brink of going ga-ga... | ||
| 14 | * | ||
| 15 | * Also thanks to Jesper Skov for helping me with info on how the Amiga | ||
| 16 | * does things... | ||
| 17 | */ | ||
| 18 | |||
| 19 | /* | ||
| 20 | * This is currently only set up to use one 53c9x card at a time; it could be | ||
| 21 | * changed fairly easily to detect/use more than one, but I'm not too sure how | ||
| 22 | * many cards that use the 53c9x on MCA systems there are (if, in fact, there | ||
| 23 | * are cards that use them, other than the one built into some NCR systems)... | ||
| 24 | * If anyone requests this, I'll throw it in, otherwise it's not worth the | ||
| 25 | * effort. | ||
| 26 | */ | ||
| 27 | |||
| 28 | /* | ||
| 29 | * Info on the 86C01 MCA interface chip at the bottom, if you care enough to | ||
| 30 | * look. | ||
| 31 | */ | ||
| 32 | |||
| 33 | #include <linux/delay.h> | ||
| 34 | #include <linux/interrupt.h> | ||
| 35 | #include <linux/kernel.h> | ||
| 36 | #include <linux/mca.h> | ||
| 37 | #include <linux/types.h> | ||
| 38 | #include <linux/string.h> | ||
| 39 | #include <linux/slab.h> | ||
| 40 | #include <linux/blkdev.h> | ||
| 41 | #include <linux/proc_fs.h> | ||
| 42 | #include <linux/stat.h> | ||
| 43 | #include <linux/mca-legacy.h> | ||
| 44 | |||
| 45 | #include "scsi.h" | ||
| 46 | #include <scsi/scsi_host.h> | ||
| 47 | #include "NCR53C9x.h" | ||
| 48 | |||
| 49 | #include <asm/dma.h> | ||
| 50 | #include <asm/irq.h> | ||
| 51 | #include <asm/mca_dma.h> | ||
| 52 | #include <asm/pgtable.h> | ||
| 53 | |||
| 54 | /* | ||
| 55 | * From ibmmca.c (IBM scsi controller card driver) -- used for turning PS2 disk | ||
| 56 | * activity LED on and off | ||
| 57 | */ | ||
| 58 | |||
| 59 | #define PS2_SYS_CTR 0x92 | ||
| 60 | |||
| 61 | /* Ports the ncr's 53c94 can be put at; indexed by pos register value */ | ||
| 62 | |||
| 63 | #define MCA_53C9X_IO_PORTS { \ | ||
| 64 | 0x0000, 0x0240, 0x0340, 0x0400, \ | ||
| 65 | 0x0420, 0x3240, 0x8240, 0xA240, \ | ||
| 66 | } | ||
| 67 | |||
| 68 | /* | ||
| 69 | * Supposedly there were some cards put together with the 'c9x and 86c01. If | ||
| 70 | * they have different ID's from the ones on the 3500 series machines, | ||
| 71 | * you can add them here and hopefully things will work out. | ||
| 72 | */ | ||
| 73 | |||
| 74 | #define MCA_53C9X_IDS { \ | ||
| 75 | 0x7F4C, \ | ||
| 76 | 0x0000, \ | ||
| 77 | } | ||
| 78 | |||
| 79 | static int dma_bytes_sent(struct NCR_ESP *, int); | ||
| 80 | static int dma_can_transfer(struct NCR_ESP *, Scsi_Cmnd *); | ||
| 81 | static void dma_dump_state(struct NCR_ESP *); | ||
| 82 | static void dma_init_read(struct NCR_ESP *, __u32, int); | ||
| 83 | static void dma_init_write(struct NCR_ESP *, __u32, int); | ||
| 84 | static void dma_ints_off(struct NCR_ESP *); | ||
| 85 | static void dma_ints_on(struct NCR_ESP *); | ||
| 86 | static int dma_irq_p(struct NCR_ESP *); | ||
| 87 | static int dma_ports_p(struct NCR_ESP *); | ||
| 88 | static void dma_setup(struct NCR_ESP *, __u32, int, int); | ||
| 89 | static void dma_led_on(struct NCR_ESP *); | ||
| 90 | static void dma_led_off(struct NCR_ESP *); | ||
| 91 | |||
| 92 | /* This is where all commands are put before they are trasfered to the | ||
| 93 | * 53c9x via PIO. | ||
| 94 | */ | ||
| 95 | |||
| 96 | static volatile unsigned char cmd_buffer[16]; | ||
| 97 | |||
| 98 | /* | ||
| 99 | * We keep the structure that is used to access the registers on the 53c9x | ||
| 100 | * here. | ||
| 101 | */ | ||
| 102 | |||
| 103 | static struct ESP_regs eregs; | ||
| 104 | |||
| 105 | /***************************************************************** Detection */ | ||
| 106 | static int mca_esp_detect(struct scsi_host_template *tpnt) | ||
| 107 | { | ||
| 108 | struct NCR_ESP *esp; | ||
| 109 | static int io_port_by_pos[] = MCA_53C9X_IO_PORTS; | ||
| 110 | int mca_53c9x_ids[] = MCA_53C9X_IDS; | ||
| 111 | int *id_to_check = mca_53c9x_ids; | ||
| 112 | int slot; | ||
| 113 | int pos[3]; | ||
| 114 | unsigned int tmp_io_addr; | ||
| 115 | unsigned char tmp_byte; | ||
| 116 | |||
| 117 | |||
| 118 | if (!MCA_bus) | ||
| 119 | return 0; | ||
| 120 | |||
| 121 | while (*id_to_check) { | ||
| 122 | if ((slot = mca_find_adapter(*id_to_check, 0)) != | ||
| 123 | MCA_NOTFOUND) | ||
| 124 | { | ||
| 125 | esp = esp_allocate(tpnt, NULL, 0); | ||
| 126 | |||
| 127 | pos[0] = mca_read_stored_pos(slot, 2); | ||
| 128 | pos[1] = mca_read_stored_pos(slot, 3); | ||
| 129 | pos[2] = mca_read_stored_pos(slot, 4); | ||
| 130 | |||
| 131 | esp->eregs = &eregs; | ||
| 132 | |||
| 133 | /* | ||
| 134 | * IO port base is given in the first (non-ID) pos | ||
| 135 | * register, like so: | ||
| 136 | * | ||
| 137 | * Bits 3 2 1 IO base | ||
| 138 | * ---------------------------- | ||
| 139 | * 0 0 0 <disabled> | ||
| 140 | * 0 0 1 0x0240 | ||
| 141 | * 0 1 0 0x0340 | ||
| 142 | * 0 1 1 0x0400 | ||
| 143 | * 1 0 0 0x0420 | ||
| 144 | * 1 0 1 0x3240 | ||
| 145 | * 1 1 0 0x8240 | ||
| 146 | * 1 1 1 0xA240 | ||
| 147 | */ | ||
| 148 | |||
| 149 | tmp_io_addr = | ||
| 150 | io_port_by_pos[(pos[0] & 0x0E) >> 1]; | ||
| 151 | |||
| 152 | esp->eregs->io_addr = tmp_io_addr + 0x10; | ||
| 153 | |||
| 154 | if (esp->eregs->io_addr == 0x0000) { | ||
| 155 | printk("Adapter is disabled.\n"); | ||
| 156 | break; | ||
| 157 | } | ||
| 158 | |||
| 159 | /* | ||
| 160 | * IRQ is specified in bits 4 and 5: | ||
| 161 | * | ||
| 162 | * Bits 4 5 IRQ | ||
| 163 | * ----------------------- | ||
| 164 | * 0 0 3 | ||
| 165 | * 0 1 5 | ||
| 166 | * 1 0 7 | ||
| 167 | * 1 1 9 | ||
| 168 | */ | ||
| 169 | |||
| 170 | esp->irq = ((pos[0] & 0x30) >> 3) + 3; | ||
| 171 | |||
| 172 | /* | ||
| 173 | * DMA channel is in the low 3 bits of the second | ||
| 174 | * POS register | ||
| 175 | */ | ||
| 176 | |||
| 177 | esp->dma = pos[1] & 7; | ||
| 178 | esp->slot = slot; | ||
| 179 | |||
| 180 | if (request_irq(esp->irq, esp_intr, 0, | ||
| 181 | "NCR 53c9x SCSI", esp->ehost)) | ||
| 182 | { | ||
| 183 | printk("Unable to request IRQ %d.\n", esp->irq); | ||
| 184 | esp_deallocate(esp); | ||
| 185 | scsi_unregister(esp->ehost); | ||
| 186 | return 0; | ||
| 187 | } | ||
| 188 | |||
| 189 | if (request_dma(esp->dma, "NCR 53c9x SCSI")) { | ||
| 190 | printk("Unable to request DMA channel %d.\n", | ||
| 191 | esp->dma); | ||
| 192 | free_irq(esp->irq, esp_intr); | ||
| 193 | esp_deallocate(esp); | ||
| 194 | scsi_unregister(esp->ehost); | ||
| 195 | return 0; | ||
| 196 | } | ||
| 197 | |||
| 198 | request_region(tmp_io_addr, 32, "NCR 53c9x SCSI"); | ||
| 199 | |||
| 200 | /* | ||
| 201 | * 86C01 handles DMA, IO mode, from address | ||
| 202 | * (base + 0x0a) | ||
| 203 | */ | ||
| 204 | |||
| 205 | mca_disable_dma(esp->dma); | ||
| 206 | mca_set_dma_io(esp->dma, tmp_io_addr + 0x0a); | ||
| 207 | mca_enable_dma(esp->dma); | ||
| 208 | |||
| 209 | /* Tell the 86C01 to give us interrupts */ | ||
| 210 | |||
| 211 | tmp_byte = inb(tmp_io_addr + 0x02) | 0x40; | ||
| 212 | outb(tmp_byte, tmp_io_addr + 0x02); | ||
| 213 | |||
| 214 | /* | ||
| 215 | * Scsi ID -- general purpose register, hi | ||
| 216 | * 2 bits; add 4 to this number to get the | ||
| 217 | * ID | ||
| 218 | */ | ||
| 219 | |||
| 220 | esp->scsi_id = ((pos[2] & 0xC0) >> 6) + 4; | ||
| 221 | |||
| 222 | /* Do command transfer with programmed I/O */ | ||
| 223 | |||
| 224 | esp->do_pio_cmds = 1; | ||
| 225 | |||
| 226 | /* Required functions */ | ||
| 227 | |||
| 228 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 229 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 230 | esp->dma_dump_state = &dma_dump_state; | ||
| 231 | esp->dma_init_read = &dma_init_read; | ||
| 232 | esp->dma_init_write = &dma_init_write; | ||
| 233 | esp->dma_ints_off = &dma_ints_off; | ||
| 234 | esp->dma_ints_on = &dma_ints_on; | ||
| 235 | esp->dma_irq_p = &dma_irq_p; | ||
| 236 | esp->dma_ports_p = &dma_ports_p; | ||
| 237 | esp->dma_setup = &dma_setup; | ||
| 238 | |||
| 239 | /* Optional functions */ | ||
| 240 | |||
| 241 | esp->dma_barrier = NULL; | ||
| 242 | esp->dma_drain = NULL; | ||
| 243 | esp->dma_invalidate = NULL; | ||
| 244 | esp->dma_irq_entry = NULL; | ||
| 245 | esp->dma_irq_exit = NULL; | ||
| 246 | esp->dma_led_on = dma_led_on; | ||
| 247 | esp->dma_led_off = dma_led_off; | ||
| 248 | esp->dma_poll = NULL; | ||
| 249 | esp->dma_reset = NULL; | ||
| 250 | |||
| 251 | /* Set the command buffer */ | ||
| 252 | |||
| 253 | esp->esp_command = (volatile unsigned char*) | ||
| 254 | cmd_buffer; | ||
| 255 | esp->esp_command_dvma = isa_virt_to_bus(cmd_buffer); | ||
| 256 | |||
| 257 | /* SCSI chip speed */ | ||
| 258 | |||
| 259 | esp->cfreq = 25000000; | ||
| 260 | |||
| 261 | /* Differential SCSI? I think not. */ | ||
| 262 | |||
| 263 | esp->diff = 0; | ||
| 264 | |||
| 265 | esp_initialize(esp); | ||
| 266 | |||
| 267 | printk(" Adapter found in slot %2d: io port 0x%x " | ||
| 268 | "irq %d dma channel %d\n", slot + 1, tmp_io_addr, | ||
| 269 | esp->irq, esp->dma); | ||
| 270 | |||
| 271 | mca_set_adapter_name(slot, "NCR 53C9X SCSI Adapter"); | ||
| 272 | mca_mark_as_used(slot); | ||
| 273 | |||
| 274 | break; | ||
| 275 | } | ||
| 276 | |||
| 277 | id_to_check++; | ||
| 278 | } | ||
| 279 | |||
| 280 | return esps_in_use; | ||
| 281 | } | ||
| 282 | |||
| 283 | |||
| 284 | /******************************************************************* Release */ | ||
| 285 | |||
| 286 | static int mca_esp_release(struct Scsi_Host *host) | ||
| 287 | { | ||
| 288 | struct NCR_ESP *esp = (struct NCR_ESP *)host->hostdata; | ||
| 289 | unsigned char tmp_byte; | ||
| 290 | |||
| 291 | esp_deallocate(esp); | ||
| 292 | /* | ||
| 293 | * Tell the 86C01 to stop sending interrupts | ||
| 294 | */ | ||
| 295 | |||
| 296 | tmp_byte = inb(esp->eregs->io_addr - 0x0E); | ||
| 297 | tmp_byte &= ~0x40; | ||
| 298 | outb(tmp_byte, esp->eregs->io_addr - 0x0E); | ||
| 299 | |||
| 300 | free_irq(esp->irq, esp_intr); | ||
| 301 | free_dma(esp->dma); | ||
| 302 | |||
| 303 | mca_mark_as_unused(esp->slot); | ||
| 304 | |||
| 305 | return 0; | ||
| 306 | } | ||
| 307 | |||
| 308 | /************************************************************* DMA Functions */ | ||
| 309 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count) | ||
| 310 | { | ||
| 311 | /* Ask the 53c9x. It knows. */ | ||
| 312 | |||
| 313 | return fifo_count; | ||
| 314 | } | ||
| 315 | |||
| 316 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 317 | { | ||
| 318 | /* | ||
| 319 | * The MCA dma channels can only do up to 128K bytes at a time. | ||
| 320 | * (16 bit mode) | ||
| 321 | */ | ||
| 322 | |||
| 323 | unsigned long sz = sp->SCp.this_residual; | ||
| 324 | if(sz > 0x20000) | ||
| 325 | sz = 0x20000; | ||
| 326 | return sz; | ||
| 327 | } | ||
| 328 | |||
| 329 | static void dma_dump_state(struct NCR_ESP *esp) | ||
| 330 | { | ||
| 331 | /* | ||
| 332 | * Doesn't quite match up to the other drivers, but we do what we | ||
| 333 | * can. | ||
| 334 | */ | ||
| 335 | |||
| 336 | ESPLOG(("esp%d: dma channel <%d>\n", esp->esp_id, esp->dma)); | ||
| 337 | ESPLOG(("bytes left to dma: %d\n", mca_get_dma_residue(esp->dma))); | ||
| 338 | } | ||
| 339 | |||
| 340 | static void dma_init_read(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 341 | { | ||
| 342 | unsigned long flags; | ||
| 343 | |||
| 344 | |||
| 345 | save_flags(flags); | ||
| 346 | cli(); | ||
| 347 | |||
| 348 | mca_disable_dma(esp->dma); | ||
| 349 | mca_set_dma_mode(esp->dma, MCA_DMA_MODE_XFER | MCA_DMA_MODE_16 | | ||
| 350 | MCA_DMA_MODE_IO); | ||
| 351 | mca_set_dma_addr(esp->dma, addr); | ||
| 352 | mca_set_dma_count(esp->dma, length / 2); /* !!! */ | ||
| 353 | mca_enable_dma(esp->dma); | ||
| 354 | |||
| 355 | restore_flags(flags); | ||
| 356 | } | ||
| 357 | |||
| 358 | static void dma_init_write(struct NCR_ESP *esp, __u32 addr, int length) | ||
| 359 | { | ||
| 360 | unsigned long flags; | ||
| 361 | |||
| 362 | |||
| 363 | save_flags(flags); | ||
| 364 | cli(); | ||
| 365 | |||
| 366 | mca_disable_dma(esp->dma); | ||
| 367 | mca_set_dma_mode(esp->dma, MCA_DMA_MODE_XFER | MCA_DMA_MODE_WRITE | | ||
| 368 | MCA_DMA_MODE_16 | MCA_DMA_MODE_IO); | ||
| 369 | mca_set_dma_addr(esp->dma, addr); | ||
| 370 | mca_set_dma_count(esp->dma, length / 2); /* !!! */ | ||
| 371 | mca_enable_dma(esp->dma); | ||
| 372 | |||
| 373 | restore_flags(flags); | ||
| 374 | } | ||
| 375 | |||
| 376 | static void dma_ints_off(struct NCR_ESP *esp) | ||
| 377 | { | ||
| 378 | /* | ||
| 379 | * Tell the 'C01 to shut up. All interrupts are routed through it. | ||
| 380 | */ | ||
| 381 | |||
| 382 | outb(inb(esp->eregs->io_addr - 0x0E) & ~0x40, | ||
| 383 | esp->eregs->io_addr - 0x0E); | ||
| 384 | } | ||
| 385 | |||
| 386 | static void dma_ints_on(struct NCR_ESP *esp) | ||
| 387 | { | ||
| 388 | /* | ||
| 389 | * Ok. You can speak again. | ||
| 390 | */ | ||
| 391 | |||
| 392 | outb(inb(esp->eregs->io_addr - 0x0E) | 0x40, | ||
| 393 | esp->eregs->io_addr - 0x0E); | ||
| 394 | } | ||
| 395 | |||
| 396 | static int dma_irq_p(struct NCR_ESP *esp) | ||
| 397 | { | ||
| 398 | /* | ||
| 399 | * DaveM says that this should return a "yes" if there is an interrupt | ||
| 400 | * or a DMA error occurred. I copied the Amiga driver's semantics, | ||
| 401 | * though, because it seems to work and we can't really tell if | ||
| 402 | * a DMA error happened. This gives the "yes" if the scsi chip | ||
| 403 | * is sending an interrupt and no DMA activity is taking place | ||
| 404 | */ | ||
| 405 | |||
| 406 | return (!(inb(esp->eregs->io_addr - 0x04) & 1) && | ||
| 407 | !(inb(esp->eregs->io_addr - 0x04) & 2) ); | ||
| 408 | } | ||
| 409 | |||
| 410 | static int dma_ports_p(struct NCR_ESP *esp) | ||
| 411 | { | ||
| 412 | /* | ||
| 413 | * Check to see if interrupts are enabled on the 'C01 (in case abort | ||
| 414 | * is entered multiple times, so we only do the abort once) | ||
| 415 | */ | ||
| 416 | |||
| 417 | return (inb(esp->eregs->io_addr - 0x0E) & 0x40) ? 1:0; | ||
| 418 | } | ||
| 419 | |||
| 420 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write) | ||
| 421 | { | ||
| 422 | if(write){ | ||
| 423 | dma_init_write(esp, addr, count); | ||
| 424 | } else { | ||
| 425 | dma_init_read(esp, addr, count); | ||
| 426 | } | ||
| 427 | } | ||
| 428 | |||
| 429 | /* | ||
| 430 | * These will not play nicely with other disk controllers that try to use the | ||
| 431 | * disk active LED... but what can you do? Don't answer that. | ||
| 432 | * | ||
| 433 | * Stolen shamelessly from ibmmca.c -- IBM Microchannel SCSI adapter driver | ||
| 434 | * | ||
| 435 | */ | ||
| 436 | |||
| 437 | static void dma_led_on(struct NCR_ESP *esp) | ||
| 438 | { | ||
| 439 | outb(inb(PS2_SYS_CTR) | 0xc0, PS2_SYS_CTR); | ||
| 440 | } | ||
| 441 | |||
| 442 | static void dma_led_off(struct NCR_ESP *esp) | ||
| 443 | { | ||
| 444 | outb(inb(PS2_SYS_CTR) & 0x3f, PS2_SYS_CTR); | ||
| 445 | } | ||
| 446 | |||
| 447 | static struct scsi_host_template driver_template = { | ||
| 448 | .proc_name = "mca_53c9x", | ||
| 449 | .name = "NCR 53c9x SCSI", | ||
| 450 | .detect = mca_esp_detect, | ||
| 451 | .slave_alloc = esp_slave_alloc, | ||
| 452 | .slave_destroy = esp_slave_destroy, | ||
| 453 | .release = mca_esp_release, | ||
| 454 | .queuecommand = esp_queue, | ||
| 455 | .eh_abort_handler = esp_abort, | ||
| 456 | .eh_bus_reset_handler = esp_reset, | ||
| 457 | .can_queue = 7, | ||
| 458 | .sg_tablesize = SG_ALL, | ||
| 459 | .cmd_per_lun = 1, | ||
| 460 | .unchecked_isa_dma = 1, | ||
| 461 | .use_clustering = DISABLE_CLUSTERING | ||
| 462 | }; | ||
| 463 | |||
| 464 | |||
| 465 | #include "scsi_module.c" | ||
| 466 | |||
| 467 | /* | ||
| 468 | * OK, here's the goods I promised. The NCR 86C01 is an MCA interface chip | ||
| 469 | * that handles enabling/diabling IRQ, dma interfacing, IO port selection | ||
| 470 | * and other fun stuff. It takes up 16 addresses, and the chip it is | ||
| 471 | * connnected to gets the following 16. Registers are as follows: | ||
| 472 | * | ||
| 473 | * Offsets 0-1 : Card ID | ||
| 474 | * | ||
| 475 | * Offset 2 : Mode enable register -- | ||
| 476 | * Bit 7 : Data Word width (1 = 16, 0 = 8) | ||
| 477 | * Bit 6 : IRQ enable (1 = enabled) | ||
| 478 | * Bits 5,4 : IRQ select | ||
| 479 | * 0 0 : IRQ 3 | ||
| 480 | * 0 1 : IRQ 5 | ||
| 481 | * 1 0 : IRQ 7 | ||
| 482 | * 1 1 : IRQ 9 | ||
| 483 | * Bits 3-1 : Base Address | ||
| 484 | * 0 0 0 : <disabled> | ||
| 485 | * 0 0 1 : 0x0240 | ||
| 486 | * 0 1 0 : 0x0340 | ||
| 487 | * 0 1 1 : 0x0400 | ||
| 488 | * 1 0 0 : 0x0420 | ||
| 489 | * 1 0 1 : 0x3240 | ||
| 490 | * 1 1 0 : 0x8240 | ||
| 491 | * 1 1 1 : 0xA240 | ||
| 492 | * Bit 0 : Card enable (1 = enabled) | ||
| 493 | * | ||
| 494 | * Offset 3 : DMA control register -- | ||
| 495 | * Bit 7 : DMA enable (1 = enabled) | ||
| 496 | * Bits 6,5 : Preemt Count Select (transfers to complete after | ||
| 497 | * 'C01 has been preempted on MCA bus) | ||
| 498 | * 0 0 : 0 | ||
| 499 | * 0 1 : 1 | ||
| 500 | * 1 0 : 3 | ||
| 501 | * 1 1 : 7 | ||
| 502 | * (all these wacky numbers; I'm sure there's a reason somewhere) | ||
| 503 | * Bit 4 : Fairness enable (1 = fair bus priority) | ||
| 504 | * Bits 3-0 : Arbitration level (0-15 consecutive) | ||
| 505 | * | ||
| 506 | * Offset 4 : General purpose register | ||
| 507 | * Bits 7-3 : User definable (here, 7,6 are SCSI ID) | ||
| 508 | * Bits 2-0 : reserved | ||
| 509 | * | ||
| 510 | * Offset 10 : DMA decode register (used for IO based DMA; also can do | ||
| 511 | * PIO through this port) | ||
| 512 | * | ||
| 513 | * Offset 12 : Status | ||
| 514 | * Bits 7-2 : reserved | ||
| 515 | * Bit 1 : DMA pending (1 = pending) | ||
| 516 | * Bit 0 : IRQ pending (0 = pending) | ||
| 517 | * | ||
| 518 | * Exciting, huh? | ||
| 519 | * | ||
| 520 | */ | ||
diff --git a/drivers/scsi/oktagon_esp.c b/drivers/scsi/oktagon_esp.c deleted file mode 100644 index 8e5eadbd5c51..000000000000 --- a/drivers/scsi/oktagon_esp.c +++ /dev/null | |||
| @@ -1,606 +0,0 @@ | |||
| 1 | /* | ||
| 2 | * Oktagon_esp.c -- Driver for bsc Oktagon | ||
| 3 | * | ||
| 4 | * Written by Carsten Pluntke 1998 | ||
| 5 | * | ||
| 6 | * Based on cyber_esp.c | ||
| 7 | */ | ||
| 8 | |||
| 9 | |||
| 10 | #if defined(CONFIG_AMIGA) || defined(CONFIG_APUS) | ||
| 11 | #define USE_BOTTOM_HALF | ||
| 12 | #endif | ||
| 13 | |||
| 14 | #include <linux/module.h> | ||
| 15 | |||
| 16 | #include <linux/kernel.h> | ||
| 17 | #include <linux/delay.h> | ||
| 18 | #include <linux/types.h> | ||
| 19 | #include <linux/string.h> | ||
| 20 | #include <linux/slab.h> | ||
| 21 | #include <linux/blkdev.h> | ||
| 22 | #include <linux/proc_fs.h> | ||
| 23 | #include <linux/stat.h> | ||
| 24 | #include <linux/reboot.h> | ||
| 25 | #include <asm/system.h> | ||
| 26 | #include <asm/ptrace.h> | ||
| 27 | #include <asm/pgtable.h> | ||
| 28 | |||
| 29 | |||
| 30 | #include "scsi.h" | ||
| 31 | #include <scsi/scsi_host.h> | ||
| 32 | #include "NCR53C9x.h" | ||
| 33 | |||
| 34 | #include <linux/zorro.h> | ||
| 35 | #include <asm/irq.h> | ||
| 36 | #include <asm/amigaints.h> | ||
| 37 | #include <asm/amigahw.h> | ||
| 38 | |||
| 39 | #ifdef USE_BOTTOM_HALF | ||
| 40 | #include <linux/workqueue.h> | ||
| 41 | #include <linux/interrupt.h> | ||
| 42 | #endif | ||
| 43 | |||
| 44 | /* The controller registers can be found in the Z2 config area at these | ||
| 45 | * offsets: | ||
| 46 | */ | ||
| 47 | #define OKTAGON_ESP_ADDR 0x03000 | ||
| 48 | #define OKTAGON_DMA_ADDR 0x01000 | ||
| 49 | |||
| 50 | |||
| 51 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count); | ||
| 52 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 53 | static void dma_dump_state(struct NCR_ESP *esp); | ||
| 54 | static void dma_init_read(struct NCR_ESP *esp, __u32 vaddress, int length); | ||
| 55 | static void dma_init_write(struct NCR_ESP *esp, __u32 vaddress, int length); | ||
| 56 | static void dma_ints_off(struct NCR_ESP *esp); | ||
| 57 | static void dma_ints_on(struct NCR_ESP *esp); | ||
| 58 | static int dma_irq_p(struct NCR_ESP *esp); | ||
| 59 | static void dma_led_off(struct NCR_ESP *esp); | ||
| 60 | static void dma_led_on(struct NCR_ESP *esp); | ||
| 61 | static int dma_ports_p(struct NCR_ESP *esp); | ||
| 62 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write); | ||
| 63 | |||
| 64 | static void dma_irq_exit(struct NCR_ESP *esp); | ||
| 65 | static void dma_invalidate(struct NCR_ESP *esp); | ||
| 66 | |||
| 67 | static void dma_mmu_get_scsi_one(struct NCR_ESP *,Scsi_Cmnd *); | ||
| 68 | static void dma_mmu_get_scsi_sgl(struct NCR_ESP *,Scsi_Cmnd *); | ||
| 69 | static void dma_mmu_release_scsi_one(struct NCR_ESP *,Scsi_Cmnd *); | ||
| 70 | static void dma_mmu_release_scsi_sgl(struct NCR_ESP *,Scsi_Cmnd *); | ||
| 71 | static void dma_advance_sg(Scsi_Cmnd *); | ||
| 72 | static int oktagon_notify_reboot(struct notifier_block *this, unsigned long code, void *x); | ||
| 73 | |||
| 74 | #ifdef USE_BOTTOM_HALF | ||
| 75 | static void dma_commit(struct work_struct *unused); | ||
| 76 | |||
| 77 | long oktag_to_io(long *paddr, long *addr, long len); | ||
| 78 | long oktag_from_io(long *addr, long *paddr, long len); | ||
| 79 | |||
| 80 | static DECLARE_WORK(tq_fake_dma, dma_commit); | ||
| 81 | |||
| 82 | #define DMA_MAXTRANSFER 0x8000 | ||
| 83 | |||
| 84 | #else | ||
| 85 | |||
| 86 | /* | ||
| 87 | * No bottom half. Use transfer directly from IRQ. Find a narrow path | ||
| 88 | * between too much IRQ overhead and clogging the IRQ for too long. | ||
| 89 | */ | ||
| 90 | |||
| 91 | #define DMA_MAXTRANSFER 0x1000 | ||
| 92 | |||
| 93 | #endif | ||
| 94 | |||
| 95 | static struct notifier_block oktagon_notifier = { | ||
| 96 | oktagon_notify_reboot, | ||
| 97 | NULL, | ||
| 98 | 0 | ||
| 99 | }; | ||
| 100 | |||
| 101 | static long *paddress; | ||
| 102 | static long *address; | ||
| 103 | static long len; | ||
| 104 | static long dma_on; | ||
| 105 | static int direction; | ||
| 106 | static struct NCR_ESP *current_esp; | ||
| 107 | |||
| 108 | |||
| 109 | static volatile unsigned char cmd_buffer[16]; | ||
| 110 | /* This is where all commands are put | ||
| 111 | * before they are trasfered to the ESP chip | ||
| 112 | * via PIO. | ||
| 113 | */ | ||
| 114 | |||
| 115 | /***************************************************************** Detection */ | ||
| 116 | int oktagon_esp_detect(struct scsi_host_template *tpnt) | ||
| 117 | { | ||
| 118 | struct NCR_ESP *esp; | ||
| 119 | struct zorro_dev *z = NULL; | ||
| 120 | unsigned long address; | ||
| 121 | struct ESP_regs *eregs; | ||
| 122 | |||
| 123 | while ((z = zorro_find_device(ZORRO_PROD_BSC_OKTAGON_2008, z))) { | ||
| 124 | unsigned long board = z->resource.start; | ||
| 125 | if (request_mem_region(board+OKTAGON_ESP_ADDR, | ||
| 126 | sizeof(struct ESP_regs), "NCR53C9x")) { | ||
| 127 | /* | ||
| 128 | * It is a SCSI controller. | ||
| 129 | * Hardwire Host adapter to SCSI ID 7 | ||
| 130 | */ | ||
| 131 | |||
| 132 | address = (unsigned long)ZTWO_VADDR(board); | ||
| 133 | eregs = (struct ESP_regs *)(address + OKTAGON_ESP_ADDR); | ||
| 134 | |||
| 135 | /* This line was 5 lines lower */ | ||
| 136 | esp = esp_allocate(tpnt, (void *)board + OKTAGON_ESP_ADDR, 0); | ||
| 137 | |||
| 138 | /* we have to shift the registers only one bit for oktagon */ | ||
| 139 | esp->shift = 1; | ||
| 140 | |||
| 141 | esp_write(eregs->esp_cfg1, (ESP_CONFIG1_PENABLE | 7)); | ||
| 142 | udelay(5); | ||
| 143 | if (esp_read(eregs->esp_cfg1) != (ESP_CONFIG1_PENABLE | 7)) | ||
| 144 | return 0; /* Bail out if address did not hold data */ | ||
| 145 | |||
| 146 | /* Do command transfer with programmed I/O */ | ||
| 147 | esp->do_pio_cmds = 1; | ||
| 148 | |||
| 149 | /* Required functions */ | ||
| 150 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 151 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 152 | esp->dma_dump_state = &dma_dump_state; | ||
| 153 | esp->dma_init_read = &dma_init_read; | ||
| 154 | esp->dma_init_write = &dma_init_write; | ||
| 155 | esp->dma_ints_off = &dma_ints_off; | ||
| 156 | esp->dma_ints_on = &dma_ints_on; | ||
| 157 | esp->dma_irq_p = &dma_irq_p; | ||
| 158 | esp->dma_ports_p = &dma_ports_p; | ||
| 159 | esp->dma_setup = &dma_setup; | ||
| 160 | |||
| 161 | /* Optional functions */ | ||
| 162 | esp->dma_barrier = 0; | ||
| 163 | esp->dma_drain = 0; | ||
| 164 | esp->dma_invalidate = &dma_invalidate; | ||
| 165 | esp->dma_irq_entry = 0; | ||
| 166 | esp->dma_irq_exit = &dma_irq_exit; | ||
| 167 | esp->dma_led_on = &dma_led_on; | ||
| 168 | esp->dma_led_off = &dma_led_off; | ||
| 169 | esp->dma_poll = 0; | ||
| 170 | esp->dma_reset = 0; | ||
| 171 | |||
| 172 | esp->dma_mmu_get_scsi_one = &dma_mmu_get_scsi_one; | ||
| 173 | esp->dma_mmu_get_scsi_sgl = &dma_mmu_get_scsi_sgl; | ||
| 174 | esp->dma_mmu_release_scsi_one = &dma_mmu_release_scsi_one; | ||
| 175 | esp->dma_mmu_release_scsi_sgl = &dma_mmu_release_scsi_sgl; | ||
| 176 | esp->dma_advance_sg = &dma_advance_sg; | ||
| 177 | |||
| 178 | /* SCSI chip speed */ | ||
| 179 | /* Looking at the quartz of the SCSI board... */ | ||
| 180 | esp->cfreq = 25000000; | ||
| 181 | |||
| 182 | /* The DMA registers on the CyberStorm are mapped | ||
| 183 | * relative to the device (i.e. in the same Zorro | ||
| 184 | * I/O block). | ||
| 185 | */ | ||
| 186 | esp->dregs = (void *)(address + OKTAGON_DMA_ADDR); | ||
| 187 | |||
| 188 | paddress = (long *) esp->dregs; | ||
| 189 | |||
| 190 | /* ESP register base */ | ||
| 191 | esp->eregs = eregs; | ||
| 192 | |||
| 193 | /* Set the command buffer */ | ||
| 194 | esp->esp_command = (volatile unsigned char*) cmd_buffer; | ||
| 195 | |||
| 196 | /* Yes, the virtual address. See below. */ | ||
| 197 | esp->esp_command_dvma = (__u32) cmd_buffer; | ||
| 198 | |||
| 199 | esp->irq = IRQ_AMIGA_PORTS; | ||
| 200 | request_irq(IRQ_AMIGA_PORTS, esp_intr, IRQF_SHARED, | ||
| 201 | "BSC Oktagon SCSI", esp->ehost); | ||
| 202 | |||
| 203 | /* Figure out our scsi ID on the bus */ | ||
| 204 | esp->scsi_id = 7; | ||
| 205 | |||
| 206 | /* We don't have a differential SCSI-bus. */ | ||
| 207 | esp->diff = 0; | ||
| 208 | |||
| 209 | esp_initialize(esp); | ||
| 210 | |||
| 211 | printk("ESP_Oktagon Driver 1.1" | ||
| 212 | #ifdef USE_BOTTOM_HALF | ||
| 213 | " [BOTTOM_HALF]" | ||
| 214 | #else | ||
| 215 | " [IRQ]" | ||
| 216 | #endif | ||
| 217 | " registered.\n"); | ||
| 218 | printk("ESP: Total of %d ESP hosts found, %d actually in use.\n", nesps,esps_in_use); | ||
| 219 | esps_running = esps_in_use; | ||
| 220 | current_esp = esp; | ||
| 221 | register_reboot_notifier(&oktagon_notifier); | ||
| 222 | return esps_in_use; | ||
| 223 | } | ||
| 224 | } | ||
| 225 | return 0; | ||
| 226 | } | ||
| 227 | |||
| 228 | |||
| 229 | /* | ||
| 230 | * On certain configurations the SCSI equipment gets confused on reboot, | ||
| 231 | * so we have to reset it then. | ||
| 232 | */ | ||
| 233 | |||
| 234 | static int | ||
| 235 | oktagon_notify_reboot(struct notifier_block *this, unsigned long code, void *x) | ||
| 236 | { | ||
| 237 | struct NCR_ESP *esp; | ||
| 238 | |||
| 239 | if((code == SYS_DOWN || code == SYS_HALT) && (esp = current_esp)) | ||
| 240 | { | ||
| 241 | esp_bootup_reset(esp,esp->eregs); | ||
| 242 | udelay(500); /* Settle time. Maybe unnecessary. */ | ||
| 243 | } | ||
| 244 | return NOTIFY_DONE; | ||
| 245 | } | ||
| 246 | |||
| 247 | |||
| 248 | |||
| 249 | #ifdef USE_BOTTOM_HALF | ||
| 250 | |||
| 251 | |||
| 252 | /* | ||
| 253 | * The bsc Oktagon controller has no real DMA, so we have to do the 'DMA | ||
| 254 | * transfer' in the interrupt (Yikes!) or use a bottom half to not to clutter | ||
| 255 | * IRQ's for longer-than-good. | ||
| 256 | * | ||
| 257 | * FIXME | ||
| 258 | * BIG PROBLEM: 'len' is usually the buffer length, not the expected length | ||
| 259 | * of the data. So DMA may finish prematurely, further reads lead to | ||
| 260 | * 'machine check' on APUS systems (don't know about m68k systems, AmigaOS | ||
| 261 | * deliberately ignores the bus faults) and a normal copy-loop can't | ||
| 262 | * be exited prematurely just at the right moment by the dma_invalidate IRQ. | ||
| 263 | * So do it the hard way, write an own copier in assembler and | ||
| 264 | * catch the exception. | ||
| 265 | * -- Carsten | ||
| 266 | */ | ||
| 267 | |||
| 268 | |||
| 269 | static void dma_commit(struct work_struct *unused) | ||
| 270 | { | ||
| 271 | long wait,len2,pos; | ||
| 272 | struct NCR_ESP *esp; | ||
| 273 | |||
| 274 | ESPDATA(("Transfer: %ld bytes, Address 0x%08lX, Direction: %d\n", | ||
| 275 | len,(long) address,direction)); | ||
| 276 | dma_ints_off(current_esp); | ||
| 277 | |||
| 278 | pos = 0; | ||
| 279 | wait = 1; | ||
| 280 | if(direction) /* write? (memory to device) */ | ||
| 281 | { | ||
| 282 | while(len > 0) | ||
| 283 | { | ||
| 284 | len2 = oktag_to_io(paddress, address+pos, len); | ||
| 285 | if(!len2) | ||
| 286 | { | ||
| 287 | if(wait > 1000) | ||
| 288 | { | ||
| 289 | printk("Expedited DMA exit (writing) %ld\n",len); | ||
| 290 | break; | ||
| 291 | } | ||
| 292 | mdelay(wait); | ||
| 293 | wait *= 2; | ||
| 294 | } | ||
| 295 | pos += len2; | ||
| 296 | len -= len2*sizeof(long); | ||
| 297 | } | ||
| 298 | } else { | ||
| 299 | while(len > 0) | ||
| 300 | { | ||
| 301 | len2 = oktag_from_io(address+pos, paddress, len); | ||
| 302 | if(!len2) | ||
| 303 | { | ||
| 304 | if(wait > 1000) | ||
| 305 | { | ||
| 306 | printk("Expedited DMA exit (reading) %ld\n",len); | ||
| 307 | break; | ||
| 308 | } | ||
| 309 | mdelay(wait); | ||
| 310 | wait *= 2; | ||
| 311 | } | ||
| 312 | pos += len2; | ||
| 313 | len -= len2*sizeof(long); | ||
| 314 | } | ||
| 315 | } | ||
| 316 | |||
| 317 | /* to make esp->shift work */ | ||
| 318 | esp=current_esp; | ||
| 319 | |||
| 320 | #if 0 | ||
| 321 | len2 = (esp_read(current_esp->eregs->esp_tclow) & 0xff) | | ||
| 322 | ((esp_read(current_esp->eregs->esp_tcmed) & 0xff) << 8); | ||
| 323 | |||
| 324 | /* | ||
| 325 | * Uh uh. If you see this, len and transfer count registers were out of | ||
| 326 | * sync. That means really serious trouble. | ||
| 327 | */ | ||
| 328 | |||
| 329 | if(len2) | ||
| 330 | printk("Eeeek!! Transfer count still %ld!\n",len2); | ||
| 331 | #endif | ||
| 332 | |||
| 333 | /* | ||
| 334 | * Normally we just need to exit and wait for the interrupt to come. | ||
| 335 | * But at least one device (my Microtek ScanMaker 630) regularly mis- | ||
| 336 | * calculates the bytes it should send which is really ugly because | ||
| 337 | * it locks up the SCSI bus if not accounted for. | ||
| 338 | */ | ||
| 339 | |||
| 340 | if(!(esp_read(current_esp->eregs->esp_status) & ESP_STAT_INTR)) | ||
| 341 | { | ||
| 342 | long len = 100; | ||
| 343 | long trash[10]; | ||
| 344 | |||
| 345 | /* | ||
| 346 | * Interrupt bit was not set. Either the device is just plain lazy | ||
| 347 | * so we give it a 10 ms chance or... | ||
| 348 | */ | ||
| 349 | while(len-- && (!(esp_read(current_esp->eregs->esp_status) & ESP_STAT_INTR))) | ||
| 350 | udelay(100); | ||
| 351 | |||
| 352 | |||
| 353 | if(!(esp_read(current_esp->eregs->esp_status) & ESP_STAT_INTR)) | ||
| 354 | { | ||
| 355 | /* | ||
| 356 | * So we think that the transfer count is out of sync. Since we | ||
| 357 | * have all we want we are happy and can ditch the trash. | ||
| 358 | */ | ||
| 359 | |||
| 360 | len = DMA_MAXTRANSFER; | ||
| 361 | |||
| 362 | while(len-- && (!(esp_read(current_esp->eregs->esp_status) & ESP_STAT_INTR))) | ||
| 363 | oktag_from_io(trash,paddress,2); | ||
| 364 | |||
| 365 | if(!(esp_read(current_esp->eregs->esp_status) & ESP_STAT_INTR)) | ||
| 366 | { | ||
| 367 | /* | ||
| 368 | * Things really have gone wrong. If we leave the system in that | ||
| 369 | * state, the SCSI bus is locked forever. I hope that this will | ||
| 370 | * turn the system in a more or less running state. | ||
| 371 | */ | ||
| 372 | printk("Device is bolixed, trying bus reset...\n"); | ||
| 373 | esp_bootup_reset(current_esp,current_esp->eregs); | ||
| 374 | } | ||
| 375 | } | ||
| 376 | } | ||
| 377 | |||
| 378 | ESPDATA(("Transfer_finale: do_data_finale should come\n")); | ||
| 379 | |||
| 380 | len = 0; | ||
| 381 | dma_on = 0; | ||
| 382 | dma_ints_on(current_esp); | ||
| 383 | } | ||
| 384 | |||
| 385 | #endif | ||
| 386 | |||
| 387 | /************************************************************* DMA Functions */ | ||
| 388 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count) | ||
| 389 | { | ||
| 390 | /* Since the CyberStorm DMA is fully dedicated to the ESP chip, | ||
| 391 | * the number of bytes sent (to the ESP chip) equals the number | ||
| 392 | * of bytes in the FIFO - there is no buffering in the DMA controller. | ||
| 393 | * XXXX Do I read this right? It is from host to ESP, right? | ||
| 394 | */ | ||
| 395 | return fifo_count; | ||
| 396 | } | ||
| 397 | |||
| 398 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 399 | { | ||
| 400 | unsigned long sz = sp->SCp.this_residual; | ||
| 401 | if(sz > DMA_MAXTRANSFER) | ||
| 402 | sz = DMA_MAXTRANSFER; | ||
| 403 | return sz; | ||
| 404 | } | ||
| 405 | |||
| 406 | static void dma_dump_state(struct NCR_ESP *esp) | ||
| 407 | { | ||
| 408 | } | ||
| 409 | |||
| 410 | /* | ||
| 411 | * What the f$@& is this? | ||
| 412 | * | ||
| 413 | * Some SCSI devices (like my Microtek ScanMaker 630 scanner) want to transfer | ||
| 414 | * more data than requested. How much? Dunno. So ditch the bogus data into | ||
| 415 | * the sink, hoping the device will advance to the next phase sooner or later. | ||
| 416 | * | ||
| 417 | * -- Carsten | ||
| 418 | */ | ||
| 419 | |||
| 420 | static long oktag_eva_buffer[16]; /* The data sink */ | ||
| 421 | |||
| 422 | static void oktag_check_dma(void) | ||
| 423 | { | ||
| 424 | struct NCR_ESP *esp; | ||
| 425 | |||
| 426 | esp=current_esp; | ||
| 427 | if(!len) | ||
| 428 | { | ||
| 429 | address = oktag_eva_buffer; | ||
| 430 | len = 2; | ||
| 431 | /* esp_do_data sets them to zero like len */ | ||
| 432 | esp_write(current_esp->eregs->esp_tclow,2); | ||
| 433 | esp_write(current_esp->eregs->esp_tcmed,0); | ||
| 434 | } | ||
| 435 | } | ||
| 436 | |||
| 437 | static void dma_init_read(struct NCR_ESP *esp, __u32 vaddress, int length) | ||
| 438 | { | ||
| 439 | /* Zorro is noncached, everything else done using processor. */ | ||
| 440 | /* cache_clear(addr, length); */ | ||
| 441 | |||
| 442 | if(dma_on) | ||
| 443 | panic("dma_init_read while dma process is initialized/running!\n"); | ||
| 444 | direction = 0; | ||
| 445 | address = (long *) vaddress; | ||
| 446 | current_esp = esp; | ||
| 447 | len = length; | ||
| 448 | oktag_check_dma(); | ||
| 449 | dma_on = 1; | ||
| 450 | } | ||
| 451 | |||
| 452 | static void dma_init_write(struct NCR_ESP *esp, __u32 vaddress, int length) | ||
| 453 | { | ||
| 454 | /* cache_push(addr, length); */ | ||
| 455 | |||
| 456 | if(dma_on) | ||
| 457 | panic("dma_init_write while dma process is initialized/running!\n"); | ||
| 458 | direction = 1; | ||
| 459 | address = (long *) vaddress; | ||
| 460 | current_esp = esp; | ||
| 461 | len = length; | ||
| 462 | oktag_check_dma(); | ||
| 463 | dma_on = 1; | ||
| 464 | } | ||
| 465 | |||
| 466 | static void dma_ints_off(struct NCR_ESP *esp) | ||
| 467 | { | ||
| 468 | disable_irq(esp->irq); | ||
| 469 | } | ||
| 470 | |||
| 471 | static void dma_ints_on(struct NCR_ESP *esp) | ||
| 472 | { | ||
| 473 | enable_irq(esp->irq); | ||
| 474 | } | ||
| 475 | |||
| 476 | static int dma_irq_p(struct NCR_ESP *esp) | ||
| 477 | { | ||
| 478 | /* It's important to check the DMA IRQ bit in the correct way! */ | ||
| 479 | return (esp_read(esp->eregs->esp_status) & ESP_STAT_INTR); | ||
| 480 | } | ||
| 481 | |||
| 482 | static void dma_led_off(struct NCR_ESP *esp) | ||
| 483 | { | ||
| 484 | } | ||
| 485 | |||
| 486 | static void dma_led_on(struct NCR_ESP *esp) | ||
| 487 | { | ||
| 488 | } | ||
| 489 | |||
| 490 | static int dma_ports_p(struct NCR_ESP *esp) | ||
| 491 | { | ||
| 492 | return ((amiga_custom.intenar) & IF_PORTS); | ||
| 493 | } | ||
| 494 | |||
| 495 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write) | ||
| 496 | { | ||
| 497 | /* On the Sparc, DMA_ST_WRITE means "move data from device to memory" | ||
| 498 | * so when (write) is true, it actually means READ! | ||
| 499 | */ | ||
| 500 | if(write){ | ||
| 501 | dma_init_read(esp, addr, count); | ||
| 502 | } else { | ||
| 503 | dma_init_write(esp, addr, count); | ||
| 504 | } | ||
| 505 | } | ||
| 506 | |||
| 507 | /* | ||
| 508 | * IRQ entry when DMA transfer is ready to be started | ||
| 509 | */ | ||
| 510 | |||
| 511 | static void dma_irq_exit(struct NCR_ESP *esp) | ||
| 512 | { | ||
| 513 | #ifdef USE_BOTTOM_HALF | ||
| 514 | if(dma_on) | ||
| 515 | { | ||
| 516 | schedule_work(&tq_fake_dma); | ||
| 517 | } | ||
| 518 | #else | ||
| 519 | while(len && !dma_irq_p(esp)) | ||
| 520 | { | ||
| 521 | if(direction) | ||
| 522 | *paddress = *address++; | ||
| 523 | else | ||
| 524 | *address++ = *paddress; | ||
| 525 | len -= (sizeof(long)); | ||
| 526 | } | ||
| 527 | len = 0; | ||
| 528 | dma_on = 0; | ||
| 529 | #endif | ||
| 530 | } | ||
| 531 | |||
| 532 | /* | ||
| 533 | * IRQ entry when DMA has just finished | ||
| 534 | */ | ||
| 535 | |||
| 536 | static void dma_invalidate(struct NCR_ESP *esp) | ||
| 537 | { | ||
| 538 | } | ||
| 539 | |||
| 540 | /* | ||
| 541 | * Since the processor does the data transfer we have to use the custom | ||
| 542 | * mmu interface to pass the virtual address, not the physical. | ||
| 543 | */ | ||
| 544 | |||
| 545 | void dma_mmu_get_scsi_one(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 546 | { | ||
| 547 | sp->SCp.ptr = | ||
| 548 | sp->request_buffer; | ||
| 549 | } | ||
| 550 | |||
| 551 | void dma_mmu_get_scsi_sgl(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 552 | { | ||
| 553 | sp->SCp.ptr = sg_virt(sp->SCp.buffer); | ||
| 554 | } | ||
| 555 | |||
| 556 | void dma_mmu_release_scsi_one(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 557 | { | ||
| 558 | } | ||
| 559 | |||
| 560 | void dma_mmu_release_scsi_sgl(struct NCR_ESP *esp, Scsi_Cmnd *sp) | ||
| 561 | { | ||
| 562 | } | ||
| 563 | |||
| 564 | void dma_advance_sg(Scsi_Cmnd *sp) | ||
| 565 | { | ||
| 566 | sp->SCp.ptr = sg_virt(sp->SCp.buffer); | ||
| 567 | } | ||
| 568 | |||
| 569 | |||
| 570 | #define HOSTS_C | ||
| 571 | |||
| 572 | int oktagon_esp_release(struct Scsi_Host *instance) | ||
| 573 | { | ||
| 574 | #ifdef MODULE | ||
| 575 | unsigned long address = (unsigned long)((struct NCR_ESP *)instance->hostdata)->edev; | ||
| 576 | esp_release(); | ||
| 577 | release_mem_region(address, sizeof(struct ESP_regs)); | ||
| 578 | free_irq(IRQ_AMIGA_PORTS, esp_intr); | ||
| 579 | unregister_reboot_notifier(&oktagon_notifier); | ||
| 580 | #endif | ||
| 581 | return 1; | ||
| 582 | } | ||
| 583 | |||
| 584 | |||
| 585 | static struct scsi_host_template driver_template = { | ||
| 586 | .proc_name = "esp-oktagon", | ||
| 587 | .proc_info = &esp_proc_info, | ||
| 588 | .name = "BSC Oktagon SCSI", | ||
| 589 | .detect = oktagon_esp_detect, | ||
| 590 | .slave_alloc = esp_slave_alloc, | ||
| 591 | .slave_destroy = esp_slave_destroy, | ||
| 592 | .release = oktagon_esp_release, | ||
| 593 | .queuecommand = esp_queue, | ||
| 594 | .eh_abort_handler = esp_abort, | ||
| 595 | .eh_bus_reset_handler = esp_reset, | ||
| 596 | .can_queue = 7, | ||
| 597 | .this_id = 7, | ||
| 598 | .sg_tablesize = SG_ALL, | ||
| 599 | .cmd_per_lun = 1, | ||
| 600 | .use_clustering = ENABLE_CLUSTERING | ||
| 601 | }; | ||
| 602 | |||
| 603 | |||
| 604 | #include "scsi_module.c" | ||
| 605 | |||
| 606 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/scsi/oktagon_io.S b/drivers/scsi/oktagon_io.S deleted file mode 100644 index 8a7340b02707..000000000000 --- a/drivers/scsi/oktagon_io.S +++ /dev/null | |||
| @@ -1,194 +0,0 @@ | |||
| 1 | /* -*- mode: asm -*- | ||
| 2 | * Due to problems while transferring data I've put these routines as assembly | ||
| 3 | * code. | ||
| 4 | * Since I'm no PPC assembler guru, the code is just the assembler version of | ||
| 5 | |||
| 6 | int oktag_to_io(long *paddr,long *addr,long len) | ||
| 7 | { | ||
| 8 | long *addr2 = addr; | ||
| 9 | for(len=(len+sizeof(long)-1)/sizeof(long);len--;) | ||
| 10 | *paddr = *addr2++; | ||
| 11 | return addr2 - addr; | ||
| 12 | } | ||
| 13 | |||
| 14 | int oktag_from_io(long *addr,long *paddr,long len) | ||
| 15 | { | ||
| 16 | long *addr2 = addr; | ||
| 17 | for(len=(len+sizeof(long)-1)/sizeof(long);len--;) | ||
| 18 | *addr2++ = *paddr; | ||
| 19 | return addr2 - addr; | ||
| 20 | } | ||
| 21 | |||
| 22 | * assembled using gcc -O2 -S, with two exception catch points where data | ||
| 23 | * is moved to/from the IO register. | ||
| 24 | */ | ||
| 25 | |||
| 26 | |||
| 27 | #ifdef CONFIG_APUS | ||
| 28 | |||
| 29 | .file "oktagon_io.c" | ||
| 30 | |||
| 31 | gcc2_compiled.: | ||
| 32 | /* | ||
| 33 | .section ".text" | ||
| 34 | */ | ||
| 35 | .align 2 | ||
| 36 | .globl oktag_to_io | ||
| 37 | .type oktag_to_io,@function | ||
| 38 | oktag_to_io: | ||
| 39 | addi 5,5,3 | ||
| 40 | srwi 5,5,2 | ||
| 41 | cmpwi 1,5,0 | ||
| 42 | mr 9,3 | ||
| 43 | mr 3,4 | ||
| 44 | addi 5,5,-1 | ||
| 45 | bc 12,6,.L3 | ||
| 46 | .L5: | ||
| 47 | cmpwi 1,5,0 | ||
| 48 | lwz 0,0(3) | ||
| 49 | addi 3,3,4 | ||
| 50 | addi 5,5,-1 | ||
| 51 | exp1: stw 0,0(9) | ||
| 52 | bc 4,6,.L5 | ||
| 53 | .L3: | ||
| 54 | ret1: subf 3,4,3 | ||
| 55 | srawi 3,3,2 | ||
| 56 | blr | ||
| 57 | .Lfe1: | ||
| 58 | .size oktag_to_io,.Lfe1-oktag_to_io | ||
| 59 | .align 2 | ||
| 60 | .globl oktag_from_io | ||
| 61 | .type oktag_from_io,@function | ||
| 62 | oktag_from_io: | ||
| 63 | addi 5,5,3 | ||
| 64 | srwi 5,5,2 | ||
| 65 | cmpwi 1,5,0 | ||
| 66 | mr 9,3 | ||
| 67 | addi 5,5,-1 | ||
| 68 | bc 12,6,.L9 | ||
| 69 | .L11: | ||
| 70 | cmpwi 1,5,0 | ||
| 71 | exp2: lwz 0,0(4) | ||
| 72 | addi 5,5,-1 | ||
| 73 | stw 0,0(3) | ||
| 74 | addi 3,3,4 | ||
| 75 | bc 4,6,.L11 | ||
| 76 | .L9: | ||
| 77 | ret2: subf 3,9,3 | ||
| 78 | srawi 3,3,2 | ||
| 79 | blr | ||
| 80 | .Lfe2: | ||
| 81 | .size oktag_from_io,.Lfe2-oktag_from_io | ||
| 82 | .ident "GCC: (GNU) egcs-2.90.29 980515 (egcs-1.0.3 release)" | ||
| 83 | |||
| 84 | /* | ||
| 85 | * Exception table. | ||
| 86 | * Second longword shows where to jump when an exception at the addr the first | ||
| 87 | * longword is pointing to is caught. | ||
| 88 | */ | ||
| 89 | |||
| 90 | .section __ex_table,"a" | ||
| 91 | .align 2 | ||
| 92 | oktagon_except: | ||
| 93 | .long exp1,ret1 | ||
| 94 | .long exp2,ret2 | ||
| 95 | |||
| 96 | #else | ||
| 97 | |||
| 98 | /* | ||
| 99 | The code which follows is for 680x0 based assembler and is meant for | ||
| 100 | Linux/m68k. It was created by cross compiling the code using the | ||
| 101 | instructions given above. I then added the four labels used in the | ||
| 102 | exception handler table at the bottom of this file. | ||
| 103 | - Kevin <kcozens@interlog.com> | ||
| 104 | */ | ||
| 105 | |||
| 106 | #ifdef CONFIG_AMIGA | ||
| 107 | |||
| 108 | .file "oktagon_io.c" | ||
| 109 | .version "01.01" | ||
| 110 | gcc2_compiled.: | ||
| 111 | .text | ||
| 112 | .align 2 | ||
| 113 | .globl oktag_to_io | ||
| 114 | .type oktag_to_io,@function | ||
| 115 | oktag_to_io: | ||
| 116 | link.w %a6,#0 | ||
| 117 | move.l %d2,-(%sp) | ||
| 118 | move.l 8(%a6),%a1 | ||
| 119 | move.l 12(%a6),%d1 | ||
| 120 | move.l %d1,%a0 | ||
| 121 | move.l 16(%a6),%d0 | ||
| 122 | addq.l #3,%d0 | ||
| 123 | lsr.l #2,%d0 | ||
| 124 | subq.l #1,%d0 | ||
| 125 | moveq.l #-1,%d2 | ||
| 126 | cmp.l %d0,%d2 | ||
| 127 | jbeq .L3 | ||
| 128 | .L5: | ||
| 129 | exp1: | ||
| 130 | move.l (%a0)+,(%a1) | ||
| 131 | dbra %d0,.L5 | ||
| 132 | clr.w %d0 | ||
| 133 | subq.l #1,%d0 | ||
| 134 | jbcc .L5 | ||
| 135 | .L3: | ||
| 136 | ret1: | ||
| 137 | move.l %a0,%d0 | ||
| 138 | sub.l %d1,%d0 | ||
| 139 | asr.l #2,%d0 | ||
| 140 | move.l -4(%a6),%d2 | ||
| 141 | unlk %a6 | ||
| 142 | rts | ||
| 143 | |||
| 144 | .Lfe1: | ||
| 145 | .size oktag_to_io,.Lfe1-oktag_to_io | ||
| 146 | .align 2 | ||
| 147 | .globl oktag_from_io | ||
| 148 | .type oktag_from_io,@function | ||
| 149 | oktag_from_io: | ||
| 150 | link.w %a6,#0 | ||
| 151 | move.l %d2,-(%sp) | ||
| 152 | move.l 8(%a6),%d1 | ||
| 153 | move.l 12(%a6),%a1 | ||
| 154 | move.l %d1,%a0 | ||
| 155 | move.l 16(%a6),%d0 | ||
| 156 | addq.l #3,%d0 | ||
| 157 | lsr.l #2,%d0 | ||
| 158 | subq.l #1,%d0 | ||
| 159 | moveq.l #-1,%d2 | ||
| 160 | cmp.l %d0,%d2 | ||
| 161 | jbeq .L9 | ||
| 162 | .L11: | ||
| 163 | exp2: | ||
| 164 | move.l (%a1),(%a0)+ | ||
| 165 | dbra %d0,.L11 | ||
| 166 | clr.w %d0 | ||
| 167 | subq.l #1,%d0 | ||
| 168 | jbcc .L11 | ||
| 169 | .L9: | ||
| 170 | ret2: | ||
| 171 | move.l %a0,%d0 | ||
| 172 | sub.l %d1,%d0 | ||
| 173 | asr.l #2,%d0 | ||
| 174 | move.l -4(%a6),%d2 | ||
| 175 | unlk %a6 | ||
| 176 | rts | ||
| 177 | .Lfe2: | ||
| 178 | .size oktag_from_io,.Lfe2-oktag_from_io | ||
| 179 | .ident "GCC: (GNU) 2.7.2.1" | ||
| 180 | |||
| 181 | /* | ||
| 182 | * Exception table. | ||
| 183 | * Second longword shows where to jump when an exception at the addr the first | ||
| 184 | * longword is pointing to is caught. | ||
| 185 | */ | ||
| 186 | |||
| 187 | .section __ex_table,"a" | ||
| 188 | .align 2 | ||
| 189 | oktagon_except: | ||
| 190 | .long exp1,ret1 | ||
| 191 | .long exp2,ret2 | ||
| 192 | |||
| 193 | #endif | ||
| 194 | #endif | ||
diff --git a/drivers/scsi/ps3rom.c b/drivers/scsi/ps3rom.c index 17b4a7c4618c..0cd614a0fa73 100644 --- a/drivers/scsi/ps3rom.c +++ b/drivers/scsi/ps3rom.c | |||
| @@ -35,7 +35,7 @@ | |||
| 35 | 35 | ||
| 36 | #define BOUNCE_SIZE (64*1024) | 36 | #define BOUNCE_SIZE (64*1024) |
| 37 | 37 | ||
| 38 | #define PS3ROM_MAX_SECTORS (BOUNCE_SIZE / CD_FRAMESIZE) | 38 | #define PS3ROM_MAX_SECTORS (BOUNCE_SIZE >> 9) |
| 39 | 39 | ||
| 40 | 40 | ||
| 41 | struct ps3rom_private { | 41 | struct ps3rom_private { |
diff --git a/drivers/scsi/qla2xxx/qla_attr.c b/drivers/scsi/qla2xxx/qla_attr.c index adf97320574b..4894dc886b62 100644 --- a/drivers/scsi/qla2xxx/qla_attr.c +++ b/drivers/scsi/qla2xxx/qla_attr.c | |||
| @@ -428,6 +428,19 @@ qla2x00_sysfs_read_sfp(struct kobject *kobj, | |||
| 428 | if (!capable(CAP_SYS_ADMIN) || off != 0 || count != SFP_DEV_SIZE * 2) | 428 | if (!capable(CAP_SYS_ADMIN) || off != 0 || count != SFP_DEV_SIZE * 2) |
| 429 | return 0; | 429 | return 0; |
| 430 | 430 | ||
| 431 | if (ha->sfp_data) | ||
| 432 | goto do_read; | ||
| 433 | |||
| 434 | ha->sfp_data = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, | ||
| 435 | &ha->sfp_data_dma); | ||
| 436 | if (!ha->sfp_data) { | ||
| 437 | qla_printk(KERN_WARNING, ha, | ||
| 438 | "Unable to allocate memory for SFP read-data.\n"); | ||
| 439 | return 0; | ||
| 440 | } | ||
| 441 | |||
| 442 | do_read: | ||
| 443 | memset(ha->sfp_data, 0, SFP_BLOCK_SIZE); | ||
| 431 | addr = 0xa0; | 444 | addr = 0xa0; |
| 432 | for (iter = 0, offset = 0; iter < (SFP_DEV_SIZE * 2) / SFP_BLOCK_SIZE; | 445 | for (iter = 0, offset = 0; iter < (SFP_DEV_SIZE * 2) / SFP_BLOCK_SIZE; |
| 433 | iter++, offset += SFP_BLOCK_SIZE) { | 446 | iter++, offset += SFP_BLOCK_SIZE) { |
| @@ -835,7 +848,7 @@ qla2x00_get_host_port_id(struct Scsi_Host *shost) | |||
| 835 | static void | 848 | static void |
| 836 | qla2x00_get_host_speed(struct Scsi_Host *shost) | 849 | qla2x00_get_host_speed(struct Scsi_Host *shost) |
| 837 | { | 850 | { |
| 838 | scsi_qla_host_t *ha = shost_priv(shost); | 851 | scsi_qla_host_t *ha = to_qla_parent(shost_priv(shost)); |
| 839 | uint32_t speed = 0; | 852 | uint32_t speed = 0; |
| 840 | 853 | ||
| 841 | switch (ha->link_data_rate) { | 854 | switch (ha->link_data_rate) { |
| @@ -848,6 +861,9 @@ qla2x00_get_host_speed(struct Scsi_Host *shost) | |||
| 848 | case PORT_SPEED_4GB: | 861 | case PORT_SPEED_4GB: |
| 849 | speed = 4; | 862 | speed = 4; |
| 850 | break; | 863 | break; |
| 864 | case PORT_SPEED_8GB: | ||
| 865 | speed = 8; | ||
| 866 | break; | ||
| 851 | } | 867 | } |
| 852 | fc_host_speed(shost) = speed; | 868 | fc_host_speed(shost) = speed; |
| 853 | } | 869 | } |
| @@ -855,7 +871,7 @@ qla2x00_get_host_speed(struct Scsi_Host *shost) | |||
| 855 | static void | 871 | static void |
| 856 | qla2x00_get_host_port_type(struct Scsi_Host *shost) | 872 | qla2x00_get_host_port_type(struct Scsi_Host *shost) |
| 857 | { | 873 | { |
| 858 | scsi_qla_host_t *ha = shost_priv(shost); | 874 | scsi_qla_host_t *ha = to_qla_parent(shost_priv(shost)); |
| 859 | uint32_t port_type = FC_PORTTYPE_UNKNOWN; | 875 | uint32_t port_type = FC_PORTTYPE_UNKNOWN; |
| 860 | 876 | ||
| 861 | switch (ha->current_topology) { | 877 | switch (ha->current_topology) { |
| @@ -965,7 +981,7 @@ qla2x00_issue_lip(struct Scsi_Host *shost) | |||
| 965 | static struct fc_host_statistics * | 981 | static struct fc_host_statistics * |
| 966 | qla2x00_get_fc_host_stats(struct Scsi_Host *shost) | 982 | qla2x00_get_fc_host_stats(struct Scsi_Host *shost) |
| 967 | { | 983 | { |
| 968 | scsi_qla_host_t *ha = shost_priv(shost); | 984 | scsi_qla_host_t *ha = to_qla_parent(shost_priv(shost)); |
| 969 | int rval; | 985 | int rval; |
| 970 | struct link_statistics *stats; | 986 | struct link_statistics *stats; |
| 971 | dma_addr_t stats_dma; | 987 | dma_addr_t stats_dma; |
| @@ -1049,7 +1065,7 @@ qla2x00_get_host_fabric_name(struct Scsi_Host *shost) | |||
| 1049 | static void | 1065 | static void |
| 1050 | qla2x00_get_host_port_state(struct Scsi_Host *shost) | 1066 | qla2x00_get_host_port_state(struct Scsi_Host *shost) |
| 1051 | { | 1067 | { |
| 1052 | scsi_qla_host_t *ha = shost_priv(shost); | 1068 | scsi_qla_host_t *ha = to_qla_parent(shost_priv(shost)); |
| 1053 | 1069 | ||
| 1054 | if (!ha->flags.online) | 1070 | if (!ha->flags.online) |
| 1055 | fc_host_port_state(shost) = FC_PORTSTATE_OFFLINE; | 1071 | fc_host_port_state(shost) = FC_PORTSTATE_OFFLINE; |
diff --git a/drivers/scsi/qla2xxx/qla_def.h b/drivers/scsi/qla2xxx/qla_def.h index b72c7f170854..3750319f4968 100644 --- a/drivers/scsi/qla2xxx/qla_def.h +++ b/drivers/scsi/qla2xxx/qla_def.h | |||
| @@ -2041,8 +2041,6 @@ typedef struct vport_params { | |||
| 2041 | #define VP_RET_CODE_NO_MEM 5 | 2041 | #define VP_RET_CODE_NO_MEM 5 |
| 2042 | #define VP_RET_CODE_NOT_FOUND 6 | 2042 | #define VP_RET_CODE_NOT_FOUND 6 |
| 2043 | 2043 | ||
| 2044 | #define to_qla_parent(x) (((x)->parent) ? (x)->parent : (x)) | ||
| 2045 | |||
| 2046 | /* | 2044 | /* |
| 2047 | * ISP operations | 2045 | * ISP operations |
| 2048 | */ | 2046 | */ |
diff --git a/drivers/scsi/qla2xxx/qla_gbl.h b/drivers/scsi/qla2xxx/qla_gbl.h index ba35fc26ce6b..193f688ec3d7 100644 --- a/drivers/scsi/qla2xxx/qla_gbl.h +++ b/drivers/scsi/qla2xxx/qla_gbl.h | |||
| @@ -66,6 +66,7 @@ extern int ql2xqfullrampup; | |||
| 66 | extern int num_hosts; | 66 | extern int num_hosts; |
| 67 | 67 | ||
| 68 | extern int qla2x00_loop_reset(scsi_qla_host_t *); | 68 | extern int qla2x00_loop_reset(scsi_qla_host_t *); |
| 69 | extern void qla2x00_abort_all_cmds(scsi_qla_host_t *, int); | ||
| 69 | 70 | ||
| 70 | /* | 71 | /* |
| 71 | * Global Functions in qla_mid.c source file. | 72 | * Global Functions in qla_mid.c source file. |
diff --git a/drivers/scsi/qla2xxx/qla_init.c b/drivers/scsi/qla2xxx/qla_init.c index d0633ca894be..d5c7853e7eba 100644 --- a/drivers/scsi/qla2xxx/qla_init.c +++ b/drivers/scsi/qla2xxx/qla_init.c | |||
| @@ -925,6 +925,16 @@ qla2x00_setup_chip(scsi_qla_host_t *ha) | |||
| 925 | { | 925 | { |
| 926 | int rval; | 926 | int rval; |
| 927 | uint32_t srisc_address = 0; | 927 | uint32_t srisc_address = 0; |
| 928 | struct device_reg_2xxx __iomem *reg = &ha->iobase->isp; | ||
| 929 | unsigned long flags; | ||
| 930 | |||
| 931 | if (!IS_FWI2_CAPABLE(ha) && !IS_QLA2100(ha) && !IS_QLA2200(ha)) { | ||
| 932 | /* Disable SRAM, Instruction RAM and GP RAM parity. */ | ||
| 933 | spin_lock_irqsave(&ha->hardware_lock, flags); | ||
| 934 | WRT_REG_WORD(®->hccr, (HCCR_ENABLE_PARITY + 0x0)); | ||
| 935 | RD_REG_WORD(®->hccr); | ||
| 936 | spin_unlock_irqrestore(&ha->hardware_lock, flags); | ||
| 937 | } | ||
| 928 | 938 | ||
| 929 | /* Load firmware sequences */ | 939 | /* Load firmware sequences */ |
| 930 | rval = ha->isp_ops->load_risc(ha, &srisc_address); | 940 | rval = ha->isp_ops->load_risc(ha, &srisc_address); |
| @@ -968,6 +978,19 @@ qla2x00_setup_chip(scsi_qla_host_t *ha) | |||
| 968 | } | 978 | } |
| 969 | } | 979 | } |
| 970 | 980 | ||
| 981 | if (!IS_FWI2_CAPABLE(ha) && !IS_QLA2100(ha) && !IS_QLA2200(ha)) { | ||
| 982 | /* Enable proper parity. */ | ||
| 983 | spin_lock_irqsave(&ha->hardware_lock, flags); | ||
| 984 | if (IS_QLA2300(ha)) | ||
| 985 | /* SRAM parity */ | ||
| 986 | WRT_REG_WORD(®->hccr, HCCR_ENABLE_PARITY + 0x1); | ||
| 987 | else | ||
| 988 | /* SRAM, Instruction RAM and GP RAM parity */ | ||
| 989 | WRT_REG_WORD(®->hccr, HCCR_ENABLE_PARITY + 0x7); | ||
| 990 | RD_REG_WORD(®->hccr); | ||
| 991 | spin_unlock_irqrestore(&ha->hardware_lock, flags); | ||
| 992 | } | ||
| 993 | |||
| 971 | if (rval) { | 994 | if (rval) { |
| 972 | DEBUG2_3(printk("scsi(%ld): Setup chip **** FAILED ****.\n", | 995 | DEBUG2_3(printk("scsi(%ld): Setup chip **** FAILED ****.\n", |
| 973 | ha->host_no)); | 996 | ha->host_no)); |
| @@ -3213,9 +3236,6 @@ int | |||
| 3213 | qla2x00_abort_isp(scsi_qla_host_t *ha) | 3236 | qla2x00_abort_isp(scsi_qla_host_t *ha) |
| 3214 | { | 3237 | { |
| 3215 | int rval; | 3238 | int rval; |
| 3216 | unsigned long flags = 0; | ||
| 3217 | uint16_t cnt; | ||
| 3218 | srb_t *sp; | ||
| 3219 | uint8_t status = 0; | 3239 | uint8_t status = 0; |
| 3220 | 3240 | ||
| 3221 | if (ha->flags.online) { | 3241 | if (ha->flags.online) { |
| @@ -3236,19 +3256,8 @@ qla2x00_abort_isp(scsi_qla_host_t *ha) | |||
| 3236 | LOOP_DOWN_TIME); | 3256 | LOOP_DOWN_TIME); |
| 3237 | } | 3257 | } |
| 3238 | 3258 | ||
| 3239 | spin_lock_irqsave(&ha->hardware_lock, flags); | ||
| 3240 | /* Requeue all commands in outstanding command list. */ | 3259 | /* Requeue all commands in outstanding command list. */ |
| 3241 | for (cnt = 1; cnt < MAX_OUTSTANDING_COMMANDS; cnt++) { | 3260 | qla2x00_abort_all_cmds(ha, DID_RESET << 16); |
| 3242 | sp = ha->outstanding_cmds[cnt]; | ||
| 3243 | if (sp) { | ||
| 3244 | ha->outstanding_cmds[cnt] = NULL; | ||
| 3245 | sp->flags = 0; | ||
| 3246 | sp->cmd->result = DID_RESET << 16; | ||
| 3247 | sp->cmd->host_scribble = (unsigned char *)NULL; | ||
| 3248 | qla2x00_sp_compl(ha, sp); | ||
| 3249 | } | ||
| 3250 | } | ||
| 3251 | spin_unlock_irqrestore(&ha->hardware_lock, flags); | ||
| 3252 | 3261 | ||
| 3253 | ha->isp_ops->get_flash_version(ha, ha->request_ring); | 3262 | ha->isp_ops->get_flash_version(ha, ha->request_ring); |
| 3254 | 3263 | ||
| @@ -3273,6 +3282,7 @@ qla2x00_abort_isp(scsi_qla_host_t *ha) | |||
| 3273 | clear_bit(ISP_ABORT_RETRY, &ha->dpc_flags); | 3282 | clear_bit(ISP_ABORT_RETRY, &ha->dpc_flags); |
| 3274 | 3283 | ||
| 3275 | if (ha->eft) { | 3284 | if (ha->eft) { |
| 3285 | memset(ha->eft, 0, EFT_SIZE); | ||
| 3276 | rval = qla2x00_enable_eft_trace(ha, | 3286 | rval = qla2x00_enable_eft_trace(ha, |
| 3277 | ha->eft_dma, EFT_NUM_BUFFERS); | 3287 | ha->eft_dma, EFT_NUM_BUFFERS); |
| 3278 | if (rval) { | 3288 | if (rval) { |
| @@ -3357,60 +3367,15 @@ static int | |||
| 3357 | qla2x00_restart_isp(scsi_qla_host_t *ha) | 3367 | qla2x00_restart_isp(scsi_qla_host_t *ha) |
| 3358 | { | 3368 | { |
| 3359 | uint8_t status = 0; | 3369 | uint8_t status = 0; |
| 3360 | struct device_reg_2xxx __iomem *reg = &ha->iobase->isp; | ||
| 3361 | unsigned long flags = 0; | ||
| 3362 | uint32_t wait_time; | 3370 | uint32_t wait_time; |
| 3363 | 3371 | ||
| 3364 | /* If firmware needs to be loaded */ | 3372 | /* If firmware needs to be loaded */ |
| 3365 | if (qla2x00_isp_firmware(ha)) { | 3373 | if (qla2x00_isp_firmware(ha)) { |
| 3366 | ha->flags.online = 0; | 3374 | ha->flags.online = 0; |
| 3367 | if (!(status = ha->isp_ops->chip_diag(ha))) { | 3375 | if (!(status = ha->isp_ops->chip_diag(ha))) |
| 3368 | if (IS_QLA2100(ha) || IS_QLA2200(ha)) { | ||
| 3369 | status = qla2x00_setup_chip(ha); | ||
| 3370 | goto done; | ||
| 3371 | } | ||
| 3372 | |||
| 3373 | spin_lock_irqsave(&ha->hardware_lock, flags); | ||
| 3374 | |||
| 3375 | if (!IS_QLA24XX(ha) && !IS_QLA54XX(ha) && | ||
| 3376 | !IS_QLA25XX(ha)) { | ||
| 3377 | /* | ||
| 3378 | * Disable SRAM, Instruction RAM and GP RAM | ||
| 3379 | * parity. | ||
| 3380 | */ | ||
| 3381 | WRT_REG_WORD(®->hccr, | ||
| 3382 | (HCCR_ENABLE_PARITY + 0x0)); | ||
| 3383 | RD_REG_WORD(®->hccr); | ||
| 3384 | } | ||
| 3385 | |||
| 3386 | spin_unlock_irqrestore(&ha->hardware_lock, flags); | ||
| 3387 | |||
| 3388 | status = qla2x00_setup_chip(ha); | 3376 | status = qla2x00_setup_chip(ha); |
| 3389 | |||
| 3390 | spin_lock_irqsave(&ha->hardware_lock, flags); | ||
| 3391 | |||
| 3392 | if (!IS_QLA24XX(ha) && !IS_QLA54XX(ha) && | ||
| 3393 | !IS_QLA25XX(ha)) { | ||
| 3394 | /* Enable proper parity */ | ||
| 3395 | if (IS_QLA2300(ha)) | ||
| 3396 | /* SRAM parity */ | ||
| 3397 | WRT_REG_WORD(®->hccr, | ||
| 3398 | (HCCR_ENABLE_PARITY + 0x1)); | ||
| 3399 | else | ||
| 3400 | /* | ||
| 3401 | * SRAM, Instruction RAM and GP RAM | ||
| 3402 | * parity. | ||
| 3403 | */ | ||
| 3404 | WRT_REG_WORD(®->hccr, | ||
| 3405 | (HCCR_ENABLE_PARITY + 0x7)); | ||
| 3406 | RD_REG_WORD(®->hccr); | ||
| 3407 | } | ||
| 3408 | |||
| 3409 | spin_unlock_irqrestore(&ha->hardware_lock, flags); | ||
| 3410 | } | ||
| 3411 | } | 3377 | } |
| 3412 | 3378 | ||
| 3413 | done: | ||
| 3414 | if (!status && !(status = qla2x00_init_rings(ha))) { | 3379 | if (!status && !(status = qla2x00_init_rings(ha))) { |
| 3415 | clear_bit(RESET_MARKER_NEEDED, &ha->dpc_flags); | 3380 | clear_bit(RESET_MARKER_NEEDED, &ha->dpc_flags); |
| 3416 | if (!(status = qla2x00_fw_ready(ha))) { | 3381 | if (!(status = qla2x00_fw_ready(ha))) { |
diff --git a/drivers/scsi/qla2xxx/qla_inline.h b/drivers/scsi/qla2xxx/qla_inline.h index 8e3b04464cff..5d1a3f7c408f 100644 --- a/drivers/scsi/qla2xxx/qla_inline.h +++ b/drivers/scsi/qla2xxx/qla_inline.h | |||
| @@ -119,6 +119,13 @@ static __inline__ void qla2x00_check_fabric_devices(scsi_qla_host_t *ha) | |||
| 119 | qla2x00_get_firmware_state(ha, &fw_state); | 119 | qla2x00_get_firmware_state(ha, &fw_state); |
| 120 | } | 120 | } |
| 121 | 121 | ||
| 122 | static __inline__ scsi_qla_host_t * to_qla_parent(scsi_qla_host_t *); | ||
| 123 | static __inline__ scsi_qla_host_t * | ||
| 124 | to_qla_parent(scsi_qla_host_t *ha) | ||
| 125 | { | ||
| 126 | return ha->parent ? ha->parent : ha; | ||
| 127 | } | ||
| 128 | |||
| 122 | /** | 129 | /** |
| 123 | * qla2x00_issue_marker() - Issue a Marker IOCB if necessary. | 130 | * qla2x00_issue_marker() - Issue a Marker IOCB if necessary. |
| 124 | * @ha: HA context | 131 | * @ha: HA context |
diff --git a/drivers/scsi/qla2xxx/qla_isr.c b/drivers/scsi/qla2xxx/qla_isr.c index 642a0c3f09c6..14e6f22944b7 100644 --- a/drivers/scsi/qla2xxx/qla_isr.c +++ b/drivers/scsi/qla2xxx/qla_isr.c | |||
| @@ -1815,6 +1815,8 @@ int | |||
| 1815 | qla2x00_request_irqs(scsi_qla_host_t *ha) | 1815 | qla2x00_request_irqs(scsi_qla_host_t *ha) |
| 1816 | { | 1816 | { |
| 1817 | int ret; | 1817 | int ret; |
| 1818 | device_reg_t __iomem *reg = ha->iobase; | ||
| 1819 | unsigned long flags; | ||
| 1818 | 1820 | ||
| 1819 | /* If possible, enable MSI-X. */ | 1821 | /* If possible, enable MSI-X. */ |
| 1820 | if (!IS_QLA2432(ha) && !IS_QLA2532(ha)) | 1822 | if (!IS_QLA2432(ha) && !IS_QLA2532(ha)) |
| @@ -1846,7 +1848,7 @@ qla2x00_request_irqs(scsi_qla_host_t *ha) | |||
| 1846 | DEBUG2(qla_printk(KERN_INFO, ha, | 1848 | DEBUG2(qla_printk(KERN_INFO, ha, |
| 1847 | "MSI-X: Enabled (0x%X, 0x%X).\n", ha->chip_revision, | 1849 | "MSI-X: Enabled (0x%X, 0x%X).\n", ha->chip_revision, |
| 1848 | ha->fw_attributes)); | 1850 | ha->fw_attributes)); |
| 1849 | return ret; | 1851 | goto clear_risc_ints; |
| 1850 | } | 1852 | } |
| 1851 | qla_printk(KERN_WARNING, ha, | 1853 | qla_printk(KERN_WARNING, ha, |
| 1852 | "MSI-X: Falling back-to INTa mode -- %d.\n", ret); | 1854 | "MSI-X: Falling back-to INTa mode -- %d.\n", ret); |
| @@ -1864,15 +1866,30 @@ skip_msi: | |||
| 1864 | 1866 | ||
| 1865 | ret = request_irq(ha->pdev->irq, ha->isp_ops->intr_handler, | 1867 | ret = request_irq(ha->pdev->irq, ha->isp_ops->intr_handler, |
| 1866 | IRQF_DISABLED|IRQF_SHARED, QLA2XXX_DRIVER_NAME, ha); | 1868 | IRQF_DISABLED|IRQF_SHARED, QLA2XXX_DRIVER_NAME, ha); |
| 1867 | if (!ret) { | 1869 | if (ret) { |
| 1868 | ha->flags.inta_enabled = 1; | ||
| 1869 | ha->host->irq = ha->pdev->irq; | ||
| 1870 | } else { | ||
| 1871 | qla_printk(KERN_WARNING, ha, | 1870 | qla_printk(KERN_WARNING, ha, |
| 1872 | "Failed to reserve interrupt %d already in use.\n", | 1871 | "Failed to reserve interrupt %d already in use.\n", |
| 1873 | ha->pdev->irq); | 1872 | ha->pdev->irq); |
| 1873 | goto fail; | ||
| 1874 | } | ||
| 1875 | ha->flags.inta_enabled = 1; | ||
| 1876 | ha->host->irq = ha->pdev->irq; | ||
| 1877 | clear_risc_ints: | ||
| 1878 | |||
| 1879 | ha->isp_ops->disable_intrs(ha); | ||
| 1880 | spin_lock_irqsave(&ha->hardware_lock, flags); | ||
| 1881 | if (IS_FWI2_CAPABLE(ha)) { | ||
| 1882 | WRT_REG_DWORD(®->isp24.hccr, HCCRX_CLR_HOST_INT); | ||
| 1883 | WRT_REG_DWORD(®->isp24.hccr, HCCRX_CLR_RISC_INT); | ||
| 1884 | } else { | ||
| 1885 | WRT_REG_WORD(®->isp.semaphore, 0); | ||
| 1886 | WRT_REG_WORD(®->isp.hccr, HCCR_CLR_RISC_INT); | ||
| 1887 | WRT_REG_WORD(®->isp.hccr, HCCR_CLR_HOST_INT); | ||
| 1874 | } | 1888 | } |
| 1889 | spin_unlock_irqrestore(&ha->hardware_lock, flags); | ||
| 1890 | ha->isp_ops->enable_intrs(ha); | ||
| 1875 | 1891 | ||
| 1892 | fail: | ||
| 1876 | return ret; | 1893 | return ret; |
| 1877 | } | 1894 | } |
| 1878 | 1895 | ||
diff --git a/drivers/scsi/qla2xxx/qla_mbx.c b/drivers/scsi/qla2xxx/qla_mbx.c index 0c10c0b0fb73..99d29fff836d 100644 --- a/drivers/scsi/qla2xxx/qla_mbx.c +++ b/drivers/scsi/qla2xxx/qla_mbx.c | |||
| @@ -980,7 +980,7 @@ qla2x00_init_firmware(scsi_qla_host_t *ha, uint16_t size) | |||
| 980 | DEBUG11(printk("qla2x00_init_firmware(%ld): entered.\n", | 980 | DEBUG11(printk("qla2x00_init_firmware(%ld): entered.\n", |
| 981 | ha->host_no)); | 981 | ha->host_no)); |
| 982 | 982 | ||
| 983 | if (ha->fw_attributes & BIT_2) | 983 | if (ha->flags.npiv_supported) |
| 984 | mcp->mb[0] = MBC_MID_INITIALIZE_FIRMWARE; | 984 | mcp->mb[0] = MBC_MID_INITIALIZE_FIRMWARE; |
| 985 | else | 985 | else |
| 986 | mcp->mb[0] = MBC_INITIALIZE_FIRMWARE; | 986 | mcp->mb[0] = MBC_INITIALIZE_FIRMWARE; |
diff --git a/drivers/scsi/qla2xxx/qla_os.c b/drivers/scsi/qla2xxx/qla_os.c index 8f69caf83272..3c1b43356adb 100644 --- a/drivers/scsi/qla2xxx/qla_os.c +++ b/drivers/scsi/qla2xxx/qla_os.c | |||
| @@ -204,10 +204,8 @@ static int qla2x00_do_dpc(void *data); | |||
| 204 | 204 | ||
| 205 | static void qla2x00_rst_aen(scsi_qla_host_t *); | 205 | static void qla2x00_rst_aen(scsi_qla_host_t *); |
| 206 | 206 | ||
| 207 | static uint8_t qla2x00_mem_alloc(scsi_qla_host_t *); | 207 | static int qla2x00_mem_alloc(scsi_qla_host_t *); |
| 208 | static void qla2x00_mem_free(scsi_qla_host_t *ha); | 208 | static void qla2x00_mem_free(scsi_qla_host_t *ha); |
| 209 | static int qla2x00_allocate_sp_pool( scsi_qla_host_t *ha); | ||
| 210 | static void qla2x00_free_sp_pool(scsi_qla_host_t *ha); | ||
| 211 | static void qla2x00_sp_free_dma(scsi_qla_host_t *, srb_t *); | 209 | static void qla2x00_sp_free_dma(scsi_qla_host_t *, srb_t *); |
| 212 | 210 | ||
| 213 | /* -------------------------------------------------------------------------- */ | 211 | /* -------------------------------------------------------------------------- */ |
| @@ -1117,6 +1115,27 @@ qla2x00_device_reset(scsi_qla_host_t *ha, fc_port_t *reset_fcport) | |||
| 1117 | return ha->isp_ops->abort_target(reset_fcport); | 1115 | return ha->isp_ops->abort_target(reset_fcport); |
| 1118 | } | 1116 | } |
| 1119 | 1117 | ||
| 1118 | void | ||
| 1119 | qla2x00_abort_all_cmds(scsi_qla_host_t *ha, int res) | ||
| 1120 | { | ||
| 1121 | int cnt; | ||
| 1122 | unsigned long flags; | ||
| 1123 | srb_t *sp; | ||
| 1124 | |||
| 1125 | spin_lock_irqsave(&ha->hardware_lock, flags); | ||
| 1126 | for (cnt = 1; cnt < MAX_OUTSTANDING_COMMANDS; cnt++) { | ||
| 1127 | sp = ha->outstanding_cmds[cnt]; | ||
| 1128 | if (sp) { | ||
| 1129 | ha->outstanding_cmds[cnt] = NULL; | ||
| 1130 | sp->flags = 0; | ||
| 1131 | sp->cmd->result = res; | ||
| 1132 | sp->cmd->host_scribble = (unsigned char *)NULL; | ||
| 1133 | qla2x00_sp_compl(ha, sp); | ||
| 1134 | } | ||
| 1135 | } | ||
| 1136 | spin_unlock_irqrestore(&ha->hardware_lock, flags); | ||
| 1137 | } | ||
| 1138 | |||
| 1120 | static int | 1139 | static int |
| 1121 | qla2xxx_slave_alloc(struct scsi_device *sdev) | 1140 | qla2xxx_slave_alloc(struct scsi_device *sdev) |
| 1122 | { | 1141 | { |
| @@ -1557,10 +1576,8 @@ static int __devinit | |||
| 1557 | qla2x00_probe_one(struct pci_dev *pdev, const struct pci_device_id *id) | 1576 | qla2x00_probe_one(struct pci_dev *pdev, const struct pci_device_id *id) |
| 1558 | { | 1577 | { |
| 1559 | int ret = -ENODEV; | 1578 | int ret = -ENODEV; |
| 1560 | device_reg_t __iomem *reg; | ||
| 1561 | struct Scsi_Host *host; | 1579 | struct Scsi_Host *host; |
| 1562 | scsi_qla_host_t *ha; | 1580 | scsi_qla_host_t *ha; |
| 1563 | unsigned long flags = 0; | ||
| 1564 | char pci_info[30]; | 1581 | char pci_info[30]; |
| 1565 | char fw_str[30]; | 1582 | char fw_str[30]; |
| 1566 | struct scsi_host_template *sht; | 1583 | struct scsi_host_template *sht; |
| @@ -1608,6 +1625,7 @@ qla2x00_probe_one(struct pci_dev *pdev, const struct pci_device_id *id) | |||
| 1608 | ha->parent = NULL; | 1625 | ha->parent = NULL; |
| 1609 | ha->bars = bars; | 1626 | ha->bars = bars; |
| 1610 | ha->mem_only = mem_only; | 1627 | ha->mem_only = mem_only; |
| 1628 | spin_lock_init(&ha->hardware_lock); | ||
| 1611 | 1629 | ||
| 1612 | /* Set ISP-type information. */ | 1630 | /* Set ISP-type information. */ |
| 1613 | qla2x00_set_isp_flags(ha); | 1631 | qla2x00_set_isp_flags(ha); |
| @@ -1621,8 +1639,6 @@ qla2x00_probe_one(struct pci_dev *pdev, const struct pci_device_id *id) | |||
| 1621 | "Found an ISP%04X, irq %d, iobase 0x%p\n", pdev->device, pdev->irq, | 1639 | "Found an ISP%04X, irq %d, iobase 0x%p\n", pdev->device, pdev->irq, |
| 1622 | ha->iobase); | 1640 | ha->iobase); |
| 1623 | 1641 | ||
| 1624 | spin_lock_init(&ha->hardware_lock); | ||
| 1625 | |||
| 1626 | ha->prev_topology = 0; | 1642 | ha->prev_topology = 0; |
| 1627 | ha->init_cb_size = sizeof(init_cb_t); | 1643 | ha->init_cb_size = sizeof(init_cb_t); |
| 1628 | ha->mgmt_svr_loop_id = MANAGEMENT_SERVER + ha->vp_idx; | 1644 | ha->mgmt_svr_loop_id = MANAGEMENT_SERVER + ha->vp_idx; |
| @@ -1751,34 +1767,6 @@ qla2x00_probe_one(struct pci_dev *pdev, const struct pci_device_id *id) | |||
| 1751 | DEBUG2(printk("DEBUG: detect hba %ld at address = %p\n", | 1767 | DEBUG2(printk("DEBUG: detect hba %ld at address = %p\n", |
| 1752 | ha->host_no, ha)); | 1768 | ha->host_no, ha)); |
| 1753 | 1769 | ||
| 1754 | ha->isp_ops->disable_intrs(ha); | ||
| 1755 | |||
| 1756 | spin_lock_irqsave(&ha->hardware_lock, flags); | ||
| 1757 | reg = ha->iobase; | ||
| 1758 | if (IS_FWI2_CAPABLE(ha)) { | ||
| 1759 | WRT_REG_DWORD(®->isp24.hccr, HCCRX_CLR_HOST_INT); | ||
| 1760 | WRT_REG_DWORD(®->isp24.hccr, HCCRX_CLR_RISC_INT); | ||
| 1761 | } else { | ||
| 1762 | WRT_REG_WORD(®->isp.semaphore, 0); | ||
| 1763 | WRT_REG_WORD(®->isp.hccr, HCCR_CLR_RISC_INT); | ||
| 1764 | WRT_REG_WORD(®->isp.hccr, HCCR_CLR_HOST_INT); | ||
| 1765 | |||
| 1766 | /* Enable proper parity */ | ||
| 1767 | if (!IS_QLA2100(ha) && !IS_QLA2200(ha)) { | ||
| 1768 | if (IS_QLA2300(ha)) | ||
| 1769 | /* SRAM parity */ | ||
| 1770 | WRT_REG_WORD(®->isp.hccr, | ||
| 1771 | (HCCR_ENABLE_PARITY + 0x1)); | ||
| 1772 | else | ||
| 1773 | /* SRAM, Instruction RAM and GP RAM parity */ | ||
| 1774 | WRT_REG_WORD(®->isp.hccr, | ||
| 1775 | (HCCR_ENABLE_PARITY + 0x7)); | ||
| 1776 | } | ||
| 1777 | } | ||
| 1778 | spin_unlock_irqrestore(&ha->hardware_lock, flags); | ||
| 1779 | |||
| 1780 | ha->isp_ops->enable_intrs(ha); | ||
| 1781 | |||
| 1782 | pci_set_drvdata(pdev, ha); | 1770 | pci_set_drvdata(pdev, ha); |
| 1783 | 1771 | ||
| 1784 | ha->flags.init_done = 1; | 1772 | ha->flags.init_done = 1; |
| @@ -1848,10 +1836,14 @@ qla2x00_remove_one(struct pci_dev *pdev) | |||
| 1848 | static void | 1836 | static void |
| 1849 | qla2x00_free_device(scsi_qla_host_t *ha) | 1837 | qla2x00_free_device(scsi_qla_host_t *ha) |
| 1850 | { | 1838 | { |
| 1839 | qla2x00_abort_all_cmds(ha, DID_NO_CONNECT << 16); | ||
| 1840 | |||
| 1851 | /* Disable timer */ | 1841 | /* Disable timer */ |
| 1852 | if (ha->timer_active) | 1842 | if (ha->timer_active) |
| 1853 | qla2x00_stop_timer(ha); | 1843 | qla2x00_stop_timer(ha); |
| 1854 | 1844 | ||
| 1845 | ha->flags.online = 0; | ||
| 1846 | |||
| 1855 | /* Kill the kernel thread for this host */ | 1847 | /* Kill the kernel thread for this host */ |
| 1856 | if (ha->dpc_thread) { | 1848 | if (ha->dpc_thread) { |
| 1857 | struct task_struct *t = ha->dpc_thread; | 1849 | struct task_struct *t = ha->dpc_thread; |
| @@ -1870,8 +1862,6 @@ qla2x00_free_device(scsi_qla_host_t *ha) | |||
| 1870 | if (ha->eft) | 1862 | if (ha->eft) |
| 1871 | qla2x00_disable_eft_trace(ha); | 1863 | qla2x00_disable_eft_trace(ha); |
| 1872 | 1864 | ||
| 1873 | ha->flags.online = 0; | ||
| 1874 | |||
| 1875 | /* Stop currently executing firmware. */ | 1865 | /* Stop currently executing firmware. */ |
| 1876 | qla2x00_try_to_stop_firmware(ha); | 1866 | qla2x00_try_to_stop_firmware(ha); |
| 1877 | 1867 | ||
| @@ -2010,196 +2000,109 @@ qla2x00_mark_all_devices_lost(scsi_qla_host_t *ha, int defer) | |||
| 2010 | * | 2000 | * |
| 2011 | * Returns: | 2001 | * Returns: |
| 2012 | * 0 = success. | 2002 | * 0 = success. |
| 2013 | * 1 = failure. | 2003 | * !0 = failure. |
| 2014 | */ | 2004 | */ |
| 2015 | static uint8_t | 2005 | static int |
| 2016 | qla2x00_mem_alloc(scsi_qla_host_t *ha) | 2006 | qla2x00_mem_alloc(scsi_qla_host_t *ha) |
| 2017 | { | 2007 | { |
| 2018 | char name[16]; | 2008 | char name[16]; |
| 2019 | uint8_t status = 1; | ||
| 2020 | int retry= 10; | ||
| 2021 | |||
| 2022 | do { | ||
| 2023 | /* | ||
| 2024 | * This will loop only once if everything goes well, else some | ||
| 2025 | * number of retries will be performed to get around a kernel | ||
| 2026 | * bug where available mem is not allocated until after a | ||
| 2027 | * little delay and a retry. | ||
| 2028 | */ | ||
| 2029 | ha->request_ring = dma_alloc_coherent(&ha->pdev->dev, | ||
| 2030 | (ha->request_q_length + 1) * sizeof(request_t), | ||
| 2031 | &ha->request_dma, GFP_KERNEL); | ||
| 2032 | if (ha->request_ring == NULL) { | ||
| 2033 | qla_printk(KERN_WARNING, ha, | ||
| 2034 | "Memory Allocation failed - request_ring\n"); | ||
| 2035 | |||
| 2036 | qla2x00_mem_free(ha); | ||
| 2037 | msleep(100); | ||
| 2038 | |||
| 2039 | continue; | ||
| 2040 | } | ||
| 2041 | |||
| 2042 | ha->response_ring = dma_alloc_coherent(&ha->pdev->dev, | ||
| 2043 | (ha->response_q_length + 1) * sizeof(response_t), | ||
| 2044 | &ha->response_dma, GFP_KERNEL); | ||
| 2045 | if (ha->response_ring == NULL) { | ||
| 2046 | qla_printk(KERN_WARNING, ha, | ||
| 2047 | "Memory Allocation failed - response_ring\n"); | ||
| 2048 | |||
| 2049 | qla2x00_mem_free(ha); | ||
| 2050 | msleep(100); | ||
| 2051 | |||
| 2052 | continue; | ||
| 2053 | } | ||
| 2054 | |||
| 2055 | ha->gid_list = dma_alloc_coherent(&ha->pdev->dev, GID_LIST_SIZE, | ||
| 2056 | &ha->gid_list_dma, GFP_KERNEL); | ||
| 2057 | if (ha->gid_list == NULL) { | ||
| 2058 | qla_printk(KERN_WARNING, ha, | ||
| 2059 | "Memory Allocation failed - gid_list\n"); | ||
| 2060 | |||
| 2061 | qla2x00_mem_free(ha); | ||
| 2062 | msleep(100); | ||
| 2063 | |||
| 2064 | continue; | ||
| 2065 | } | ||
| 2066 | |||
| 2067 | /* get consistent memory allocated for init control block */ | ||
| 2068 | ha->init_cb = dma_alloc_coherent(&ha->pdev->dev, | ||
| 2069 | ha->init_cb_size, &ha->init_cb_dma, GFP_KERNEL); | ||
| 2070 | if (ha->init_cb == NULL) { | ||
| 2071 | qla_printk(KERN_WARNING, ha, | ||
| 2072 | "Memory Allocation failed - init_cb\n"); | ||
| 2073 | |||
| 2074 | qla2x00_mem_free(ha); | ||
| 2075 | msleep(100); | ||
| 2076 | |||
| 2077 | continue; | ||
| 2078 | } | ||
| 2079 | memset(ha->init_cb, 0, ha->init_cb_size); | ||
| 2080 | |||
| 2081 | snprintf(name, sizeof(name), "%s_%ld", QLA2XXX_DRIVER_NAME, | ||
| 2082 | ha->host_no); | ||
| 2083 | ha->s_dma_pool = dma_pool_create(name, &ha->pdev->dev, | ||
| 2084 | DMA_POOL_SIZE, 8, 0); | ||
| 2085 | if (ha->s_dma_pool == NULL) { | ||
| 2086 | qla_printk(KERN_WARNING, ha, | ||
| 2087 | "Memory Allocation failed - s_dma_pool\n"); | ||
| 2088 | |||
| 2089 | qla2x00_mem_free(ha); | ||
| 2090 | msleep(100); | ||
| 2091 | |||
| 2092 | continue; | ||
| 2093 | } | ||
| 2094 | |||
| 2095 | if (qla2x00_allocate_sp_pool(ha)) { | ||
| 2096 | qla_printk(KERN_WARNING, ha, | ||
| 2097 | "Memory Allocation failed - " | ||
| 2098 | "qla2x00_allocate_sp_pool()\n"); | ||
| 2099 | |||
| 2100 | qla2x00_mem_free(ha); | ||
| 2101 | msleep(100); | ||
| 2102 | |||
| 2103 | continue; | ||
| 2104 | } | ||
| 2105 | |||
| 2106 | /* Allocate memory for SNS commands */ | ||
| 2107 | if (IS_QLA2100(ha) || IS_QLA2200(ha)) { | ||
| 2108 | /* Get consistent memory allocated for SNS commands */ | ||
| 2109 | ha->sns_cmd = dma_alloc_coherent(&ha->pdev->dev, | ||
| 2110 | sizeof(struct sns_cmd_pkt), &ha->sns_cmd_dma, | ||
| 2111 | GFP_KERNEL); | ||
| 2112 | if (ha->sns_cmd == NULL) { | ||
| 2113 | /* error */ | ||
| 2114 | qla_printk(KERN_WARNING, ha, | ||
| 2115 | "Memory Allocation failed - sns_cmd\n"); | ||
| 2116 | |||
| 2117 | qla2x00_mem_free(ha); | ||
| 2118 | msleep(100); | ||
| 2119 | |||
| 2120 | continue; | ||
| 2121 | } | ||
| 2122 | memset(ha->sns_cmd, 0, sizeof(struct sns_cmd_pkt)); | ||
| 2123 | } else { | ||
| 2124 | /* Get consistent memory allocated for MS IOCB */ | ||
| 2125 | ha->ms_iocb = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, | ||
| 2126 | &ha->ms_iocb_dma); | ||
| 2127 | if (ha->ms_iocb == NULL) { | ||
| 2128 | /* error */ | ||
| 2129 | qla_printk(KERN_WARNING, ha, | ||
| 2130 | "Memory Allocation failed - ms_iocb\n"); | ||
| 2131 | |||
| 2132 | qla2x00_mem_free(ha); | ||
| 2133 | msleep(100); | ||
| 2134 | |||
| 2135 | continue; | ||
| 2136 | } | ||
| 2137 | memset(ha->ms_iocb, 0, sizeof(ms_iocb_entry_t)); | ||
| 2138 | |||
| 2139 | /* | ||
| 2140 | * Get consistent memory allocated for CT SNS | ||
| 2141 | * commands | ||
| 2142 | */ | ||
| 2143 | ha->ct_sns = dma_alloc_coherent(&ha->pdev->dev, | ||
| 2144 | sizeof(struct ct_sns_pkt), &ha->ct_sns_dma, | ||
| 2145 | GFP_KERNEL); | ||
| 2146 | if (ha->ct_sns == NULL) { | ||
| 2147 | /* error */ | ||
| 2148 | qla_printk(KERN_WARNING, ha, | ||
| 2149 | "Memory Allocation failed - ct_sns\n"); | ||
| 2150 | 2009 | ||
| 2151 | qla2x00_mem_free(ha); | 2010 | ha->request_ring = dma_alloc_coherent(&ha->pdev->dev, |
| 2152 | msleep(100); | 2011 | (ha->request_q_length + 1) * sizeof(request_t), &ha->request_dma, |
| 2012 | GFP_KERNEL); | ||
| 2013 | if (!ha->request_ring) | ||
| 2014 | goto fail; | ||
| 2015 | |||
| 2016 | ha->response_ring = dma_alloc_coherent(&ha->pdev->dev, | ||
| 2017 | (ha->response_q_length + 1) * sizeof(response_t), | ||
| 2018 | &ha->response_dma, GFP_KERNEL); | ||
| 2019 | if (!ha->response_ring) | ||
| 2020 | goto fail_free_request_ring; | ||
| 2021 | |||
| 2022 | ha->gid_list = dma_alloc_coherent(&ha->pdev->dev, GID_LIST_SIZE, | ||
| 2023 | &ha->gid_list_dma, GFP_KERNEL); | ||
| 2024 | if (!ha->gid_list) | ||
| 2025 | goto fail_free_response_ring; | ||
| 2026 | |||
| 2027 | ha->init_cb = dma_alloc_coherent(&ha->pdev->dev, ha->init_cb_size, | ||
| 2028 | &ha->init_cb_dma, GFP_KERNEL); | ||
| 2029 | if (!ha->init_cb) | ||
| 2030 | goto fail_free_gid_list; | ||
| 2031 | |||
| 2032 | snprintf(name, sizeof(name), "%s_%ld", QLA2XXX_DRIVER_NAME, | ||
| 2033 | ha->host_no); | ||
| 2034 | ha->s_dma_pool = dma_pool_create(name, &ha->pdev->dev, | ||
| 2035 | DMA_POOL_SIZE, 8, 0); | ||
| 2036 | if (!ha->s_dma_pool) | ||
| 2037 | goto fail_free_init_cb; | ||
| 2153 | 2038 | ||
| 2154 | continue; | 2039 | ha->srb_mempool = mempool_create_slab_pool(SRB_MIN_REQ, srb_cachep); |
| 2155 | } | 2040 | if (!ha->srb_mempool) |
| 2156 | memset(ha->ct_sns, 0, sizeof(struct ct_sns_pkt)); | 2041 | goto fail_free_s_dma_pool; |
| 2157 | 2042 | ||
| 2158 | if (IS_FWI2_CAPABLE(ha)) { | 2043 | /* Get memory for cached NVRAM */ |
| 2159 | /* | 2044 | ha->nvram = kzalloc(MAX_NVRAM_SIZE, GFP_KERNEL); |
| 2160 | * Get consistent memory allocated for SFP | 2045 | if (!ha->nvram) |
| 2161 | * block. | 2046 | goto fail_free_srb_mempool; |
| 2162 | */ | 2047 | |
| 2163 | ha->sfp_data = dma_pool_alloc(ha->s_dma_pool, | 2048 | /* Allocate memory for SNS commands */ |
| 2164 | GFP_KERNEL, &ha->sfp_data_dma); | 2049 | if (IS_QLA2100(ha) || IS_QLA2200(ha)) { |
| 2165 | if (ha->sfp_data == NULL) { | 2050 | /* Get consistent memory allocated for SNS commands */ |
| 2166 | qla_printk(KERN_WARNING, ha, | 2051 | ha->sns_cmd = dma_alloc_coherent(&ha->pdev->dev, |
| 2167 | "Memory Allocation failed - " | 2052 | sizeof(struct sns_cmd_pkt), &ha->sns_cmd_dma, GFP_KERNEL); |
| 2168 | "sfp_data\n"); | 2053 | if (!ha->sns_cmd) |
| 2169 | 2054 | goto fail_free_nvram; | |
| 2170 | qla2x00_mem_free(ha); | 2055 | } else { |
| 2171 | msleep(100); | 2056 | /* Get consistent memory allocated for MS IOCB */ |
| 2172 | 2057 | ha->ms_iocb = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, | |
| 2173 | continue; | 2058 | &ha->ms_iocb_dma); |
| 2174 | } | 2059 | if (!ha->ms_iocb) |
| 2175 | memset(ha->sfp_data, 0, SFP_BLOCK_SIZE); | 2060 | goto fail_free_nvram; |
| 2176 | } | ||
| 2177 | } | ||
| 2178 | |||
| 2179 | /* Get memory for cached NVRAM */ | ||
| 2180 | ha->nvram = kzalloc(MAX_NVRAM_SIZE, GFP_KERNEL); | ||
| 2181 | if (ha->nvram == NULL) { | ||
| 2182 | /* error */ | ||
| 2183 | qla_printk(KERN_WARNING, ha, | ||
| 2184 | "Memory Allocation failed - nvram cache\n"); | ||
| 2185 | |||
| 2186 | qla2x00_mem_free(ha); | ||
| 2187 | msleep(100); | ||
| 2188 | |||
| 2189 | continue; | ||
| 2190 | } | ||
| 2191 | |||
| 2192 | /* Done all allocations without any error. */ | ||
| 2193 | status = 0; | ||
| 2194 | |||
| 2195 | } while (retry-- && status != 0); | ||
| 2196 | 2061 | ||
| 2197 | if (status) { | 2062 | /* Get consistent memory allocated for CT SNS commands */ |
| 2198 | printk(KERN_WARNING | 2063 | ha->ct_sns = dma_alloc_coherent(&ha->pdev->dev, |
| 2199 | "%s(): **** FAILED ****\n", __func__); | 2064 | sizeof(struct ct_sns_pkt), &ha->ct_sns_dma, GFP_KERNEL); |
| 2065 | if (!ha->ct_sns) | ||
| 2066 | goto fail_free_ms_iocb; | ||
| 2200 | } | 2067 | } |
| 2201 | 2068 | ||
| 2202 | return(status); | 2069 | return 0; |
| 2070 | |||
| 2071 | fail_free_ms_iocb: | ||
| 2072 | dma_pool_free(ha->s_dma_pool, ha->ms_iocb, ha->ms_iocb_dma); | ||
| 2073 | ha->ms_iocb = NULL; | ||
| 2074 | ha->ms_iocb_dma = 0; | ||
| 2075 | fail_free_nvram: | ||
| 2076 | kfree(ha->nvram); | ||
| 2077 | ha->nvram = NULL; | ||
| 2078 | fail_free_srb_mempool: | ||
| 2079 | mempool_destroy(ha->srb_mempool); | ||
| 2080 | ha->srb_mempool = NULL; | ||
| 2081 | fail_free_s_dma_pool: | ||
| 2082 | dma_pool_destroy(ha->s_dma_pool); | ||
| 2083 | ha->s_dma_pool = NULL; | ||
| 2084 | fail_free_init_cb: | ||
| 2085 | dma_free_coherent(&ha->pdev->dev, ha->init_cb_size, ha->init_cb, | ||
| 2086 | ha->init_cb_dma); | ||
| 2087 | ha->init_cb = NULL; | ||
| 2088 | ha->init_cb_dma = 0; | ||
| 2089 | fail_free_gid_list: | ||
| 2090 | dma_free_coherent(&ha->pdev->dev, GID_LIST_SIZE, ha->gid_list, | ||
| 2091 | ha->gid_list_dma); | ||
| 2092 | ha->gid_list = NULL; | ||
| 2093 | ha->gid_list_dma = 0; | ||
| 2094 | fail_free_response_ring: | ||
| 2095 | dma_free_coherent(&ha->pdev->dev, (ha->response_q_length + 1) * | ||
| 2096 | sizeof(response_t), ha->response_ring, ha->response_dma); | ||
| 2097 | ha->response_ring = NULL; | ||
| 2098 | ha->response_dma = 0; | ||
| 2099 | fail_free_request_ring: | ||
| 2100 | dma_free_coherent(&ha->pdev->dev, (ha->request_q_length + 1) * | ||
| 2101 | sizeof(request_t), ha->request_ring, ha->request_dma); | ||
| 2102 | ha->request_ring = NULL; | ||
| 2103 | ha->request_dma = 0; | ||
| 2104 | fail: | ||
| 2105 | return -ENOMEM; | ||
| 2203 | } | 2106 | } |
| 2204 | 2107 | ||
| 2205 | /* | 2108 | /* |
| @@ -2215,14 +2118,8 @@ qla2x00_mem_free(scsi_qla_host_t *ha) | |||
| 2215 | struct list_head *fcpl, *fcptemp; | 2118 | struct list_head *fcpl, *fcptemp; |
| 2216 | fc_port_t *fcport; | 2119 | fc_port_t *fcport; |
| 2217 | 2120 | ||
| 2218 | if (ha == NULL) { | 2121 | if (ha->srb_mempool) |
| 2219 | /* error */ | 2122 | mempool_destroy(ha->srb_mempool); |
| 2220 | DEBUG2(printk("%s(): ERROR invalid ha pointer.\n", __func__)); | ||
| 2221 | return; | ||
| 2222 | } | ||
| 2223 | |||
| 2224 | /* free sp pool */ | ||
| 2225 | qla2x00_free_sp_pool(ha); | ||
| 2226 | 2123 | ||
| 2227 | if (ha->fce) | 2124 | if (ha->fce) |
| 2228 | dma_free_coherent(&ha->pdev->dev, FCE_SIZE, ha->fce, | 2125 | dma_free_coherent(&ha->pdev->dev, FCE_SIZE, ha->fce, |
| @@ -2270,6 +2167,7 @@ qla2x00_mem_free(scsi_qla_host_t *ha) | |||
| 2270 | (ha->request_q_length + 1) * sizeof(request_t), | 2167 | (ha->request_q_length + 1) * sizeof(request_t), |
| 2271 | ha->request_ring, ha->request_dma); | 2168 | ha->request_ring, ha->request_dma); |
| 2272 | 2169 | ||
| 2170 | ha->srb_mempool = NULL; | ||
| 2273 | ha->eft = NULL; | 2171 | ha->eft = NULL; |
| 2274 | ha->eft_dma = 0; | 2172 | ha->eft_dma = 0; |
| 2275 | ha->sns_cmd = NULL; | 2173 | ha->sns_cmd = NULL; |
| @@ -2308,44 +2206,6 @@ qla2x00_mem_free(scsi_qla_host_t *ha) | |||
| 2308 | kfree(ha->nvram); | 2206 | kfree(ha->nvram); |
| 2309 | } | 2207 | } |
| 2310 | 2208 | ||
| 2311 | /* | ||
| 2312 | * qla2x00_allocate_sp_pool | ||
| 2313 | * This routine is called during initialization to allocate | ||
| 2314 | * memory for local srb_t. | ||
| 2315 | * | ||
| 2316 | * Input: | ||
| 2317 | * ha = adapter block pointer. | ||
| 2318 | * | ||
| 2319 | * Context: | ||
| 2320 | * Kernel context. | ||
| 2321 | */ | ||
| 2322 | static int | ||
| 2323 | qla2x00_allocate_sp_pool(scsi_qla_host_t *ha) | ||
| 2324 | { | ||
| 2325 | int rval; | ||
| 2326 | |||
| 2327 | rval = QLA_SUCCESS; | ||
| 2328 | ha->srb_mempool = mempool_create_slab_pool(SRB_MIN_REQ, srb_cachep); | ||
| 2329 | if (ha->srb_mempool == NULL) { | ||
| 2330 | qla_printk(KERN_INFO, ha, "Unable to allocate SRB mempool.\n"); | ||
| 2331 | rval = QLA_FUNCTION_FAILED; | ||
| 2332 | } | ||
| 2333 | return (rval); | ||
| 2334 | } | ||
| 2335 | |||
| 2336 | /* | ||
| 2337 | * This routine frees all adapter allocated memory. | ||
| 2338 | * | ||
| 2339 | */ | ||
| 2340 | static void | ||
| 2341 | qla2x00_free_sp_pool( scsi_qla_host_t *ha) | ||
| 2342 | { | ||
| 2343 | if (ha->srb_mempool) { | ||
| 2344 | mempool_destroy(ha->srb_mempool); | ||
| 2345 | ha->srb_mempool = NULL; | ||
| 2346 | } | ||
| 2347 | } | ||
| 2348 | |||
| 2349 | /************************************************************************** | 2209 | /************************************************************************** |
| 2350 | * qla2x00_do_dpc | 2210 | * qla2x00_do_dpc |
| 2351 | * This kernel thread is a task that is schedule by the interrupt handler | 2211 | * This kernel thread is a task that is schedule by the interrupt handler |
| @@ -2367,6 +2227,9 @@ qla2x00_do_dpc(void *data) | |||
| 2367 | fc_port_t *fcport; | 2227 | fc_port_t *fcport; |
| 2368 | uint8_t status; | 2228 | uint8_t status; |
| 2369 | uint16_t next_loopid; | 2229 | uint16_t next_loopid; |
| 2230 | struct scsi_qla_host *vha; | ||
| 2231 | int i; | ||
| 2232 | |||
| 2370 | 2233 | ||
| 2371 | ha = (scsi_qla_host_t *)data; | 2234 | ha = (scsi_qla_host_t *)data; |
| 2372 | 2235 | ||
| @@ -2409,6 +2272,18 @@ qla2x00_do_dpc(void *data) | |||
| 2409 | } | 2272 | } |
| 2410 | clear_bit(ABORT_ISP_ACTIVE, &ha->dpc_flags); | 2273 | clear_bit(ABORT_ISP_ACTIVE, &ha->dpc_flags); |
| 2411 | } | 2274 | } |
| 2275 | |||
| 2276 | for_each_mapped_vp_idx(ha, i) { | ||
| 2277 | list_for_each_entry(vha, &ha->vp_list, | ||
| 2278 | vp_list) { | ||
| 2279 | if (i == vha->vp_idx) { | ||
| 2280 | set_bit(ISP_ABORT_NEEDED, | ||
| 2281 | &vha->dpc_flags); | ||
| 2282 | break; | ||
| 2283 | } | ||
| 2284 | } | ||
| 2285 | } | ||
| 2286 | |||
| 2412 | DEBUG(printk("scsi(%ld): dpc: qla2x00_abort_isp end\n", | 2287 | DEBUG(printk("scsi(%ld): dpc: qla2x00_abort_isp end\n", |
| 2413 | ha->host_no)); | 2288 | ha->host_no)); |
| 2414 | } | 2289 | } |
| @@ -3029,3 +2904,4 @@ MODULE_FIRMWARE(FW_FILE_ISP22XX); | |||
| 3029 | MODULE_FIRMWARE(FW_FILE_ISP2300); | 2904 | MODULE_FIRMWARE(FW_FILE_ISP2300); |
| 3030 | MODULE_FIRMWARE(FW_FILE_ISP2322); | 2905 | MODULE_FIRMWARE(FW_FILE_ISP2322); |
| 3031 | MODULE_FIRMWARE(FW_FILE_ISP24XX); | 2906 | MODULE_FIRMWARE(FW_FILE_ISP24XX); |
| 2907 | MODULE_FIRMWARE(FW_FILE_ISP25XX); | ||
diff --git a/drivers/scsi/qla2xxx/qla_sup.c b/drivers/scsi/qla2xxx/qla_sup.c index b68fb73613ed..26822c8807ee 100644 --- a/drivers/scsi/qla2xxx/qla_sup.c +++ b/drivers/scsi/qla2xxx/qla_sup.c | |||
| @@ -893,6 +893,8 @@ qla2x00_flip_colors(scsi_qla_host_t *ha, uint16_t *pflags) | |||
| 893 | } | 893 | } |
| 894 | } | 894 | } |
| 895 | 895 | ||
| 896 | #define PIO_REG(h, r) ((h)->pio_address + offsetof(struct device_reg_2xxx, r)) | ||
| 897 | |||
| 896 | void | 898 | void |
| 897 | qla2x00_beacon_blink(struct scsi_qla_host *ha) | 899 | qla2x00_beacon_blink(struct scsi_qla_host *ha) |
| 898 | { | 900 | { |
| @@ -902,15 +904,12 @@ qla2x00_beacon_blink(struct scsi_qla_host *ha) | |||
| 902 | unsigned long flags; | 904 | unsigned long flags; |
| 903 | struct device_reg_2xxx __iomem *reg = &ha->iobase->isp; | 905 | struct device_reg_2xxx __iomem *reg = &ha->iobase->isp; |
| 904 | 906 | ||
| 905 | if (ha->pio_address) | ||
| 906 | reg = (struct device_reg_2xxx __iomem *)ha->pio_address; | ||
| 907 | |||
| 908 | spin_lock_irqsave(&ha->hardware_lock, flags); | 907 | spin_lock_irqsave(&ha->hardware_lock, flags); |
| 909 | 908 | ||
| 910 | /* Save the Original GPIOE. */ | 909 | /* Save the Original GPIOE. */ |
| 911 | if (ha->pio_address) { | 910 | if (ha->pio_address) { |
| 912 | gpio_enable = RD_REG_WORD_PIO(®->gpioe); | 911 | gpio_enable = RD_REG_WORD_PIO(PIO_REG(ha, gpioe)); |
| 913 | gpio_data = RD_REG_WORD_PIO(®->gpiod); | 912 | gpio_data = RD_REG_WORD_PIO(PIO_REG(ha, gpiod)); |
| 914 | } else { | 913 | } else { |
| 915 | gpio_enable = RD_REG_WORD(®->gpioe); | 914 | gpio_enable = RD_REG_WORD(®->gpioe); |
| 916 | gpio_data = RD_REG_WORD(®->gpiod); | 915 | gpio_data = RD_REG_WORD(®->gpiod); |
| @@ -920,7 +919,7 @@ qla2x00_beacon_blink(struct scsi_qla_host *ha) | |||
| 920 | gpio_enable |= GPIO_LED_MASK; | 919 | gpio_enable |= GPIO_LED_MASK; |
| 921 | 920 | ||
| 922 | if (ha->pio_address) { | 921 | if (ha->pio_address) { |
| 923 | WRT_REG_WORD_PIO(®->gpioe, gpio_enable); | 922 | WRT_REG_WORD_PIO(PIO_REG(ha, gpioe), gpio_enable); |
| 924 | } else { | 923 | } else { |
| 925 | WRT_REG_WORD(®->gpioe, gpio_enable); | 924 | WRT_REG_WORD(®->gpioe, gpio_enable); |
| 926 | RD_REG_WORD(®->gpioe); | 925 | RD_REG_WORD(®->gpioe); |
| @@ -936,7 +935,7 @@ qla2x00_beacon_blink(struct scsi_qla_host *ha) | |||
| 936 | 935 | ||
| 937 | /* Set the modified gpio_data values */ | 936 | /* Set the modified gpio_data values */ |
| 938 | if (ha->pio_address) { | 937 | if (ha->pio_address) { |
| 939 | WRT_REG_WORD_PIO(®->gpiod, gpio_data); | 938 | WRT_REG_WORD_PIO(PIO_REG(ha, gpiod), gpio_data); |
| 940 | } else { | 939 | } else { |
| 941 | WRT_REG_WORD(®->gpiod, gpio_data); | 940 | WRT_REG_WORD(®->gpiod, gpio_data); |
| 942 | RD_REG_WORD(®->gpiod); | 941 | RD_REG_WORD(®->gpiod); |
| @@ -962,14 +961,11 @@ qla2x00_beacon_on(struct scsi_qla_host *ha) | |||
| 962 | return QLA_FUNCTION_FAILED; | 961 | return QLA_FUNCTION_FAILED; |
| 963 | } | 962 | } |
| 964 | 963 | ||
| 965 | if (ha->pio_address) | ||
| 966 | reg = (struct device_reg_2xxx __iomem *)ha->pio_address; | ||
| 967 | |||
| 968 | /* Turn off LEDs. */ | 964 | /* Turn off LEDs. */ |
| 969 | spin_lock_irqsave(&ha->hardware_lock, flags); | 965 | spin_lock_irqsave(&ha->hardware_lock, flags); |
| 970 | if (ha->pio_address) { | 966 | if (ha->pio_address) { |
| 971 | gpio_enable = RD_REG_WORD_PIO(®->gpioe); | 967 | gpio_enable = RD_REG_WORD_PIO(PIO_REG(ha, gpioe)); |
| 972 | gpio_data = RD_REG_WORD_PIO(®->gpiod); | 968 | gpio_data = RD_REG_WORD_PIO(PIO_REG(ha, gpiod)); |
| 973 | } else { | 969 | } else { |
| 974 | gpio_enable = RD_REG_WORD(®->gpioe); | 970 | gpio_enable = RD_REG_WORD(®->gpioe); |
| 975 | gpio_data = RD_REG_WORD(®->gpiod); | 971 | gpio_data = RD_REG_WORD(®->gpiod); |
| @@ -978,7 +974,7 @@ qla2x00_beacon_on(struct scsi_qla_host *ha) | |||
| 978 | 974 | ||
| 979 | /* Set the modified gpio_enable values. */ | 975 | /* Set the modified gpio_enable values. */ |
| 980 | if (ha->pio_address) { | 976 | if (ha->pio_address) { |
| 981 | WRT_REG_WORD_PIO(®->gpioe, gpio_enable); | 977 | WRT_REG_WORD_PIO(PIO_REG(ha, gpioe), gpio_enable); |
| 982 | } else { | 978 | } else { |
| 983 | WRT_REG_WORD(®->gpioe, gpio_enable); | 979 | WRT_REG_WORD(®->gpioe, gpio_enable); |
| 984 | RD_REG_WORD(®->gpioe); | 980 | RD_REG_WORD(®->gpioe); |
| @@ -987,7 +983,7 @@ qla2x00_beacon_on(struct scsi_qla_host *ha) | |||
| 987 | /* Clear out previously set LED colour. */ | 983 | /* Clear out previously set LED colour. */ |
| 988 | gpio_data &= ~GPIO_LED_MASK; | 984 | gpio_data &= ~GPIO_LED_MASK; |
| 989 | if (ha->pio_address) { | 985 | if (ha->pio_address) { |
| 990 | WRT_REG_WORD_PIO(®->gpiod, gpio_data); | 986 | WRT_REG_WORD_PIO(PIO_REG(ha, gpiod), gpio_data); |
| 991 | } else { | 987 | } else { |
| 992 | WRT_REG_WORD(®->gpiod, gpio_data); | 988 | WRT_REG_WORD(®->gpiod, gpio_data); |
| 993 | RD_REG_WORD(®->gpiod); | 989 | RD_REG_WORD(®->gpiod); |
| @@ -1244,13 +1240,12 @@ qla2x00_read_flash_byte(scsi_qla_host_t *ha, uint32_t addr) | |||
| 1244 | if (ha->pio_address) { | 1240 | if (ha->pio_address) { |
| 1245 | uint16_t data2; | 1241 | uint16_t data2; |
| 1246 | 1242 | ||
| 1247 | reg = (struct device_reg_2xxx __iomem *)ha->pio_address; | 1243 | WRT_REG_WORD_PIO(PIO_REG(ha, flash_address), (uint16_t)addr); |
| 1248 | WRT_REG_WORD_PIO(®->flash_address, (uint16_t)addr); | ||
| 1249 | do { | 1244 | do { |
| 1250 | data = RD_REG_WORD_PIO(®->flash_data); | 1245 | data = RD_REG_WORD_PIO(PIO_REG(ha, flash_data)); |
| 1251 | barrier(); | 1246 | barrier(); |
| 1252 | cpu_relax(); | 1247 | cpu_relax(); |
| 1253 | data2 = RD_REG_WORD_PIO(®->flash_data); | 1248 | data2 = RD_REG_WORD_PIO(PIO_REG(ha, flash_data)); |
| 1254 | } while (data != data2); | 1249 | } while (data != data2); |
| 1255 | } else { | 1250 | } else { |
| 1256 | WRT_REG_WORD(®->flash_address, (uint16_t)addr); | 1251 | WRT_REG_WORD(®->flash_address, (uint16_t)addr); |
| @@ -1304,9 +1299,8 @@ qla2x00_write_flash_byte(scsi_qla_host_t *ha, uint32_t addr, uint8_t data) | |||
| 1304 | 1299 | ||
| 1305 | /* Always perform IO mapped accesses to the FLASH registers. */ | 1300 | /* Always perform IO mapped accesses to the FLASH registers. */ |
| 1306 | if (ha->pio_address) { | 1301 | if (ha->pio_address) { |
| 1307 | reg = (struct device_reg_2xxx __iomem *)ha->pio_address; | 1302 | WRT_REG_WORD_PIO(PIO_REG(ha, flash_address), (uint16_t)addr); |
| 1308 | WRT_REG_WORD_PIO(®->flash_address, (uint16_t)addr); | 1303 | WRT_REG_WORD_PIO(PIO_REG(ha, flash_data), (uint16_t)data); |
| 1309 | WRT_REG_WORD_PIO(®->flash_data, (uint16_t)data); | ||
| 1310 | } else { | 1304 | } else { |
| 1311 | WRT_REG_WORD(®->flash_address, (uint16_t)addr); | 1305 | WRT_REG_WORD(®->flash_address, (uint16_t)addr); |
| 1312 | RD_REG_WORD(®->ctrl_status); /* PCI Posting. */ | 1306 | RD_REG_WORD(®->ctrl_status); /* PCI Posting. */ |
diff --git a/drivers/scsi/qla2xxx/qla_version.h b/drivers/scsi/qla2xxx/qla_version.h index 2c2f6b4697c7..c5742cc15abb 100644 --- a/drivers/scsi/qla2xxx/qla_version.h +++ b/drivers/scsi/qla2xxx/qla_version.h | |||
| @@ -7,7 +7,7 @@ | |||
| 7 | /* | 7 | /* |
| 8 | * Driver version | 8 | * Driver version |
| 9 | */ | 9 | */ |
| 10 | #define QLA2XXX_VERSION "8.02.00-k7" | 10 | #define QLA2XXX_VERSION "8.02.00-k8" |
| 11 | 11 | ||
| 12 | #define QLA_DRIVER_MAJOR_VER 8 | 12 | #define QLA_DRIVER_MAJOR_VER 8 |
| 13 | #define QLA_DRIVER_MINOR_VER 2 | 13 | #define QLA_DRIVER_MINOR_VER 2 |
diff --git a/drivers/scsi/qla4xxx/ql4_init.c b/drivers/scsi/qla4xxx/ql4_init.c index 49925f92555e..10b3b9a620f3 100644 --- a/drivers/scsi/qla4xxx/ql4_init.c +++ b/drivers/scsi/qla4xxx/ql4_init.c | |||
| @@ -1306,6 +1306,7 @@ int qla4xxx_process_ddb_changed(struct scsi_qla_host *ha, | |||
| 1306 | atomic_set(&ddb_entry->relogin_timer, 0); | 1306 | atomic_set(&ddb_entry->relogin_timer, 0); |
| 1307 | clear_bit(DF_RELOGIN, &ddb_entry->flags); | 1307 | clear_bit(DF_RELOGIN, &ddb_entry->flags); |
| 1308 | clear_bit(DF_NO_RELOGIN, &ddb_entry->flags); | 1308 | clear_bit(DF_NO_RELOGIN, &ddb_entry->flags); |
| 1309 | iscsi_unblock_session(ddb_entry->sess); | ||
| 1309 | iscsi_session_event(ddb_entry->sess, | 1310 | iscsi_session_event(ddb_entry->sess, |
| 1310 | ISCSI_KEVENT_CREATE_SESSION); | 1311 | ISCSI_KEVENT_CREATE_SESSION); |
| 1311 | /* | 1312 | /* |
diff --git a/drivers/scsi/qla4xxx/ql4_os.c b/drivers/scsi/qla4xxx/ql4_os.c index 2e2b9fedffcc..c3c59d763037 100644 --- a/drivers/scsi/qla4xxx/ql4_os.c +++ b/drivers/scsi/qla4xxx/ql4_os.c | |||
| @@ -63,8 +63,6 @@ static int qla4xxx_sess_get_param(struct iscsi_cls_session *sess, | |||
| 63 | enum iscsi_param param, char *buf); | 63 | enum iscsi_param param, char *buf); |
| 64 | static int qla4xxx_host_get_param(struct Scsi_Host *shost, | 64 | static int qla4xxx_host_get_param(struct Scsi_Host *shost, |
| 65 | enum iscsi_host_param param, char *buf); | 65 | enum iscsi_host_param param, char *buf); |
| 66 | static void qla4xxx_conn_stop(struct iscsi_cls_conn *conn, int flag); | ||
| 67 | static int qla4xxx_conn_start(struct iscsi_cls_conn *conn); | ||
| 68 | static void qla4xxx_recovery_timedout(struct iscsi_cls_session *session); | 66 | static void qla4xxx_recovery_timedout(struct iscsi_cls_session *session); |
| 69 | 67 | ||
| 70 | /* | 68 | /* |
| @@ -91,6 +89,8 @@ static struct scsi_host_template qla4xxx_driver_template = { | |||
| 91 | .slave_alloc = qla4xxx_slave_alloc, | 89 | .slave_alloc = qla4xxx_slave_alloc, |
| 92 | .slave_destroy = qla4xxx_slave_destroy, | 90 | .slave_destroy = qla4xxx_slave_destroy, |
| 93 | 91 | ||
| 92 | .scan_finished = iscsi_scan_finished, | ||
| 93 | |||
| 94 | .this_id = -1, | 94 | .this_id = -1, |
| 95 | .cmd_per_lun = 3, | 95 | .cmd_per_lun = 3, |
| 96 | .use_clustering = ENABLE_CLUSTERING, | 96 | .use_clustering = ENABLE_CLUSTERING, |
| @@ -116,8 +116,6 @@ static struct iscsi_transport qla4xxx_iscsi_transport = { | |||
| 116 | .get_conn_param = qla4xxx_conn_get_param, | 116 | .get_conn_param = qla4xxx_conn_get_param, |
| 117 | .get_session_param = qla4xxx_sess_get_param, | 117 | .get_session_param = qla4xxx_sess_get_param, |
| 118 | .get_host_param = qla4xxx_host_get_param, | 118 | .get_host_param = qla4xxx_host_get_param, |
| 119 | .start_conn = qla4xxx_conn_start, | ||
| 120 | .stop_conn = qla4xxx_conn_stop, | ||
| 121 | .session_recovery_timedout = qla4xxx_recovery_timedout, | 119 | .session_recovery_timedout = qla4xxx_recovery_timedout, |
| 122 | }; | 120 | }; |
| 123 | 121 | ||
| @@ -128,48 +126,19 @@ static void qla4xxx_recovery_timedout(struct iscsi_cls_session *session) | |||
| 128 | struct ddb_entry *ddb_entry = session->dd_data; | 126 | struct ddb_entry *ddb_entry = session->dd_data; |
| 129 | struct scsi_qla_host *ha = ddb_entry->ha; | 127 | struct scsi_qla_host *ha = ddb_entry->ha; |
| 130 | 128 | ||
| 131 | DEBUG2(printk("scsi%ld: %s: index [%d] port down retry count of (%d) " | 129 | if (atomic_read(&ddb_entry->state) != DDB_STATE_ONLINE) { |
| 132 | "secs exhausted, marking device DEAD.\n", ha->host_no, | 130 | atomic_set(&ddb_entry->state, DDB_STATE_DEAD); |
| 133 | __func__, ddb_entry->fw_ddb_index, | ||
| 134 | ha->port_down_retry_count)); | ||
| 135 | |||
| 136 | atomic_set(&ddb_entry->state, DDB_STATE_DEAD); | ||
| 137 | |||
| 138 | DEBUG2(printk("scsi%ld: %s: scheduling dpc routine - dpc flags = " | ||
| 139 | "0x%lx\n", ha->host_no, __func__, ha->dpc_flags)); | ||
| 140 | queue_work(ha->dpc_thread, &ha->dpc_work); | ||
| 141 | } | ||
| 142 | |||
| 143 | static int qla4xxx_conn_start(struct iscsi_cls_conn *conn) | ||
| 144 | { | ||
| 145 | struct iscsi_cls_session *session; | ||
| 146 | struct ddb_entry *ddb_entry; | ||
| 147 | |||
| 148 | session = iscsi_dev_to_session(conn->dev.parent); | ||
| 149 | ddb_entry = session->dd_data; | ||
| 150 | |||
| 151 | DEBUG2(printk("scsi%ld: %s: index [%d] starting conn\n", | ||
| 152 | ddb_entry->ha->host_no, __func__, | ||
| 153 | ddb_entry->fw_ddb_index)); | ||
| 154 | iscsi_unblock_session(session); | ||
| 155 | return 0; | ||
| 156 | } | ||
| 157 | |||
| 158 | static void qla4xxx_conn_stop(struct iscsi_cls_conn *conn, int flag) | ||
| 159 | { | ||
| 160 | struct iscsi_cls_session *session; | ||
| 161 | struct ddb_entry *ddb_entry; | ||
| 162 | 131 | ||
| 163 | session = iscsi_dev_to_session(conn->dev.parent); | 132 | DEBUG2(printk("scsi%ld: %s: index [%d] port down retry count " |
| 164 | ddb_entry = session->dd_data; | 133 | "of (%d) secs exhausted, marking device DEAD.\n", |
| 134 | ha->host_no, __func__, ddb_entry->fw_ddb_index, | ||
| 135 | ha->port_down_retry_count)); | ||
| 165 | 136 | ||
| 166 | DEBUG2(printk("scsi%ld: %s: index [%d] stopping conn\n", | 137 | DEBUG2(printk("scsi%ld: %s: scheduling dpc routine - dpc " |
| 167 | ddb_entry->ha->host_no, __func__, | 138 | "flags = 0x%lx\n", |
| 168 | ddb_entry->fw_ddb_index)); | 139 | ha->host_no, __func__, ha->dpc_flags)); |
| 169 | if (flag == STOP_CONN_RECOVER) | 140 | queue_work(ha->dpc_thread, &ha->dpc_work); |
| 170 | iscsi_block_session(session); | 141 | } |
| 171 | else | ||
| 172 | printk(KERN_ERR "iscsi: invalid stop flag %d\n", flag); | ||
| 173 | } | 142 | } |
| 174 | 143 | ||
| 175 | static int qla4xxx_host_get_param(struct Scsi_Host *shost, | 144 | static int qla4xxx_host_get_param(struct Scsi_Host *shost, |
| @@ -308,6 +277,9 @@ int qla4xxx_add_sess(struct ddb_entry *ddb_entry) | |||
| 308 | DEBUG2(printk(KERN_ERR "Could not add connection.\n")); | 277 | DEBUG2(printk(KERN_ERR "Could not add connection.\n")); |
| 309 | return -ENOMEM; | 278 | return -ENOMEM; |
| 310 | } | 279 | } |
| 280 | |||
| 281 | /* finally ready to go */ | ||
| 282 | iscsi_unblock_session(ddb_entry->sess); | ||
| 311 | return 0; | 283 | return 0; |
| 312 | } | 284 | } |
| 313 | 285 | ||
| @@ -364,6 +336,7 @@ void qla4xxx_mark_device_missing(struct scsi_qla_host *ha, | |||
| 364 | DEBUG3(printk("scsi%d:%d:%d: index [%d] marked MISSING\n", | 336 | DEBUG3(printk("scsi%d:%d:%d: index [%d] marked MISSING\n", |
| 365 | ha->host_no, ddb_entry->bus, ddb_entry->target, | 337 | ha->host_no, ddb_entry->bus, ddb_entry->target, |
| 366 | ddb_entry->fw_ddb_index)); | 338 | ddb_entry->fw_ddb_index)); |
| 339 | iscsi_block_session(ddb_entry->sess); | ||
| 367 | iscsi_conn_error(ddb_entry->conn, ISCSI_ERR_CONN_FAILED); | 340 | iscsi_conn_error(ddb_entry->conn, ISCSI_ERR_CONN_FAILED); |
| 368 | } | 341 | } |
| 369 | 342 | ||
| @@ -430,9 +403,21 @@ static int qla4xxx_queuecommand(struct scsi_cmnd *cmd, | |||
| 430 | { | 403 | { |
| 431 | struct scsi_qla_host *ha = to_qla_host(cmd->device->host); | 404 | struct scsi_qla_host *ha = to_qla_host(cmd->device->host); |
| 432 | struct ddb_entry *ddb_entry = cmd->device->hostdata; | 405 | struct ddb_entry *ddb_entry = cmd->device->hostdata; |
| 406 | struct iscsi_cls_session *sess = ddb_entry->sess; | ||
| 433 | struct srb *srb; | 407 | struct srb *srb; |
| 434 | int rval; | 408 | int rval; |
| 435 | 409 | ||
| 410 | if (!sess) { | ||
| 411 | cmd->result = DID_IMM_RETRY << 16; | ||
| 412 | goto qc_fail_command; | ||
| 413 | } | ||
| 414 | |||
| 415 | rval = iscsi_session_chkready(sess); | ||
| 416 | if (rval) { | ||
| 417 | cmd->result = rval; | ||
| 418 | goto qc_fail_command; | ||
| 419 | } | ||
| 420 | |||
| 436 | if (atomic_read(&ddb_entry->state) != DDB_STATE_ONLINE) { | 421 | if (atomic_read(&ddb_entry->state) != DDB_STATE_ONLINE) { |
| 437 | if (atomic_read(&ddb_entry->state) == DDB_STATE_DEAD) { | 422 | if (atomic_read(&ddb_entry->state) == DDB_STATE_DEAD) { |
| 438 | cmd->result = DID_NO_CONNECT << 16; | 423 | cmd->result = DID_NO_CONNECT << 16; |
| @@ -1323,7 +1308,7 @@ static int __devinit qla4xxx_probe_adapter(struct pci_dev *pdev, | |||
| 1323 | qla4xxx_version_str, ha->pdev->device, pci_name(ha->pdev), | 1308 | qla4xxx_version_str, ha->pdev->device, pci_name(ha->pdev), |
| 1324 | ha->host_no, ha->firmware_version[0], ha->firmware_version[1], | 1309 | ha->host_no, ha->firmware_version[0], ha->firmware_version[1], |
| 1325 | ha->patch_number, ha->build_number); | 1310 | ha->patch_number, ha->build_number); |
| 1326 | 1311 | scsi_scan_host(host); | |
| 1327 | return 0; | 1312 | return 0; |
| 1328 | 1313 | ||
| 1329 | remove_host: | 1314 | remove_host: |
diff --git a/drivers/scsi/scsi.c b/drivers/scsi/scsi.c index b35d19472caa..fecba05b4e77 100644 --- a/drivers/scsi/scsi.c +++ b/drivers/scsi/scsi.c | |||
| @@ -969,9 +969,10 @@ void starget_for_each_device(struct scsi_target *starget, void *data, | |||
| 969 | EXPORT_SYMBOL(starget_for_each_device); | 969 | EXPORT_SYMBOL(starget_for_each_device); |
| 970 | 970 | ||
| 971 | /** | 971 | /** |
| 972 | * __starget_for_each_device - helper to walk all devices of a target | 972 | * __starget_for_each_device - helper to walk all devices of a target (UNLOCKED) |
| 973 | * (UNLOCKED) | ||
| 974 | * @starget: target whose devices we want to iterate over. | 973 | * @starget: target whose devices we want to iterate over. |
| 974 | * @data: parameter for callback @fn() | ||
| 975 | * @fn: callback function that is invoked for each device | ||
| 975 | * | 976 | * |
| 976 | * This traverses over each device of @starget. It does _not_ | 977 | * This traverses over each device of @starget. It does _not_ |
| 977 | * take a reference on the scsi_device, so the whole loop must be | 978 | * take a reference on the scsi_device, so the whole loop must be |
diff --git a/drivers/scsi/scsi_lib.c b/drivers/scsi/scsi_lib.c index f243fc30c908..135c1d054701 100644 --- a/drivers/scsi/scsi_lib.c +++ b/drivers/scsi/scsi_lib.c | |||
| @@ -301,7 +301,6 @@ static int scsi_req_map_sg(struct request *rq, struct scatterlist *sgl, | |||
| 301 | page = sg_page(sg); | 301 | page = sg_page(sg); |
| 302 | off = sg->offset; | 302 | off = sg->offset; |
| 303 | len = sg->length; | 303 | len = sg->length; |
| 304 | data_len += len; | ||
| 305 | 304 | ||
| 306 | while (len > 0 && data_len > 0) { | 305 | while (len > 0 && data_len > 0) { |
| 307 | /* | 306 | /* |
diff --git a/drivers/scsi/scsi_transport_iscsi.c b/drivers/scsi/scsi_transport_iscsi.c index 0d7b4e79415c..fac7534f3ec4 100644 --- a/drivers/scsi/scsi_transport_iscsi.c +++ b/drivers/scsi/scsi_transport_iscsi.c | |||
| @@ -30,10 +30,10 @@ | |||
| 30 | #include <scsi/scsi_transport_iscsi.h> | 30 | #include <scsi/scsi_transport_iscsi.h> |
| 31 | #include <scsi/iscsi_if.h> | 31 | #include <scsi/iscsi_if.h> |
| 32 | 32 | ||
| 33 | #define ISCSI_SESSION_ATTRS 18 | 33 | #define ISCSI_SESSION_ATTRS 19 |
| 34 | #define ISCSI_CONN_ATTRS 11 | 34 | #define ISCSI_CONN_ATTRS 13 |
| 35 | #define ISCSI_HOST_ATTRS 4 | 35 | #define ISCSI_HOST_ATTRS 4 |
| 36 | #define ISCSI_TRANSPORT_VERSION "2.0-867" | 36 | #define ISCSI_TRANSPORT_VERSION "2.0-868" |
| 37 | 37 | ||
| 38 | struct iscsi_internal { | 38 | struct iscsi_internal { |
| 39 | int daemon_pid; | 39 | int daemon_pid; |
| @@ -127,12 +127,13 @@ static int iscsi_setup_host(struct transport_container *tc, struct device *dev, | |||
| 127 | memset(ihost, 0, sizeof(*ihost)); | 127 | memset(ihost, 0, sizeof(*ihost)); |
| 128 | INIT_LIST_HEAD(&ihost->sessions); | 128 | INIT_LIST_HEAD(&ihost->sessions); |
| 129 | mutex_init(&ihost->mutex); | 129 | mutex_init(&ihost->mutex); |
| 130 | atomic_set(&ihost->nr_scans, 0); | ||
| 130 | 131 | ||
| 131 | snprintf(ihost->unbind_workq_name, KOBJ_NAME_LEN, "iscsi_unbind_%d", | 132 | snprintf(ihost->scan_workq_name, KOBJ_NAME_LEN, "iscsi_scan_%d", |
| 132 | shost->host_no); | 133 | shost->host_no); |
| 133 | ihost->unbind_workq = create_singlethread_workqueue( | 134 | ihost->scan_workq = create_singlethread_workqueue( |
| 134 | ihost->unbind_workq_name); | 135 | ihost->scan_workq_name); |
| 135 | if (!ihost->unbind_workq) | 136 | if (!ihost->scan_workq) |
| 136 | return -ENOMEM; | 137 | return -ENOMEM; |
| 137 | return 0; | 138 | return 0; |
| 138 | } | 139 | } |
| @@ -143,7 +144,7 @@ static int iscsi_remove_host(struct transport_container *tc, struct device *dev, | |||
| 143 | struct Scsi_Host *shost = dev_to_shost(dev); | 144 | struct Scsi_Host *shost = dev_to_shost(dev); |
| 144 | struct iscsi_host *ihost = shost->shost_data; | 145 | struct iscsi_host *ihost = shost->shost_data; |
| 145 | 146 | ||
| 146 | destroy_workqueue(ihost->unbind_workq); | 147 | destroy_workqueue(ihost->scan_workq); |
| 147 | return 0; | 148 | return 0; |
| 148 | } | 149 | } |
| 149 | 150 | ||
| @@ -221,6 +222,54 @@ static struct iscsi_cls_conn *iscsi_conn_lookup(uint32_t sid, uint32_t cid) | |||
| 221 | * The following functions can be used by LLDs that allocate | 222 | * The following functions can be used by LLDs that allocate |
| 222 | * their own scsi_hosts or by software iscsi LLDs | 223 | * their own scsi_hosts or by software iscsi LLDs |
| 223 | */ | 224 | */ |
| 225 | static struct { | ||
| 226 | int value; | ||
| 227 | char *name; | ||
| 228 | } iscsi_session_state_names[] = { | ||
| 229 | { ISCSI_SESSION_LOGGED_IN, "LOGGED_IN" }, | ||
| 230 | { ISCSI_SESSION_FAILED, "FAILED" }, | ||
| 231 | { ISCSI_SESSION_FREE, "FREE" }, | ||
| 232 | }; | ||
| 233 | |||
| 234 | const char *iscsi_session_state_name(int state) | ||
| 235 | { | ||
| 236 | int i; | ||
| 237 | char *name = NULL; | ||
| 238 | |||
| 239 | for (i = 0; i < ARRAY_SIZE(iscsi_session_state_names); i++) { | ||
| 240 | if (iscsi_session_state_names[i].value == state) { | ||
| 241 | name = iscsi_session_state_names[i].name; | ||
| 242 | break; | ||
| 243 | } | ||
| 244 | } | ||
| 245 | return name; | ||
| 246 | } | ||
| 247 | |||
| 248 | int iscsi_session_chkready(struct iscsi_cls_session *session) | ||
| 249 | { | ||
| 250 | unsigned long flags; | ||
| 251 | int err; | ||
| 252 | |||
| 253 | spin_lock_irqsave(&session->lock, flags); | ||
| 254 | switch (session->state) { | ||
| 255 | case ISCSI_SESSION_LOGGED_IN: | ||
| 256 | err = 0; | ||
| 257 | break; | ||
| 258 | case ISCSI_SESSION_FAILED: | ||
| 259 | err = DID_IMM_RETRY << 16; | ||
| 260 | break; | ||
| 261 | case ISCSI_SESSION_FREE: | ||
| 262 | err = DID_NO_CONNECT << 16; | ||
| 263 | break; | ||
| 264 | default: | ||
| 265 | err = DID_NO_CONNECT << 16; | ||
| 266 | break; | ||
| 267 | } | ||
| 268 | spin_unlock_irqrestore(&session->lock, flags); | ||
| 269 | return err; | ||
| 270 | } | ||
| 271 | EXPORT_SYMBOL_GPL(iscsi_session_chkready); | ||
| 272 | |||
| 224 | static void iscsi_session_release(struct device *dev) | 273 | static void iscsi_session_release(struct device *dev) |
| 225 | { | 274 | { |
| 226 | struct iscsi_cls_session *session = iscsi_dev_to_session(dev); | 275 | struct iscsi_cls_session *session = iscsi_dev_to_session(dev); |
| @@ -236,6 +285,25 @@ static int iscsi_is_session_dev(const struct device *dev) | |||
| 236 | return dev->release == iscsi_session_release; | 285 | return dev->release == iscsi_session_release; |
| 237 | } | 286 | } |
| 238 | 287 | ||
| 288 | /** | ||
| 289 | * iscsi_scan_finished - helper to report when running scans are done | ||
| 290 | * @shost: scsi host | ||
| 291 | * @time: scan run time | ||
| 292 | * | ||
| 293 | * This function can be used by drives like qla4xxx to report to the scsi | ||
| 294 | * layer when the scans it kicked off at module load time are done. | ||
| 295 | */ | ||
| 296 | int iscsi_scan_finished(struct Scsi_Host *shost, unsigned long time) | ||
| 297 | { | ||
| 298 | struct iscsi_host *ihost = shost->shost_data; | ||
| 299 | /* | ||
| 300 | * qla4xxx will have kicked off some session unblocks before calling | ||
| 301 | * scsi_scan_host, so just wait for them to complete. | ||
| 302 | */ | ||
| 303 | return !atomic_read(&ihost->nr_scans); | ||
| 304 | } | ||
| 305 | EXPORT_SYMBOL_GPL(iscsi_scan_finished); | ||
| 306 | |||
| 239 | static int iscsi_user_scan(struct Scsi_Host *shost, uint channel, | 307 | static int iscsi_user_scan(struct Scsi_Host *shost, uint channel, |
| 240 | uint id, uint lun) | 308 | uint id, uint lun) |
| 241 | { | 309 | { |
| @@ -254,14 +322,50 @@ static int iscsi_user_scan(struct Scsi_Host *shost, uint channel, | |||
| 254 | return 0; | 322 | return 0; |
| 255 | } | 323 | } |
| 256 | 324 | ||
| 325 | static void iscsi_scan_session(struct work_struct *work) | ||
| 326 | { | ||
| 327 | struct iscsi_cls_session *session = | ||
| 328 | container_of(work, struct iscsi_cls_session, scan_work); | ||
| 329 | struct Scsi_Host *shost = iscsi_session_to_shost(session); | ||
| 330 | struct iscsi_host *ihost = shost->shost_data; | ||
| 331 | unsigned long flags; | ||
| 332 | |||
| 333 | spin_lock_irqsave(&session->lock, flags); | ||
| 334 | if (session->state != ISCSI_SESSION_LOGGED_IN) { | ||
| 335 | spin_unlock_irqrestore(&session->lock, flags); | ||
| 336 | goto done; | ||
| 337 | } | ||
| 338 | spin_unlock_irqrestore(&session->lock, flags); | ||
| 339 | |||
| 340 | scsi_scan_target(&session->dev, 0, session->target_id, | ||
| 341 | SCAN_WILD_CARD, 1); | ||
| 342 | done: | ||
| 343 | atomic_dec(&ihost->nr_scans); | ||
| 344 | } | ||
| 345 | |||
| 257 | static void session_recovery_timedout(struct work_struct *work) | 346 | static void session_recovery_timedout(struct work_struct *work) |
| 258 | { | 347 | { |
| 259 | struct iscsi_cls_session *session = | 348 | struct iscsi_cls_session *session = |
| 260 | container_of(work, struct iscsi_cls_session, | 349 | container_of(work, struct iscsi_cls_session, |
| 261 | recovery_work.work); | 350 | recovery_work.work); |
| 351 | unsigned long flags; | ||
| 352 | |||
| 353 | iscsi_cls_session_printk(KERN_INFO, session, | ||
| 354 | "session recovery timed out after %d secs\n", | ||
| 355 | session->recovery_tmo); | ||
| 262 | 356 | ||
| 263 | dev_printk(KERN_INFO, &session->dev, "iscsi: session recovery timed " | 357 | spin_lock_irqsave(&session->lock, flags); |
| 264 | "out after %d secs\n", session->recovery_tmo); | 358 | switch (session->state) { |
| 359 | case ISCSI_SESSION_FAILED: | ||
| 360 | session->state = ISCSI_SESSION_FREE; | ||
| 361 | break; | ||
| 362 | case ISCSI_SESSION_LOGGED_IN: | ||
| 363 | case ISCSI_SESSION_FREE: | ||
| 364 | /* we raced with the unblock's flush */ | ||
| 365 | spin_unlock_irqrestore(&session->lock, flags); | ||
| 366 | return; | ||
| 367 | } | ||
| 368 | spin_unlock_irqrestore(&session->lock, flags); | ||
| 265 | 369 | ||
| 266 | if (session->transport->session_recovery_timedout) | 370 | if (session->transport->session_recovery_timedout) |
| 267 | session->transport->session_recovery_timedout(session); | 371 | session->transport->session_recovery_timedout(session); |
| @@ -269,16 +373,44 @@ static void session_recovery_timedout(struct work_struct *work) | |||
| 269 | scsi_target_unblock(&session->dev); | 373 | scsi_target_unblock(&session->dev); |
| 270 | } | 374 | } |
| 271 | 375 | ||
| 272 | void iscsi_unblock_session(struct iscsi_cls_session *session) | 376 | void __iscsi_unblock_session(struct iscsi_cls_session *session) |
| 273 | { | 377 | { |
| 274 | if (!cancel_delayed_work(&session->recovery_work)) | 378 | if (!cancel_delayed_work(&session->recovery_work)) |
| 275 | flush_workqueue(iscsi_eh_timer_workq); | 379 | flush_workqueue(iscsi_eh_timer_workq); |
| 276 | scsi_target_unblock(&session->dev); | 380 | scsi_target_unblock(&session->dev); |
| 277 | } | 381 | } |
| 382 | |||
| 383 | void iscsi_unblock_session(struct iscsi_cls_session *session) | ||
| 384 | { | ||
| 385 | struct Scsi_Host *shost = iscsi_session_to_shost(session); | ||
| 386 | struct iscsi_host *ihost = shost->shost_data; | ||
| 387 | unsigned long flags; | ||
| 388 | |||
| 389 | spin_lock_irqsave(&session->lock, flags); | ||
| 390 | session->state = ISCSI_SESSION_LOGGED_IN; | ||
| 391 | spin_unlock_irqrestore(&session->lock, flags); | ||
| 392 | |||
| 393 | __iscsi_unblock_session(session); | ||
| 394 | /* | ||
| 395 | * Only do kernel scanning if the driver is properly hooked into | ||
| 396 | * the async scanning code (drivers like iscsi_tcp do login and | ||
| 397 | * scanning from userspace). | ||
| 398 | */ | ||
| 399 | if (shost->hostt->scan_finished) { | ||
| 400 | if (queue_work(ihost->scan_workq, &session->scan_work)) | ||
| 401 | atomic_inc(&ihost->nr_scans); | ||
| 402 | } | ||
| 403 | } | ||
| 278 | EXPORT_SYMBOL_GPL(iscsi_unblock_session); | 404 | EXPORT_SYMBOL_GPL(iscsi_unblock_session); |
| 279 | 405 | ||
| 280 | void iscsi_block_session(struct iscsi_cls_session *session) | 406 | void iscsi_block_session(struct iscsi_cls_session *session) |
| 281 | { | 407 | { |
| 408 | unsigned long flags; | ||
| 409 | |||
| 410 | spin_lock_irqsave(&session->lock, flags); | ||
| 411 | session->state = ISCSI_SESSION_FAILED; | ||
| 412 | spin_unlock_irqrestore(&session->lock, flags); | ||
| 413 | |||
| 282 | scsi_target_block(&session->dev); | 414 | scsi_target_block(&session->dev); |
| 283 | queue_delayed_work(iscsi_eh_timer_workq, &session->recovery_work, | 415 | queue_delayed_work(iscsi_eh_timer_workq, &session->recovery_work, |
| 284 | session->recovery_tmo * HZ); | 416 | session->recovery_tmo * HZ); |
| @@ -311,7 +443,7 @@ static int iscsi_unbind_session(struct iscsi_cls_session *session) | |||
| 311 | struct Scsi_Host *shost = iscsi_session_to_shost(session); | 443 | struct Scsi_Host *shost = iscsi_session_to_shost(session); |
| 312 | struct iscsi_host *ihost = shost->shost_data; | 444 | struct iscsi_host *ihost = shost->shost_data; |
| 313 | 445 | ||
| 314 | return queue_work(ihost->unbind_workq, &session->unbind_work); | 446 | return queue_work(ihost->scan_workq, &session->unbind_work); |
| 315 | } | 447 | } |
| 316 | 448 | ||
| 317 | struct iscsi_cls_session * | 449 | struct iscsi_cls_session * |
| @@ -327,10 +459,13 @@ iscsi_alloc_session(struct Scsi_Host *shost, | |||
| 327 | 459 | ||
| 328 | session->transport = transport; | 460 | session->transport = transport; |
| 329 | session->recovery_tmo = 120; | 461 | session->recovery_tmo = 120; |
| 462 | session->state = ISCSI_SESSION_FREE; | ||
| 330 | INIT_DELAYED_WORK(&session->recovery_work, session_recovery_timedout); | 463 | INIT_DELAYED_WORK(&session->recovery_work, session_recovery_timedout); |
| 331 | INIT_LIST_HEAD(&session->host_list); | 464 | INIT_LIST_HEAD(&session->host_list); |
| 332 | INIT_LIST_HEAD(&session->sess_list); | 465 | INIT_LIST_HEAD(&session->sess_list); |
| 333 | INIT_WORK(&session->unbind_work, __iscsi_unbind_session); | 466 | INIT_WORK(&session->unbind_work, __iscsi_unbind_session); |
| 467 | INIT_WORK(&session->scan_work, iscsi_scan_session); | ||
| 468 | spin_lock_init(&session->lock); | ||
| 334 | 469 | ||
| 335 | /* this is released in the dev's release function */ | 470 | /* this is released in the dev's release function */ |
| 336 | scsi_host_get(shost); | 471 | scsi_host_get(shost); |
| @@ -358,8 +493,8 @@ int iscsi_add_session(struct iscsi_cls_session *session, unsigned int target_id) | |||
| 358 | session->sid); | 493 | session->sid); |
| 359 | err = device_add(&session->dev); | 494 | err = device_add(&session->dev); |
| 360 | if (err) { | 495 | if (err) { |
| 361 | dev_printk(KERN_ERR, &session->dev, "iscsi: could not " | 496 | iscsi_cls_session_printk(KERN_ERR, session, |
| 362 | "register session's dev\n"); | 497 | "could not register session's dev\n"); |
| 363 | goto release_host; | 498 | goto release_host; |
| 364 | } | 499 | } |
| 365 | transport_register_device(&session->dev); | 500 | transport_register_device(&session->dev); |
| @@ -444,22 +579,28 @@ void iscsi_remove_session(struct iscsi_cls_session *session) | |||
| 444 | * If we are blocked let commands flow again. The lld or iscsi | 579 | * If we are blocked let commands flow again. The lld or iscsi |
| 445 | * layer should set up the queuecommand to fail commands. | 580 | * layer should set up the queuecommand to fail commands. |
| 446 | */ | 581 | */ |
| 447 | iscsi_unblock_session(session); | 582 | spin_lock_irqsave(&session->lock, flags); |
| 448 | iscsi_unbind_session(session); | 583 | session->state = ISCSI_SESSION_FREE; |
| 584 | spin_unlock_irqrestore(&session->lock, flags); | ||
| 585 | __iscsi_unblock_session(session); | ||
| 586 | __iscsi_unbind_session(&session->unbind_work); | ||
| 587 | |||
| 588 | /* flush running scans */ | ||
| 589 | flush_workqueue(ihost->scan_workq); | ||
| 449 | /* | 590 | /* |
| 450 | * If the session dropped while removing devices then we need to make | 591 | * If the session dropped while removing devices then we need to make |
| 451 | * sure it is not blocked | 592 | * sure it is not blocked |
| 452 | */ | 593 | */ |
| 453 | if (!cancel_delayed_work(&session->recovery_work)) | 594 | if (!cancel_delayed_work(&session->recovery_work)) |
| 454 | flush_workqueue(iscsi_eh_timer_workq); | 595 | flush_workqueue(iscsi_eh_timer_workq); |
| 455 | flush_workqueue(ihost->unbind_workq); | ||
| 456 | 596 | ||
| 457 | /* hw iscsi may not have removed all connections from session */ | 597 | /* hw iscsi may not have removed all connections from session */ |
| 458 | err = device_for_each_child(&session->dev, NULL, | 598 | err = device_for_each_child(&session->dev, NULL, |
| 459 | iscsi_iter_destroy_conn_fn); | 599 | iscsi_iter_destroy_conn_fn); |
| 460 | if (err) | 600 | if (err) |
| 461 | dev_printk(KERN_ERR, &session->dev, "iscsi: Could not delete " | 601 | iscsi_cls_session_printk(KERN_ERR, session, |
| 462 | "all connections for session. Error %d.\n", err); | 602 | "Could not delete all connections " |
| 603 | "for session. Error %d.\n", err); | ||
| 463 | 604 | ||
| 464 | transport_unregister_device(&session->dev); | 605 | transport_unregister_device(&session->dev); |
| 465 | device_del(&session->dev); | 606 | device_del(&session->dev); |
| @@ -531,8 +672,8 @@ iscsi_create_conn(struct iscsi_cls_session *session, uint32_t cid) | |||
| 531 | conn->dev.release = iscsi_conn_release; | 672 | conn->dev.release = iscsi_conn_release; |
| 532 | err = device_register(&conn->dev); | 673 | err = device_register(&conn->dev); |
| 533 | if (err) { | 674 | if (err) { |
| 534 | dev_printk(KERN_ERR, &conn->dev, "iscsi: could not register " | 675 | iscsi_cls_session_printk(KERN_ERR, session, "could not " |
| 535 | "connection's dev\n"); | 676 | "register connection's dev\n"); |
| 536 | goto release_parent_ref; | 677 | goto release_parent_ref; |
| 537 | } | 678 | } |
| 538 | transport_register_device(&conn->dev); | 679 | transport_register_device(&conn->dev); |
| @@ -639,8 +780,8 @@ int iscsi_recv_pdu(struct iscsi_cls_conn *conn, struct iscsi_hdr *hdr, | |||
| 639 | skb = alloc_skb(len, GFP_ATOMIC); | 780 | skb = alloc_skb(len, GFP_ATOMIC); |
| 640 | if (!skb) { | 781 | if (!skb) { |
| 641 | iscsi_conn_error(conn, ISCSI_ERR_CONN_FAILED); | 782 | iscsi_conn_error(conn, ISCSI_ERR_CONN_FAILED); |
| 642 | dev_printk(KERN_ERR, &conn->dev, "iscsi: can not deliver " | 783 | iscsi_cls_conn_printk(KERN_ERR, conn, "can not deliver " |
| 643 | "control PDU: OOM\n"); | 784 | "control PDU: OOM\n"); |
| 644 | return -ENOMEM; | 785 | return -ENOMEM; |
| 645 | } | 786 | } |
| 646 | 787 | ||
| @@ -661,20 +802,27 @@ EXPORT_SYMBOL_GPL(iscsi_recv_pdu); | |||
| 661 | 802 | ||
| 662 | void iscsi_conn_error(struct iscsi_cls_conn *conn, enum iscsi_err error) | 803 | void iscsi_conn_error(struct iscsi_cls_conn *conn, enum iscsi_err error) |
| 663 | { | 804 | { |
| 805 | struct iscsi_cls_session *session = iscsi_conn_to_session(conn); | ||
| 664 | struct nlmsghdr *nlh; | 806 | struct nlmsghdr *nlh; |
| 665 | struct sk_buff *skb; | 807 | struct sk_buff *skb; |
| 666 | struct iscsi_uevent *ev; | 808 | struct iscsi_uevent *ev; |
| 667 | struct iscsi_internal *priv; | 809 | struct iscsi_internal *priv; |
| 668 | int len = NLMSG_SPACE(sizeof(*ev)); | 810 | int len = NLMSG_SPACE(sizeof(*ev)); |
| 811 | unsigned long flags; | ||
| 669 | 812 | ||
| 670 | priv = iscsi_if_transport_lookup(conn->transport); | 813 | priv = iscsi_if_transport_lookup(conn->transport); |
| 671 | if (!priv) | 814 | if (!priv) |
| 672 | return; | 815 | return; |
| 673 | 816 | ||
| 817 | spin_lock_irqsave(&session->lock, flags); | ||
| 818 | if (session->state == ISCSI_SESSION_LOGGED_IN) | ||
| 819 | session->state = ISCSI_SESSION_FAILED; | ||
| 820 | spin_unlock_irqrestore(&session->lock, flags); | ||
| 821 | |||
| 674 | skb = alloc_skb(len, GFP_ATOMIC); | 822 | skb = alloc_skb(len, GFP_ATOMIC); |
| 675 | if (!skb) { | 823 | if (!skb) { |
| 676 | dev_printk(KERN_ERR, &conn->dev, "iscsi: gracefully ignored " | 824 | iscsi_cls_conn_printk(KERN_ERR, conn, "gracefully ignored " |
| 677 | "conn error (%d)\n", error); | 825 | "conn error (%d)\n", error); |
| 678 | return; | 826 | return; |
| 679 | } | 827 | } |
| 680 | 828 | ||
| @@ -688,8 +836,8 @@ void iscsi_conn_error(struct iscsi_cls_conn *conn, enum iscsi_err error) | |||
| 688 | 836 | ||
| 689 | iscsi_broadcast_skb(skb, GFP_ATOMIC); | 837 | iscsi_broadcast_skb(skb, GFP_ATOMIC); |
| 690 | 838 | ||
| 691 | dev_printk(KERN_INFO, &conn->dev, "iscsi: detected conn error (%d)\n", | 839 | iscsi_cls_conn_printk(KERN_INFO, conn, "detected conn error (%d)\n", |
| 692 | error); | 840 | error); |
| 693 | } | 841 | } |
| 694 | EXPORT_SYMBOL_GPL(iscsi_conn_error); | 842 | EXPORT_SYMBOL_GPL(iscsi_conn_error); |
| 695 | 843 | ||
| @@ -744,8 +892,8 @@ iscsi_if_get_stats(struct iscsi_transport *transport, struct nlmsghdr *nlh) | |||
| 744 | 892 | ||
| 745 | skbstat = alloc_skb(len, GFP_ATOMIC); | 893 | skbstat = alloc_skb(len, GFP_ATOMIC); |
| 746 | if (!skbstat) { | 894 | if (!skbstat) { |
| 747 | dev_printk(KERN_ERR, &conn->dev, "iscsi: can not " | 895 | iscsi_cls_conn_printk(KERN_ERR, conn, "can not " |
| 748 | "deliver stats: OOM\n"); | 896 | "deliver stats: OOM\n"); |
| 749 | return -ENOMEM; | 897 | return -ENOMEM; |
| 750 | } | 898 | } |
| 751 | 899 | ||
| @@ -801,8 +949,9 @@ int iscsi_session_event(struct iscsi_cls_session *session, | |||
| 801 | 949 | ||
| 802 | skb = alloc_skb(len, GFP_KERNEL); | 950 | skb = alloc_skb(len, GFP_KERNEL); |
| 803 | if (!skb) { | 951 | if (!skb) { |
| 804 | dev_printk(KERN_ERR, &session->dev, "Cannot notify userspace " | 952 | iscsi_cls_session_printk(KERN_ERR, session, |
| 805 | "of session event %u\n", event); | 953 | "Cannot notify userspace of session " |
| 954 | "event %u\n", event); | ||
| 806 | return -ENOMEM; | 955 | return -ENOMEM; |
| 807 | } | 956 | } |
| 808 | 957 | ||
| @@ -825,8 +974,8 @@ int iscsi_session_event(struct iscsi_cls_session *session, | |||
| 825 | ev->r.unbind_session.sid = session->sid; | 974 | ev->r.unbind_session.sid = session->sid; |
| 826 | break; | 975 | break; |
| 827 | default: | 976 | default: |
| 828 | dev_printk(KERN_ERR, &session->dev, "Invalid event %u.\n", | 977 | iscsi_cls_session_printk(KERN_ERR, session, "Invalid event " |
| 829 | event); | 978 | "%u.\n", event); |
| 830 | kfree_skb(skb); | 979 | kfree_skb(skb); |
| 831 | return -EINVAL; | 980 | return -EINVAL; |
| 832 | } | 981 | } |
| @@ -837,8 +986,10 @@ int iscsi_session_event(struct iscsi_cls_session *session, | |||
| 837 | */ | 986 | */ |
| 838 | rc = iscsi_broadcast_skb(skb, GFP_KERNEL); | 987 | rc = iscsi_broadcast_skb(skb, GFP_KERNEL); |
| 839 | if (rc < 0) | 988 | if (rc < 0) |
| 840 | dev_printk(KERN_ERR, &session->dev, "Cannot notify userspace " | 989 | iscsi_cls_session_printk(KERN_ERR, session, |
| 841 | "of session event %u. Check iscsi daemon\n", event); | 990 | "Cannot notify userspace of session " |
| 991 | "event %u. Check iscsi daemon\n", | ||
| 992 | event); | ||
| 842 | return rc; | 993 | return rc; |
| 843 | } | 994 | } |
| 844 | EXPORT_SYMBOL_GPL(iscsi_session_event); | 995 | EXPORT_SYMBOL_GPL(iscsi_session_event); |
| @@ -871,16 +1022,15 @@ iscsi_if_create_conn(struct iscsi_transport *transport, struct iscsi_uevent *ev) | |||
| 871 | 1022 | ||
| 872 | session = iscsi_session_lookup(ev->u.c_conn.sid); | 1023 | session = iscsi_session_lookup(ev->u.c_conn.sid); |
| 873 | if (!session) { | 1024 | if (!session) { |
| 874 | printk(KERN_ERR "iscsi: invalid session %d\n", | 1025 | printk(KERN_ERR "iscsi: invalid session %d.\n", |
| 875 | ev->u.c_conn.sid); | 1026 | ev->u.c_conn.sid); |
| 876 | return -EINVAL; | 1027 | return -EINVAL; |
| 877 | } | 1028 | } |
| 878 | 1029 | ||
| 879 | conn = transport->create_conn(session, ev->u.c_conn.cid); | 1030 | conn = transport->create_conn(session, ev->u.c_conn.cid); |
| 880 | if (!conn) { | 1031 | if (!conn) { |
| 881 | printk(KERN_ERR "iscsi: couldn't create a new " | 1032 | iscsi_cls_session_printk(KERN_ERR, session, |
| 882 | "connection for session %d\n", | 1033 | "couldn't create a new connection."); |
| 883 | session->sid); | ||
| 884 | return -ENOMEM; | 1034 | return -ENOMEM; |
| 885 | } | 1035 | } |
| 886 | 1036 | ||
| @@ -1246,6 +1396,15 @@ iscsi_session_attr(fast_abort, ISCSI_PARAM_FAST_ABORT, 0); | |||
| 1246 | iscsi_session_attr(abort_tmo, ISCSI_PARAM_ABORT_TMO, 0); | 1396 | iscsi_session_attr(abort_tmo, ISCSI_PARAM_ABORT_TMO, 0); |
| 1247 | iscsi_session_attr(lu_reset_tmo, ISCSI_PARAM_LU_RESET_TMO, 0); | 1397 | iscsi_session_attr(lu_reset_tmo, ISCSI_PARAM_LU_RESET_TMO, 0); |
| 1248 | 1398 | ||
| 1399 | static ssize_t | ||
| 1400 | show_priv_session_state(struct class_device *cdev, char *buf) | ||
| 1401 | { | ||
| 1402 | struct iscsi_cls_session *session = iscsi_cdev_to_session(cdev); | ||
| 1403 | return sprintf(buf, "%s\n", iscsi_session_state_name(session->state)); | ||
| 1404 | } | ||
| 1405 | static ISCSI_CLASS_ATTR(priv_sess, state, S_IRUGO, show_priv_session_state, | ||
| 1406 | NULL); | ||
| 1407 | |||
| 1249 | #define iscsi_priv_session_attr_show(field, format) \ | 1408 | #define iscsi_priv_session_attr_show(field, format) \ |
| 1250 | static ssize_t \ | 1409 | static ssize_t \ |
| 1251 | show_priv_session_##field(struct class_device *cdev, char *buf) \ | 1410 | show_priv_session_##field(struct class_device *cdev, char *buf) \ |
| @@ -1472,6 +1631,7 @@ iscsi_register_transport(struct iscsi_transport *tt) | |||
| 1472 | SETUP_SESSION_RD_ATTR(abort_tmo, ISCSI_ABORT_TMO); | 1631 | SETUP_SESSION_RD_ATTR(abort_tmo, ISCSI_ABORT_TMO); |
| 1473 | SETUP_SESSION_RD_ATTR(lu_reset_tmo,ISCSI_LU_RESET_TMO); | 1632 | SETUP_SESSION_RD_ATTR(lu_reset_tmo,ISCSI_LU_RESET_TMO); |
| 1474 | SETUP_PRIV_SESSION_RD_ATTR(recovery_tmo); | 1633 | SETUP_PRIV_SESSION_RD_ATTR(recovery_tmo); |
| 1634 | SETUP_PRIV_SESSION_RD_ATTR(state); | ||
| 1475 | 1635 | ||
| 1476 | BUG_ON(count > ISCSI_SESSION_ATTRS); | 1636 | BUG_ON(count > ISCSI_SESSION_ATTRS); |
| 1477 | priv->session_attrs[count] = NULL; | 1637 | priv->session_attrs[count] = NULL; |
diff --git a/drivers/scsi/sd.c b/drivers/scsi/sd.c index 51a5557f42dd..37df8bbe7f46 100644 --- a/drivers/scsi/sd.c +++ b/drivers/scsi/sd.c | |||
| @@ -929,6 +929,7 @@ static int sd_done(struct scsi_cmnd *SCpnt) | |||
| 929 | unsigned int xfer_size = scsi_bufflen(SCpnt); | 929 | unsigned int xfer_size = scsi_bufflen(SCpnt); |
| 930 | unsigned int good_bytes = result ? 0 : xfer_size; | 930 | unsigned int good_bytes = result ? 0 : xfer_size; |
| 931 | u64 start_lba = SCpnt->request->sector; | 931 | u64 start_lba = SCpnt->request->sector; |
| 932 | u64 end_lba = SCpnt->request->sector + (xfer_size / 512); | ||
| 932 | u64 bad_lba; | 933 | u64 bad_lba; |
| 933 | struct scsi_sense_hdr sshdr; | 934 | struct scsi_sense_hdr sshdr; |
| 934 | int sense_valid = 0; | 935 | int sense_valid = 0; |
| @@ -967,26 +968,23 @@ static int sd_done(struct scsi_cmnd *SCpnt) | |||
| 967 | goto out; | 968 | goto out; |
| 968 | if (xfer_size <= SCpnt->device->sector_size) | 969 | if (xfer_size <= SCpnt->device->sector_size) |
| 969 | goto out; | 970 | goto out; |
| 970 | switch (SCpnt->device->sector_size) { | 971 | if (SCpnt->device->sector_size < 512) { |
| 971 | case 256: | 972 | /* only legitimate sector_size here is 256 */ |
| 972 | start_lba <<= 1; | 973 | start_lba <<= 1; |
| 973 | break; | 974 | end_lba <<= 1; |
| 974 | case 512: | 975 | } else { |
| 975 | break; | 976 | /* be careful ... don't want any overflows */ |
| 976 | case 1024: | 977 | u64 factor = SCpnt->device->sector_size / 512; |
| 977 | start_lba >>= 1; | 978 | do_div(start_lba, factor); |
| 978 | break; | 979 | do_div(end_lba, factor); |
| 979 | case 2048: | ||
| 980 | start_lba >>= 2; | ||
| 981 | break; | ||
| 982 | case 4096: | ||
| 983 | start_lba >>= 3; | ||
| 984 | break; | ||
| 985 | default: | ||
| 986 | /* Print something here with limiting frequency. */ | ||
| 987 | goto out; | ||
| 988 | break; | ||
| 989 | } | 980 | } |
| 981 | |||
| 982 | if (bad_lba < start_lba || bad_lba >= end_lba) | ||
| 983 | /* the bad lba was reported incorrectly, we have | ||
| 984 | * no idea where the error is | ||
| 985 | */ | ||
| 986 | goto out; | ||
| 987 | |||
| 990 | /* This computation should always be done in terms of | 988 | /* This computation should always be done in terms of |
| 991 | * the resolution of the device's medium. | 989 | * the resolution of the device's medium. |
| 992 | */ | 990 | */ |
diff --git a/drivers/scsi/ses.c b/drivers/scsi/ses.c new file mode 100644 index 000000000000..2a6e4f472eaa --- /dev/null +++ b/drivers/scsi/ses.c | |||
| @@ -0,0 +1,689 @@ | |||
| 1 | /* | ||
| 2 | * SCSI Enclosure Services | ||
| 3 | * | ||
| 4 | * Copyright (C) 2008 James Bottomley <James.Bottomley@HansenPartnership.com> | ||
| 5 | * | ||
| 6 | **----------------------------------------------------------------------------- | ||
| 7 | ** | ||
| 8 | ** This program is free software; you can redistribute it and/or | ||
| 9 | ** modify it under the terms of the GNU General Public License | ||
| 10 | ** version 2 as published by the Free Software Foundation. | ||
| 11 | ** | ||
| 12 | ** This program is distributed in the hope that it will be useful, | ||
| 13 | ** but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 14 | ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 15 | ** GNU General Public License for more details. | ||
| 16 | ** | ||
| 17 | ** You should have received a copy of the GNU General Public License | ||
| 18 | ** along with this program; if not, write to the Free Software | ||
| 19 | ** Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
| 20 | ** | ||
| 21 | **----------------------------------------------------------------------------- | ||
| 22 | */ | ||
| 23 | |||
| 24 | #include <linux/module.h> | ||
| 25 | #include <linux/kernel.h> | ||
| 26 | #include <linux/enclosure.h> | ||
| 27 | |||
| 28 | #include <scsi/scsi.h> | ||
| 29 | #include <scsi/scsi_cmnd.h> | ||
| 30 | #include <scsi/scsi_dbg.h> | ||
| 31 | #include <scsi/scsi_device.h> | ||
| 32 | #include <scsi/scsi_driver.h> | ||
| 33 | #include <scsi/scsi_host.h> | ||
| 34 | |||
| 35 | struct ses_device { | ||
| 36 | char *page1; | ||
| 37 | char *page2; | ||
| 38 | char *page10; | ||
| 39 | short page1_len; | ||
| 40 | short page2_len; | ||
| 41 | short page10_len; | ||
| 42 | }; | ||
| 43 | |||
| 44 | struct ses_component { | ||
| 45 | u64 addr; | ||
| 46 | unsigned char *desc; | ||
| 47 | }; | ||
| 48 | |||
| 49 | static int ses_probe(struct device *dev) | ||
| 50 | { | ||
| 51 | struct scsi_device *sdev = to_scsi_device(dev); | ||
| 52 | int err = -ENODEV; | ||
| 53 | |||
| 54 | if (sdev->type != TYPE_ENCLOSURE) | ||
| 55 | goto out; | ||
| 56 | |||
| 57 | err = 0; | ||
| 58 | sdev_printk(KERN_NOTICE, sdev, "Attached Enclosure device\n"); | ||
| 59 | |||
| 60 | out: | ||
| 61 | return err; | ||
| 62 | } | ||
| 63 | |||
| 64 | #define SES_TIMEOUT 30 | ||
| 65 | #define SES_RETRIES 3 | ||
| 66 | |||
| 67 | static int ses_recv_diag(struct scsi_device *sdev, int page_code, | ||
| 68 | void *buf, int bufflen) | ||
| 69 | { | ||
| 70 | char cmd[] = { | ||
| 71 | RECEIVE_DIAGNOSTIC, | ||
| 72 | 1, /* Set PCV bit */ | ||
| 73 | page_code, | ||
| 74 | bufflen >> 8, | ||
| 75 | bufflen & 0xff, | ||
| 76 | 0 | ||
| 77 | }; | ||
| 78 | |||
| 79 | return scsi_execute_req(sdev, cmd, DMA_FROM_DEVICE, buf, bufflen, | ||
| 80 | NULL, SES_TIMEOUT, SES_RETRIES); | ||
| 81 | } | ||
| 82 | |||
| 83 | static int ses_send_diag(struct scsi_device *sdev, int page_code, | ||
| 84 | void *buf, int bufflen) | ||
| 85 | { | ||
| 86 | u32 result; | ||
| 87 | |||
| 88 | char cmd[] = { | ||
| 89 | SEND_DIAGNOSTIC, | ||
| 90 | 0x10, /* Set PF bit */ | ||
| 91 | 0, | ||
| 92 | bufflen >> 8, | ||
| 93 | bufflen & 0xff, | ||
| 94 | 0 | ||
| 95 | }; | ||
| 96 | |||
| 97 | result = scsi_execute_req(sdev, cmd, DMA_TO_DEVICE, buf, bufflen, | ||
| 98 | NULL, SES_TIMEOUT, SES_RETRIES); | ||
| 99 | if (result) | ||
| 100 | sdev_printk(KERN_ERR, sdev, "SEND DIAGNOSTIC result: %8x\n", | ||
| 101 | result); | ||
| 102 | return result; | ||
| 103 | } | ||
| 104 | |||
| 105 | static int ses_set_page2_descriptor(struct enclosure_device *edev, | ||
| 106 | struct enclosure_component *ecomp, | ||
| 107 | char *desc) | ||
| 108 | { | ||
| 109 | int i, j, count = 0, descriptor = ecomp->number; | ||
| 110 | struct scsi_device *sdev = to_scsi_device(edev->cdev.dev); | ||
| 111 | struct ses_device *ses_dev = edev->scratch; | ||
| 112 | char *type_ptr = ses_dev->page1 + 12 + ses_dev->page1[11]; | ||
| 113 | char *desc_ptr = ses_dev->page2 + 8; | ||
| 114 | |||
| 115 | /* Clear everything */ | ||
| 116 | memset(desc_ptr, 0, ses_dev->page2_len - 8); | ||
| 117 | for (i = 0; i < ses_dev->page1[10]; i++, type_ptr += 4) { | ||
| 118 | for (j = 0; j < type_ptr[1]; j++) { | ||
| 119 | desc_ptr += 4; | ||
| 120 | if (type_ptr[0] != ENCLOSURE_COMPONENT_DEVICE && | ||
| 121 | type_ptr[0] != ENCLOSURE_COMPONENT_ARRAY_DEVICE) | ||
| 122 | continue; | ||
| 123 | if (count++ == descriptor) { | ||
| 124 | memcpy(desc_ptr, desc, 4); | ||
| 125 | /* set select */ | ||
| 126 | desc_ptr[0] |= 0x80; | ||
| 127 | /* clear reserved, just in case */ | ||
| 128 | desc_ptr[0] &= 0xf0; | ||
| 129 | } | ||
| 130 | } | ||
| 131 | } | ||
| 132 | |||
| 133 | return ses_send_diag(sdev, 2, ses_dev->page2, ses_dev->page2_len); | ||
| 134 | } | ||
| 135 | |||
| 136 | static char *ses_get_page2_descriptor(struct enclosure_device *edev, | ||
| 137 | struct enclosure_component *ecomp) | ||
| 138 | { | ||
| 139 | int i, j, count = 0, descriptor = ecomp->number; | ||
| 140 | struct scsi_device *sdev = to_scsi_device(edev->cdev.dev); | ||
| 141 | struct ses_device *ses_dev = edev->scratch; | ||
| 142 | char *type_ptr = ses_dev->page1 + 12 + ses_dev->page1[11]; | ||
| 143 | char *desc_ptr = ses_dev->page2 + 8; | ||
| 144 | |||
| 145 | ses_recv_diag(sdev, 2, ses_dev->page2, ses_dev->page2_len); | ||
| 146 | |||
| 147 | for (i = 0; i < ses_dev->page1[10]; i++, type_ptr += 4) { | ||
| 148 | for (j = 0; j < type_ptr[1]; j++) { | ||
| 149 | desc_ptr += 4; | ||
| 150 | if (type_ptr[0] != ENCLOSURE_COMPONENT_DEVICE && | ||
| 151 | type_ptr[0] != ENCLOSURE_COMPONENT_ARRAY_DEVICE) | ||
| 152 | continue; | ||
| 153 | if (count++ == descriptor) | ||
| 154 | return desc_ptr; | ||
| 155 | } | ||
| 156 | } | ||
| 157 | return NULL; | ||
| 158 | } | ||
| 159 | |||
| 160 | static void ses_get_fault(struct enclosure_device *edev, | ||
| 161 | struct enclosure_component *ecomp) | ||
| 162 | { | ||
| 163 | char *desc; | ||
| 164 | |||
| 165 | desc = ses_get_page2_descriptor(edev, ecomp); | ||
| 166 | ecomp->fault = (desc[3] & 0x60) >> 4; | ||
| 167 | } | ||
| 168 | |||
| 169 | static int ses_set_fault(struct enclosure_device *edev, | ||
| 170 | struct enclosure_component *ecomp, | ||
| 171 | enum enclosure_component_setting val) | ||
| 172 | { | ||
| 173 | char desc[4] = {0 }; | ||
| 174 | |||
| 175 | switch (val) { | ||
| 176 | case ENCLOSURE_SETTING_DISABLED: | ||
| 177 | /* zero is disabled */ | ||
| 178 | break; | ||
| 179 | case ENCLOSURE_SETTING_ENABLED: | ||
| 180 | desc[2] = 0x02; | ||
| 181 | break; | ||
| 182 | default: | ||
| 183 | /* SES doesn't do the SGPIO blink settings */ | ||
| 184 | return -EINVAL; | ||
| 185 | } | ||
| 186 | |||
| 187 | return ses_set_page2_descriptor(edev, ecomp, desc); | ||
| 188 | } | ||
| 189 | |||
| 190 | static void ses_get_status(struct enclosure_device *edev, | ||
| 191 | struct enclosure_component *ecomp) | ||
| 192 | { | ||
| 193 | char *desc; | ||
| 194 | |||
| 195 | desc = ses_get_page2_descriptor(edev, ecomp); | ||
| 196 | ecomp->status = (desc[0] & 0x0f); | ||
| 197 | } | ||
| 198 | |||
| 199 | static void ses_get_locate(struct enclosure_device *edev, | ||
| 200 | struct enclosure_component *ecomp) | ||
| 201 | { | ||
| 202 | char *desc; | ||
| 203 | |||
| 204 | desc = ses_get_page2_descriptor(edev, ecomp); | ||
| 205 | ecomp->locate = (desc[2] & 0x02) ? 1 : 0; | ||
| 206 | } | ||
| 207 | |||
| 208 | static int ses_set_locate(struct enclosure_device *edev, | ||
| 209 | struct enclosure_component *ecomp, | ||
| 210 | enum enclosure_component_setting val) | ||
| 211 | { | ||
| 212 | char desc[4] = {0 }; | ||
| 213 | |||
| 214 | switch (val) { | ||
| 215 | case ENCLOSURE_SETTING_DISABLED: | ||
| 216 | /* zero is disabled */ | ||
| 217 | break; | ||
| 218 | case ENCLOSURE_SETTING_ENABLED: | ||
| 219 | desc[2] = 0x02; | ||
| 220 | break; | ||
| 221 | default: | ||
| 222 | /* SES doesn't do the SGPIO blink settings */ | ||
| 223 | return -EINVAL; | ||
| 224 | } | ||
| 225 | return ses_set_page2_descriptor(edev, ecomp, desc); | ||
| 226 | } | ||
| 227 | |||
| 228 | static int ses_set_active(struct enclosure_device *edev, | ||
| 229 | struct enclosure_component *ecomp, | ||
| 230 | enum enclosure_component_setting val) | ||
| 231 | { | ||
| 232 | char desc[4] = {0 }; | ||
| 233 | |||
| 234 | switch (val) { | ||
| 235 | case ENCLOSURE_SETTING_DISABLED: | ||
| 236 | /* zero is disabled */ | ||
| 237 | ecomp->active = 0; | ||
| 238 | break; | ||
| 239 | case ENCLOSURE_SETTING_ENABLED: | ||
| 240 | desc[2] = 0x80; | ||
| 241 | ecomp->active = 1; | ||
| 242 | break; | ||
| 243 | default: | ||
| 244 | /* SES doesn't do the SGPIO blink settings */ | ||
| 245 | return -EINVAL; | ||
| 246 | } | ||
| 247 | return ses_set_page2_descriptor(edev, ecomp, desc); | ||
| 248 | } | ||
| 249 | |||
| 250 | static struct enclosure_component_callbacks ses_enclosure_callbacks = { | ||
| 251 | .get_fault = ses_get_fault, | ||
| 252 | .set_fault = ses_set_fault, | ||
| 253 | .get_status = ses_get_status, | ||
| 254 | .get_locate = ses_get_locate, | ||
| 255 | .set_locate = ses_set_locate, | ||
| 256 | .set_active = ses_set_active, | ||
| 257 | }; | ||
| 258 | |||
| 259 | struct ses_host_edev { | ||
| 260 | struct Scsi_Host *shost; | ||
| 261 | struct enclosure_device *edev; | ||
| 262 | }; | ||
| 263 | |||
| 264 | int ses_match_host(struct enclosure_device *edev, void *data) | ||
| 265 | { | ||
| 266 | struct ses_host_edev *sed = data; | ||
| 267 | struct scsi_device *sdev; | ||
| 268 | |||
| 269 | if (!scsi_is_sdev_device(edev->cdev.dev)) | ||
| 270 | return 0; | ||
| 271 | |||
| 272 | sdev = to_scsi_device(edev->cdev.dev); | ||
| 273 | |||
| 274 | if (sdev->host != sed->shost) | ||
| 275 | return 0; | ||
| 276 | |||
| 277 | sed->edev = edev; | ||
| 278 | return 1; | ||
| 279 | } | ||
| 280 | |||
| 281 | static void ses_process_descriptor(struct enclosure_component *ecomp, | ||
| 282 | unsigned char *desc) | ||
| 283 | { | ||
| 284 | int eip = desc[0] & 0x10; | ||
| 285 | int invalid = desc[0] & 0x80; | ||
| 286 | enum scsi_protocol proto = desc[0] & 0x0f; | ||
| 287 | u64 addr = 0; | ||
| 288 | struct ses_component *scomp = ecomp->scratch; | ||
| 289 | unsigned char *d; | ||
| 290 | |||
| 291 | scomp->desc = desc; | ||
| 292 | |||
| 293 | if (invalid) | ||
| 294 | return; | ||
| 295 | |||
| 296 | switch (proto) { | ||
| 297 | case SCSI_PROTOCOL_SAS: | ||
| 298 | if (eip) | ||
| 299 | d = desc + 8; | ||
| 300 | else | ||
| 301 | d = desc + 4; | ||
| 302 | /* only take the phy0 addr */ | ||
| 303 | addr = (u64)d[12] << 56 | | ||
| 304 | (u64)d[13] << 48 | | ||
| 305 | (u64)d[14] << 40 | | ||
| 306 | (u64)d[15] << 32 | | ||
| 307 | (u64)d[16] << 24 | | ||
| 308 | (u64)d[17] << 16 | | ||
| 309 | (u64)d[18] << 8 | | ||
| 310 | (u64)d[19]; | ||
| 311 | break; | ||
| 312 | default: | ||
| 313 | /* FIXME: Need to add more protocols than just SAS */ | ||
| 314 | break; | ||
| 315 | } | ||
| 316 | scomp->addr = addr; | ||
| 317 | } | ||
| 318 | |||
| 319 | struct efd { | ||
| 320 | u64 addr; | ||
| 321 | struct device *dev; | ||
| 322 | }; | ||
| 323 | |||
| 324 | static int ses_enclosure_find_by_addr(struct enclosure_device *edev, | ||
| 325 | void *data) | ||
| 326 | { | ||
| 327 | struct efd *efd = data; | ||
| 328 | int i; | ||
| 329 | struct ses_component *scomp; | ||
| 330 | |||
| 331 | if (!edev->component[0].scratch) | ||
| 332 | return 0; | ||
| 333 | |||
| 334 | for (i = 0; i < edev->components; i++) { | ||
| 335 | scomp = edev->component[i].scratch; | ||
| 336 | if (scomp->addr != efd->addr) | ||
| 337 | continue; | ||
| 338 | |||
| 339 | enclosure_add_device(edev, i, efd->dev); | ||
| 340 | return 1; | ||
| 341 | } | ||
| 342 | return 0; | ||
| 343 | } | ||
| 344 | |||
| 345 | #define VPD_INQUIRY_SIZE 512 | ||
| 346 | |||
| 347 | static void ses_match_to_enclosure(struct enclosure_device *edev, | ||
| 348 | struct scsi_device *sdev) | ||
| 349 | { | ||
| 350 | unsigned char *buf = kmalloc(VPD_INQUIRY_SIZE, GFP_KERNEL); | ||
| 351 | unsigned char *desc; | ||
| 352 | int len; | ||
| 353 | struct efd efd = { | ||
| 354 | .addr = 0, | ||
| 355 | }; | ||
| 356 | unsigned char cmd[] = { | ||
| 357 | INQUIRY, | ||
| 358 | 1, | ||
| 359 | 0x83, | ||
| 360 | VPD_INQUIRY_SIZE >> 8, | ||
| 361 | VPD_INQUIRY_SIZE & 0xff, | ||
| 362 | 0 | ||
| 363 | }; | ||
| 364 | |||
| 365 | if (!buf) | ||
| 366 | return; | ||
| 367 | |||
| 368 | if (scsi_execute_req(sdev, cmd, DMA_FROM_DEVICE, buf, | ||
| 369 | VPD_INQUIRY_SIZE, NULL, SES_TIMEOUT, SES_RETRIES)) | ||
| 370 | goto free; | ||
| 371 | |||
| 372 | len = (buf[2] << 8) + buf[3]; | ||
| 373 | desc = buf + 4; | ||
| 374 | while (desc < buf + len) { | ||
| 375 | enum scsi_protocol proto = desc[0] >> 4; | ||
| 376 | u8 code_set = desc[0] & 0x0f; | ||
| 377 | u8 piv = desc[1] & 0x80; | ||
| 378 | u8 assoc = (desc[1] & 0x30) >> 4; | ||
| 379 | u8 type = desc[1] & 0x0f; | ||
| 380 | u8 len = desc[3]; | ||
| 381 | |||
| 382 | if (piv && code_set == 1 && assoc == 1 && code_set == 1 | ||
| 383 | && proto == SCSI_PROTOCOL_SAS && type == 3 && len == 8) | ||
| 384 | efd.addr = (u64)desc[4] << 56 | | ||
| 385 | (u64)desc[5] << 48 | | ||
| 386 | (u64)desc[6] << 40 | | ||
| 387 | (u64)desc[7] << 32 | | ||
| 388 | (u64)desc[8] << 24 | | ||
| 389 | (u64)desc[9] << 16 | | ||
| 390 | (u64)desc[10] << 8 | | ||
| 391 | (u64)desc[11]; | ||
| 392 | |||
| 393 | desc += len + 4; | ||
| 394 | } | ||
| 395 | if (!efd.addr) | ||
| 396 | goto free; | ||
| 397 | |||
| 398 | efd.dev = &sdev->sdev_gendev; | ||
| 399 | |||
| 400 | enclosure_for_each_device(ses_enclosure_find_by_addr, &efd); | ||
| 401 | free: | ||
| 402 | kfree(buf); | ||
| 403 | } | ||
| 404 | |||
| 405 | #define INIT_ALLOC_SIZE 32 | ||
| 406 | |||
| 407 | static int ses_intf_add(struct class_device *cdev, | ||
| 408 | struct class_interface *intf) | ||
| 409 | { | ||
| 410 | struct scsi_device *sdev = to_scsi_device(cdev->dev); | ||
| 411 | struct scsi_device *tmp_sdev; | ||
| 412 | unsigned char *buf = NULL, *hdr_buf, *type_ptr, *desc_ptr, | ||
| 413 | *addl_desc_ptr; | ||
| 414 | struct ses_device *ses_dev; | ||
| 415 | u32 result; | ||
| 416 | int i, j, types, len, components = 0; | ||
| 417 | int err = -ENOMEM; | ||
| 418 | struct enclosure_device *edev; | ||
| 419 | struct ses_component *scomp; | ||
| 420 | |||
| 421 | if (!scsi_device_enclosure(sdev)) { | ||
| 422 | /* not an enclosure, but might be in one */ | ||
| 423 | edev = enclosure_find(&sdev->host->shost_gendev); | ||
| 424 | if (edev) { | ||
| 425 | ses_match_to_enclosure(edev, sdev); | ||
| 426 | class_device_put(&edev->cdev); | ||
| 427 | } | ||
| 428 | return -ENODEV; | ||
| 429 | } | ||
| 430 | |||
| 431 | /* TYPE_ENCLOSURE prints a message in probe */ | ||
| 432 | if (sdev->type != TYPE_ENCLOSURE) | ||
| 433 | sdev_printk(KERN_NOTICE, sdev, "Embedded Enclosure Device\n"); | ||
| 434 | |||
| 435 | ses_dev = kzalloc(sizeof(*ses_dev), GFP_KERNEL); | ||
| 436 | hdr_buf = kzalloc(INIT_ALLOC_SIZE, GFP_KERNEL); | ||
| 437 | if (!hdr_buf || !ses_dev) | ||
| 438 | goto err_init_free; | ||
| 439 | |||
| 440 | result = ses_recv_diag(sdev, 1, hdr_buf, INIT_ALLOC_SIZE); | ||
| 441 | if (result) | ||
| 442 | goto recv_failed; | ||
| 443 | |||
| 444 | if (hdr_buf[1] != 0) { | ||
| 445 | /* FIXME: need subenclosure support; I've just never | ||
| 446 | * seen a device with subenclosures and it makes the | ||
| 447 | * traversal routines more complex */ | ||
| 448 | sdev_printk(KERN_ERR, sdev, | ||
| 449 | "FIXME driver has no support for subenclosures (%d)\n", | ||
| 450 | buf[1]); | ||
| 451 | goto err_free; | ||
| 452 | } | ||
| 453 | |||
| 454 | len = (hdr_buf[2] << 8) + hdr_buf[3] + 4; | ||
| 455 | buf = kzalloc(len, GFP_KERNEL); | ||
| 456 | if (!buf) | ||
| 457 | goto err_free; | ||
| 458 | |||
| 459 | ses_dev->page1 = buf; | ||
| 460 | ses_dev->page1_len = len; | ||
| 461 | |||
| 462 | result = ses_recv_diag(sdev, 1, buf, len); | ||
| 463 | if (result) | ||
| 464 | goto recv_failed; | ||
| 465 | |||
| 466 | types = buf[10]; | ||
| 467 | len = buf[11]; | ||
| 468 | |||
| 469 | type_ptr = buf + 12 + len; | ||
| 470 | |||
| 471 | for (i = 0; i < types; i++, type_ptr += 4) { | ||
| 472 | if (type_ptr[0] == ENCLOSURE_COMPONENT_DEVICE || | ||
| 473 | type_ptr[0] == ENCLOSURE_COMPONENT_ARRAY_DEVICE) | ||
| 474 | components += type_ptr[1]; | ||
| 475 | } | ||
| 476 | |||
| 477 | result = ses_recv_diag(sdev, 2, hdr_buf, INIT_ALLOC_SIZE); | ||
| 478 | if (result) | ||
| 479 | goto recv_failed; | ||
| 480 | |||
| 481 | len = (hdr_buf[2] << 8) + hdr_buf[3] + 4; | ||
| 482 | buf = kzalloc(len, GFP_KERNEL); | ||
| 483 | if (!buf) | ||
| 484 | goto err_free; | ||
| 485 | |||
| 486 | /* make sure getting page 2 actually works */ | ||
| 487 | result = ses_recv_diag(sdev, 2, buf, len); | ||
| 488 | if (result) | ||
| 489 | goto recv_failed; | ||
| 490 | ses_dev->page2 = buf; | ||
| 491 | ses_dev->page2_len = len; | ||
| 492 | |||
| 493 | /* The additional information page --- allows us | ||
| 494 | * to match up the devices */ | ||
| 495 | result = ses_recv_diag(sdev, 10, hdr_buf, INIT_ALLOC_SIZE); | ||
| 496 | if (result) | ||
| 497 | goto no_page10; | ||
| 498 | |||
| 499 | len = (hdr_buf[2] << 8) + hdr_buf[3] + 4; | ||
| 500 | buf = kzalloc(len, GFP_KERNEL); | ||
| 501 | if (!buf) | ||
| 502 | goto err_free; | ||
| 503 | |||
| 504 | result = ses_recv_diag(sdev, 10, buf, len); | ||
| 505 | if (result) | ||
| 506 | goto recv_failed; | ||
| 507 | ses_dev->page10 = buf; | ||
| 508 | ses_dev->page10_len = len; | ||
| 509 | |||
| 510 | no_page10: | ||
| 511 | scomp = kmalloc(sizeof(struct ses_component) * components, GFP_KERNEL); | ||
| 512 | if (!scomp) | ||
| 513 | goto err_free; | ||
| 514 | |||
| 515 | edev = enclosure_register(cdev->dev, sdev->sdev_gendev.bus_id, | ||
| 516 | components, &ses_enclosure_callbacks); | ||
| 517 | if (IS_ERR(edev)) { | ||
| 518 | err = PTR_ERR(edev); | ||
| 519 | goto err_free; | ||
| 520 | } | ||
| 521 | |||
| 522 | edev->scratch = ses_dev; | ||
| 523 | for (i = 0; i < components; i++) | ||
| 524 | edev->component[i].scratch = scomp++; | ||
| 525 | |||
| 526 | /* Page 7 for the descriptors is optional */ | ||
| 527 | buf = NULL; | ||
| 528 | result = ses_recv_diag(sdev, 7, hdr_buf, INIT_ALLOC_SIZE); | ||
| 529 | if (result) | ||
| 530 | goto simple_populate; | ||
| 531 | |||
| 532 | len = (hdr_buf[2] << 8) + hdr_buf[3] + 4; | ||
| 533 | /* add 1 for trailing '\0' we'll use */ | ||
| 534 | buf = kzalloc(len + 1, GFP_KERNEL); | ||
| 535 | result = ses_recv_diag(sdev, 7, buf, len); | ||
| 536 | if (result) { | ||
| 537 | simple_populate: | ||
| 538 | kfree(buf); | ||
| 539 | buf = NULL; | ||
| 540 | desc_ptr = NULL; | ||
| 541 | addl_desc_ptr = NULL; | ||
| 542 | } else { | ||
| 543 | desc_ptr = buf + 8; | ||
| 544 | len = (desc_ptr[2] << 8) + desc_ptr[3]; | ||
| 545 | /* skip past overall descriptor */ | ||
| 546 | desc_ptr += len + 4; | ||
| 547 | addl_desc_ptr = ses_dev->page10 + 8; | ||
| 548 | } | ||
| 549 | type_ptr = ses_dev->page1 + 12 + ses_dev->page1[11]; | ||
| 550 | components = 0; | ||
| 551 | for (i = 0; i < types; i++, type_ptr += 4) { | ||
| 552 | for (j = 0; j < type_ptr[1]; j++) { | ||
| 553 | char *name = NULL; | ||
| 554 | struct enclosure_component *ecomp; | ||
| 555 | |||
| 556 | if (desc_ptr) { | ||
| 557 | len = (desc_ptr[2] << 8) + desc_ptr[3]; | ||
| 558 | desc_ptr += 4; | ||
| 559 | /* Add trailing zero - pushes into | ||
| 560 | * reserved space */ | ||
| 561 | desc_ptr[len] = '\0'; | ||
| 562 | name = desc_ptr; | ||
| 563 | } | ||
| 564 | if (type_ptr[0] != ENCLOSURE_COMPONENT_DEVICE && | ||
| 565 | type_ptr[0] != ENCLOSURE_COMPONENT_ARRAY_DEVICE) | ||
| 566 | continue; | ||
| 567 | ecomp = enclosure_component_register(edev, | ||
| 568 | components++, | ||
| 569 | type_ptr[0], | ||
| 570 | name); | ||
| 571 | if (desc_ptr) { | ||
| 572 | desc_ptr += len; | ||
| 573 | if (!IS_ERR(ecomp)) | ||
| 574 | ses_process_descriptor(ecomp, | ||
| 575 | addl_desc_ptr); | ||
| 576 | |||
| 577 | if (addl_desc_ptr) | ||
| 578 | addl_desc_ptr += addl_desc_ptr[1] + 2; | ||
| 579 | } | ||
| 580 | } | ||
| 581 | } | ||
| 582 | kfree(buf); | ||
| 583 | kfree(hdr_buf); | ||
| 584 | |||
| 585 | /* see if there are any devices matching before | ||
| 586 | * we found the enclosure */ | ||
| 587 | shost_for_each_device(tmp_sdev, sdev->host) { | ||
| 588 | if (tmp_sdev->lun != 0 || scsi_device_enclosure(tmp_sdev)) | ||
| 589 | continue; | ||
| 590 | ses_match_to_enclosure(edev, tmp_sdev); | ||
| 591 | } | ||
| 592 | |||
| 593 | return 0; | ||
| 594 | |||
| 595 | recv_failed: | ||
| 596 | sdev_printk(KERN_ERR, sdev, "Failed to get diagnostic page 0x%x\n", | ||
| 597 | result); | ||
| 598 | err = -ENODEV; | ||
| 599 | err_free: | ||
| 600 | kfree(buf); | ||
| 601 | kfree(ses_dev->page10); | ||
| 602 | kfree(ses_dev->page2); | ||
| 603 | kfree(ses_dev->page1); | ||
| 604 | err_init_free: | ||
| 605 | kfree(ses_dev); | ||
| 606 | kfree(hdr_buf); | ||
| 607 | sdev_printk(KERN_ERR, sdev, "Failed to bind enclosure %d\n", err); | ||
| 608 | return err; | ||
| 609 | } | ||
| 610 | |||
| 611 | static int ses_remove(struct device *dev) | ||
| 612 | { | ||
| 613 | return 0; | ||
| 614 | } | ||
| 615 | |||
| 616 | static void ses_intf_remove(struct class_device *cdev, | ||
| 617 | struct class_interface *intf) | ||
| 618 | { | ||
| 619 | struct scsi_device *sdev = to_scsi_device(cdev->dev); | ||
| 620 | struct enclosure_device *edev; | ||
| 621 | struct ses_device *ses_dev; | ||
| 622 | |||
| 623 | if (!scsi_device_enclosure(sdev)) | ||
| 624 | return; | ||
| 625 | |||
| 626 | edev = enclosure_find(cdev->dev); | ||
| 627 | if (!edev) | ||
| 628 | return; | ||
| 629 | |||
| 630 | ses_dev = edev->scratch; | ||
| 631 | edev->scratch = NULL; | ||
| 632 | |||
| 633 | kfree(ses_dev->page1); | ||
| 634 | kfree(ses_dev->page2); | ||
| 635 | kfree(ses_dev); | ||
| 636 | |||
| 637 | kfree(edev->component[0].scratch); | ||
| 638 | |||
| 639 | class_device_put(&edev->cdev); | ||
| 640 | enclosure_unregister(edev); | ||
| 641 | } | ||
| 642 | |||
| 643 | static struct class_interface ses_interface = { | ||
| 644 | .add = ses_intf_add, | ||
| 645 | .remove = ses_intf_remove, | ||
| 646 | }; | ||
| 647 | |||
| 648 | static struct scsi_driver ses_template = { | ||
| 649 | .owner = THIS_MODULE, | ||
| 650 | .gendrv = { | ||
| 651 | .name = "ses", | ||
| 652 | .probe = ses_probe, | ||
| 653 | .remove = ses_remove, | ||
| 654 | }, | ||
| 655 | }; | ||
| 656 | |||
| 657 | static int __init ses_init(void) | ||
| 658 | { | ||
| 659 | int err; | ||
| 660 | |||
| 661 | err = scsi_register_interface(&ses_interface); | ||
| 662 | if (err) | ||
| 663 | return err; | ||
| 664 | |||
| 665 | err = scsi_register_driver(&ses_template.gendrv); | ||
| 666 | if (err) | ||
| 667 | goto out_unreg; | ||
| 668 | |||
| 669 | return 0; | ||
| 670 | |||
| 671 | out_unreg: | ||
| 672 | scsi_unregister_interface(&ses_interface); | ||
| 673 | return err; | ||
| 674 | } | ||
| 675 | |||
| 676 | static void __exit ses_exit(void) | ||
| 677 | { | ||
| 678 | scsi_unregister_driver(&ses_template.gendrv); | ||
| 679 | scsi_unregister_interface(&ses_interface); | ||
| 680 | } | ||
| 681 | |||
| 682 | module_init(ses_init); | ||
| 683 | module_exit(ses_exit); | ||
| 684 | |||
| 685 | MODULE_ALIAS_SCSI_DEVICE(TYPE_ENCLOSURE); | ||
| 686 | |||
| 687 | MODULE_AUTHOR("James Bottomley"); | ||
| 688 | MODULE_DESCRIPTION("SCSI Enclosure Services (ses) driver"); | ||
| 689 | MODULE_LICENSE("GPL v2"); | ||
diff --git a/drivers/scsi/sg.c b/drivers/scsi/sg.c index aba28f335b88..e5156aa6dd20 100644 --- a/drivers/scsi/sg.c +++ b/drivers/scsi/sg.c | |||
| @@ -1160,23 +1160,22 @@ sg_fasync(int fd, struct file *filp, int mode) | |||
| 1160 | return (retval < 0) ? retval : 0; | 1160 | return (retval < 0) ? retval : 0; |
| 1161 | } | 1161 | } |
| 1162 | 1162 | ||
| 1163 | static struct page * | 1163 | static int |
| 1164 | sg_vma_nopage(struct vm_area_struct *vma, unsigned long addr, int *type) | 1164 | sg_vma_fault(struct vm_area_struct *vma, struct vm_fault *vmf) |
| 1165 | { | 1165 | { |
| 1166 | Sg_fd *sfp; | 1166 | Sg_fd *sfp; |
| 1167 | struct page *page = NOPAGE_SIGBUS; | ||
| 1168 | unsigned long offset, len, sa; | 1167 | unsigned long offset, len, sa; |
| 1169 | Sg_scatter_hold *rsv_schp; | 1168 | Sg_scatter_hold *rsv_schp; |
| 1170 | struct scatterlist *sg; | 1169 | struct scatterlist *sg; |
| 1171 | int k; | 1170 | int k; |
| 1172 | 1171 | ||
| 1173 | if ((NULL == vma) || (!(sfp = (Sg_fd *) vma->vm_private_data))) | 1172 | if ((NULL == vma) || (!(sfp = (Sg_fd *) vma->vm_private_data))) |
| 1174 | return page; | 1173 | return VM_FAULT_SIGBUS; |
| 1175 | rsv_schp = &sfp->reserve; | 1174 | rsv_schp = &sfp->reserve; |
| 1176 | offset = addr - vma->vm_start; | 1175 | offset = vmf->pgoff << PAGE_SHIFT; |
| 1177 | if (offset >= rsv_schp->bufflen) | 1176 | if (offset >= rsv_schp->bufflen) |
| 1178 | return page; | 1177 | return VM_FAULT_SIGBUS; |
| 1179 | SCSI_LOG_TIMEOUT(3, printk("sg_vma_nopage: offset=%lu, scatg=%d\n", | 1178 | SCSI_LOG_TIMEOUT(3, printk("sg_vma_fault: offset=%lu, scatg=%d\n", |
| 1180 | offset, rsv_schp->k_use_sg)); | 1179 | offset, rsv_schp->k_use_sg)); |
| 1181 | sg = rsv_schp->buffer; | 1180 | sg = rsv_schp->buffer; |
| 1182 | sa = vma->vm_start; | 1181 | sa = vma->vm_start; |
| @@ -1185,21 +1184,21 @@ sg_vma_nopage(struct vm_area_struct *vma, unsigned long addr, int *type) | |||
| 1185 | len = vma->vm_end - sa; | 1184 | len = vma->vm_end - sa; |
| 1186 | len = (len < sg->length) ? len : sg->length; | 1185 | len = (len < sg->length) ? len : sg->length; |
| 1187 | if (offset < len) { | 1186 | if (offset < len) { |
| 1187 | struct page *page; | ||
| 1188 | page = virt_to_page(page_address(sg_page(sg)) + offset); | 1188 | page = virt_to_page(page_address(sg_page(sg)) + offset); |
| 1189 | get_page(page); /* increment page count */ | 1189 | get_page(page); /* increment page count */ |
| 1190 | break; | 1190 | vmf->page = page; |
| 1191 | return 0; /* success */ | ||
| 1191 | } | 1192 | } |
| 1192 | sa += len; | 1193 | sa += len; |
| 1193 | offset -= len; | 1194 | offset -= len; |
| 1194 | } | 1195 | } |
| 1195 | 1196 | ||
| 1196 | if (type) | 1197 | return VM_FAULT_SIGBUS; |
| 1197 | *type = VM_FAULT_MINOR; | ||
| 1198 | return page; | ||
| 1199 | } | 1198 | } |
| 1200 | 1199 | ||
| 1201 | static struct vm_operations_struct sg_mmap_vm_ops = { | 1200 | static struct vm_operations_struct sg_mmap_vm_ops = { |
| 1202 | .nopage = sg_vma_nopage, | 1201 | .fault = sg_vma_fault, |
| 1203 | }; | 1202 | }; |
| 1204 | 1203 | ||
| 1205 | static int | 1204 | static int |
diff --git a/drivers/scsi/sr.c b/drivers/scsi/sr.c index 50ba49250203..208565bdbe8e 100644 --- a/drivers/scsi/sr.c +++ b/drivers/scsi/sr.c | |||
| @@ -163,6 +163,29 @@ static void scsi_cd_put(struct scsi_cd *cd) | |||
| 163 | mutex_unlock(&sr_ref_mutex); | 163 | mutex_unlock(&sr_ref_mutex); |
| 164 | } | 164 | } |
| 165 | 165 | ||
| 166 | /* identical to scsi_test_unit_ready except that it doesn't | ||
| 167 | * eat the NOT_READY returns for removable media */ | ||
| 168 | int sr_test_unit_ready(struct scsi_device *sdev, struct scsi_sense_hdr *sshdr) | ||
| 169 | { | ||
| 170 | int retries = MAX_RETRIES; | ||
| 171 | int the_result; | ||
| 172 | u8 cmd[] = {TEST_UNIT_READY, 0, 0, 0, 0, 0 }; | ||
| 173 | |||
| 174 | /* issue TEST_UNIT_READY until the initial startup UNIT_ATTENTION | ||
| 175 | * conditions are gone, or a timeout happens | ||
| 176 | */ | ||
| 177 | do { | ||
| 178 | the_result = scsi_execute_req(sdev, cmd, DMA_NONE, NULL, | ||
| 179 | 0, sshdr, SR_TIMEOUT, | ||
| 180 | retries--); | ||
| 181 | |||
| 182 | } while (retries > 0 && | ||
| 183 | (!scsi_status_is_good(the_result) || | ||
| 184 | (scsi_sense_valid(sshdr) && | ||
| 185 | sshdr->sense_key == UNIT_ATTENTION))); | ||
| 186 | return the_result; | ||
| 187 | } | ||
| 188 | |||
| 166 | /* | 189 | /* |
| 167 | * This function checks to see if the media has been changed in the | 190 | * This function checks to see if the media has been changed in the |
| 168 | * CDROM drive. It is possible that we have already sensed a change, | 191 | * CDROM drive. It is possible that we have already sensed a change, |
| @@ -185,8 +208,7 @@ static int sr_media_change(struct cdrom_device_info *cdi, int slot) | |||
| 185 | } | 208 | } |
| 186 | 209 | ||
| 187 | sshdr = kzalloc(sizeof(*sshdr), GFP_KERNEL); | 210 | sshdr = kzalloc(sizeof(*sshdr), GFP_KERNEL); |
| 188 | retval = scsi_test_unit_ready(cd->device, SR_TIMEOUT, MAX_RETRIES, | 211 | retval = sr_test_unit_ready(cd->device, sshdr); |
| 189 | sshdr); | ||
| 190 | if (retval || (scsi_sense_valid(sshdr) && | 212 | if (retval || (scsi_sense_valid(sshdr) && |
| 191 | /* 0x3a is medium not present */ | 213 | /* 0x3a is medium not present */ |
| 192 | sshdr->asc == 0x3a)) { | 214 | sshdr->asc == 0x3a)) { |
| @@ -733,10 +755,8 @@ static void get_capabilities(struct scsi_cd *cd) | |||
| 733 | { | 755 | { |
| 734 | unsigned char *buffer; | 756 | unsigned char *buffer; |
| 735 | struct scsi_mode_data data; | 757 | struct scsi_mode_data data; |
| 736 | unsigned char cmd[MAX_COMMAND_SIZE]; | ||
| 737 | struct scsi_sense_hdr sshdr; | 758 | struct scsi_sense_hdr sshdr; |
| 738 | unsigned int the_result; | 759 | int rc, n; |
| 739 | int retries, rc, n; | ||
| 740 | 760 | ||
| 741 | static const char *loadmech[] = | 761 | static const char *loadmech[] = |
| 742 | { | 762 | { |
| @@ -758,23 +778,8 @@ static void get_capabilities(struct scsi_cd *cd) | |||
| 758 | return; | 778 | return; |
| 759 | } | 779 | } |
| 760 | 780 | ||
| 761 | /* issue TEST_UNIT_READY until the initial startup UNIT_ATTENTION | 781 | /* eat unit attentions */ |
| 762 | * conditions are gone, or a timeout happens | 782 | sr_test_unit_ready(cd->device, &sshdr); |
| 763 | */ | ||
| 764 | retries = 0; | ||
| 765 | do { | ||
| 766 | memset((void *)cmd, 0, MAX_COMMAND_SIZE); | ||
| 767 | cmd[0] = TEST_UNIT_READY; | ||
| 768 | |||
| 769 | the_result = scsi_execute_req (cd->device, cmd, DMA_NONE, NULL, | ||
| 770 | 0, &sshdr, SR_TIMEOUT, | ||
| 771 | MAX_RETRIES); | ||
| 772 | |||
| 773 | retries++; | ||
| 774 | } while (retries < 5 && | ||
| 775 | (!scsi_status_is_good(the_result) || | ||
| 776 | (scsi_sense_valid(&sshdr) && | ||
| 777 | sshdr.sense_key == UNIT_ATTENTION))); | ||
| 778 | 783 | ||
| 779 | /* ask for mode page 0x2a */ | 784 | /* ask for mode page 0x2a */ |
| 780 | rc = scsi_mode_sense(cd->device, 0, 0x2a, buffer, 128, | 785 | rc = scsi_mode_sense(cd->device, 0, 0x2a, buffer, 128, |
diff --git a/drivers/scsi/sr.h b/drivers/scsi/sr.h index 81fbc0b78a52..1e144dfdbd4b 100644 --- a/drivers/scsi/sr.h +++ b/drivers/scsi/sr.h | |||
| @@ -61,6 +61,7 @@ int sr_select_speed(struct cdrom_device_info *cdi, int speed); | |||
| 61 | int sr_audio_ioctl(struct cdrom_device_info *, unsigned int, void *); | 61 | int sr_audio_ioctl(struct cdrom_device_info *, unsigned int, void *); |
| 62 | 62 | ||
| 63 | int sr_is_xa(Scsi_CD *); | 63 | int sr_is_xa(Scsi_CD *); |
| 64 | int sr_test_unit_ready(struct scsi_device *sdev, struct scsi_sense_hdr *sshdr); | ||
| 64 | 65 | ||
| 65 | /* sr_vendor.c */ | 66 | /* sr_vendor.c */ |
| 66 | void sr_vendor_init(Scsi_CD *); | 67 | void sr_vendor_init(Scsi_CD *); |
diff --git a/drivers/scsi/sr_ioctl.c b/drivers/scsi/sr_ioctl.c index d5cebff1d646..ae87d08df588 100644 --- a/drivers/scsi/sr_ioctl.c +++ b/drivers/scsi/sr_ioctl.c | |||
| @@ -306,8 +306,7 @@ int sr_drive_status(struct cdrom_device_info *cdi, int slot) | |||
| 306 | /* we have no changer support */ | 306 | /* we have no changer support */ |
| 307 | return -EINVAL; | 307 | return -EINVAL; |
| 308 | } | 308 | } |
| 309 | if (0 == scsi_test_unit_ready(cd->device, SR_TIMEOUT, MAX_RETRIES, | 309 | if (0 == sr_test_unit_ready(cd->device, &sshdr)) |
| 310 | &sshdr)) | ||
| 311 | return CDS_DISC_OK; | 310 | return CDS_DISC_OK; |
| 312 | 311 | ||
| 313 | if (!cdrom_get_media_event(cdi, &med)) { | 312 | if (!cdrom_get_media_event(cdi, &med)) { |
diff --git a/drivers/scsi/sun3x_esp.c b/drivers/scsi/sun3x_esp.c index 1bc41907a038..06152c7fa689 100644 --- a/drivers/scsi/sun3x_esp.c +++ b/drivers/scsi/sun3x_esp.c | |||
| @@ -1,392 +1,316 @@ | |||
| 1 | /* sun3x_esp.c: EnhancedScsiProcessor Sun3x SCSI driver code. | 1 | /* sun3x_esp.c: ESP front-end for Sun3x systems. |
| 2 | * | 2 | * |
| 3 | * (C) 1999 Thomas Bogendoerfer (tsbogend@alpha.franken.de) | 3 | * Copyright (C) 2007,2008 Thomas Bogendoerfer (tsbogend@alpha.franken.de) |
| 4 | * | ||
| 5 | * Based on David S. Miller's esp driver | ||
| 6 | */ | 4 | */ |
| 7 | 5 | ||
| 8 | #include <linux/kernel.h> | 6 | #include <linux/kernel.h> |
| 9 | #include <linux/types.h> | 7 | #include <linux/types.h> |
| 10 | #include <linux/string.h> | ||
| 11 | #include <linux/slab.h> | ||
| 12 | #include <linux/blkdev.h> | ||
| 13 | #include <linux/proc_fs.h> | ||
| 14 | #include <linux/stat.h> | ||
| 15 | #include <linux/delay.h> | 8 | #include <linux/delay.h> |
| 9 | #include <linux/module.h> | ||
| 10 | #include <linux/init.h> | ||
| 11 | #include <linux/platform_device.h> | ||
| 12 | #include <linux/dma-mapping.h> | ||
| 16 | #include <linux/interrupt.h> | 13 | #include <linux/interrupt.h> |
| 17 | 14 | ||
| 18 | #include "scsi.h" | ||
| 19 | #include <scsi/scsi_host.h> | ||
| 20 | #include "NCR53C9x.h" | ||
| 21 | |||
| 22 | #include <asm/sun3x.h> | 15 | #include <asm/sun3x.h> |
| 16 | #include <asm/io.h> | ||
| 17 | #include <asm/dma.h> | ||
| 23 | #include <asm/dvma.h> | 18 | #include <asm/dvma.h> |
| 24 | #include <asm/irq.h> | ||
| 25 | |||
| 26 | static void dma_barrier(struct NCR_ESP *esp); | ||
| 27 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count); | ||
| 28 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 29 | static void dma_drain(struct NCR_ESP *esp); | ||
| 30 | static void dma_invalidate(struct NCR_ESP *esp); | ||
| 31 | static void dma_dump_state(struct NCR_ESP *esp); | ||
| 32 | static void dma_init_read(struct NCR_ESP *esp, __u32 vaddress, int length); | ||
| 33 | static void dma_init_write(struct NCR_ESP *esp, __u32 vaddress, int length); | ||
| 34 | static void dma_ints_off(struct NCR_ESP *esp); | ||
| 35 | static void dma_ints_on(struct NCR_ESP *esp); | ||
| 36 | static int dma_irq_p(struct NCR_ESP *esp); | ||
| 37 | static void dma_poll(struct NCR_ESP *esp, unsigned char *vaddr); | ||
| 38 | static int dma_ports_p(struct NCR_ESP *esp); | ||
| 39 | static void dma_reset(struct NCR_ESP *esp); | ||
| 40 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write); | ||
| 41 | static void dma_mmu_get_scsi_one (struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 42 | static void dma_mmu_get_scsi_sgl (struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 43 | static void dma_mmu_release_scsi_one (struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 44 | static void dma_mmu_release_scsi_sgl (struct NCR_ESP *esp, Scsi_Cmnd *sp); | ||
| 45 | static void dma_advance_sg (Scsi_Cmnd *sp); | ||
| 46 | |||
| 47 | /* Detecting ESP chips on the machine. This is the simple and easy | ||
| 48 | * version. | ||
| 49 | */ | ||
| 50 | int sun3x_esp_detect(struct scsi_host_template *tpnt) | ||
| 51 | { | ||
| 52 | struct NCR_ESP *esp; | ||
| 53 | struct ConfigDev *esp_dev; | ||
| 54 | |||
| 55 | esp_dev = 0; | ||
| 56 | esp = esp_allocate(tpnt, esp_dev, 0); | ||
| 57 | |||
| 58 | /* Do command transfer with DMA */ | ||
| 59 | esp->do_pio_cmds = 0; | ||
| 60 | |||
| 61 | /* Required functions */ | ||
| 62 | esp->dma_bytes_sent = &dma_bytes_sent; | ||
| 63 | esp->dma_can_transfer = &dma_can_transfer; | ||
| 64 | esp->dma_dump_state = &dma_dump_state; | ||
| 65 | esp->dma_init_read = &dma_init_read; | ||
| 66 | esp->dma_init_write = &dma_init_write; | ||
| 67 | esp->dma_ints_off = &dma_ints_off; | ||
| 68 | esp->dma_ints_on = &dma_ints_on; | ||
| 69 | esp->dma_irq_p = &dma_irq_p; | ||
| 70 | esp->dma_ports_p = &dma_ports_p; | ||
| 71 | esp->dma_setup = &dma_setup; | ||
| 72 | |||
| 73 | /* Optional functions */ | ||
| 74 | esp->dma_barrier = &dma_barrier; | ||
| 75 | esp->dma_invalidate = &dma_invalidate; | ||
| 76 | esp->dma_drain = &dma_drain; | ||
| 77 | esp->dma_irq_entry = 0; | ||
| 78 | esp->dma_irq_exit = 0; | ||
| 79 | esp->dma_led_on = 0; | ||
| 80 | esp->dma_led_off = 0; | ||
| 81 | esp->dma_poll = &dma_poll; | ||
| 82 | esp->dma_reset = &dma_reset; | ||
| 83 | |||
| 84 | /* virtual DMA functions */ | ||
| 85 | esp->dma_mmu_get_scsi_one = &dma_mmu_get_scsi_one; | ||
| 86 | esp->dma_mmu_get_scsi_sgl = &dma_mmu_get_scsi_sgl; | ||
| 87 | esp->dma_mmu_release_scsi_one = &dma_mmu_release_scsi_one; | ||
| 88 | esp->dma_mmu_release_scsi_sgl = &dma_mmu_release_scsi_sgl; | ||
| 89 | esp->dma_advance_sg = &dma_advance_sg; | ||
| 90 | |||
| 91 | /* SCSI chip speed */ | ||
| 92 | esp->cfreq = 20000000; | ||
| 93 | esp->eregs = (struct ESP_regs *)(SUN3X_ESP_BASE); | ||
| 94 | esp->dregs = (void *)SUN3X_ESP_DMA; | ||
| 95 | 19 | ||
| 96 | esp->esp_command = (volatile unsigned char *)dvma_malloc(DVMA_PAGE_SIZE); | 20 | /* DMA controller reg offsets */ |
| 97 | esp->esp_command_dvma = dvma_vtob((unsigned long)esp->esp_command); | 21 | #define DMA_CSR 0x00UL /* rw DMA control/status register 0x00 */ |
| 98 | 22 | #define DMA_ADDR 0x04UL /* rw DMA transfer address register 0x04 */ | |
| 99 | esp->irq = 2; | 23 | #define DMA_COUNT 0x08UL /* rw DMA transfer count register 0x08 */ |
| 100 | if (request_irq(esp->irq, esp_intr, IRQF_DISABLED, | 24 | #define DMA_TEST 0x0cUL /* rw DMA test/debug register 0x0c */ |
| 101 | "SUN3X SCSI", esp->ehost)) { | ||
| 102 | esp_deallocate(esp); | ||
| 103 | return 0; | ||
| 104 | } | ||
| 105 | 25 | ||
| 106 | esp->scsi_id = 7; | 26 | #include <scsi/scsi_host.h> |
| 107 | esp->diff = 0; | ||
| 108 | 27 | ||
| 109 | esp_initialize(esp); | 28 | #include "esp_scsi.h" |
| 110 | 29 | ||
| 111 | /* for reasons beyond my knowledge (and which should likely be fixed) | 30 | #define DRV_MODULE_NAME "sun3x_esp" |
| 112 | sync mode doesn't work on a 3/80 at 5mhz. but it does at 4. */ | 31 | #define PFX DRV_MODULE_NAME ": " |
| 113 | esp->sync_defp = 0x3f; | 32 | #define DRV_VERSION "1.000" |
| 33 | #define DRV_MODULE_RELDATE "Nov 1, 2007" | ||
| 114 | 34 | ||
| 115 | printk("ESP: Total of %d ESP hosts found, %d actually in use.\n", nesps, | 35 | /* |
| 116 | esps_in_use); | 36 | * m68k always assumes readl/writel operate on little endian |
| 117 | esps_running = esps_in_use; | 37 | * mmio space; this is wrong at least for Sun3x, so we |
| 118 | return esps_in_use; | 38 | * need to workaround this until a proper way is found |
| 39 | */ | ||
| 40 | #if 0 | ||
| 41 | #define dma_read32(REG) \ | ||
| 42 | readl(esp->dma_regs + (REG)) | ||
| 43 | #define dma_write32(VAL, REG) \ | ||
| 44 | writel((VAL), esp->dma_regs + (REG)) | ||
| 45 | #else | ||
| 46 | #define dma_read32(REG) \ | ||
| 47 | *(volatile u32 *)(esp->dma_regs + (REG)) | ||
| 48 | #define dma_write32(VAL, REG) \ | ||
| 49 | do { *(volatile u32 *)(esp->dma_regs + (REG)) = (VAL); } while (0) | ||
| 50 | #endif | ||
| 51 | |||
| 52 | static void sun3x_esp_write8(struct esp *esp, u8 val, unsigned long reg) | ||
| 53 | { | ||
| 54 | writeb(val, esp->regs + (reg * 4UL)); | ||
| 119 | } | 55 | } |
| 120 | 56 | ||
| 121 | static void dma_do_drain(struct NCR_ESP *esp) | 57 | static u8 sun3x_esp_read8(struct esp *esp, unsigned long reg) |
| 122 | { | 58 | { |
| 123 | struct sparc_dma_registers *dregs = | 59 | return readb(esp->regs + (reg * 4UL)); |
| 124 | (struct sparc_dma_registers *) esp->dregs; | ||
| 125 | |||
| 126 | int count = 500000; | ||
| 127 | |||
| 128 | while((dregs->cond_reg & DMA_PEND_READ) && (--count > 0)) | ||
| 129 | udelay(1); | ||
| 130 | |||
| 131 | if(!count) { | ||
| 132 | printk("%s:%d timeout CSR %08lx\n", __FILE__, __LINE__, dregs->cond_reg); | ||
| 133 | } | ||
| 134 | |||
| 135 | dregs->cond_reg |= DMA_FIFO_STDRAIN; | ||
| 136 | |||
| 137 | count = 500000; | ||
| 138 | |||
| 139 | while((dregs->cond_reg & DMA_FIFO_ISDRAIN) && (--count > 0)) | ||
| 140 | udelay(1); | ||
| 141 | |||
| 142 | if(!count) { | ||
| 143 | printk("%s:%d timeout CSR %08lx\n", __FILE__, __LINE__, dregs->cond_reg); | ||
| 144 | } | ||
| 145 | |||
| 146 | } | 60 | } |
| 147 | 61 | ||
| 148 | static void dma_barrier(struct NCR_ESP *esp) | 62 | static dma_addr_t sun3x_esp_map_single(struct esp *esp, void *buf, |
| 63 | size_t sz, int dir) | ||
| 149 | { | 64 | { |
| 150 | struct sparc_dma_registers *dregs = | 65 | return dma_map_single(esp->dev, buf, sz, dir); |
| 151 | (struct sparc_dma_registers *) esp->dregs; | ||
| 152 | int count = 500000; | ||
| 153 | |||
| 154 | while((dregs->cond_reg & DMA_PEND_READ) && (--count > 0)) | ||
| 155 | udelay(1); | ||
| 156 | |||
| 157 | if(!count) { | ||
| 158 | printk("%s:%d timeout CSR %08lx\n", __FILE__, __LINE__, dregs->cond_reg); | ||
| 159 | } | ||
| 160 | |||
| 161 | dregs->cond_reg &= ~(DMA_ENABLE); | ||
| 162 | } | 66 | } |
| 163 | 67 | ||
| 164 | /* This uses various DMA csr fields and the fifo flags count value to | 68 | static int sun3x_esp_map_sg(struct esp *esp, struct scatterlist *sg, |
| 165 | * determine how many bytes were successfully sent/received by the ESP. | 69 | int num_sg, int dir) |
| 166 | */ | ||
| 167 | static int dma_bytes_sent(struct NCR_ESP *esp, int fifo_count) | ||
| 168 | { | 70 | { |
| 169 | struct sparc_dma_registers *dregs = | 71 | return dma_map_sg(esp->dev, sg, num_sg, dir); |
| 170 | (struct sparc_dma_registers *) esp->dregs; | ||
| 171 | |||
| 172 | int rval = dregs->st_addr - esp->esp_command_dvma; | ||
| 173 | |||
| 174 | return rval - fifo_count; | ||
| 175 | } | 72 | } |
| 176 | 73 | ||
| 177 | static int dma_can_transfer(struct NCR_ESP *esp, Scsi_Cmnd *sp) | 74 | static void sun3x_esp_unmap_single(struct esp *esp, dma_addr_t addr, |
| 75 | size_t sz, int dir) | ||
| 178 | { | 76 | { |
| 179 | return sp->SCp.this_residual; | 77 | dma_unmap_single(esp->dev, addr, sz, dir); |
| 180 | } | 78 | } |
| 181 | 79 | ||
| 182 | static void dma_drain(struct NCR_ESP *esp) | 80 | static void sun3x_esp_unmap_sg(struct esp *esp, struct scatterlist *sg, |
| 81 | int num_sg, int dir) | ||
| 183 | { | 82 | { |
| 184 | struct sparc_dma_registers *dregs = | 83 | dma_unmap_sg(esp->dev, sg, num_sg, dir); |
| 185 | (struct sparc_dma_registers *) esp->dregs; | ||
| 186 | int count = 500000; | ||
| 187 | |||
| 188 | if(dregs->cond_reg & DMA_FIFO_ISDRAIN) { | ||
| 189 | dregs->cond_reg |= DMA_FIFO_STDRAIN; | ||
| 190 | while((dregs->cond_reg & DMA_FIFO_ISDRAIN) && (--count > 0)) | ||
| 191 | udelay(1); | ||
| 192 | if(!count) { | ||
| 193 | printk("%s:%d timeout CSR %08lx\n", __FILE__, __LINE__, dregs->cond_reg); | ||
| 194 | } | ||
| 195 | |||
| 196 | } | ||
| 197 | } | 84 | } |
| 198 | 85 | ||
| 199 | static void dma_invalidate(struct NCR_ESP *esp) | 86 | static int sun3x_esp_irq_pending(struct esp *esp) |
| 200 | { | 87 | { |
| 201 | struct sparc_dma_registers *dregs = | 88 | if (dma_read32(DMA_CSR) & (DMA_HNDL_INTR | DMA_HNDL_ERROR)) |
| 202 | (struct sparc_dma_registers *) esp->dregs; | 89 | return 1; |
| 203 | 90 | return 0; | |
| 204 | __u32 tmp; | 91 | } |
| 205 | int count = 500000; | ||
| 206 | |||
| 207 | while(((tmp = dregs->cond_reg) & DMA_PEND_READ) && (--count > 0)) | ||
| 208 | udelay(1); | ||
| 209 | 92 | ||
| 210 | if(!count) { | 93 | static void sun3x_esp_reset_dma(struct esp *esp) |
| 211 | printk("%s:%d timeout CSR %08lx\n", __FILE__, __LINE__, dregs->cond_reg); | 94 | { |
| 212 | } | 95 | u32 val; |
| 213 | 96 | ||
| 214 | dregs->cond_reg = tmp | DMA_FIFO_INV; | 97 | val = dma_read32(DMA_CSR); |
| 215 | dregs->cond_reg &= ~DMA_FIFO_INV; | 98 | dma_write32(val | DMA_RST_SCSI, DMA_CSR); |
| 99 | dma_write32(val & ~DMA_RST_SCSI, DMA_CSR); | ||
| 216 | 100 | ||
| 101 | /* Enable interrupts. */ | ||
| 102 | val = dma_read32(DMA_CSR); | ||
| 103 | dma_write32(val | DMA_INT_ENAB, DMA_CSR); | ||
| 217 | } | 104 | } |
| 218 | 105 | ||
| 219 | static void dma_dump_state(struct NCR_ESP *esp) | 106 | static void sun3x_esp_dma_drain(struct esp *esp) |
| 220 | { | 107 | { |
| 221 | struct sparc_dma_registers *dregs = | 108 | u32 csr; |
| 222 | (struct sparc_dma_registers *) esp->dregs; | 109 | int lim; |
| 223 | 110 | ||
| 224 | ESPLOG(("esp%d: dma -- cond_reg<%08lx> addr<%08lx>\n", | 111 | csr = dma_read32(DMA_CSR); |
| 225 | esp->esp_id, dregs->cond_reg, dregs->st_addr)); | 112 | if (!(csr & DMA_FIFO_ISDRAIN)) |
| 226 | } | 113 | return; |
| 227 | 114 | ||
| 228 | static void dma_init_read(struct NCR_ESP *esp, __u32 vaddress, int length) | 115 | dma_write32(csr | DMA_FIFO_STDRAIN, DMA_CSR); |
| 229 | { | ||
| 230 | struct sparc_dma_registers *dregs = | ||
| 231 | (struct sparc_dma_registers *) esp->dregs; | ||
| 232 | 116 | ||
| 233 | dregs->st_addr = vaddress; | 117 | lim = 1000; |
| 234 | dregs->cond_reg |= (DMA_ST_WRITE | DMA_ENABLE); | 118 | while (dma_read32(DMA_CSR) & DMA_FIFO_ISDRAIN) { |
| 119 | if (--lim == 0) { | ||
| 120 | printk(KERN_ALERT PFX "esp%d: DMA will not drain!\n", | ||
| 121 | esp->host->unique_id); | ||
| 122 | break; | ||
| 123 | } | ||
| 124 | udelay(1); | ||
| 125 | } | ||
| 235 | } | 126 | } |
| 236 | 127 | ||
| 237 | static void dma_init_write(struct NCR_ESP *esp, __u32 vaddress, int length) | 128 | static void sun3x_esp_dma_invalidate(struct esp *esp) |
| 238 | { | 129 | { |
| 239 | struct sparc_dma_registers *dregs = | 130 | u32 val; |
| 240 | (struct sparc_dma_registers *) esp->dregs; | 131 | int lim; |
| 241 | 132 | ||
| 242 | /* Set up the DMA counters */ | 133 | lim = 1000; |
| 134 | while ((val = dma_read32(DMA_CSR)) & DMA_PEND_READ) { | ||
| 135 | if (--lim == 0) { | ||
| 136 | printk(KERN_ALERT PFX "esp%d: DMA will not " | ||
| 137 | "invalidate!\n", esp->host->unique_id); | ||
| 138 | break; | ||
| 139 | } | ||
| 140 | udelay(1); | ||
| 141 | } | ||
| 243 | 142 | ||
| 244 | dregs->st_addr = vaddress; | 143 | val &= ~(DMA_ENABLE | DMA_ST_WRITE | DMA_BCNT_ENAB); |
| 245 | dregs->cond_reg = ((dregs->cond_reg & ~(DMA_ST_WRITE)) | DMA_ENABLE); | 144 | val |= DMA_FIFO_INV; |
| 145 | dma_write32(val, DMA_CSR); | ||
| 146 | val &= ~DMA_FIFO_INV; | ||
| 147 | dma_write32(val, DMA_CSR); | ||
| 246 | } | 148 | } |
| 247 | 149 | ||
| 248 | static void dma_ints_off(struct NCR_ESP *esp) | 150 | static void sun3x_esp_send_dma_cmd(struct esp *esp, u32 addr, u32 esp_count, |
| 151 | u32 dma_count, int write, u8 cmd) | ||
| 249 | { | 152 | { |
| 250 | DMA_INTSOFF((struct sparc_dma_registers *) esp->dregs); | 153 | u32 csr; |
| 154 | |||
| 155 | BUG_ON(!(cmd & ESP_CMD_DMA)); | ||
| 156 | |||
| 157 | sun3x_esp_write8(esp, (esp_count >> 0) & 0xff, ESP_TCLOW); | ||
| 158 | sun3x_esp_write8(esp, (esp_count >> 8) & 0xff, ESP_TCMED); | ||
| 159 | csr = dma_read32(DMA_CSR); | ||
| 160 | csr |= DMA_ENABLE; | ||
| 161 | if (write) | ||
| 162 | csr |= DMA_ST_WRITE; | ||
| 163 | else | ||
| 164 | csr &= ~DMA_ST_WRITE; | ||
| 165 | dma_write32(csr, DMA_CSR); | ||
| 166 | dma_write32(addr, DMA_ADDR); | ||
| 167 | |||
| 168 | scsi_esp_cmd(esp, cmd); | ||
| 251 | } | 169 | } |
| 252 | 170 | ||
| 253 | static void dma_ints_on(struct NCR_ESP *esp) | 171 | static int sun3x_esp_dma_error(struct esp *esp) |
| 254 | { | 172 | { |
| 255 | DMA_INTSON((struct sparc_dma_registers *) esp->dregs); | 173 | u32 csr = dma_read32(DMA_CSR); |
| 256 | } | ||
| 257 | 174 | ||
| 258 | static int dma_irq_p(struct NCR_ESP *esp) | 175 | if (csr & DMA_HNDL_ERROR) |
| 259 | { | 176 | return 1; |
| 260 | return DMA_IRQ_P((struct sparc_dma_registers *) esp->dregs); | 177 | |
| 178 | return 0; | ||
| 261 | } | 179 | } |
| 262 | 180 | ||
| 263 | static void dma_poll(struct NCR_ESP *esp, unsigned char *vaddr) | 181 | static const struct esp_driver_ops sun3x_esp_ops = { |
| 182 | .esp_write8 = sun3x_esp_write8, | ||
| 183 | .esp_read8 = sun3x_esp_read8, | ||
| 184 | .map_single = sun3x_esp_map_single, | ||
| 185 | .map_sg = sun3x_esp_map_sg, | ||
| 186 | .unmap_single = sun3x_esp_unmap_single, | ||
| 187 | .unmap_sg = sun3x_esp_unmap_sg, | ||
| 188 | .irq_pending = sun3x_esp_irq_pending, | ||
| 189 | .reset_dma = sun3x_esp_reset_dma, | ||
| 190 | .dma_drain = sun3x_esp_dma_drain, | ||
| 191 | .dma_invalidate = sun3x_esp_dma_invalidate, | ||
| 192 | .send_dma_cmd = sun3x_esp_send_dma_cmd, | ||
| 193 | .dma_error = sun3x_esp_dma_error, | ||
| 194 | }; | ||
| 195 | |||
| 196 | static int __devinit esp_sun3x_probe(struct platform_device *dev) | ||
| 264 | { | 197 | { |
| 265 | int count = 50; | 198 | struct scsi_host_template *tpnt = &scsi_esp_template; |
| 266 | dma_do_drain(esp); | 199 | struct Scsi_Host *host; |
| 200 | struct esp *esp; | ||
| 201 | struct resource *res; | ||
| 202 | int err = -ENOMEM; | ||
| 267 | 203 | ||
| 268 | /* Wait till the first bits settle. */ | 204 | host = scsi_host_alloc(tpnt, sizeof(struct esp)); |
| 269 | while((*(volatile unsigned char *)vaddr == 0xff) && (--count > 0)) | 205 | if (!host) |
| 270 | udelay(1); | 206 | goto fail; |
| 271 | 207 | ||
| 272 | if(!count) { | 208 | host->max_id = 8; |
| 273 | // printk("%s:%d timeout expire (data %02x)\n", __FILE__, __LINE__, | 209 | esp = shost_priv(host); |
| 274 | // esp_read(esp->eregs->esp_fdata)); | ||
| 275 | //mach_halt(); | ||
| 276 | vaddr[0] = esp_read(esp->eregs->esp_fdata); | ||
| 277 | vaddr[1] = esp_read(esp->eregs->esp_fdata); | ||
| 278 | } | ||
| 279 | 210 | ||
| 280 | } | 211 | esp->host = host; |
| 212 | esp->dev = dev; | ||
| 213 | esp->ops = &sun3x_esp_ops; | ||
| 281 | 214 | ||
| 282 | static int dma_ports_p(struct NCR_ESP *esp) | 215 | res = platform_get_resource(dev, IORESOURCE_MEM, 0); |
| 283 | { | 216 | if (!res && !res->start) |
| 284 | return (((struct sparc_dma_registers *) esp->dregs)->cond_reg | 217 | goto fail_unlink; |
| 285 | & DMA_INT_ENAB); | ||
| 286 | } | ||
| 287 | 218 | ||
| 288 | /* Resetting various pieces of the ESP scsi driver chipset/buses. */ | 219 | esp->regs = ioremap_nocache(res->start, 0x20); |
| 289 | static void dma_reset(struct NCR_ESP *esp) | 220 | if (!esp->regs) |
| 290 | { | 221 | goto fail_unmap_regs; |
| 291 | struct sparc_dma_registers *dregs = | ||
| 292 | (struct sparc_dma_registers *)esp->dregs; | ||
| 293 | 222 | ||
| 294 | /* Punt the DVMA into a known state. */ | 223 | res = platform_get_resource(dev, IORESOURCE_MEM, 1); |
| 295 | dregs->cond_reg |= DMA_RST_SCSI; | 224 | if (!res && !res->start) |
| 296 | dregs->cond_reg &= ~(DMA_RST_SCSI); | 225 | goto fail_unmap_regs; |
| 297 | DMA_INTSON(dregs); | ||
| 298 | } | ||
| 299 | 226 | ||
| 300 | static void dma_setup(struct NCR_ESP *esp, __u32 addr, int count, int write) | 227 | esp->dma_regs = ioremap_nocache(res->start, 0x10); |
| 301 | { | ||
| 302 | struct sparc_dma_registers *dregs = | ||
| 303 | (struct sparc_dma_registers *) esp->dregs; | ||
| 304 | unsigned long nreg = dregs->cond_reg; | ||
| 305 | 228 | ||
| 306 | // printk("dma_setup %c addr %08x cnt %08x\n", | 229 | esp->command_block = dma_alloc_coherent(esp->dev, 16, |
| 307 | // write ? 'W' : 'R', addr, count); | 230 | &esp->command_block_dma, |
| 231 | GFP_KERNEL); | ||
| 232 | if (!esp->command_block) | ||
| 233 | goto fail_unmap_regs_dma; | ||
| 308 | 234 | ||
| 309 | dma_do_drain(esp); | 235 | host->irq = platform_get_irq(dev, 0); |
| 236 | err = request_irq(host->irq, scsi_esp_intr, IRQF_SHARED, | ||
| 237 | "SUN3X ESP", esp); | ||
| 238 | if (err < 0) | ||
| 239 | goto fail_unmap_command_block; | ||
| 310 | 240 | ||
| 311 | if(write) | 241 | esp->scsi_id = 7; |
| 312 | nreg |= DMA_ST_WRITE; | 242 | esp->host->this_id = esp->scsi_id; |
| 313 | else { | 243 | esp->scsi_id_mask = (1 << esp->scsi_id); |
| 314 | nreg &= ~(DMA_ST_WRITE); | 244 | esp->cfreq = 20000000; |
| 315 | } | ||
| 316 | |||
| 317 | nreg |= DMA_ENABLE; | ||
| 318 | dregs->cond_reg = nreg; | ||
| 319 | dregs->st_addr = addr; | ||
| 320 | } | ||
| 321 | 245 | ||
| 322 | static void dma_mmu_get_scsi_one (struct NCR_ESP *esp, Scsi_Cmnd *sp) | 246 | dev_set_drvdata(&dev->dev, esp); |
| 323 | { | 247 | |
| 324 | sp->SCp.have_data_in = dvma_map((unsigned long)sp->SCp.buffer, | 248 | err = scsi_esp_register(esp, &dev->dev); |
| 325 | sp->SCp.this_residual); | 249 | if (err) |
| 326 | sp->SCp.ptr = (char *)((unsigned long)sp->SCp.have_data_in); | 250 | goto fail_free_irq; |
| 251 | |||
| 252 | return 0; | ||
| 253 | |||
| 254 | fail_free_irq: | ||
| 255 | free_irq(host->irq, esp); | ||
| 256 | fail_unmap_command_block: | ||
| 257 | dma_free_coherent(esp->dev, 16, | ||
| 258 | esp->command_block, | ||
| 259 | esp->command_block_dma); | ||
| 260 | fail_unmap_regs_dma: | ||
| 261 | iounmap(esp->dma_regs); | ||
| 262 | fail_unmap_regs: | ||
| 263 | iounmap(esp->regs); | ||
| 264 | fail_unlink: | ||
| 265 | scsi_host_put(host); | ||
| 266 | fail: | ||
| 267 | return err; | ||
| 327 | } | 268 | } |
| 328 | 269 | ||
| 329 | static void dma_mmu_get_scsi_sgl (struct NCR_ESP *esp, Scsi_Cmnd *sp) | 270 | static int __devexit esp_sun3x_remove(struct platform_device *dev) |
| 330 | { | 271 | { |
| 331 | int sz = sp->SCp.buffers_residual; | 272 | struct esp *esp = dev_get_drvdata(&dev->dev); |
| 332 | struct scatterlist *sg = sp->SCp.buffer; | 273 | unsigned int irq = esp->host->irq; |
| 333 | 274 | u32 val; | |
| 334 | while (sz >= 0) { | ||
| 335 | sg[sz].dma_address = dvma_map((unsigned long)sg_virt(&sg[sz]), | ||
| 336 | sg[sz].length); | ||
| 337 | sz--; | ||
| 338 | } | ||
| 339 | sp->SCp.ptr=(char *)((unsigned long)sp->SCp.buffer->dma_address); | ||
| 340 | } | ||
| 341 | 275 | ||
| 342 | static void dma_mmu_release_scsi_one (struct NCR_ESP *esp, Scsi_Cmnd *sp) | 276 | scsi_esp_unregister(esp); |
| 343 | { | ||
| 344 | dvma_unmap((char *)sp->SCp.have_data_in); | ||
| 345 | } | ||
| 346 | 277 | ||
| 347 | static void dma_mmu_release_scsi_sgl (struct NCR_ESP *esp, Scsi_Cmnd *sp) | 278 | /* Disable interrupts. */ |
| 348 | { | 279 | val = dma_read32(DMA_CSR); |
| 349 | int sz = sp->use_sg - 1; | 280 | dma_write32(val & ~DMA_INT_ENAB, DMA_CSR); |
| 350 | struct scatterlist *sg = (struct scatterlist *)sp->request_buffer; | ||
| 351 | |||
| 352 | while(sz >= 0) { | ||
| 353 | dvma_unmap((char *)sg[sz].dma_address); | ||
| 354 | sz--; | ||
| 355 | } | ||
| 356 | } | ||
| 357 | 281 | ||
| 358 | static void dma_advance_sg (Scsi_Cmnd *sp) | 282 | free_irq(irq, esp); |
| 359 | { | 283 | dma_free_coherent(esp->dev, 16, |
| 360 | sp->SCp.ptr = (char *)((unsigned long)sp->SCp.buffer->dma_address); | 284 | esp->command_block, |
| 361 | } | 285 | esp->command_block_dma); |
| 362 | 286 | ||
| 363 | static int sun3x_esp_release(struct Scsi_Host *instance) | 287 | scsi_host_put(esp->host); |
| 364 | { | ||
| 365 | /* this code does not support being compiled as a module */ | ||
| 366 | return 1; | ||
| 367 | 288 | ||
| 289 | return 0; | ||
| 368 | } | 290 | } |
| 369 | 291 | ||
| 370 | static struct scsi_host_template driver_template = { | 292 | static struct platform_driver esp_sun3x_driver = { |
| 371 | .proc_name = "sun3x_esp", | 293 | .probe = esp_sun3x_probe, |
| 372 | .proc_info = &esp_proc_info, | 294 | .remove = __devexit_p(esp_sun3x_remove), |
| 373 | .name = "Sun ESP 100/100a/200", | 295 | .driver = { |
| 374 | .detect = sun3x_esp_detect, | 296 | .name = "sun3x_esp", |
| 375 | .release = sun3x_esp_release, | 297 | }, |
| 376 | .slave_alloc = esp_slave_alloc, | ||
| 377 | .slave_destroy = esp_slave_destroy, | ||
| 378 | .info = esp_info, | ||
| 379 | .queuecommand = esp_queue, | ||
| 380 | .eh_abort_handler = esp_abort, | ||
| 381 | .eh_bus_reset_handler = esp_reset, | ||
| 382 | .can_queue = 7, | ||
| 383 | .this_id = 7, | ||
| 384 | .sg_tablesize = SG_ALL, | ||
| 385 | .cmd_per_lun = 1, | ||
| 386 | .use_clustering = DISABLE_CLUSTERING, | ||
| 387 | }; | 298 | }; |
| 388 | 299 | ||
| 300 | static int __init sun3x_esp_init(void) | ||
| 301 | { | ||
| 302 | return platform_driver_register(&esp_sun3x_driver); | ||
| 303 | } | ||
| 389 | 304 | ||
| 390 | #include "scsi_module.c" | 305 | static void __exit sun3x_esp_exit(void) |
| 306 | { | ||
| 307 | platform_driver_unregister(&esp_sun3x_driver); | ||
| 308 | } | ||
| 391 | 309 | ||
| 310 | MODULE_DESCRIPTION("Sun3x ESP SCSI driver"); | ||
| 311 | MODULE_AUTHOR("Thomas Bogendoerfer (tsbogend@alpha.franken.de)"); | ||
| 392 | MODULE_LICENSE("GPL"); | 312 | MODULE_LICENSE("GPL"); |
| 313 | MODULE_VERSION(DRV_VERSION); | ||
| 314 | |||
| 315 | module_init(sun3x_esp_init); | ||
| 316 | module_exit(sun3x_esp_exit); | ||
diff --git a/drivers/scsi/sym53c8xx_2/sym_hipd.c b/drivers/scsi/sym53c8xx_2/sym_hipd.c index 254bdaeb35ff..35142b5341b5 100644 --- a/drivers/scsi/sym53c8xx_2/sym_hipd.c +++ b/drivers/scsi/sym53c8xx_2/sym_hipd.c | |||
| @@ -3842,7 +3842,7 @@ int sym_compute_residual(struct sym_hcb *np, struct sym_ccb *cp) | |||
| 3842 | if (cp->startp == cp->phys.head.lastp || | 3842 | if (cp->startp == cp->phys.head.lastp || |
| 3843 | sym_evaluate_dp(np, cp, scr_to_cpu(cp->phys.head.lastp), | 3843 | sym_evaluate_dp(np, cp, scr_to_cpu(cp->phys.head.lastp), |
| 3844 | &dp_ofs) < 0) { | 3844 | &dp_ofs) < 0) { |
| 3845 | return cp->data_len; | 3845 | return cp->data_len - cp->odd_byte_adjustment; |
| 3846 | } | 3846 | } |
| 3847 | 3847 | ||
| 3848 | /* | 3848 | /* |
diff --git a/drivers/scsi/u14-34f.c b/drivers/scsi/u14-34f.c index 662c00451be4..58d7eee4fe81 100644 --- a/drivers/scsi/u14-34f.c +++ b/drivers/scsi/u14-34f.c | |||
| @@ -1216,7 +1216,7 @@ static void scsi_to_dev_dir(unsigned int i, unsigned int j) { | |||
| 1216 | cpp->xdir = DTD_IN; | 1216 | cpp->xdir = DTD_IN; |
| 1217 | return; | 1217 | return; |
| 1218 | } | 1218 | } |
| 1219 | else if (SCpnt->sc_data_direction == DMA_FROM_DEVICE) { | 1219 | else if (SCpnt->sc_data_direction == DMA_TO_DEVICE) { |
| 1220 | cpp->xdir = DTD_OUT; | 1220 | cpp->xdir = DTD_OUT; |
| 1221 | return; | 1221 | return; |
| 1222 | } | 1222 | } |
