Linux Audio

Check our new training course

Loading...
v5.4
  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * PCI Express Hot Plug Controller Driver
  4 *
  5 * Copyright (C) 1995,2001 Compaq Computer Corporation
  6 * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)
  7 * Copyright (C) 2001 IBM Corp.
  8 * Copyright (C) 2003-2004 Intel Corporation
  9 *
 10 * All rights reserved.
 11 *
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 12 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
 13 *
 14 */
 15
 16#define dev_fmt(fmt) "pciehp: " fmt
 17
 18#include <linux/kernel.h>
 19#include <linux/types.h>
 20#include <linux/pm_runtime.h>
 21#include <linux/pci.h>
 
 22#include "pciehp.h"
 23
 24/* The following routines constitute the bulk of the
 25   hotplug controller logic
 26 */
 
 
 
 
 
 
 27
 28#define SAFE_REMOVAL	 true
 29#define SURPRISE_REMOVAL false
 
 30
 31static void set_slot_off(struct controller *ctrl)
 
 
 
 
 
 32{
 
 
 
 
 
 
 33	/*
 34	 * Turn off slot, turn on attention indicator, turn off power
 35	 * indicator
 36	 */
 37	if (POWER_CTRL(ctrl)) {
 38		pciehp_power_off_slot(ctrl);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 39
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 40		/*
 41		 * After turning power off, we must wait for at least 1 second
 42		 * before taking any action that relies on power having been
 43		 * removed from the slot/adapter.
 44		 */
 45		msleep(1000);
 46	}
 47
 48	pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_OFF,
 49			      PCI_EXP_SLTCTL_ATTN_IND_ON);
 
 
 
 
 
 
 
 
 50}
 51
 52/**
 53 * board_added - Called after a board has been added to the system.
 54 * @ctrl: PCIe hotplug controller where board is added
 55 *
 56 * Turns power on for the board.
 57 * Configures board.
 58 */
 59static int board_added(struct controller *ctrl)
 60{
 61	int retval = 0;
 
 62	struct pci_bus *parent = ctrl->pcie->port->subordinate;
 63
 64	if (POWER_CTRL(ctrl)) {
 65		/* Power on slot */
 66		retval = pciehp_power_on_slot(ctrl);
 67		if (retval)
 68			return retval;
 69	}
 70
 71	pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_BLINK,
 72			      INDICATOR_NOOP);
 73
 74	/* Check link training status */
 75	retval = pciehp_check_link_status(ctrl);
 76	if (retval) {
 77		ctrl_err(ctrl, "Failed to check link status\n");
 78		goto err_exit;
 79	}
 80
 81	/* Check for a power fault */
 82	if (ctrl->power_fault_detected || pciehp_query_power_fault(ctrl)) {
 83		ctrl_err(ctrl, "Slot(%s): Power fault\n", slot_name(ctrl));
 84		retval = -EIO;
 85		goto err_exit;
 86	}
 87
 88	retval = pciehp_configure_device(ctrl);
 89	if (retval) {
 90		if (retval != -EEXIST) {
 91			ctrl_err(ctrl, "Cannot add device at %04x:%02x:00\n",
 92				 pci_domain_nr(parent), parent->number);
 93			goto err_exit;
 94		}
 95	}
 96
 97	pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_ON,
 98			      PCI_EXP_SLTCTL_ATTN_IND_OFF);
 
 99	return 0;
100
101err_exit:
102	set_slot_off(ctrl);
103	return retval;
104}
105
106/**
107 * remove_board - Turn off slot and Power Indicator
108 * @ctrl: PCIe hotplug controller where board is being removed
109 * @safe_removal: whether the board is safely removed (versus surprise removed)
110 */
111static void remove_board(struct controller *ctrl, bool safe_removal)
112{
113	pciehp_unconfigure_device(ctrl, safe_removal);
 
114
115	if (POWER_CTRL(ctrl)) {
116		pciehp_power_off_slot(ctrl);
 
117
 
 
 
 
 
 
 
 
118		/*
119		 * After turning power off, we must wait for at least 1 second
120		 * before taking any action that relies on power having been
121		 * removed from the slot/adapter.
122		 */
123		msleep(1000);
124
125		/* Ignore link or presence changes caused by power off */
126		atomic_and(~(PCI_EXP_SLTSTA_DLLSC | PCI_EXP_SLTSTA_PDC),
127			   &ctrl->pending_events);
128	}
129
130	pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_OFF,
131			      INDICATOR_NOOP);
 
 
 
132}
133
134static int pciehp_enable_slot(struct controller *ctrl);
135static int pciehp_disable_slot(struct controller *ctrl, bool safe_removal);
 
 
136
137void pciehp_request(struct controller *ctrl, int action)
 
 
 
 
 
 
 
138{
139	atomic_or(action, &ctrl->pending_events);
140	if (!pciehp_poll_mode)
141		irq_wake_thread(ctrl->pcie->irq, ctrl);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
142}
143
144void pciehp_queue_pushbutton_work(struct work_struct *work)
145{
146	struct controller *ctrl = container_of(work, struct controller,
147					       button_work.work);
148
149	mutex_lock(&ctrl->state_lock);
150	switch (ctrl->state) {
 
 
 
 
 
 
 
 
 
151	case BLINKINGOFF_STATE:
152		pciehp_request(ctrl, DISABLE_SLOT);
153		break;
154	case BLINKINGON_STATE:
155		pciehp_request(ctrl, PCI_EXP_SLTSTA_PDC);
156		break;
157	default:
158		break;
 
159	}
160	mutex_unlock(&ctrl->state_lock);
 
 
161}
162
163void pciehp_handle_button_press(struct controller *ctrl)
 
 
 
164{
165	mutex_lock(&ctrl->state_lock);
166	switch (ctrl->state) {
167	case OFF_STATE:
168	case ON_STATE:
169		if (ctrl->state == ON_STATE) {
170			ctrl->state = BLINKINGOFF_STATE;
171			ctrl_info(ctrl, "Slot(%s): Powering off due to button press\n",
172				  slot_name(ctrl));
 
 
 
173		} else {
174			ctrl->state = BLINKINGON_STATE;
175			ctrl_info(ctrl, "Slot(%s) Powering on due to button press\n",
176				  slot_name(ctrl));
 
177		}
178		/* blink power indicator and turn off attention */
179		pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_BLINK,
180				      PCI_EXP_SLTCTL_ATTN_IND_OFF);
181		schedule_delayed_work(&ctrl->button_work, 5 * HZ);
 
 
 
182		break;
183	case BLINKINGOFF_STATE:
184	case BLINKINGON_STATE:
185		/*
186		 * Cancel if we are still blinking; this means that we
187		 * press the attention again before the 5 sec. limit
188		 * expires to cancel hot-add or hot-remove
189		 */
190		ctrl_info(ctrl, "Slot(%s): Button cancel\n", slot_name(ctrl));
191		cancel_delayed_work(&ctrl->button_work);
192		if (ctrl->state == BLINKINGOFF_STATE) {
193			ctrl->state = ON_STATE;
194			pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_ON,
195					      PCI_EXP_SLTCTL_ATTN_IND_OFF);
196		} else {
197			ctrl->state = OFF_STATE;
198			pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_OFF,
199					      PCI_EXP_SLTCTL_ATTN_IND_OFF);
200		}
201		ctrl_info(ctrl, "Slot(%s): Action canceled due to button press\n",
202			  slot_name(ctrl));
 
 
 
203		break;
204	default:
205		ctrl_err(ctrl, "Slot(%s): Ignoring invalid state %#x\n",
206			 slot_name(ctrl), ctrl->state);
 
 
 
 
 
207		break;
208	}
209	mutex_unlock(&ctrl->state_lock);
210}
211
212void pciehp_handle_disable_request(struct controller *ctrl)
213{
214	mutex_lock(&ctrl->state_lock);
215	switch (ctrl->state) {
216	case BLINKINGON_STATE:
217	case BLINKINGOFF_STATE:
218		cancel_delayed_work(&ctrl->button_work);
219		break;
220	}
221	ctrl->state = POWEROFF_STATE;
222	mutex_unlock(&ctrl->state_lock);
223
224	ctrl->request_result = pciehp_disable_slot(ctrl, SAFE_REMOVAL);
225}
226
227void pciehp_handle_presence_or_link_change(struct controller *ctrl, u32 events)
 
 
 
228{
229	bool present, link_active;
 
230
231	/*
232	 * If the slot is on and presence or link has changed, turn it off.
233	 * Even if it's occupied again, we cannot assume the card is the same.
234	 */
235	mutex_lock(&ctrl->state_lock);
236	switch (ctrl->state) {
237	case BLINKINGOFF_STATE:
238		cancel_delayed_work(&ctrl->button_work);
239		/* fall through */
240	case ON_STATE:
241		ctrl->state = POWEROFF_STATE;
242		mutex_unlock(&ctrl->state_lock);
243		if (events & PCI_EXP_SLTSTA_DLLSC)
244			ctrl_info(ctrl, "Slot(%s): Link Down\n",
245				  slot_name(ctrl));
246		if (events & PCI_EXP_SLTSTA_PDC)
247			ctrl_info(ctrl, "Slot(%s): Card not present\n",
248				  slot_name(ctrl));
249		pciehp_disable_slot(ctrl, SURPRISE_REMOVAL);
250		break;
251	default:
252		mutex_unlock(&ctrl->state_lock);
253		break;
254	}
255
256	/* Turn the slot on if it's occupied or link is up */
257	mutex_lock(&ctrl->state_lock);
258	present = pciehp_card_present(ctrl);
259	link_active = pciehp_check_link_active(ctrl);
260	if (!present && !link_active) {
261		mutex_unlock(&ctrl->state_lock);
262		return;
263	}
 
 
264
265	switch (ctrl->state) {
266	case BLINKINGON_STATE:
267		cancel_delayed_work(&ctrl->button_work);
268		/* fall through */
269	case OFF_STATE:
270		ctrl->state = POWERON_STATE;
271		mutex_unlock(&ctrl->state_lock);
272		if (present)
273			ctrl_info(ctrl, "Slot(%s): Card present\n",
274				  slot_name(ctrl));
275		if (link_active)
276			ctrl_info(ctrl, "Slot(%s): Link Up\n",
277				  slot_name(ctrl));
278		ctrl->request_result = pciehp_enable_slot(ctrl);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
279		break;
280	default:
281		mutex_unlock(&ctrl->state_lock);
282		break;
283	}
 
 
 
284}
285
286static int __pciehp_enable_slot(struct controller *ctrl)
287{
288	u8 getstatus = 0;
 
 
289
290	if (MRL_SENS(ctrl)) {
291		pciehp_get_latch_status(ctrl, &getstatus);
292		if (getstatus) {
293			ctrl_info(ctrl, "Slot(%s): Latch open\n",
294				  slot_name(ctrl));
 
 
 
 
 
295			return -ENODEV;
296		}
297	}
298
299	if (POWER_CTRL(ctrl)) {
300		pciehp_get_power_status(ctrl, &getstatus);
301		if (getstatus) {
302			ctrl_info(ctrl, "Slot(%s): Already enabled\n",
303				  slot_name(ctrl));
304			return 0;
305		}
306	}
307
308	return board_added(ctrl);
309}
310
311static int pciehp_enable_slot(struct controller *ctrl)
312{
313	int ret;
314
315	pm_runtime_get_sync(&ctrl->pcie->port->dev);
316	ret = __pciehp_enable_slot(ctrl);
317	if (ret && ATTN_BUTTN(ctrl))
318		/* may be blinking */
319		pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_OFF,
320				      INDICATOR_NOOP);
321	pm_runtime_put(&ctrl->pcie->port->dev);
322
323	mutex_lock(&ctrl->state_lock);
324	ctrl->state = ret ? OFF_STATE : ON_STATE;
325	mutex_unlock(&ctrl->state_lock);
326
327	return ret;
328}
329
330static int __pciehp_disable_slot(struct controller *ctrl, bool safe_removal)
 
331{
332	u8 getstatus = 0;
 
 
333
334	if (POWER_CTRL(ctrl)) {
335		pciehp_get_power_status(ctrl, &getstatus);
336		if (!getstatus) {
337			ctrl_info(ctrl, "Slot(%s): Already disabled\n",
338				  slot_name(ctrl));
339			return -EINVAL;
 
 
 
340		}
341	}
342
343	remove_board(ctrl, safe_removal);
344	return 0;
345}
346
347static int pciehp_disable_slot(struct controller *ctrl, bool safe_removal)
348{
349	int ret;
350
351	pm_runtime_get_sync(&ctrl->pcie->port->dev);
352	ret = __pciehp_disable_slot(ctrl, safe_removal);
353	pm_runtime_put(&ctrl->pcie->port->dev);
354
355	mutex_lock(&ctrl->state_lock);
356	ctrl->state = OFF_STATE;
357	mutex_unlock(&ctrl->state_lock);
 
 
 
 
 
358
359	return ret;
360}
361
362int pciehp_sysfs_enable_slot(struct hotplug_slot *hotplug_slot)
363{
364	struct controller *ctrl = to_ctrl(hotplug_slot);
 
365
366	mutex_lock(&ctrl->state_lock);
367	switch (ctrl->state) {
368	case BLINKINGON_STATE:
369	case OFF_STATE:
370		mutex_unlock(&ctrl->state_lock);
371		/*
372		 * The IRQ thread becomes a no-op if the user pulls out the
373		 * card before the thread wakes up, so initialize to -ENODEV.
374		 */
375		ctrl->request_result = -ENODEV;
376		pciehp_request(ctrl, PCI_EXP_SLTSTA_PDC);
377		wait_event(ctrl->requester,
378			   !atomic_read(&ctrl->pending_events));
379		return ctrl->request_result;
380	case POWERON_STATE:
381		ctrl_info(ctrl, "Slot(%s): Already in powering on state\n",
382			  slot_name(ctrl));
383		break;
384	case BLINKINGOFF_STATE:
385	case ON_STATE:
386	case POWEROFF_STATE:
387		ctrl_info(ctrl, "Slot(%s): Already enabled\n",
388			  slot_name(ctrl));
389		break;
390	default:
391		ctrl_err(ctrl, "Slot(%s): Invalid state %#x\n",
392			 slot_name(ctrl), ctrl->state);
393		break;
394	}
395	mutex_unlock(&ctrl->state_lock);
396
397	return -ENODEV;
398}
399
400int pciehp_sysfs_disable_slot(struct hotplug_slot *hotplug_slot)
401{
402	struct controller *ctrl = to_ctrl(hotplug_slot);
 
403
404	mutex_lock(&ctrl->state_lock);
405	switch (ctrl->state) {
406	case BLINKINGOFF_STATE:
407	case ON_STATE:
408		mutex_unlock(&ctrl->state_lock);
409		pciehp_request(ctrl, DISABLE_SLOT);
410		wait_event(ctrl->requester,
411			   !atomic_read(&ctrl->pending_events));
412		return ctrl->request_result;
 
 
413	case POWEROFF_STATE:
414		ctrl_info(ctrl, "Slot(%s): Already in powering off state\n",
415			  slot_name(ctrl));
416		break;
417	case BLINKINGON_STATE:
418	case OFF_STATE:
419	case POWERON_STATE:
420		ctrl_info(ctrl, "Slot(%s): Already disabled\n",
421			  slot_name(ctrl));
422		break;
423	default:
424		ctrl_err(ctrl, "Slot(%s): Invalid state %#x\n",
425			 slot_name(ctrl), ctrl->state);
426		break;
427	}
428	mutex_unlock(&ctrl->state_lock);
429
430	return -ENODEV;
431}
v3.5.6
 
  1/*
  2 * PCI Express 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 *
 26 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
 27 *
 28 */
 29
 30#include <linux/module.h>
 
 31#include <linux/kernel.h>
 32#include <linux/types.h>
 33#include <linux/slab.h>
 34#include <linux/pci.h>
 35#include "../pci.h"
 36#include "pciehp.h"
 37
 38static void interrupt_event_handler(struct work_struct *work);
 39
 40static int queue_interrupt_event(struct slot *p_slot, u32 event_type)
 41{
 42	struct event_info *info;
 43
 44	info = kmalloc(sizeof(*info), GFP_ATOMIC);
 45	if (!info)
 46		return -ENOMEM;
 47
 48	info->event_type = event_type;
 49	info->p_slot = p_slot;
 50	INIT_WORK(&info->work, interrupt_event_handler);
 51
 52	queue_work(pciehp_wq, &info->work);
 53
 54	return 0;
 55}
 56
 57u8 pciehp_handle_attention_button(struct slot *p_slot)
 58{
 59	u32 event_type;
 60	struct controller *ctrl = p_slot->ctrl;
 61
 62	/* Attention Button Change */
 63	ctrl_dbg(ctrl, "Attention button interrupt received\n");
 64
 65	/*
 66	 *  Button pressed - See if need to TAKE ACTION!!!
 
 67	 */
 68	ctrl_info(ctrl, "Button pressed on Slot(%s)\n", slot_name(p_slot));
 69	event_type = INT_BUTTON_PRESS;
 70
 71	queue_interrupt_event(p_slot, event_type);
 72
 73	return 0;
 74}
 75
 76u8 pciehp_handle_switch_change(struct slot *p_slot)
 77{
 78	u8 getstatus;
 79	u32 event_type;
 80	struct controller *ctrl = p_slot->ctrl;
 81
 82	/* Switch Change */
 83	ctrl_dbg(ctrl, "Switch interrupt received\n");
 84
 85	pciehp_get_latch_status(p_slot, &getstatus);
 86	if (getstatus) {
 87		/*
 88		 * Switch opened
 89		 */
 90		ctrl_info(ctrl, "Latch open on Slot(%s)\n", slot_name(p_slot));
 91		event_type = INT_SWITCH_OPEN;
 92	} else {
 93		/*
 94		 *  Switch closed
 95		 */
 96		ctrl_info(ctrl, "Latch close on Slot(%s)\n", slot_name(p_slot));
 97		event_type = INT_SWITCH_CLOSE;
 98	}
 99
100	queue_interrupt_event(p_slot, event_type);
101
102	return 1;
103}
104
105u8 pciehp_handle_presence_change(struct slot *p_slot)
106{
107	u32 event_type;
108	u8 presence_save;
109	struct controller *ctrl = p_slot->ctrl;
110
111	/* Presence Change */
112	ctrl_dbg(ctrl, "Presence/Notify input change\n");
113
114	/* Switch is open, assume a presence change
115	 * Save the presence state
116	 */
117	pciehp_get_adapter_status(p_slot, &presence_save);
118	if (presence_save) {
119		/*
120		 * Card Present
121		 */
122		ctrl_info(ctrl, "Card present on Slot(%s)\n", slot_name(p_slot));
123		event_type = INT_PRESENCE_ON;
124	} else {
125		/*
126		 * Not Present
127		 */
128		ctrl_info(ctrl, "Card not present on Slot(%s)\n",
129			  slot_name(p_slot));
130		event_type = INT_PRESENCE_OFF;
131	}
132
133	queue_interrupt_event(p_slot, event_type);
134
135	return 1;
136}
137
138u8 pciehp_handle_power_fault(struct slot *p_slot)
139{
140	u32 event_type;
141	struct controller *ctrl = p_slot->ctrl;
142
143	/* power fault */
144	ctrl_dbg(ctrl, "Power fault interrupt received\n");
145	ctrl_err(ctrl, "Power fault on slot %s\n", slot_name(p_slot));
146	event_type = INT_POWER_FAULT;
147	ctrl_info(ctrl, "Power fault bit %x set\n", 0);
148	queue_interrupt_event(p_slot, event_type);
149
150	return 1;
151}
152
153/* The following routines constitute the bulk of the
154   hotplug controller logic
155 */
156
157static void set_slot_off(struct controller *ctrl, struct slot * pslot)
158{
159	/* turn off slot, turn on Amber LED, turn off Green LED if supported*/
160	if (POWER_CTRL(ctrl)) {
161		if (pciehp_power_off_slot(pslot)) {
162			ctrl_err(ctrl,
163				 "Issue of Slot Power Off command failed\n");
164			return;
165		}
166		/*
167		 * After turning power off, we must wait for at least 1 second
168		 * before taking any action that relies on power having been
169		 * removed from the slot/adapter.
170		 */
171		msleep(1000);
172	}
173
174	if (PWR_LED(ctrl))
175		pciehp_green_led_off(pslot);
176
177	if (ATTN_LED(ctrl)) {
178		if (pciehp_set_attention_status(pslot, 1)) {
179			ctrl_err(ctrl,
180				 "Issue of Set Attention Led command failed\n");
181			return;
182		}
183	}
184}
185
186/**
187 * board_added - Called after a board has been added to the system.
188 * @p_slot: &slot where board is added
189 *
190 * Turns power on for the board.
191 * Configures board.
192 */
193static int board_added(struct slot *p_slot)
194{
195	int retval = 0;
196	struct controller *ctrl = p_slot->ctrl;
197	struct pci_bus *parent = ctrl->pcie->port->subordinate;
198
199	if (POWER_CTRL(ctrl)) {
200		/* Power on slot */
201		retval = pciehp_power_on_slot(p_slot);
202		if (retval)
203			return retval;
204	}
205
206	if (PWR_LED(ctrl))
207		pciehp_green_led_blink(p_slot);
208
209	/* Check link training status */
210	retval = pciehp_check_link_status(ctrl);
211	if (retval) {
212		ctrl_err(ctrl, "Failed to check link status\n");
213		goto err_exit;
214	}
215
216	/* Check for a power fault */
217	if (ctrl->power_fault_detected || pciehp_query_power_fault(p_slot)) {
218		ctrl_err(ctrl, "Power fault on slot %s\n", slot_name(p_slot));
219		retval = -EIO;
220		goto err_exit;
221	}
222
223	retval = pciehp_configure_device(p_slot);
224	if (retval) {
225		ctrl_err(ctrl, "Cannot add device at %04x:%02x:00\n",
226			 pci_domain_nr(parent), parent->number);
227		goto err_exit;
 
 
228	}
229
230	if (PWR_LED(ctrl))
231		pciehp_green_led_on(p_slot);
232
233	return 0;
234
235err_exit:
236	set_slot_off(ctrl, p_slot);
237	return retval;
238}
239
240/**
241 * remove_board - Turns off slot and LEDs
242 * @p_slot: slot where board is being removed
 
243 */
244static int remove_board(struct slot *p_slot)
245{
246	int retval = 0;
247	struct controller *ctrl = p_slot->ctrl;
248
249	retval = pciehp_unconfigure_device(p_slot);
250	if (retval)
251		return retval;
252
253	if (POWER_CTRL(ctrl)) {
254		/* power off slot */
255		retval = pciehp_power_off_slot(p_slot);
256		if (retval) {
257			ctrl_err(ctrl,
258				 "Issue of Slot Disable command failed\n");
259			return retval;
260		}
261		/*
262		 * After turning power off, we must wait for at least 1 second
263		 * before taking any action that relies on power having been
264		 * removed from the slot/adapter.
265		 */
266		msleep(1000);
 
 
 
 
267	}
268
269	/* turn off Green LED */
270	if (PWR_LED(ctrl))
271		pciehp_green_led_off(p_slot);
272
273	return 0;
274}
275
276struct power_work_info {
277	struct slot *p_slot;
278	struct work_struct work;
279};
280
281/**
282 * pciehp_power_thread - handle pushbutton events
283 * @work: &struct work_struct describing work to be done
284 *
285 * Scheduled procedure to handle blocking stuff for the pushbuttons.
286 * Handles all pending events and exits.
287 */
288static void pciehp_power_thread(struct work_struct *work)
289{
290	struct power_work_info *info =
291		container_of(work, struct power_work_info, work);
292	struct slot *p_slot = info->p_slot;
293
294	mutex_lock(&p_slot->lock);
295	switch (p_slot->state) {
296	case POWEROFF_STATE:
297		mutex_unlock(&p_slot->lock);
298		ctrl_dbg(p_slot->ctrl,
299			 "Disabling domain:bus:device=%04x:%02x:00\n",
300			 pci_domain_nr(p_slot->ctrl->pcie->port->subordinate),
301			 p_slot->ctrl->pcie->port->subordinate->number);
302		pciehp_disable_slot(p_slot);
303		mutex_lock(&p_slot->lock);
304		p_slot->state = STATIC_STATE;
305		break;
306	case POWERON_STATE:
307		mutex_unlock(&p_slot->lock);
308		if (pciehp_enable_slot(p_slot) && PWR_LED(p_slot->ctrl))
309			pciehp_green_led_off(p_slot);
310		mutex_lock(&p_slot->lock);
311		p_slot->state = STATIC_STATE;
312		break;
313	default:
314		break;
315	}
316	mutex_unlock(&p_slot->lock);
317
318	kfree(info);
319}
320
321void pciehp_queue_pushbutton_work(struct work_struct *work)
322{
323	struct slot *p_slot = container_of(work, struct slot, work.work);
324	struct power_work_info *info;
325
326	info = kmalloc(sizeof(*info), GFP_KERNEL);
327	if (!info) {
328		ctrl_err(p_slot->ctrl, "%s: Cannot allocate memory\n",
329			 __func__);
330		return;
331	}
332	info->p_slot = p_slot;
333	INIT_WORK(&info->work, pciehp_power_thread);
334
335	mutex_lock(&p_slot->lock);
336	switch (p_slot->state) {
337	case BLINKINGOFF_STATE:
338		p_slot->state = POWEROFF_STATE;
339		break;
340	case BLINKINGON_STATE:
341		p_slot->state = POWERON_STATE;
342		break;
343	default:
344		kfree(info);
345		goto out;
346	}
347	queue_work(pciehp_wq, &info->work);
348 out:
349	mutex_unlock(&p_slot->lock);
350}
351
352/*
353 * Note: This function must be called with slot->lock held
354 */
355static void handle_button_press_event(struct slot *p_slot)
356{
357	struct controller *ctrl = p_slot->ctrl;
358	u8 getstatus;
359
360	switch (p_slot->state) {
361	case STATIC_STATE:
362		pciehp_get_power_status(p_slot, &getstatus);
363		if (getstatus) {
364			p_slot->state = BLINKINGOFF_STATE;
365			ctrl_info(ctrl,
366				  "PCI slot #%s - powering off due to button "
367				  "press.\n", slot_name(p_slot));
368		} else {
369			p_slot->state = BLINKINGON_STATE;
370			ctrl_info(ctrl,
371				  "PCI slot #%s - powering on due to button "
372				  "press.\n", slot_name(p_slot));
373		}
374		/* blink green LED and turn off amber */
375		if (PWR_LED(ctrl))
376			pciehp_green_led_blink(p_slot);
377		if (ATTN_LED(ctrl))
378			pciehp_set_attention_status(p_slot, 0);
379
380		queue_delayed_work(pciehp_wq, &p_slot->work, 5*HZ);
381		break;
382	case BLINKINGOFF_STATE:
383	case BLINKINGON_STATE:
384		/*
385		 * Cancel if we are still blinking; this means that we
386		 * press the attention again before the 5 sec. limit
387		 * expires to cancel hot-add or hot-remove
388		 */
389		ctrl_info(ctrl, "Button cancel on Slot(%s)\n", slot_name(p_slot));
390		cancel_delayed_work(&p_slot->work);
391		if (p_slot->state == BLINKINGOFF_STATE) {
392			if (PWR_LED(ctrl))
393				pciehp_green_led_on(p_slot);
 
394		} else {
395			if (PWR_LED(ctrl))
396				pciehp_green_led_off(p_slot);
 
397		}
398		if (ATTN_LED(ctrl))
399			pciehp_set_attention_status(p_slot, 0);
400		ctrl_info(ctrl, "PCI slot #%s - action canceled "
401			  "due to button press\n", slot_name(p_slot));
402		p_slot->state = STATIC_STATE;
403		break;
404	case POWEROFF_STATE:
405	case POWERON_STATE:
406		/*
407		 * Ignore if the slot is on power-on or power-off state;
408		 * this means that the previous attention button action
409		 * to hot-add or hot-remove is undergoing
410		 */
411		ctrl_info(ctrl, "Button ignore on Slot(%s)\n", slot_name(p_slot));
412		break;
413	default:
414		ctrl_warn(ctrl, "Not a valid state\n");
 
 
 
 
 
 
 
 
 
415		break;
416	}
 
 
 
 
417}
418
419/*
420 * Note: This function must be called with slot->lock held
421 */
422static void handle_surprise_event(struct slot *p_slot)
423{
424	u8 getstatus;
425	struct power_work_info *info;
426
427	info = kmalloc(sizeof(*info), GFP_KERNEL);
428	if (!info) {
429		ctrl_err(p_slot->ctrl, "%s: Cannot allocate memory\n",
430			 __func__);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
431		return;
432	}
433	info->p_slot = p_slot;
434	INIT_WORK(&info->work, pciehp_power_thread);
435
436	pciehp_get_adapter_status(p_slot, &getstatus);
437	if (!getstatus)
438		p_slot->state = POWEROFF_STATE;
439	else
440		p_slot->state = POWERON_STATE;
441
442	queue_work(pciehp_wq, &info->work);
443}
444
445static void interrupt_event_handler(struct work_struct *work)
446{
447	struct event_info *info = container_of(work, struct event_info, work);
448	struct slot *p_slot = info->p_slot;
449	struct controller *ctrl = p_slot->ctrl;
450
451	mutex_lock(&p_slot->lock);
452	switch (info->event_type) {
453	case INT_BUTTON_PRESS:
454		handle_button_press_event(p_slot);
455		break;
456	case INT_POWER_FAULT:
457		if (!POWER_CTRL(ctrl))
458			break;
459		if (ATTN_LED(ctrl))
460			pciehp_set_attention_status(p_slot, 1);
461		if (PWR_LED(ctrl))
462			pciehp_green_led_off(p_slot);
463		break;
464	case INT_PRESENCE_ON:
465	case INT_PRESENCE_OFF:
466		if (!HP_SUPR_RM(ctrl))
467			break;
468		ctrl_dbg(ctrl, "Surprise Removal\n");
469		handle_surprise_event(p_slot);
470		break;
471	default:
 
472		break;
473	}
474	mutex_unlock(&p_slot->lock);
475
476	kfree(info);
477}
478
479int pciehp_enable_slot(struct slot *p_slot)
480{
481	u8 getstatus = 0;
482	int rc;
483	struct controller *ctrl = p_slot->ctrl;
484
485	rc = pciehp_get_adapter_status(p_slot, &getstatus);
486	if (rc || !getstatus) {
487		ctrl_info(ctrl, "No adapter on slot(%s)\n", slot_name(p_slot));
488		return -ENODEV;
489	}
490	if (MRL_SENS(p_slot->ctrl)) {
491		rc = pciehp_get_latch_status(p_slot, &getstatus);
492		if (rc || getstatus) {
493			ctrl_info(ctrl, "Latch open on slot(%s)\n",
494				  slot_name(p_slot));
495			return -ENODEV;
496		}
497	}
498
499	if (POWER_CTRL(p_slot->ctrl)) {
500		rc = pciehp_get_power_status(p_slot, &getstatus);
501		if (rc || getstatus) {
502			ctrl_info(ctrl, "Already enabled on slot(%s)\n",
503				  slot_name(p_slot));
504			return -EINVAL;
505		}
506	}
507
508	pciehp_get_latch_status(p_slot, &getstatus);
 
509
510	rc = board_added(p_slot);
511	if (rc) {
512		pciehp_get_latch_status(p_slot, &getstatus);
513	}
514	return rc;
 
 
 
 
 
 
 
 
 
 
 
 
515}
516
517
518int pciehp_disable_slot(struct slot *p_slot)
519{
520	u8 getstatus = 0;
521	int ret = 0;
522	struct controller *ctrl = p_slot->ctrl;
523
524	if (!p_slot->ctrl)
525		return 1;
526
527	if (!HP_SUPR_RM(p_slot->ctrl)) {
528		ret = pciehp_get_adapter_status(p_slot, &getstatus);
529		if (ret || !getstatus) {
530			ctrl_info(ctrl, "No adapter on slot(%s)\n",
531				  slot_name(p_slot));
532			return -ENODEV;
533		}
534	}
535
536	if (MRL_SENS(p_slot->ctrl)) {
537		ret = pciehp_get_latch_status(p_slot, &getstatus);
538		if (ret || getstatus) {
539			ctrl_info(ctrl, "Latch open on slot(%s)\n",
540				  slot_name(p_slot));
541			return -ENODEV;
542		}
543	}
 
 
 
544
545	if (POWER_CTRL(p_slot->ctrl)) {
546		ret = pciehp_get_power_status(p_slot, &getstatus);
547		if (ret || !getstatus) {
548			ctrl_info(ctrl, "Already disabled on slot(%s)\n",
549				  slot_name(p_slot));
550			return -EINVAL;
551		}
552	}
553
554	return remove_board(p_slot);
555}
556
557int pciehp_sysfs_enable_slot(struct slot *p_slot)
558{
559	int retval = -ENODEV;
560	struct controller *ctrl = p_slot->ctrl;
561
562	mutex_lock(&p_slot->lock);
563	switch (p_slot->state) {
564	case BLINKINGON_STATE:
565		cancel_delayed_work(&p_slot->work);
566	case STATIC_STATE:
567		p_slot->state = POWERON_STATE;
568		mutex_unlock(&p_slot->lock);
569		retval = pciehp_enable_slot(p_slot);
570		mutex_lock(&p_slot->lock);
571		p_slot->state = STATIC_STATE;
572		break;
 
 
 
573	case POWERON_STATE:
574		ctrl_info(ctrl, "Slot %s is already in powering on state\n",
575			  slot_name(p_slot));
576		break;
577	case BLINKINGOFF_STATE:
 
578	case POWEROFF_STATE:
579		ctrl_info(ctrl, "Already enabled on slot %s\n",
580			  slot_name(p_slot));
581		break;
582	default:
583		ctrl_err(ctrl, "Not a valid state on slot %s\n",
584			 slot_name(p_slot));
585		break;
586	}
587	mutex_unlock(&p_slot->lock);
588
589	return retval;
590}
591
592int pciehp_sysfs_disable_slot(struct slot *p_slot)
593{
594	int retval = -ENODEV;
595	struct controller *ctrl = p_slot->ctrl;
596
597	mutex_lock(&p_slot->lock);
598	switch (p_slot->state) {
599	case BLINKINGOFF_STATE:
600		cancel_delayed_work(&p_slot->work);
601	case STATIC_STATE:
602		p_slot->state = POWEROFF_STATE;
603		mutex_unlock(&p_slot->lock);
604		retval = pciehp_disable_slot(p_slot);
605		mutex_lock(&p_slot->lock);
606		p_slot->state = STATIC_STATE;
607		break;
608	case POWEROFF_STATE:
609		ctrl_info(ctrl, "Slot %s is already in powering off state\n",
610			  slot_name(p_slot));
611		break;
612	case BLINKINGON_STATE:
 
613	case POWERON_STATE:
614		ctrl_info(ctrl, "Already disabled on slot %s\n",
615			  slot_name(p_slot));
616		break;
617	default:
618		ctrl_err(ctrl, "Not a valid state on slot %s\n",
619			 slot_name(p_slot));
620		break;
621	}
622	mutex_unlock(&p_slot->lock);
623
624	return retval;
625}