blob: b8ab2796e66af83d42dc3f2112f7bd3ca6a651bf [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * Standard Hot Plug Controller Driver
3 *
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
8 *
9 * All rights reserved.
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 (at
14 * your option) any later version.
15 *
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
20 * details.
21 *
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.
25 *
Kristen Accardi8cf4c192005-08-16 15:16:10 -070026 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
Linus Torvalds1da177e2005-04-16 15:20:36 -070027 *
28 */
29
Linus Torvalds1da177e2005-04-16 15:20:36 -070030#include <linux/module.h>
31#include <linux/kernel.h>
32#include <linux/types.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#include <linux/pci.h>
Kenji Kaneshigef7391f52006-02-21 15:45:45 -080034#include <linux/workqueue.h>
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -070035#include "../pci.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070036#include "shpchp.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070037
David Howellsc4028952006-11-22 14:57:56 +000038static void interrupt_event_handler(struct work_struct *work);
Kenji Kaneshigea246fa42006-02-21 15:45:48 -080039static int shpchp_enable_slot(struct slot *p_slot);
40static int shpchp_disable_slot(struct slot *p_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -070041
Kenji Kaneshigef7391f52006-02-21 15:45:45 -080042static int queue_interrupt_event(struct slot *p_slot, u32 event_type)
43{
44 struct event_info *info;
45
46 info = kmalloc(sizeof(*info), GFP_ATOMIC);
47 if (!info)
48 return -ENOMEM;
49
50 info->event_type = event_type;
51 info->p_slot = p_slot;
David Howellsc4028952006-11-22 14:57:56 +000052 INIT_WORK(&info->work, interrupt_event_handler);
Kenji Kaneshigef7391f52006-02-21 15:45:45 -080053
Kenji Kaneshigea246fa42006-02-21 15:45:48 -080054 schedule_work(&info->work);
Kenji Kaneshigef7391f52006-02-21 15:45:45 -080055
56 return 0;
57}
Linus Torvalds1da177e2005-04-16 15:20:36 -070058
Kenji Kaneshige0abe68c2006-12-16 15:25:34 -080059u8 shpchp_handle_attention_button(u8 hp_slot, struct controller *ctrl)
Linus Torvalds1da177e2005-04-16 15:20:36 -070060{
Linus Torvalds1da177e2005-04-16 15:20:36 -070061 struct slot *p_slot;
Kenji Kaneshigef7391f52006-02-21 15:45:45 -080062 u32 event_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -070063
64 /* Attention Button Change */
Taku Izumibe7bce22008-10-23 11:54:39 +090065 ctrl_dbg(ctrl, "Attention button interrupt received\n");
Kenji Kaneshige9f593e32007-01-09 13:03:10 -080066
Linus Torvalds1da177e2005-04-16 15:20:36 -070067 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -070068 p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
Linus Torvalds1da177e2005-04-16 15:20:36 -070069
70 /*
71 * Button pressed - See if need to TAKE ACTION!!!
72 */
Taku Izumif98ca312008-10-23 11:52:12 +090073 ctrl_info(ctrl, "Button pressed on Slot(%s)\n", slot_name(p_slot));
Kenji Kaneshigef7391f52006-02-21 15:45:45 -080074 event_type = INT_BUTTON_PRESS;
Linus Torvalds1da177e2005-04-16 15:20:36 -070075
Kenji Kaneshigef7391f52006-02-21 15:45:45 -080076 queue_interrupt_event(p_slot, event_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -070077
78 return 0;
79
80}
81
Kenji Kaneshige0abe68c2006-12-16 15:25:34 -080082u8 shpchp_handle_switch_change(u8 hp_slot, struct controller *ctrl)
Linus Torvalds1da177e2005-04-16 15:20:36 -070083{
Linus Torvalds1da177e2005-04-16 15:20:36 -070084 struct slot *p_slot;
Linus Torvalds1da177e2005-04-16 15:20:36 -070085 u8 getstatus;
Kenji Kaneshigef7391f52006-02-21 15:45:45 -080086 u32 event_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -070087
88 /* Switch Change */
Taku Izumibe7bce22008-10-23 11:54:39 +090089 ctrl_dbg(ctrl, "Switch interrupt received\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -070090
Linus Torvalds1da177e2005-04-16 15:20:36 -070091 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -070092 p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
Linus Torvalds1da177e2005-04-16 15:20:36 -070093 p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
Taku Izumibe7bce22008-10-23 11:54:39 +090094 ctrl_dbg(ctrl, "Card present %x Power status %x\n",
95 p_slot->presence_save, p_slot->pwr_save);
Linus Torvalds1da177e2005-04-16 15:20:36 -070096
97 if (getstatus) {
98 /*
99 * Switch opened
100 */
Taku Izumif98ca312008-10-23 11:52:12 +0900101 ctrl_info(ctrl, "Latch open on Slot(%s)\n", slot_name(p_slot));
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800102 event_type = INT_SWITCH_OPEN;
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700103 if (p_slot->pwr_save && p_slot->presence_save) {
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800104 event_type = INT_POWER_FAULT;
Taku Izumif98ca312008-10-23 11:52:12 +0900105 ctrl_err(ctrl, "Surprise Removal of card\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106 }
107 } else {
108 /*
109 * Switch closed
110 */
Taku Izumif98ca312008-10-23 11:52:12 +0900111 ctrl_info(ctrl, "Latch close on Slot(%s)\n", slot_name(p_slot));
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800112 event_type = INT_SWITCH_CLOSE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113 }
114
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800115 queue_interrupt_event(p_slot, event_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800117 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118}
119
Kenji Kaneshige0abe68c2006-12-16 15:25:34 -0800120u8 shpchp_handle_presence_change(u8 hp_slot, struct controller *ctrl)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122 struct slot *p_slot;
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800123 u32 event_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700124
125 /* Presence Change */
Taku Izumibe7bce22008-10-23 11:54:39 +0900126 ctrl_dbg(ctrl, "Presence/Notify input change\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
129
Kenji Kaneshige9f593e32007-01-09 13:03:10 -0800130 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131 * Save the presence state
132 */
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700133 p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
134 if (p_slot->presence_save) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135 /*
136 * Card Present
137 */
Taku Izumif98ca312008-10-23 11:52:12 +0900138 ctrl_info(ctrl, "Card present on Slot(%s)\n",
139 slot_name(p_slot));
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800140 event_type = INT_PRESENCE_ON;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141 } else {
142 /*
143 * Not Present
144 */
Taku Izumif98ca312008-10-23 11:52:12 +0900145 ctrl_info(ctrl, "Card not present on Slot(%s)\n",
146 slot_name(p_slot));
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800147 event_type = INT_PRESENCE_OFF;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148 }
149
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800150 queue_interrupt_event(p_slot, event_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800152 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153}
154
Kenji Kaneshige0abe68c2006-12-16 15:25:34 -0800155u8 shpchp_handle_power_fault(u8 hp_slot, struct controller *ctrl)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700156{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157 struct slot *p_slot;
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800158 u32 event_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159
160 /* Power fault */
Taku Izumibe7bce22008-10-23 11:54:39 +0900161 ctrl_dbg(ctrl, "Power fault interrupt received\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162
Linus Torvalds1da177e2005-04-16 15:20:36 -0700163 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
164
165 if ( !(p_slot->hpc_ops->query_power_fault(p_slot))) {
166 /*
167 * Power fault Cleared
168 */
Taku Izumif98ca312008-10-23 11:52:12 +0900169 ctrl_info(ctrl, "Power fault cleared on Slot(%s)\n",
170 slot_name(p_slot));
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700171 p_slot->status = 0x00;
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800172 event_type = INT_POWER_FAULT_CLEAR;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700173 } else {
174 /*
175 * Power fault
176 */
Taku Izumif98ca312008-10-23 11:52:12 +0900177 ctrl_info(ctrl, "Power fault on Slot(%s)\n", slot_name(p_slot));
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800178 event_type = INT_POWER_FAULT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179 /* set power fault status for this board */
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700180 p_slot->status = 0xFF;
Taku Izumibe7bce22008-10-23 11:54:39 +0900181 ctrl_info(ctrl, "Power fault bit %x set\n", hp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800184 queue_interrupt_event(p_slot, event_type);
185
186 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187}
188
Kenji Kaneshige9f593e32007-01-09 13:03:10 -0800189/* The following routines constitute the bulk of the
Linus Torvalds1da177e2005-04-16 15:20:36 -0700190 hotplug controller logic
191 */
rajesh.shah@intel.comee138332005-10-13 12:05:42 -0700192static int change_bus_speed(struct controller *ctrl, struct slot *p_slot,
193 enum pci_bus_speed speed)
Kenji Kaneshige9f593e32007-01-09 13:03:10 -0800194{
rajesh.shah@intel.comee138332005-10-13 12:05:42 -0700195 int rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196
Taku Izumibe7bce22008-10-23 11:54:39 +0900197 ctrl_dbg(ctrl, "Change speed to %d\n", speed);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 if ((rc = p_slot->hpc_ops->set_bus_speed_mode(p_slot, speed))) {
Taku Izumif98ca312008-10-23 11:52:12 +0900199 ctrl_err(ctrl, "%s: Issue of set bus speed mode command "
200 "failed\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201 return WRONG_BUS_FREQUENCY;
202 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 return rc;
204}
205
rajesh.shah@intel.comee138332005-10-13 12:05:42 -0700206static int fix_bus_speed(struct controller *ctrl, struct slot *pslot,
207 u8 flag, enum pci_bus_speed asp, enum pci_bus_speed bsp,
208 enum pci_bus_speed msp)
Kenji Kaneshige9f593e32007-01-09 13:03:10 -0800209{
rajesh.shah@intel.comee138332005-10-13 12:05:42 -0700210 int rc = 0;
Kenji Kaneshige0afabe92006-03-01 14:55:11 +0900211
212 /*
213 * If other slots on the same bus are occupied, we cannot
214 * change the bus speed.
215 */
216 if (flag) {
217 if (asp < bsp) {
Taku Izumibe7bce22008-10-23 11:54:39 +0900218 ctrl_err(ctrl, "Speed of bus %x and adapter %x "
219 "mismatch\n", bsp, asp);
Kenji Kaneshige0afabe92006-03-01 14:55:11 +0900220 rc = WRONG_BUS_FREQUENCY;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221 }
Kenji Kaneshige0afabe92006-03-01 14:55:11 +0900222 return rc;
223 }
224
225 if (asp < msp) {
226 if (bsp != asp)
227 rc = change_bus_speed(ctrl, pslot, asp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 } else {
Kenji Kaneshige0afabe92006-03-01 14:55:11 +0900229 if (bsp != msp)
230 rc = change_bus_speed(ctrl, pslot, msp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231 }
232 return rc;
233}
234
235/**
236 * board_added - Called after a board has been added to the system.
Randy Dunlap26e6c662007-11-28 09:04:30 -0800237 * @p_slot: target &slot
Linus Torvalds1da177e2005-04-16 15:20:36 -0700238 *
Randy Dunlap26e6c662007-11-28 09:04:30 -0800239 * Turns power on for the board.
240 * Configures board.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241 */
rajesh.shah@intel.comee138332005-10-13 12:05:42 -0700242static int board_added(struct slot *p_slot)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243{
244 u8 hp_slot;
245 u8 slots_not_empty = 0;
rajesh.shah@intel.comee138332005-10-13 12:05:42 -0700246 int rc = 0;
Kenji Kaneshige0afabe92006-03-01 14:55:11 +0900247 enum pci_bus_speed asp, bsp, msp;
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700248 struct controller *ctrl = p_slot->ctrl;
Taku Izumibe7bce22008-10-23 11:54:39 +0900249 struct pci_bus *parent = ctrl->pci_dev->subordinate;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700251 hp_slot = p_slot->device - ctrl->slot_device_offset;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252
Taku Izumif98ca312008-10-23 11:52:12 +0900253 ctrl_dbg(ctrl,
254 "%s: p_slot->device, slot_offset, hp_slot = %d, %d ,%d\n",
255 __func__, p_slot->device, ctrl->slot_device_offset, hp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257 /* Power on slot without connecting to bus */
258 rc = p_slot->hpc_ops->power_on_slot(p_slot);
259 if (rc) {
Taku Izumibe7bce22008-10-23 11:54:39 +0900260 ctrl_err(ctrl, "Failed to power on slot\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261 return -1;
262 }
Kenji Kaneshige9f593e32007-01-09 13:03:10 -0800263
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264 if ((ctrl->pci_dev->vendor == 0x8086) && (ctrl->pci_dev->device == 0x0332)) {
265 if (slots_not_empty)
266 return WRONG_BUS_FREQUENCY;
Kenji Kaneshige9f593e32007-01-09 13:03:10 -0800267
Linus Torvalds1da177e2005-04-16 15:20:36 -0700268 if ((rc = p_slot->hpc_ops->set_bus_speed_mode(p_slot, PCI_SPEED_33MHz))) {
Taku Izumif98ca312008-10-23 11:52:12 +0900269 ctrl_err(ctrl, "%s: Issue of set bus speed mode command"
270 " failed\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 return WRONG_BUS_FREQUENCY;
272 }
Kenji Kaneshige9f593e32007-01-09 13:03:10 -0800273
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274 /* turn on board, blink green LED, turn off Amber LED */
275 if ((rc = p_slot->hpc_ops->slot_enable(p_slot))) {
Taku Izumibe7bce22008-10-23 11:54:39 +0900276 ctrl_err(ctrl, "Issue of Slot Enable command failed\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700277 return rc;
278 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279 }
Kenji Kaneshige9f593e32007-01-09 13:03:10 -0800280
Kenji Kaneshige0afabe92006-03-01 14:55:11 +0900281 rc = p_slot->hpc_ops->get_adapter_speed(p_slot, &asp);
282 if (rc) {
Taku Izumibe7bce22008-10-23 11:54:39 +0900283 ctrl_err(ctrl, "Can't get adapter speed or "
284 "bus mode mismatch\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285 return WRONG_BUS_FREQUENCY;
286 }
287
Kenji Kaneshige0afabe92006-03-01 14:55:11 +0900288 rc = p_slot->hpc_ops->get_cur_bus_speed(p_slot, &bsp);
289 if (rc) {
Taku Izumibe7bce22008-10-23 11:54:39 +0900290 ctrl_err(ctrl, "Can't get bus operation speed\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700291 return WRONG_BUS_FREQUENCY;
292 }
293
Kenji Kaneshige0afabe92006-03-01 14:55:11 +0900294 rc = p_slot->hpc_ops->get_max_bus_speed(p_slot, &msp);
295 if (rc) {
Taku Izumibe7bce22008-10-23 11:54:39 +0900296 ctrl_err(ctrl, "Can't get max bus operation speed\n");
Kenji Kaneshige0afabe92006-03-01 14:55:11 +0900297 msp = bsp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 }
299
300 /* Check if there are other slots or devices on the same bus */
301 if (!list_empty(&ctrl->pci_dev->subordinate->devices))
302 slots_not_empty = 1;
303
Taku Izumif98ca312008-10-23 11:52:12 +0900304 ctrl_dbg(ctrl, "%s: slots_not_empty %d, adapter_speed %d, bus_speed %d,"
305 " max_bus_speed %d\n", __func__, slots_not_empty, asp,
306 bsp, msp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307
Kenji Kaneshige0afabe92006-03-01 14:55:11 +0900308 rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, asp, bsp, msp);
309 if (rc)
310 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700311
Linus Torvalds1da177e2005-04-16 15:20:36 -0700312 /* turn on board, blink green LED, turn off Amber LED */
313 if ((rc = p_slot->hpc_ops->slot_enable(p_slot))) {
Taku Izumibe7bce22008-10-23 11:54:39 +0900314 ctrl_err(ctrl, "Issue of Slot Enable command failed\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315 return rc;
316 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700317
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318 /* Wait for ~1 second */
Kenji Kaneshige68c0b672006-02-21 15:45:42 -0800319 msleep(1000);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320
Taku Izumif98ca312008-10-23 11:52:12 +0900321 ctrl_dbg(ctrl, "%s: slot status = %x\n", __func__, p_slot->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322 /* Check for a power fault */
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700323 if (p_slot->status == 0xFF) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324 /* power fault occurred, but it was benign */
Taku Izumibe7bce22008-10-23 11:54:39 +0900325 ctrl_dbg(ctrl, "%s: Power fault\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700326 rc = POWER_FAILURE;
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700327 p_slot->status = 0;
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700328 goto err_exit;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329 }
330
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700331 if (shpchp_configure_device(p_slot)) {
Taku Izumibe7bce22008-10-23 11:54:39 +0900332 ctrl_err(ctrl, "Cannot add device at %04x:%02x:%02x\n",
333 pci_domain_nr(parent), p_slot->bus, p_slot->device);
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700334 goto err_exit;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700335 }
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700336
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700337 p_slot->status = 0;
338 p_slot->is_a_board = 0x01;
339 p_slot->pwr_save = 1;
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700340
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700341 p_slot->hpc_ops->green_led_on(p_slot);
342
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343 return 0;
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700344
345err_exit:
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700346 /* turn off slot, turn on Amber LED, turn off Green LED */
347 rc = p_slot->hpc_ops->slot_disable(p_slot);
348 if (rc) {
Taku Izumif98ca312008-10-23 11:52:12 +0900349 ctrl_err(ctrl, "%s: Issue of Slot Disable command failed\n",
350 __func__);
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700351 return rc;
352 }
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700353
rajesh.shah@intel.comdbd7a782005-10-13 12:05:36 -0700354 return(rc);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355}
356
357
358/**
Randy Dunlap26e6c662007-11-28 09:04:30 -0800359 * remove_board - Turns off slot and LEDs
360 * @p_slot: target &slot
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361 */
rajesh.shah@intel.comee138332005-10-13 12:05:42 -0700362static int remove_board(struct slot *p_slot)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363{
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700364 struct controller *ctrl = p_slot->ctrl;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365 u8 hp_slot;
rajesh.shah@intel.comee138332005-10-13 12:05:42 -0700366 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700368 if (shpchp_unconfigure_device(p_slot))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369 return(1);
370
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700371 hp_slot = p_slot->device - ctrl->slot_device_offset;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
373
Taku Izumibe7bce22008-10-23 11:54:39 +0900374 ctrl_dbg(ctrl, "%s: hp_slot = %d\n", __func__, hp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 /* Change status to shutdown */
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700377 if (p_slot->is_a_board)
378 p_slot->status = 0x01;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380 /* turn off slot, turn on Amber LED, turn off Green LED */
381 rc = p_slot->hpc_ops->slot_disable(p_slot);
382 if (rc) {
Taku Izumif98ca312008-10-23 11:52:12 +0900383 ctrl_err(ctrl, "%s: Issue of Slot Disable command failed\n",
384 __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385 return rc;
386 }
Kenji Kaneshige9f593e32007-01-09 13:03:10 -0800387
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388 rc = p_slot->hpc_ops->set_attention_status(p_slot, 0);
389 if (rc) {
Taku Izumibe7bce22008-10-23 11:54:39 +0900390 ctrl_err(ctrl, "Issue of Set Attention command failed\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391 return rc;
392 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700393
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700394 p_slot->pwr_save = 0;
395 p_slot->is_a_board = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396
397 return 0;
398}
399
400
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800401struct pushbutton_work_info {
402 struct slot *p_slot;
403 struct work_struct work;
404};
405
Linus Torvalds1da177e2005-04-16 15:20:36 -0700406/**
Randy Dunlap26e6c662007-11-28 09:04:30 -0800407 * shpchp_pushbutton_thread - handle pushbutton events
408 * @work: &struct work_struct to be handled
Linus Torvalds1da177e2005-04-16 15:20:36 -0700409 *
Randy Dunlap26e6c662007-11-28 09:04:30 -0800410 * Scheduled procedure to handle blocking stuff for the pushbuttons.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411 * Handles all pending events and exits.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700412 */
David Howellsc4028952006-11-22 14:57:56 +0000413static void shpchp_pushbutton_thread(struct work_struct *work)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414{
David Howellsc4028952006-11-22 14:57:56 +0000415 struct pushbutton_work_info *info =
416 container_of(work, struct pushbutton_work_info, work);
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800417 struct slot *p_slot = info->p_slot;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800419 mutex_lock(&p_slot->lock);
420 switch (p_slot->state) {
421 case POWEROFF_STATE:
422 mutex_unlock(&p_slot->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423 shpchp_disable_slot(p_slot);
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800424 mutex_lock(&p_slot->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425 p_slot->state = STATIC_STATE;
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800426 break;
427 case POWERON_STATE:
428 mutex_unlock(&p_slot->lock);
Kenji Kaneshiged29aadd2006-01-26 09:59:24 +0900429 if (shpchp_enable_slot(p_slot))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700430 p_slot->hpc_ops->green_led_off(p_slot);
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800431 mutex_lock(&p_slot->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432 p_slot->state = STATIC_STATE;
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800433 break;
434 default:
435 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436 }
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800437 mutex_unlock(&p_slot->lock);
438
439 kfree(info);
440}
441
Kristen Carlson Accardie325e1f2007-03-21 11:45:31 -0700442void shpchp_queue_pushbutton_work(struct work_struct *work)
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800443{
David Howellsc4028952006-11-22 14:57:56 +0000444 struct slot *p_slot = container_of(work, struct slot, work.work);
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800445 struct pushbutton_work_info *info;
446
447 info = kmalloc(sizeof(*info), GFP_KERNEL);
448 if (!info) {
Taku Izumif98ca312008-10-23 11:52:12 +0900449 ctrl_err(p_slot->ctrl, "%s: Cannot allocate memory\n",
450 __func__);
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800451 return;
452 }
453 info->p_slot = p_slot;
David Howellsc4028952006-11-22 14:57:56 +0000454 INIT_WORK(&info->work, shpchp_pushbutton_thread);
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800455
456 mutex_lock(&p_slot->lock);
457 switch (p_slot->state) {
458 case BLINKINGOFF_STATE:
459 p_slot->state = POWEROFF_STATE;
460 break;
461 case BLINKINGON_STATE:
462 p_slot->state = POWERON_STATE;
463 break;
464 default:
465 goto out;
466 }
467 queue_work(shpchp_wq, &info->work);
468 out:
469 mutex_unlock(&p_slot->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700470}
471
Linus Torvalds1da177e2005-04-16 15:20:36 -0700472static int update_slot_info (struct slot *slot)
473{
474 struct hotplug_slot_info *info;
475 int result;
476
477 info = kmalloc(sizeof(*info), GFP_KERNEL);
478 if (!info)
479 return -ENOMEM;
480
481 slot->hpc_ops->get_power_status(slot, &(info->power_status));
482 slot->hpc_ops->get_attention_status(slot, &(info->attention_status));
483 slot->hpc_ops->get_latch_status(slot, &(info->latch_status));
484 slot->hpc_ops->get_adapter_status(slot, &(info->adapter_status));
485
486 result = pci_hp_change_slot_info(slot->hotplug_slot, info);
487 kfree (info);
488 return result;
489}
490
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800491/*
492 * Note: This function must be called with slot->lock held
493 */
494static void handle_button_press_event(struct slot *p_slot)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700495{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496 u8 getstatus;
Taku Izumif98ca312008-10-23 11:52:12 +0900497 struct controller *ctrl = p_slot->ctrl;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700498
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800499 switch (p_slot->state) {
500 case STATIC_STATE:
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800501 p_slot->hpc_ops->get_power_status(p_slot, &getstatus);
502 if (getstatus) {
503 p_slot->state = BLINKINGOFF_STATE;
Taku Izumif98ca312008-10-23 11:52:12 +0900504 ctrl_info(ctrl, "PCI slot #%s - powering off due to "
505 "button press.\n", slot_name(p_slot));
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800506 } else {
507 p_slot->state = BLINKINGON_STATE;
Taku Izumif98ca312008-10-23 11:52:12 +0900508 ctrl_info(ctrl, "PCI slot #%s - powering on due to "
509 "button press.\n", slot_name(p_slot));
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800510 }
511 /* blink green LED and turn off amber */
512 p_slot->hpc_ops->green_led_blink(p_slot);
513 p_slot->hpc_ops->set_attention_status(p_slot, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800515 schedule_delayed_work(&p_slot->work, 5*HZ);
516 break;
517 case BLINKINGOFF_STATE:
518 case BLINKINGON_STATE:
519 /*
520 * Cancel if we are still blinking; this means that we
521 * press the attention again before the 5 sec. limit
522 * expires to cancel hot-add or hot-remove
523 */
Taku Izumif98ca312008-10-23 11:52:12 +0900524 ctrl_info(ctrl, "Button cancel on Slot(%s)\n",
525 slot_name(p_slot));
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800526 cancel_delayed_work(&p_slot->work);
527 if (p_slot->state == BLINKINGOFF_STATE)
528 p_slot->hpc_ops->green_led_on(p_slot);
529 else
530 p_slot->hpc_ops->green_led_off(p_slot);
531 p_slot->hpc_ops->set_attention_status(p_slot, 0);
Taku Izumif98ca312008-10-23 11:52:12 +0900532 ctrl_info(ctrl, "PCI slot #%s - action canceled due to "
533 "button press\n", slot_name(p_slot));
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800534 p_slot->state = STATIC_STATE;
535 break;
536 case POWEROFF_STATE:
537 case POWERON_STATE:
538 /*
539 * Ignore if the slot is on power-on or power-off state;
540 * this means that the previous attention button action
541 * to hot-add or hot-remove is undergoing
542 */
Taku Izumif98ca312008-10-23 11:52:12 +0900543 ctrl_info(ctrl, "Button ignore on Slot(%s)\n",
544 slot_name(p_slot));
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800545 update_slot_info(p_slot);
546 break;
547 default:
Taku Izumif98ca312008-10-23 11:52:12 +0900548 ctrl_warn(ctrl, "Not a valid state\n");
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800549 break;
550 }
551}
552
David Howellsc4028952006-11-22 14:57:56 +0000553static void interrupt_event_handler(struct work_struct *work)
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800554{
David Howellsc4028952006-11-22 14:57:56 +0000555 struct event_info *info = container_of(work, struct event_info, work);
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800556 struct slot *p_slot = info->p_slot;
557
558 mutex_lock(&p_slot->lock);
559 switch (info->event_type) {
560 case INT_BUTTON_PRESS:
561 handle_button_press_event(p_slot);
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800562 break;
563 case INT_POWER_FAULT:
Taku Izumibe7bce22008-10-23 11:54:39 +0900564 ctrl_dbg(p_slot->ctrl, "%s: Power fault\n", __func__);
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800565 p_slot->hpc_ops->set_attention_status(p_slot, 1);
566 p_slot->hpc_ops->green_led_off(p_slot);
567 break;
568 default:
569 update_slot_info(p_slot);
570 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700571 }
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800572 mutex_unlock(&p_slot->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573
Kenji Kaneshigef7391f52006-02-21 15:45:45 -0800574 kfree(info);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575}
576
577
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800578static int shpchp_enable_slot (struct slot *p_slot)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579{
580 u8 getstatus = 0;
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900581 int rc, retval = -ENODEV;
Taku Izumif98ca312008-10-23 11:52:12 +0900582 struct controller *ctrl = p_slot->ctrl;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583
584 /* Check to see if (latch closed, card present, power off) */
Ingo Molnar6aa4cdd2006-01-13 16:02:15 +0100585 mutex_lock(&p_slot->ctrl->crit_sect);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700586 rc = p_slot->hpc_ops->get_adapter_status(p_slot, &getstatus);
587 if (rc || !getstatus) {
Taku Izumif98ca312008-10-23 11:52:12 +0900588 ctrl_info(ctrl, "No adapter on slot(%s)\n", slot_name(p_slot));
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900589 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590 }
591 rc = p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
592 if (rc || getstatus) {
Taku Izumif98ca312008-10-23 11:52:12 +0900593 ctrl_info(ctrl, "Latch open on slot(%s)\n", slot_name(p_slot));
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900594 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595 }
596 rc = p_slot->hpc_ops->get_power_status(p_slot, &getstatus);
597 if (rc || getstatus) {
Taku Izumif98ca312008-10-23 11:52:12 +0900598 ctrl_info(ctrl, "Already enabled on slot(%s)\n",
599 slot_name(p_slot));
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900600 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700603 p_slot->is_a_board = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604
605 /* We have to save the presence info for these slots */
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700606 p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
607 p_slot->hpc_ops->get_power_status(p_slot, &(p_slot->pwr_save));
Taku Izumif98ca312008-10-23 11:52:12 +0900608 ctrl_dbg(ctrl, "%s: p_slot->pwr_save %x\n", __func__, p_slot->pwr_save);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609 p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700610
Keck, David53044f32006-01-16 15:22:36 -0600611 if(((p_slot->ctrl->pci_dev->vendor == PCI_VENDOR_ID_AMD) ||
612 (p_slot->ctrl->pci_dev->device == PCI_DEVICE_ID_AMD_POGO_7458))
613 && p_slot->ctrl->num_slots == 1) {
614 /* handle amd pogo errata; this must be done before enable */
615 amd_pogo_errata_save_misc_reg(p_slot);
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900616 retval = board_added(p_slot);
Keck, David53044f32006-01-16 15:22:36 -0600617 /* handle amd pogo errata; this must be done after enable */
618 amd_pogo_errata_restore_misc_reg(p_slot);
619 } else
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900620 retval = board_added(p_slot);
Keck, David53044f32006-01-16 15:22:36 -0600621
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900622 if (retval) {
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700623 p_slot->hpc_ops->get_adapter_status(p_slot,
624 &(p_slot->presence_save));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625 p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626 }
627
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700628 update_slot_info(p_slot);
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900629 out:
630 mutex_unlock(&p_slot->ctrl->crit_sect);
631 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632}
633
634
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800635static int shpchp_disable_slot (struct slot *p_slot)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700636{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700637 u8 getstatus = 0;
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900638 int rc, retval = -ENODEV;
Taku Izumif98ca312008-10-23 11:52:12 +0900639 struct controller *ctrl = p_slot->ctrl;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700640
641 if (!p_slot->ctrl)
Dely Syee17fd92005-05-05 11:57:25 -0700642 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700643
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644 /* Check to see if (latch closed, card present, power on) */
Ingo Molnar6aa4cdd2006-01-13 16:02:15 +0100645 mutex_lock(&p_slot->ctrl->crit_sect);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900647 rc = p_slot->hpc_ops->get_adapter_status(p_slot, &getstatus);
648 if (rc || !getstatus) {
Taku Izumif98ca312008-10-23 11:52:12 +0900649 ctrl_info(ctrl, "No adapter on slot(%s)\n", slot_name(p_slot));
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900650 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700651 }
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900652 rc = p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
653 if (rc || getstatus) {
Taku Izumif98ca312008-10-23 11:52:12 +0900654 ctrl_info(ctrl, "Latch open on slot(%s)\n", slot_name(p_slot));
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900655 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700656 }
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900657 rc = p_slot->hpc_ops->get_power_status(p_slot, &getstatus);
658 if (rc || !getstatus) {
Taku Izumibe7bce22008-10-23 11:54:39 +0900659 ctrl_info(ctrl, "Already disabled on slot(%s)\n",
Taku Izumif98ca312008-10-23 11:52:12 +0900660 slot_name(p_slot));
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900661 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700663
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900664 retval = remove_board(p_slot);
rajesh.shah@intel.com2178bfa2005-10-13 12:05:41 -0700665 update_slot_info(p_slot);
Kenji Kaneshigeef3be542006-01-26 10:00:33 +0900666 out:
667 mutex_unlock(&p_slot->ctrl->crit_sect);
668 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700669}
670
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800671int shpchp_sysfs_enable_slot(struct slot *p_slot)
672{
673 int retval = -ENODEV;
Taku Izumif98ca312008-10-23 11:52:12 +0900674 struct controller *ctrl = p_slot->ctrl;
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800675
676 mutex_lock(&p_slot->lock);
677 switch (p_slot->state) {
678 case BLINKINGON_STATE:
679 cancel_delayed_work(&p_slot->work);
680 case STATIC_STATE:
681 p_slot->state = POWERON_STATE;
682 mutex_unlock(&p_slot->lock);
683 retval = shpchp_enable_slot(p_slot);
684 mutex_lock(&p_slot->lock);
685 p_slot->state = STATIC_STATE;
686 break;
687 case POWERON_STATE:
Taku Izumif98ca312008-10-23 11:52:12 +0900688 ctrl_info(ctrl, "Slot %s is already in powering on state\n",
689 slot_name(p_slot));
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800690 break;
691 case BLINKINGOFF_STATE:
692 case POWEROFF_STATE:
Taku Izumif98ca312008-10-23 11:52:12 +0900693 ctrl_info(ctrl, "Already enabled on slot %s\n",
694 slot_name(p_slot));
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800695 break;
696 default:
Taku Izumif98ca312008-10-23 11:52:12 +0900697 ctrl_err(ctrl, "Not a valid state on slot %s\n",
698 slot_name(p_slot));
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800699 break;
700 }
701 mutex_unlock(&p_slot->lock);
702
703 return retval;
704}
705
706int shpchp_sysfs_disable_slot(struct slot *p_slot)
707{
708 int retval = -ENODEV;
Taku Izumif98ca312008-10-23 11:52:12 +0900709 struct controller *ctrl = p_slot->ctrl;
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800710
711 mutex_lock(&p_slot->lock);
712 switch (p_slot->state) {
713 case BLINKINGOFF_STATE:
714 cancel_delayed_work(&p_slot->work);
715 case STATIC_STATE:
716 p_slot->state = POWEROFF_STATE;
717 mutex_unlock(&p_slot->lock);
718 retval = shpchp_disable_slot(p_slot);
719 mutex_lock(&p_slot->lock);
720 p_slot->state = STATIC_STATE;
721 break;
722 case POWEROFF_STATE:
Taku Izumif98ca312008-10-23 11:52:12 +0900723 ctrl_info(ctrl, "Slot %s is already in powering off state\n",
724 slot_name(p_slot));
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800725 break;
726 case BLINKINGON_STATE:
727 case POWERON_STATE:
Taku Izumif98ca312008-10-23 11:52:12 +0900728 ctrl_info(ctrl, "Already disabled on slot %s\n",
729 slot_name(p_slot));
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800730 break;
731 default:
Taku Izumif98ca312008-10-23 11:52:12 +0900732 ctrl_err(ctrl, "Not a valid state on slot %s\n",
733 slot_name(p_slot));
Kenji Kaneshigea246fa42006-02-21 15:45:48 -0800734 break;
735 }
736 mutex_unlock(&p_slot->lock);
737
738 return retval;
739}