2 * Standard PCI Hot Plug Driver
4 * Copyright (C) 1995,2001 Compaq Computer Corporation
5 * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)
6 * Copyright (C) 2001 IBM Corp.
7 * Copyright (C) 2003-2004 Intel Corporation
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 (at
14 * your option) any later version.
16 * This program is distributed in the hope that it will be useful, but
17 * WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
19 * NON INFRINGEMENT. See the GNU General Public License for more
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26 * Send feedback to <greg@kroah.com>,<kristen.c.accardi@intel.com>
30 #include <linux/kernel.h>
31 #include <linux/module.h>
32 #include <linux/types.h>
33 #include <linux/pci.h>
34 #include <linux/interrupt.h>
39 #define DBG_K_TRACE_ENTRY ((unsigned int)0x00000001) /* On function entry */
40 #define DBG_K_TRACE_EXIT ((unsigned int)0x00000002) /* On function exit */
41 #define DBG_K_INFO ((unsigned int)0x00000004) /* Info messages */
42 #define DBG_K_ERROR ((unsigned int)0x00000008) /* Error messages */
43 #define DBG_K_TRACE (DBG_K_TRACE_ENTRY|DBG_K_TRACE_EXIT)
44 #define DBG_K_STANDARD (DBG_K_INFO|DBG_K_ERROR|DBG_K_TRACE)
45 /* Redefine this flagword to set debug level */
46 #define DEBUG_LEVEL DBG_K_STANDARD
48 #define DEFINE_DBG_BUFFER char __dbg_str_buf[256];
50 #define DBG_PRINT( dbg_flags, args... ) \
52 if ( DEBUG_LEVEL & ( dbg_flags ) ) \
55 len = sprintf( __dbg_str_buf, "%s:%d: %s: ", \
56 __FILE__, __LINE__, __FUNCTION__ ); \
57 sprintf( __dbg_str_buf + len, args ); \
58 printk( KERN_NOTICE "%s\n", __dbg_str_buf ); \
62 #define DBG_ENTER_ROUTINE DBG_PRINT (DBG_K_TRACE_ENTRY, "%s", "[Entry]");
63 #define DBG_LEAVE_ROUTINE DBG_PRINT (DBG_K_TRACE_EXIT, "%s", "[Exit]");
65 #define DEFINE_DBG_BUFFER
66 #define DBG_ENTER_ROUTINE
67 #define DBG_LEAVE_ROUTINE
70 /* Slot Available Register I field definition */
71 #define SLOT_33MHZ 0x0000001f
72 #define SLOT_66MHZ_PCIX 0x00001f00
73 #define SLOT_100MHZ_PCIX 0x001f0000
74 #define SLOT_133MHZ_PCIX 0x1f000000
76 /* Slot Available Register II field definition */
77 #define SLOT_66MHZ 0x0000001f
78 #define SLOT_66MHZ_PCIX_266 0x00000f00
79 #define SLOT_100MHZ_PCIX_266 0x0000f000
80 #define SLOT_133MHZ_PCIX_266 0x000f0000
81 #define SLOT_66MHZ_PCIX_533 0x00f00000
82 #define SLOT_100MHZ_PCIX_533 0x0f000000
83 #define SLOT_133MHZ_PCIX_533 0xf0000000
86 /* Secondary Bus Configuration Register */
87 /* For PI = 1, Bits 0 to 2 have been encoded as follows to show current bus speed/mode */
90 #define PCIX_66MHZ 0x2
91 #define PCIX_100MHZ 0x3
92 #define PCIX_133MHZ 0x4
94 /* For PI = 2, Bits 0 to 3 have been encoded as follows to show current bus speed/mode */
97 #define PCIX_66MHZ 0x2
98 #define PCIX_100MHZ 0x3
99 #define PCIX_133MHZ 0x4
100 #define PCIX_66MHZ_ECC 0x5
101 #define PCIX_100MHZ_ECC 0x6
102 #define PCIX_133MHZ_ECC 0x7
103 #define PCIX_66MHZ_266 0x9
104 #define PCIX_100MHZ_266 0xa
105 #define PCIX_133MHZ_266 0xb
106 #define PCIX_66MHZ_533 0x11
107 #define PCIX_100MHZ_533 0x12
108 #define PCIX_133MHZ_533 0x13
110 /* Slot Configuration */
111 #define SLOT_NUM 0x0000001F
112 #define FIRST_DEV_NUM 0x00001F00
113 #define PSN 0x07FF0000
114 #define UPDOWN 0x20000000
115 #define MRLSENSOR 0x40000000
116 #define ATTN_BUTTON 0x80000000
118 /* Slot Status Field Definitions */
120 #define PWR_ONLY 0x0001
121 #define ENABLED 0x0002
122 #define DISABLED 0x0003
124 /* Power Indicator State */
125 #define PWR_LED_ON 0x0004
126 #define PWR_LED_BLINK 0x0008
127 #define PWR_LED_OFF 0x000c
129 /* Attention Indicator State */
130 #define ATTEN_LED_ON 0x0010
131 #define ATTEN_LED_BLINK 0x0020
132 #define ATTEN_LED_OFF 0x0030
135 #define pwr_fault 0x0040
137 /* Attention Button */
138 #define ATTEN_BUTTON 0x0080
141 #define MRL_SENSOR 0x0100
144 #define IS_66MHZ_CAP 0x0200
146 /* PRSNT1#/PRSNT2# */
147 #define SLOT_EMP 0x0c00
149 /* PCI-X Capability */
150 #define NON_PCIX 0x0000
151 #define PCIX_66 0x1000
152 #define PCIX_133 0x3000
153 #define PCIX_266 0x4000 /* For PI = 2 only */
154 #define PCIX_533 0x5000 /* For PI = 2 only */
156 /* SHPC 'write' operations/commands */
158 /* Slot operation - 0x00h to 0x3Fh */
160 #define NO_CHANGE 0x00
162 /* Slot state - Bits 0 & 1 of controller command register */
163 #define SET_SLOT_PWR 0x01
164 #define SET_SLOT_ENABLE 0x02
165 #define SET_SLOT_DISABLE 0x03
167 /* Power indicator state - Bits 2 & 3 of controller command register*/
168 #define SET_PWR_ON 0x04
169 #define SET_PWR_BLINK 0x08
170 #define SET_PWR_OFF 0x0C
172 /* Attention indicator state - Bits 4 & 5 of controller command register*/
173 #define SET_ATTN_ON 0x010
174 #define SET_ATTN_BLINK 0x020
175 #define SET_ATTN_OFF 0x030
177 /* Set bus speed/mode A - 0x40h to 0x47h */
178 #define SETA_PCI_33MHZ 0x40
179 #define SETA_PCI_66MHZ 0x41
180 #define SETA_PCIX_66MHZ 0x42
181 #define SETA_PCIX_100MHZ 0x43
182 #define SETA_PCIX_133MHZ 0x44
183 #define RESERV_1 0x45
184 #define RESERV_2 0x46
185 #define RESERV_3 0x47
187 /* Set bus speed/mode B - 0x50h to 0x5fh */
188 #define SETB_PCI_33MHZ 0x50
189 #define SETB_PCI_66MHZ 0x51
190 #define SETB_PCIX_66MHZ_PM 0x52
191 #define SETB_PCIX_100MHZ_PM 0x53
192 #define SETB_PCIX_133MHZ_PM 0x54
193 #define SETB_PCIX_66MHZ_EM 0x55
194 #define SETB_PCIX_100MHZ_EM 0x56
195 #define SETB_PCIX_133MHZ_EM 0x57
196 #define SETB_PCIX_66MHZ_266 0x58
197 #define SETB_PCIX_100MHZ_266 0x59
198 #define SETB_PCIX_133MHZ_266 0x5a
199 #define SETB_PCIX_66MHZ_533 0x5b
200 #define SETB_PCIX_100MHZ_533 0x5c
201 #define SETB_PCIX_133MHZ_533 0x5d
204 /* Power-on all slots - 0x48h */
205 #define SET_PWR_ON_ALL 0x48
207 /* Enable all slots - 0x49h */
208 #define SET_ENABLE_ALL 0x49
210 /* SHPC controller command error code */
211 #define SWITCH_OPEN 0x1
212 #define INVALID_CMD 0x2
213 #define INVALID_SPEED_MODE 0x4
215 /* For accessing SHPC Working Register Set */
216 #define DWORD_SELECT 0x2
217 #define DWORD_DATA 0x4
218 #define BASE_OFFSET 0x0
220 /* Field Offset in Logical Slot Register - byte boundary */
221 #define SLOT_EVENT_LATCH 0x2
222 #define SLOT_SERR_INT_MASK 0x3
224 static spinlock_t hpc_event_lock
;
226 DEFINE_DBG_BUFFER
/* Debug string buffer for entire HPC defined here */
227 static struct php_ctlr_state_s
*php_ctlr_list_head
; /* HPC state linked list */
228 static int ctlr_seq_num
= 0; /* Controller sequenc # */
229 static spinlock_t list_lock
;
231 static irqreturn_t
shpc_isr(int IRQ
, void *dev_id
, struct pt_regs
*regs
);
233 static void start_int_poll_timer(struct php_ctlr_state_s
*php_ctlr
, int seconds
);
235 /* This is the interrupt polling timeout function. */
236 static void int_poll_timeout(unsigned long lphp_ctlr
)
238 struct php_ctlr_state_s
*php_ctlr
= (struct php_ctlr_state_s
*)lphp_ctlr
;
243 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
247 /* Poll for interrupt events. regs == NULL => polling */
248 shpc_isr( 0, (void *)php_ctlr
, NULL
);
250 init_timer(&php_ctlr
->int_poll_timer
);
251 if (!shpchp_poll_time
)
252 shpchp_poll_time
= 2; /* reset timer to poll in 2 secs if user doesn't specify at module installation*/
254 start_int_poll_timer(php_ctlr
, shpchp_poll_time
);
259 /* This function starts the interrupt polling timer. */
260 static void start_int_poll_timer(struct php_ctlr_state_s
*php_ctlr
, int seconds
)
263 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
267 if ( ( seconds
<= 0 ) || ( seconds
> 60 ) )
268 seconds
= 2; /* Clamp to sane value */
270 php_ctlr
->int_poll_timer
.function
= &int_poll_timeout
;
271 php_ctlr
->int_poll_timer
.data
= (unsigned long)php_ctlr
; /* Instance data */
272 php_ctlr
->int_poll_timer
.expires
= jiffies
+ seconds
* HZ
;
273 add_timer(&php_ctlr
->int_poll_timer
);
278 static inline int shpc_wait_cmd(struct controller
*ctrl
)
281 unsigned int timeout_msec
= shpchp_poll_mode
? 2000 : 1000;
282 unsigned long timeout
= msecs_to_jiffies(timeout_msec
);
283 int rc
= wait_event_interruptible_timeout(ctrl
->queue
,
284 !ctrl
->cmd_busy
, timeout
);
287 err("Command not completed in %d msec\n", timeout_msec
);
290 info("Command was interrupted by a signal\n");
297 static int shpc_write_cmd(struct slot
*slot
, u8 t_slot
, u8 cmd
)
299 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
308 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
312 for (i
= 0; i
< 10; i
++) {
313 cmd_status
= readw(php_ctlr
->creg
+ CMD_STATUS
);
315 if (!(cmd_status
& 0x1))
317 /* Check every 0.1 sec for a total of 1 sec*/
321 cmd_status
= readw(php_ctlr
->creg
+ CMD_STATUS
);
323 if (cmd_status
& 0x1) {
324 /* After 1 sec and and the controller is still busy */
325 err("%s : Controller is still busy after 1 sec.\n", __FUNCTION__
);
330 temp_word
= (t_slot
<< 8) | (cmd
& 0xFF);
331 dbg("%s: t_slot %x cmd %x\n", __FUNCTION__
, t_slot
, cmd
);
333 /* To make sure the Controller Busy bit is 0 before we send out the
336 slot
->ctrl
->cmd_busy
= 1;
337 writew(temp_word
, php_ctlr
->creg
+ CMD
);
340 * Wait for command completion.
342 retval
= shpc_wait_cmd(slot
->ctrl
);
348 static int hpc_check_cmd_status(struct controller
*ctrl
)
350 struct php_ctlr_state_s
*php_ctlr
= ctrl
->hpc_ctlr_handle
;
356 if (!ctrl
->hpc_ctlr_handle
) {
357 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
361 cmd_status
= readw(php_ctlr
->creg
+ CMD_STATUS
) & 0x000F;
363 switch (cmd_status
>> 1) {
368 retval
= SWITCH_OPEN
;
369 err("%s: Switch opened!\n", __FUNCTION__
);
372 retval
= INVALID_CMD
;
373 err("%s: Invalid HPC command!\n", __FUNCTION__
);
376 retval
= INVALID_SPEED_MODE
;
377 err("%s: Invalid bus speed/mode!\n", __FUNCTION__
);
388 static int hpc_get_attention_status(struct slot
*slot
, u8
*status
)
390 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
397 if (!slot
->ctrl
->hpc_ctlr_handle
) {
398 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
402 slot_reg
= readl(php_ctlr
->creg
+ SLOT1
+ 4*(slot
->hp_slot
));
403 slot_status
= (u16
) slot_reg
;
404 atten_led_state
= (slot_status
& 0x0030) >> 4;
406 switch (atten_led_state
) {
408 *status
= 0xFF; /* Reserved */
411 *status
= 1; /* On */
414 *status
= 2; /* Blink */
417 *status
= 0; /* Off */
428 static int hpc_get_power_status(struct slot
* slot
, u8
*status
)
430 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
438 if (!slot
->ctrl
->hpc_ctlr_handle
) {
439 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
443 slot_reg
= readl(php_ctlr
->creg
+ SLOT1
+ 4*(slot
->hp_slot
));
444 slot_status
= (u16
) slot_reg
;
445 slot_state
= (slot_status
& 0x0003);
447 switch (slot_state
) {
452 *status
= 2; /* Powered only */
455 *status
= 1; /* Enabled */
458 *status
= 0; /* Disabled */
470 static int hpc_get_latch_status(struct slot
*slot
, u8
*status
)
472 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
478 if (!slot
->ctrl
->hpc_ctlr_handle
) {
479 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
483 slot_reg
= readl(php_ctlr
->creg
+ SLOT1
+ 4*(slot
->hp_slot
));
484 slot_status
= (u16
)slot_reg
;
486 *status
= ((slot_status
& 0x0100) == 0) ? 0 : 1; /* 0 -> close; 1 -> open */
493 static int hpc_get_adapter_status(struct slot
*slot
, u8
*status
)
495 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
502 if (!slot
->ctrl
->hpc_ctlr_handle
) {
503 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
507 slot_reg
= readl(php_ctlr
->creg
+ SLOT1
+ 4*(slot
->hp_slot
));
508 slot_status
= (u16
)slot_reg
;
509 card_state
= (u8
)((slot_status
& 0x0C00) >> 10);
510 *status
= (card_state
!= 0x3) ? 1 : 0;
516 static int hpc_get_prog_int(struct slot
*slot
, u8
*prog_int
)
518 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
522 if (!slot
->ctrl
->hpc_ctlr_handle
) {
523 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
527 *prog_int
= readb(php_ctlr
->creg
+ PROG_INTERFACE
);
533 static int hpc_get_adapter_speed(struct slot
*slot
, enum pci_bus_speed
*value
)
535 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
537 u16 slot_status
, sec_bus_status
;
538 u8 m66_cap
, pcix_cap
, pi
;
543 if (!slot
->ctrl
->hpc_ctlr_handle
) {
544 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
548 if (slot
->hp_slot
>= php_ctlr
->num_slots
) {
549 err("%s: Invalid HPC slot number!\n", __FUNCTION__
);
553 pi
= readb(php_ctlr
->creg
+ PROG_INTERFACE
);
554 slot_reg
= readl(php_ctlr
->creg
+ SLOT1
+ 4*(slot
->hp_slot
));
555 dbg("%s: pi = %d, slot_reg = %x\n", __FUNCTION__
, pi
, slot_reg
);
556 slot_status
= (u16
) slot_reg
;
557 dbg("%s: slot_status = %x\n", __FUNCTION__
, slot_status
);
558 sec_bus_status
= readw(php_ctlr
->creg
+ SEC_BUS_CONFIG
);
560 pcix_cap
= (u8
) ((slot_status
& 0x3000) >> 12);
561 dbg("%s: pcix_cap = %x\n", __FUNCTION__
, pcix_cap
);
562 m66_cap
= (u8
) ((slot_status
& 0x0200) >> 9);
563 dbg("%s: m66_cap = %x\n", __FUNCTION__
, m66_cap
);
569 *value
= m66_cap
? PCI_SPEED_66MHz
: PCI_SPEED_33MHz
;
572 *value
= PCI_SPEED_66MHz_PCIX
;
575 *value
= PCI_SPEED_133MHz_PCIX
;
578 *value
= PCI_SPEED_133MHz_PCIX_266
;
581 *value
= PCI_SPEED_133MHz_PCIX_533
;
583 case 2: /* Reserved */
585 *value
= PCI_SPEED_UNKNOWN
;
592 *value
= m66_cap
? PCI_SPEED_66MHz
: PCI_SPEED_33MHz
;
595 *value
= PCI_SPEED_66MHz_PCIX
;
598 *value
= PCI_SPEED_133MHz_PCIX
;
600 case 2: /* Reserved */
602 *value
= PCI_SPEED_UNKNOWN
;
608 dbg("Adapter speed = %d\n", *value
);
614 static int hpc_get_mode1_ECC_cap(struct slot
*slot
, u8
*mode
)
616 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
623 if (!slot
->ctrl
->hpc_ctlr_handle
) {
624 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
628 pi
= readb(php_ctlr
->creg
+ PROG_INTERFACE
);
629 sec_bus_status
= readw(php_ctlr
->creg
+ SEC_BUS_CONFIG
);
632 *mode
= (sec_bus_status
& 0x0100) >> 8;
637 dbg("Mode 1 ECC cap = %d\n", *mode
);
643 static int hpc_query_power_fault(struct slot
* slot
)
645 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
648 u8 pwr_fault_state
, status
;
652 if (!slot
->ctrl
->hpc_ctlr_handle
) {
653 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
657 slot_reg
= readl(php_ctlr
->creg
+ SLOT1
+ 4*(slot
->hp_slot
));
658 slot_status
= (u16
) slot_reg
;
659 pwr_fault_state
= (slot_status
& 0x0040) >> 7;
660 status
= (pwr_fault_state
== 1) ? 0 : 1;
663 /* Note: Logic 0 => fault */
667 static int hpc_set_attention_status(struct slot
*slot
, u8 value
)
669 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
673 if (!slot
->ctrl
->hpc_ctlr_handle
) {
674 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
678 if (slot
->hp_slot
>= php_ctlr
->num_slots
) {
679 err("%s: Invalid HPC slot number!\n", __FUNCTION__
);
685 slot_cmd
= 0x30; /* OFF */
688 slot_cmd
= 0x10; /* ON */
691 slot_cmd
= 0x20; /* BLINK */
697 shpc_write_cmd(slot
, slot
->hp_slot
, slot_cmd
);
703 static void hpc_set_green_led_on(struct slot
*slot
)
705 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
708 if (!slot
->ctrl
->hpc_ctlr_handle
) {
709 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
713 if (slot
->hp_slot
>= php_ctlr
->num_slots
) {
714 err("%s: Invalid HPC slot number!\n", __FUNCTION__
);
720 shpc_write_cmd(slot
, slot
->hp_slot
, slot_cmd
);
725 static void hpc_set_green_led_off(struct slot
*slot
)
727 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
730 if (!slot
->ctrl
->hpc_ctlr_handle
) {
731 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
735 if (slot
->hp_slot
>= php_ctlr
->num_slots
) {
736 err("%s: Invalid HPC slot number!\n", __FUNCTION__
);
742 shpc_write_cmd(slot
, slot
->hp_slot
, slot_cmd
);
747 static void hpc_set_green_led_blink(struct slot
*slot
)
749 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
752 if (!slot
->ctrl
->hpc_ctlr_handle
) {
753 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
757 if (slot
->hp_slot
>= php_ctlr
->num_slots
) {
758 err("%s: Invalid HPC slot number!\n", __FUNCTION__
);
764 shpc_write_cmd(slot
, slot
->hp_slot
, slot_cmd
);
769 int shpc_get_ctlr_slot_config(struct controller
*ctrl
,
770 int *num_ctlr_slots
, /* number of slots in this HPC */
771 int *first_device_num
, /* PCI dev num of the first slot in this SHPC */
772 int *physical_slot_num
, /* phy slot num of the first slot in this SHPC */
773 int *updown
, /* physical_slot_num increament: 1 or -1 */
776 struct php_ctlr_state_s
*php_ctlr
= ctrl
->hpc_ctlr_handle
;
780 if (!ctrl
->hpc_ctlr_handle
) {
781 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
785 *first_device_num
= php_ctlr
->slot_device_offset
; /* Obtained in shpc_init() */
786 *num_ctlr_slots
= php_ctlr
->num_slots
; /* Obtained in shpc_init() */
788 *physical_slot_num
= (readl(php_ctlr
->creg
+ SLOT_CONFIG
) & PSN
) >> 16;
789 dbg("%s: physical_slot_num = %x\n", __FUNCTION__
, *physical_slot_num
);
790 *updown
= ((readl(php_ctlr
->creg
+ SLOT_CONFIG
) & UPDOWN
) >> 29) ? 1 : -1;
796 static void hpc_release_ctlr(struct controller
*ctrl
)
798 struct php_ctlr_state_s
*php_ctlr
= ctrl
->hpc_ctlr_handle
;
799 struct php_ctlr_state_s
*p
, *p_prev
;
803 if (!ctrl
->hpc_ctlr_handle
) {
804 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
808 if (shpchp_poll_mode
) {
809 del_timer(&php_ctlr
->int_poll_timer
);
812 free_irq(php_ctlr
->irq
, ctrl
);
814 pci_disable_msi(php_ctlr
->pci_dev
);
817 if (php_ctlr
->pci_dev
) {
818 iounmap(php_ctlr
->creg
);
819 release_mem_region(ctrl
->mmio_base
, ctrl
->mmio_size
);
820 php_ctlr
->pci_dev
= NULL
;
823 spin_lock(&list_lock
);
824 p
= php_ctlr_list_head
;
829 p_prev
->pnext
= p
->pnext
;
831 php_ctlr_list_head
= p
->pnext
;
838 spin_unlock(&list_lock
);
846 static int hpc_power_on_slot(struct slot
* slot
)
848 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
854 if (!slot
->ctrl
->hpc_ctlr_handle
) {
855 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
859 if (slot
->hp_slot
>= php_ctlr
->num_slots
) {
860 err("%s: Invalid HPC slot number!\n", __FUNCTION__
);
865 retval
= shpc_write_cmd(slot
, slot
->hp_slot
, slot_cmd
);
868 err("%s: Write command failed!\n", __FUNCTION__
);
877 static int hpc_slot_enable(struct slot
* slot
)
879 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
885 if (!slot
->ctrl
->hpc_ctlr_handle
) {
886 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
890 if (slot
->hp_slot
>= php_ctlr
->num_slots
) {
891 err("%s: Invalid HPC slot number!\n", __FUNCTION__
);
894 /* 3A => Slot - Enable, Power Indicator - Blink, Attention Indicator - Off */
897 retval
= shpc_write_cmd(slot
, slot
->hp_slot
, slot_cmd
);
900 err("%s: Write command failed!\n", __FUNCTION__
);
908 static int hpc_slot_disable(struct slot
* slot
)
910 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
916 if (!slot
->ctrl
->hpc_ctlr_handle
) {
917 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
921 if (slot
->hp_slot
>= php_ctlr
->num_slots
) {
922 err("%s: Invalid HPC slot number!\n", __FUNCTION__
);
926 /* 1F => Slot - Disable, Power Indicator - Off, Attention Indicator - On */
929 retval
= shpc_write_cmd(slot
, slot
->hp_slot
, slot_cmd
);
932 err("%s: Write command failed!\n", __FUNCTION__
);
940 static int hpc_set_bus_speed_mode(struct slot
* slot
, enum pci_bus_speed value
)
945 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
949 if (!slot
->ctrl
->hpc_ctlr_handle
) {
950 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
954 pi
= readb(php_ctlr
->creg
+ PROG_INTERFACE
);
959 slot_cmd
= SETA_PCI_33MHZ
;
962 slot_cmd
= SETA_PCI_66MHZ
;
965 slot_cmd
= SETA_PCIX_66MHZ
;
968 slot_cmd
= SETA_PCIX_100MHZ
;
971 slot_cmd
= SETA_PCIX_133MHZ
;
974 slot_cmd
= PCI_SPEED_UNKNOWN
;
981 slot_cmd
= SETB_PCI_33MHZ
;
984 slot_cmd
= SETB_PCI_66MHZ
;
987 slot_cmd
= SETB_PCIX_66MHZ_PM
;
990 slot_cmd
= SETB_PCIX_100MHZ_PM
;
993 slot_cmd
= SETB_PCIX_133MHZ_PM
;
996 slot_cmd
= SETB_PCIX_66MHZ_EM
;
999 slot_cmd
= SETB_PCIX_100MHZ_EM
;
1002 slot_cmd
= SETB_PCIX_133MHZ_EM
;
1005 slot_cmd
= SETB_PCIX_66MHZ_266
;
1008 slot_cmd
= SETB_PCIX_100MHZ_266
;
1011 slot_cmd
= SETB_PCIX_133MHZ_266
;
1014 slot_cmd
= SETB_PCIX_66MHZ_533
;
1017 slot_cmd
= SETB_PCIX_100MHZ_533
;
1020 slot_cmd
= SETB_PCIX_133MHZ_533
;
1023 slot_cmd
= PCI_SPEED_UNKNOWN
;
1029 retval
= shpc_write_cmd(slot
, 0, slot_cmd
);
1031 err("%s: Write command failed!\n", __FUNCTION__
);
1039 static irqreturn_t
shpc_isr(int IRQ
, void *dev_id
, struct pt_regs
*regs
)
1041 struct controller
*ctrl
= NULL
;
1042 struct php_ctlr_state_s
*php_ctlr
;
1043 u8 schedule_flag
= 0;
1045 u32 temp_dword
, intr_loc
, intr_loc2
;
1051 if (!shpchp_poll_mode
) {
1052 ctrl
= (struct controller
*)dev_id
;
1053 php_ctlr
= ctrl
->hpc_ctlr_handle
;
1055 php_ctlr
= (struct php_ctlr_state_s
*) dev_id
;
1056 ctrl
= (struct controller
*)php_ctlr
->callback_instance_id
;
1062 if (!php_ctlr
|| !php_ctlr
->creg
)
1065 /* Check to see if it was our interrupt */
1066 intr_loc
= readl(php_ctlr
->creg
+ INTR_LOC
);
1070 dbg("%s: intr_loc = %x\n",__FUNCTION__
, intr_loc
);
1072 if(!shpchp_poll_mode
) {
1073 /* Mask Global Interrupt Mask - see implementation note on p. 139 */
1074 /* of SHPC spec rev 1.0*/
1075 temp_dword
= readl(php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1076 temp_dword
|= 0x00000001;
1077 writel(temp_dword
, php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1079 intr_loc2
= readl(php_ctlr
->creg
+ INTR_LOC
);
1080 dbg("%s: intr_loc2 = %x\n",__FUNCTION__
, intr_loc2
);
1083 if (intr_loc
& 0x0001) {
1085 * Command Complete Interrupt Pending
1086 * RO only - clear by writing 1 to the Command Completion
1087 * Detect bit in Controller SERR-INT register
1089 temp_dword
= readl(php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1090 temp_dword
&= 0xfffdffff;
1091 writel(temp_dword
, php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1093 wake_up_interruptible(&ctrl
->queue
);
1096 if ((intr_loc
= (intr_loc
>> 1)) == 0) {
1097 /* Unmask Global Interrupt Mask */
1098 temp_dword
= readl(php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1099 temp_dword
&= 0xfffffffe;
1100 writel(temp_dword
, php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1105 for (hp_slot
= 0; hp_slot
< ctrl
->num_slots
; hp_slot
++) {
1106 /* To find out which slot has interrupt pending */
1107 if ((intr_loc
>> hp_slot
) & 0x01) {
1108 temp_dword
= readl(php_ctlr
->creg
+ SLOT1
+ (4*hp_slot
));
1109 dbg("%s: Slot %x with intr, slot register = %x\n",
1110 __FUNCTION__
, hp_slot
, temp_dword
);
1111 temp_byte
= (temp_dword
>> 16) & 0xFF;
1112 if ((php_ctlr
->switch_change_callback
) && (temp_byte
& 0x08))
1113 schedule_flag
+= php_ctlr
->switch_change_callback(
1114 hp_slot
, php_ctlr
->callback_instance_id
);
1115 if ((php_ctlr
->attention_button_callback
) && (temp_byte
& 0x04))
1116 schedule_flag
+= php_ctlr
->attention_button_callback(
1117 hp_slot
, php_ctlr
->callback_instance_id
);
1118 if ((php_ctlr
->presence_change_callback
) && (temp_byte
& 0x01))
1119 schedule_flag
+= php_ctlr
->presence_change_callback(
1120 hp_slot
, php_ctlr
->callback_instance_id
);
1121 if ((php_ctlr
->power_fault_callback
) && (temp_byte
& 0x12))
1122 schedule_flag
+= php_ctlr
->power_fault_callback(
1123 hp_slot
, php_ctlr
->callback_instance_id
);
1125 /* Clear all slot events */
1126 temp_dword
= 0xe01f3fff;
1127 writel(temp_dword
, php_ctlr
->creg
+ SLOT1
+ (4*hp_slot
));
1129 intr_loc2
= readl(php_ctlr
->creg
+ INTR_LOC
);
1130 dbg("%s: intr_loc2 = %x\n",__FUNCTION__
, intr_loc2
);
1133 if (!shpchp_poll_mode
) {
1134 /* Unmask Global Interrupt Mask */
1135 temp_dword
= readl(php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1136 temp_dword
&= 0xfffffffe;
1137 writel(temp_dword
, php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1143 static int hpc_get_max_bus_speed (struct slot
*slot
, enum pci_bus_speed
*value
)
1145 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
1146 enum pci_bus_speed bus_speed
= PCI_SPEED_UNKNOWN
;
1149 u32 slot_avail1
, slot_avail2
;
1153 if (!slot
->ctrl
->hpc_ctlr_handle
) {
1154 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
1158 if (slot
->hp_slot
>= php_ctlr
->num_slots
) {
1159 err("%s: Invalid HPC slot number!\n", __FUNCTION__
);
1163 pi
= readb(php_ctlr
->creg
+ PROG_INTERFACE
);
1164 slot_avail1
= readl(php_ctlr
->creg
+ SLOT_AVAIL1
);
1165 slot_avail2
= readl(php_ctlr
->creg
+ SLOT_AVAIL2
);
1168 if (slot_avail2
& SLOT_133MHZ_PCIX_533
)
1169 bus_speed
= PCIX_133MHZ_533
;
1170 else if (slot_avail2
& SLOT_100MHZ_PCIX_533
)
1171 bus_speed
= PCIX_100MHZ_533
;
1172 else if (slot_avail2
& SLOT_66MHZ_PCIX_533
)
1173 bus_speed
= PCIX_66MHZ_533
;
1174 else if (slot_avail2
& SLOT_133MHZ_PCIX_266
)
1175 bus_speed
= PCIX_133MHZ_266
;
1176 else if (slot_avail2
& SLOT_100MHZ_PCIX_266
)
1177 bus_speed
= PCIX_100MHZ_266
;
1178 else if (slot_avail2
& SLOT_66MHZ_PCIX_266
)
1179 bus_speed
= PCIX_66MHZ_266
;
1180 else if (slot_avail1
& SLOT_133MHZ_PCIX
)
1181 bus_speed
= PCIX_133MHZ
;
1182 else if (slot_avail1
& SLOT_100MHZ_PCIX
)
1183 bus_speed
= PCIX_100MHZ
;
1184 else if (slot_avail1
& SLOT_66MHZ_PCIX
)
1185 bus_speed
= PCIX_66MHZ
;
1186 else if (slot_avail2
& SLOT_66MHZ
)
1187 bus_speed
= PCI_66MHZ
;
1188 else if (slot_avail1
& SLOT_33MHZ
)
1189 bus_speed
= PCI_33MHZ
;
1190 else bus_speed
= PCI_SPEED_UNKNOWN
;
1192 if (slot_avail1
& SLOT_133MHZ_PCIX
)
1193 bus_speed
= PCIX_133MHZ
;
1194 else if (slot_avail1
& SLOT_100MHZ_PCIX
)
1195 bus_speed
= PCIX_100MHZ
;
1196 else if (slot_avail1
& SLOT_66MHZ_PCIX
)
1197 bus_speed
= PCIX_66MHZ
;
1198 else if (slot_avail2
& SLOT_66MHZ
)
1199 bus_speed
= PCI_66MHZ
;
1200 else if (slot_avail1
& SLOT_33MHZ
)
1201 bus_speed
= PCI_33MHZ
;
1202 else bus_speed
= PCI_SPEED_UNKNOWN
;
1206 dbg("Max bus speed = %d\n", bus_speed
);
1211 static int hpc_get_cur_bus_speed (struct slot
*slot
, enum pci_bus_speed
*value
)
1213 struct php_ctlr_state_s
*php_ctlr
= slot
->ctrl
->hpc_ctlr_handle
;
1214 enum pci_bus_speed bus_speed
= PCI_SPEED_UNKNOWN
;
1221 if (!slot
->ctrl
->hpc_ctlr_handle
) {
1222 err("%s: Invalid HPC controller handle!\n", __FUNCTION__
);
1226 if (slot
->hp_slot
>= php_ctlr
->num_slots
) {
1227 err("%s: Invalid HPC slot number!\n", __FUNCTION__
);
1231 pi
= readb(php_ctlr
->creg
+ PROG_INTERFACE
);
1232 sec_bus_status
= readw(php_ctlr
->creg
+ SEC_BUS_CONFIG
);
1235 switch (sec_bus_status
& 0x000f) {
1237 bus_speed
= PCI_SPEED_33MHz
;
1240 bus_speed
= PCI_SPEED_66MHz
;
1243 bus_speed
= PCI_SPEED_66MHz_PCIX
;
1246 bus_speed
= PCI_SPEED_100MHz_PCIX
;
1249 bus_speed
= PCI_SPEED_133MHz_PCIX
;
1252 bus_speed
= PCI_SPEED_66MHz_PCIX_ECC
;
1255 bus_speed
= PCI_SPEED_100MHz_PCIX_ECC
;
1258 bus_speed
= PCI_SPEED_133MHz_PCIX_ECC
;
1261 bus_speed
= PCI_SPEED_66MHz_PCIX_266
;
1264 bus_speed
= PCI_SPEED_100MHz_PCIX_266
;
1267 bus_speed
= PCI_SPEED_133MHz_PCIX_266
;
1270 bus_speed
= PCI_SPEED_66MHz_PCIX_533
;
1273 bus_speed
= PCI_SPEED_100MHz_PCIX_533
;
1276 bus_speed
= PCI_SPEED_133MHz_PCIX_533
;
1281 bus_speed
= PCI_SPEED_UNKNOWN
;
1285 /* In the case where pi is undefined, default it to 1 */
1286 switch (sec_bus_status
& 0x0007) {
1288 bus_speed
= PCI_SPEED_33MHz
;
1291 bus_speed
= PCI_SPEED_66MHz
;
1294 bus_speed
= PCI_SPEED_66MHz_PCIX
;
1297 bus_speed
= PCI_SPEED_100MHz_PCIX
;
1300 bus_speed
= PCI_SPEED_133MHz_PCIX
;
1303 bus_speed
= PCI_SPEED_UNKNOWN
; /* Reserved */
1306 bus_speed
= PCI_SPEED_UNKNOWN
; /* Reserved */
1309 bus_speed
= PCI_SPEED_UNKNOWN
; /* Reserved */
1312 bus_speed
= PCI_SPEED_UNKNOWN
;
1318 dbg("Current bus speed = %d\n", bus_speed
);
1323 static struct hpc_ops shpchp_hpc_ops
= {
1324 .power_on_slot
= hpc_power_on_slot
,
1325 .slot_enable
= hpc_slot_enable
,
1326 .slot_disable
= hpc_slot_disable
,
1327 .set_bus_speed_mode
= hpc_set_bus_speed_mode
,
1328 .set_attention_status
= hpc_set_attention_status
,
1329 .get_power_status
= hpc_get_power_status
,
1330 .get_attention_status
= hpc_get_attention_status
,
1331 .get_latch_status
= hpc_get_latch_status
,
1332 .get_adapter_status
= hpc_get_adapter_status
,
1334 .get_max_bus_speed
= hpc_get_max_bus_speed
,
1335 .get_cur_bus_speed
= hpc_get_cur_bus_speed
,
1336 .get_adapter_speed
= hpc_get_adapter_speed
,
1337 .get_mode1_ECC_cap
= hpc_get_mode1_ECC_cap
,
1338 .get_prog_int
= hpc_get_prog_int
,
1340 .query_power_fault
= hpc_query_power_fault
,
1341 .green_led_on
= hpc_set_green_led_on
,
1342 .green_led_off
= hpc_set_green_led_off
,
1343 .green_led_blink
= hpc_set_green_led_blink
,
1345 .release_ctlr
= hpc_release_ctlr
,
1346 .check_cmd_status
= hpc_check_cmd_status
,
1349 inline static int shpc_indirect_creg_read(struct controller
*ctrl
, int index
,
1353 u32 cap_offset
= ctrl
->cap_offset
;
1354 struct pci_dev
*pdev
= ctrl
->pci_dev
;
1356 rc
= pci_write_config_byte(pdev
, cap_offset
+ DWORD_SELECT
, index
);
1359 return pci_read_config_dword(pdev
, cap_offset
+ DWORD_DATA
, value
);
1362 int shpc_init(struct controller
* ctrl
, struct pci_dev
* pdev
)
1364 struct php_ctlr_state_s
*php_ctlr
, *p
;
1365 void *instance_id
= ctrl
;
1366 int rc
, num_slots
= 0;
1368 static int first
= 1;
1369 u32 shpc_base_offset
;
1370 u32 tempdword
, slot_reg
;
1375 ctrl
->pci_dev
= pdev
; /* pci_dev of the P2P bridge */
1377 spin_lock_init(&list_lock
);
1378 php_ctlr
= (struct php_ctlr_state_s
*) kmalloc(sizeof(struct php_ctlr_state_s
), GFP_KERNEL
);
1380 if (!php_ctlr
) { /* allocate controller state data */
1381 err("%s: HPC controller memory allocation error!\n", __FUNCTION__
);
1385 memset(php_ctlr
, 0, sizeof(struct php_ctlr_state_s
));
1387 php_ctlr
->pci_dev
= pdev
; /* save pci_dev in context */
1389 if ((pdev
->vendor
== PCI_VENDOR_ID_AMD
) || (pdev
->device
==
1390 PCI_DEVICE_ID_AMD_GOLAM_7450
)) {
1391 /* amd shpc driver doesn't use Base Offset; assume 0 */
1392 ctrl
->mmio_base
= pci_resource_start(pdev
, 0);
1393 ctrl
->mmio_size
= pci_resource_len(pdev
, 0);
1395 ctrl
->cap_offset
= pci_find_capability(pdev
, PCI_CAP_ID_SHPC
);
1396 if (!ctrl
->cap_offset
) {
1397 err("%s : cap_offset == 0\n", __FUNCTION__
);
1398 goto abort_free_ctlr
;
1400 dbg("%s: cap_offset = %x\n", __FUNCTION__
, ctrl
->cap_offset
);
1402 rc
= shpc_indirect_creg_read(ctrl
, 0, &shpc_base_offset
);
1404 err("%s: cannot read base_offset\n", __FUNCTION__
);
1405 goto abort_free_ctlr
;
1408 rc
= shpc_indirect_creg_read(ctrl
, 3, &tempdword
);
1410 err("%s: cannot read slot config\n", __FUNCTION__
);
1411 goto abort_free_ctlr
;
1413 num_slots
= tempdword
& SLOT_NUM
;
1414 dbg("%s: num_slots (indirect) %x\n", __FUNCTION__
, num_slots
);
1416 for (i
= 0; i
< 9 + num_slots
; i
++) {
1417 rc
= shpc_indirect_creg_read(ctrl
, i
, &tempdword
);
1419 err("%s: cannot read creg (index = %d)\n",
1421 goto abort_free_ctlr
;
1423 dbg("%s: offset %d: value %x\n", __FUNCTION__
,i
,
1428 pci_resource_start(pdev
, 0) + shpc_base_offset
;
1429 ctrl
->mmio_size
= 0x24 + 0x4 * num_slots
;
1433 spin_lock_init(&hpc_event_lock
);
1437 info("HPC vendor_id %x device_id %x ss_vid %x ss_did %x\n", pdev
->vendor
, pdev
->device
, pdev
->subsystem_vendor
,
1438 pdev
->subsystem_device
);
1440 if (pci_enable_device(pdev
))
1441 goto abort_free_ctlr
;
1443 if (!request_mem_region(ctrl
->mmio_base
, ctrl
->mmio_size
, MY_NAME
)) {
1444 err("%s: cannot reserve MMIO region\n", __FUNCTION__
);
1445 goto abort_free_ctlr
;
1448 php_ctlr
->creg
= ioremap(ctrl
->mmio_base
, ctrl
->mmio_size
);
1449 if (!php_ctlr
->creg
) {
1450 err("%s: cannot remap MMIO region %lx @ %lx\n", __FUNCTION__
,
1451 ctrl
->mmio_size
, ctrl
->mmio_base
);
1452 release_mem_region(ctrl
->mmio_base
, ctrl
->mmio_size
);
1453 goto abort_free_ctlr
;
1455 dbg("%s: php_ctlr->creg %p\n", __FUNCTION__
, php_ctlr
->creg
);
1457 init_MUTEX(&ctrl
->crit_sect
);
1458 /* Setup wait queue */
1459 init_waitqueue_head(&ctrl
->queue
);
1462 php_ctlr
->irq
= pdev
->irq
;
1463 php_ctlr
->attention_button_callback
= shpchp_handle_attention_button
,
1464 php_ctlr
->switch_change_callback
= shpchp_handle_switch_change
;
1465 php_ctlr
->presence_change_callback
= shpchp_handle_presence_change
;
1466 php_ctlr
->power_fault_callback
= shpchp_handle_power_fault
;
1467 php_ctlr
->callback_instance_id
= instance_id
;
1469 /* Return PCI Controller Info */
1470 php_ctlr
->slot_device_offset
= (readl(php_ctlr
->creg
+ SLOT_CONFIG
) & FIRST_DEV_NUM
) >> 8;
1471 php_ctlr
->num_slots
= readl(php_ctlr
->creg
+ SLOT_CONFIG
) & SLOT_NUM
;
1472 dbg("%s: slot_device_offset %x\n", __FUNCTION__
, php_ctlr
->slot_device_offset
);
1473 dbg("%s: num_slots %x\n", __FUNCTION__
, php_ctlr
->num_slots
);
1475 /* Mask Global Interrupt Mask & Command Complete Interrupt Mask */
1476 tempdword
= readl(php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1477 dbg("%s: SERR_INTR_ENABLE = %x\n", __FUNCTION__
, tempdword
);
1478 tempdword
= 0x0003000f;
1479 writel(tempdword
, php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1480 tempdword
= readl(php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1481 dbg("%s: SERR_INTR_ENABLE = %x\n", __FUNCTION__
, tempdword
);
1483 /* Mask the MRL sensor SERR Mask of individual slot in
1484 * Slot SERR-INT Mask & clear all the existing event if any
1486 for (hp_slot
= 0; hp_slot
< php_ctlr
->num_slots
; hp_slot
++) {
1487 slot_reg
= readl(php_ctlr
->creg
+ SLOT1
+ 4*hp_slot
);
1488 dbg("%s: Default Logical Slot Register %d value %x\n", __FUNCTION__
,
1490 tempdword
= 0xffff3fff;
1491 writel(tempdword
, php_ctlr
->creg
+ SLOT1
+ (4*hp_slot
));
1494 if (shpchp_poll_mode
) {/* Install interrupt polling code */
1495 /* Install and start the interrupt polling timer */
1496 init_timer(&php_ctlr
->int_poll_timer
);
1497 start_int_poll_timer( php_ctlr
, 10 ); /* start with 10 second delay */
1499 /* Installs the interrupt handler */
1500 rc
= pci_enable_msi(pdev
);
1502 info("Can't get msi for the hotplug controller\n");
1503 info("Use INTx for the hotplug controller\n");
1505 php_ctlr
->irq
= pdev
->irq
;
1507 rc
= request_irq(php_ctlr
->irq
, shpc_isr
, SA_SHIRQ
, MY_NAME
, (void *) ctrl
);
1508 dbg("%s: request_irq %d for hpc%d (returns %d)\n", __FUNCTION__
, php_ctlr
->irq
, ctlr_seq_num
, rc
);
1510 err("Can't get irq %d for the hotplug controller\n", php_ctlr
->irq
);
1511 goto abort_free_ctlr
;
1514 dbg("%s: HPC at b:d:f:irq=0x%x:%x:%x:%x\n", __FUNCTION__
,
1515 pdev
->bus
->number
, PCI_SLOT(pdev
->devfn
),
1516 PCI_FUNC(pdev
->devfn
), pdev
->irq
);
1517 get_hp_hw_control_from_firmware(pdev
);
1519 /* Add this HPC instance into the HPC list */
1520 spin_lock(&list_lock
);
1521 if (php_ctlr_list_head
== 0) {
1522 php_ctlr_list_head
= php_ctlr
;
1523 p
= php_ctlr_list_head
;
1526 p
= php_ctlr_list_head
;
1531 p
->pnext
= php_ctlr
;
1533 spin_unlock(&list_lock
);
1537 ctrl
->hpc_ctlr_handle
= php_ctlr
;
1538 ctrl
->hpc_ops
= &shpchp_hpc_ops
;
1540 for (hp_slot
= 0; hp_slot
< php_ctlr
->num_slots
; hp_slot
++) {
1541 slot_reg
= readl(php_ctlr
->creg
+ SLOT1
+ 4*hp_slot
);
1542 dbg("%s: Default Logical Slot Register %d value %x\n", __FUNCTION__
,
1544 tempdword
= 0xe01f3fff;
1545 writel(tempdword
, php_ctlr
->creg
+ SLOT1
+ (4*hp_slot
));
1547 if (!shpchp_poll_mode
) {
1548 /* Unmask all general input interrupts and SERR */
1549 tempdword
= readl(php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1550 tempdword
= 0x0000000a;
1551 writel(tempdword
, php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1552 tempdword
= readl(php_ctlr
->creg
+ SERR_INTR_ENABLE
);
1553 dbg("%s: SERR_INTR_ENABLE = %x\n", __FUNCTION__
, tempdword
);
1559 /* We end up here for the many possible ways to fail this API. */