acpiphp_glue.c 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197
  1. /*
  2. * ACPI PCI HotPlug glue functions to ACPI CA subsystem
  3. *
  4. * Copyright (C) 2002,2003 Takayoshi Kochi (t-kochi@bq.jp.nec.com)
  5. * Copyright (C) 2002 Hiroshi Aono (h-aono@ap.jp.nec.com)
  6. * Copyright (C) 2002,2003 NEC Corporation
  7. * Copyright (C) 2003-2005 Matthew Wilcox (matthew.wilcox@hp.com)
  8. * Copyright (C) 2003-2005 Hewlett Packard
  9. * Copyright (C) 2005 Rajesh Shah (rajesh.shah@intel.com)
  10. * Copyright (C) 2005 Intel Corporation
  11. *
  12. * All rights reserved.
  13. *
  14. * This program is free software; you can redistribute it and/or modify
  15. * it under the terms of the GNU General Public License as published by
  16. * the Free Software Foundation; either version 2 of the License, or (at
  17. * your option) any later version.
  18. *
  19. * This program is distributed in the hope that it will be useful, but
  20. * WITHOUT ANY WARRANTY; without even the implied warranty of
  21. * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
  22. * NON INFRINGEMENT. See the GNU General Public License for more
  23. * details.
  24. *
  25. * You should have received a copy of the GNU General Public License
  26. * along with this program; if not, write to the Free Software
  27. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  28. *
  29. * Send feedback to <kristen.c.accardi@intel.com>
  30. *
  31. */
  32. /*
  33. * Lifetime rules for pci_dev:
  34. * - The one in acpiphp_bridge has its refcount elevated by pci_get_slot()
  35. * when the bridge is scanned and it loses a refcount when the bridge
  36. * is removed.
  37. * - When a P2P bridge is present, we elevate the refcount on the subordinate
  38. * bus. It loses the refcount when the the driver unloads.
  39. */
  40. #include <linux/init.h>
  41. #include <linux/module.h>
  42. #include <linux/kernel.h>
  43. #include <linux/pci.h>
  44. #include <linux/pci_hotplug.h>
  45. #include <linux/pci-acpi.h>
  46. #include <linux/mutex.h>
  47. #include <linux/slab.h>
  48. #include <linux/acpi.h>
  49. #include "../pci.h"
  50. #include "acpiphp.h"
  51. static LIST_HEAD(bridge_list);
  52. static DEFINE_MUTEX(bridge_mutex);
  53. static DEFINE_MUTEX(acpiphp_context_lock);
  54. #define MY_NAME "acpiphp_glue"
  55. static void handle_hotplug_event(acpi_handle handle, u32 type, void *data);
  56. static void acpiphp_sanitize_bus(struct pci_bus *bus);
  57. static void acpiphp_set_hpp_values(struct pci_bus *bus);
  58. static void hotplug_event(acpi_handle handle, u32 type, void *data);
  59. static void free_bridge(struct kref *kref);
  60. static void acpiphp_context_handler(acpi_handle handle, void *context)
  61. {
  62. /* Intentionally empty. */
  63. }
  64. /**
  65. * acpiphp_init_context - Create hotplug context and grab a reference to it.
  66. * @handle: ACPI object handle to create the context for.
  67. *
  68. * Call under acpiphp_context_lock.
  69. */
  70. static struct acpiphp_context *acpiphp_init_context(acpi_handle handle)
  71. {
  72. struct acpiphp_context *context;
  73. acpi_status status;
  74. context = kzalloc(sizeof(*context), GFP_KERNEL);
  75. if (!context)
  76. return NULL;
  77. context->handle = handle;
  78. context->refcount = 1;
  79. status = acpi_attach_data(handle, acpiphp_context_handler, context);
  80. if (ACPI_FAILURE(status)) {
  81. kfree(context);
  82. return NULL;
  83. }
  84. return context;
  85. }
  86. /**
  87. * acpiphp_get_context - Get hotplug context and grab a reference to it.
  88. * @handle: ACPI object handle to get the context for.
  89. *
  90. * Call under acpiphp_context_lock.
  91. */
  92. static struct acpiphp_context *acpiphp_get_context(acpi_handle handle)
  93. {
  94. struct acpiphp_context *context = NULL;
  95. acpi_status status;
  96. void *data;
  97. status = acpi_get_data(handle, acpiphp_context_handler, &data);
  98. if (ACPI_SUCCESS(status)) {
  99. context = data;
  100. context->refcount++;
  101. }
  102. return context;
  103. }
  104. /**
  105. * acpiphp_put_context - Drop a reference to ACPI hotplug context.
  106. * @handle: ACPI object handle to put the context for.
  107. *
  108. * The context object is removed if there are no more references to it.
  109. *
  110. * Call under acpiphp_context_lock.
  111. */
  112. static void acpiphp_put_context(struct acpiphp_context *context)
  113. {
  114. if (--context->refcount)
  115. return;
  116. WARN_ON(context->bridge);
  117. acpi_detach_data(context->handle, acpiphp_context_handler);
  118. kfree(context);
  119. }
  120. static inline void get_bridge(struct acpiphp_bridge *bridge)
  121. {
  122. kref_get(&bridge->ref);
  123. }
  124. static inline void put_bridge(struct acpiphp_bridge *bridge)
  125. {
  126. kref_put(&bridge->ref, free_bridge);
  127. }
  128. static void free_bridge(struct kref *kref)
  129. {
  130. struct acpiphp_context *context;
  131. struct acpiphp_bridge *bridge;
  132. struct acpiphp_slot *slot, *next;
  133. struct acpiphp_func *func, *tmp;
  134. mutex_lock(&acpiphp_context_lock);
  135. bridge = container_of(kref, struct acpiphp_bridge, ref);
  136. list_for_each_entry_safe(slot, next, &bridge->slots, node) {
  137. list_for_each_entry_safe(func, tmp, &slot->funcs, sibling)
  138. acpiphp_put_context(func_to_context(func));
  139. kfree(slot);
  140. }
  141. context = bridge->context;
  142. /* Root bridges will not have hotplug context. */
  143. if (context) {
  144. /* Release the reference taken by acpiphp_enumerate_slots(). */
  145. put_bridge(context->func.parent);
  146. context->bridge = NULL;
  147. acpiphp_put_context(context);
  148. }
  149. put_device(&bridge->pci_bus->dev);
  150. pci_dev_put(bridge->pci_dev);
  151. kfree(bridge);
  152. mutex_unlock(&acpiphp_context_lock);
  153. }
  154. /*
  155. * the _DCK method can do funny things... and sometimes not
  156. * hah-hah funny.
  157. *
  158. * TBD - figure out a way to only call fixups for
  159. * systems that require them.
  160. */
  161. static void post_dock_fixups(acpi_handle not_used, u32 event, void *data)
  162. {
  163. struct acpiphp_context *context = data;
  164. struct pci_bus *bus = context->func.slot->bus;
  165. u32 buses;
  166. if (!bus->self)
  167. return;
  168. /* fixup bad _DCK function that rewrites
  169. * secondary bridge on slot
  170. */
  171. pci_read_config_dword(bus->self,
  172. PCI_PRIMARY_BUS,
  173. &buses);
  174. if (((buses >> 8) & 0xff) != bus->busn_res.start) {
  175. buses = (buses & 0xff000000)
  176. | ((unsigned int)(bus->primary) << 0)
  177. | ((unsigned int)(bus->busn_res.start) << 8)
  178. | ((unsigned int)(bus->busn_res.end) << 16);
  179. pci_write_config_dword(bus->self, PCI_PRIMARY_BUS, buses);
  180. }
  181. }
  182. static const struct acpi_dock_ops acpiphp_dock_ops = {
  183. .fixup = post_dock_fixups,
  184. .handler = hotplug_event,
  185. };
  186. /* Check whether the PCI device is managed by native PCIe hotplug driver */
  187. static bool device_is_managed_by_native_pciehp(struct pci_dev *pdev)
  188. {
  189. u32 reg32;
  190. acpi_handle tmp;
  191. struct acpi_pci_root *root;
  192. /* Check whether the PCIe port supports native PCIe hotplug */
  193. if (pcie_capability_read_dword(pdev, PCI_EXP_SLTCAP, &reg32))
  194. return false;
  195. if (!(reg32 & PCI_EXP_SLTCAP_HPC))
  196. return false;
  197. /*
  198. * Check whether native PCIe hotplug has been enabled for
  199. * this PCIe hierarchy.
  200. */
  201. tmp = acpi_find_root_bridge_handle(pdev);
  202. if (!tmp)
  203. return false;
  204. root = acpi_pci_find_root(tmp);
  205. if (!root)
  206. return false;
  207. if (!(root->osc_control_set & OSC_PCI_EXPRESS_NATIVE_HP_CONTROL))
  208. return false;
  209. return true;
  210. }
  211. static void acpiphp_dock_init(void *data)
  212. {
  213. struct acpiphp_context *context = data;
  214. get_bridge(context->func.parent);
  215. }
  216. static void acpiphp_dock_release(void *data)
  217. {
  218. struct acpiphp_context *context = data;
  219. put_bridge(context->func.parent);
  220. }
  221. /* callback routine to register each ACPI PCI slot object */
  222. static acpi_status register_slot(acpi_handle handle, u32 lvl, void *data,
  223. void **rv)
  224. {
  225. struct acpiphp_bridge *bridge = data;
  226. struct acpiphp_context *context;
  227. struct acpiphp_slot *slot;
  228. struct acpiphp_func *newfunc;
  229. acpi_status status = AE_OK;
  230. unsigned long long adr;
  231. int device, function;
  232. struct pci_bus *pbus = bridge->pci_bus;
  233. struct pci_dev *pdev = bridge->pci_dev;
  234. u32 val;
  235. if (pdev && device_is_managed_by_native_pciehp(pdev))
  236. return AE_OK;
  237. status = acpi_evaluate_integer(handle, "_ADR", NULL, &adr);
  238. if (ACPI_FAILURE(status)) {
  239. acpi_handle_warn(handle, "can't evaluate _ADR (%#x)\n", status);
  240. return AE_OK;
  241. }
  242. device = (adr >> 16) & 0xffff;
  243. function = adr & 0xffff;
  244. mutex_lock(&acpiphp_context_lock);
  245. context = acpiphp_init_context(handle);
  246. if (!context) {
  247. mutex_unlock(&acpiphp_context_lock);
  248. acpi_handle_err(handle, "No hotplug context\n");
  249. return AE_NOT_EXIST;
  250. }
  251. newfunc = &context->func;
  252. newfunc->function = function;
  253. newfunc->parent = bridge;
  254. mutex_unlock(&acpiphp_context_lock);
  255. if (acpi_has_method(handle, "_EJ0"))
  256. newfunc->flags = FUNC_HAS_EJ0;
  257. if (acpi_has_method(handle, "_STA"))
  258. newfunc->flags |= FUNC_HAS_STA;
  259. if (acpi_has_method(handle, "_PS0"))
  260. newfunc->flags |= FUNC_HAS_PS0;
  261. if (acpi_has_method(handle, "_PS3"))
  262. newfunc->flags |= FUNC_HAS_PS3;
  263. if (acpi_has_method(handle, "_DCK"))
  264. newfunc->flags |= FUNC_HAS_DCK;
  265. /* search for objects that share the same slot */
  266. list_for_each_entry(slot, &bridge->slots, node)
  267. if (slot->device == device)
  268. goto slot_found;
  269. slot = kzalloc(sizeof(struct acpiphp_slot), GFP_KERNEL);
  270. if (!slot) {
  271. status = AE_NO_MEMORY;
  272. goto err;
  273. }
  274. slot->bus = bridge->pci_bus;
  275. slot->device = device;
  276. INIT_LIST_HEAD(&slot->funcs);
  277. mutex_init(&slot->crit_sect);
  278. mutex_lock(&bridge_mutex);
  279. list_add_tail(&slot->node, &bridge->slots);
  280. mutex_unlock(&bridge_mutex);
  281. /* Register slots for ejectable funtions only. */
  282. if (acpi_pci_check_ejectable(pbus, handle) || is_dock_device(handle)) {
  283. unsigned long long sun;
  284. int retval;
  285. bridge->nr_slots++;
  286. status = acpi_evaluate_integer(handle, "_SUN", NULL, &sun);
  287. if (ACPI_FAILURE(status))
  288. sun = bridge->nr_slots;
  289. dbg("found ACPI PCI Hotplug slot %llu at PCI %04x:%02x:%02x\n",
  290. sun, pci_domain_nr(pbus), pbus->number, device);
  291. retval = acpiphp_register_hotplug_slot(slot, sun);
  292. if (retval) {
  293. bridge->nr_slots--;
  294. if (retval == -EBUSY)
  295. warn("Slot %llu already registered by another "
  296. "hotplug driver\n", sun);
  297. else
  298. warn("acpiphp_register_hotplug_slot failed "
  299. "(err code = 0x%x)\n", retval);
  300. }
  301. /* Even if the slot registration fails, we can still use it. */
  302. }
  303. slot_found:
  304. newfunc->slot = slot;
  305. mutex_lock(&bridge_mutex);
  306. list_add_tail(&newfunc->sibling, &slot->funcs);
  307. mutex_unlock(&bridge_mutex);
  308. if (pci_bus_read_dev_vendor_id(pbus, PCI_DEVFN(device, function),
  309. &val, 60*1000))
  310. slot->flags |= (SLOT_ENABLED | SLOT_POWEREDON);
  311. if (is_dock_device(handle)) {
  312. /* we don't want to call this device's _EJ0
  313. * because we want the dock notify handler
  314. * to call it after it calls _DCK
  315. */
  316. newfunc->flags &= ~FUNC_HAS_EJ0;
  317. if (register_hotplug_dock_device(handle,
  318. &acpiphp_dock_ops, context,
  319. acpiphp_dock_init, acpiphp_dock_release))
  320. dbg("failed to register dock device\n");
  321. }
  322. /* install notify handler */
  323. if (!(newfunc->flags & FUNC_HAS_DCK)) {
  324. status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
  325. handle_hotplug_event,
  326. context);
  327. if (ACPI_FAILURE(status))
  328. acpi_handle_err(handle,
  329. "failed to install notify handler\n");
  330. }
  331. return AE_OK;
  332. err:
  333. mutex_lock(&acpiphp_context_lock);
  334. acpiphp_put_context(context);
  335. mutex_unlock(&acpiphp_context_lock);
  336. return status;
  337. }
  338. static struct acpiphp_bridge *acpiphp_handle_to_bridge(acpi_handle handle)
  339. {
  340. struct acpiphp_context *context;
  341. struct acpiphp_bridge *bridge = NULL;
  342. mutex_lock(&acpiphp_context_lock);
  343. context = acpiphp_get_context(handle);
  344. if (context) {
  345. bridge = context->bridge;
  346. if (bridge)
  347. get_bridge(bridge);
  348. acpiphp_put_context(context);
  349. }
  350. mutex_unlock(&acpiphp_context_lock);
  351. return bridge;
  352. }
  353. static void cleanup_bridge(struct acpiphp_bridge *bridge)
  354. {
  355. struct acpiphp_slot *slot;
  356. struct acpiphp_func *func;
  357. acpi_status status;
  358. list_for_each_entry(slot, &bridge->slots, node) {
  359. list_for_each_entry(func, &slot->funcs, sibling) {
  360. acpi_handle handle = func_to_handle(func);
  361. if (is_dock_device(handle))
  362. unregister_hotplug_dock_device(handle);
  363. if (!(func->flags & FUNC_HAS_DCK)) {
  364. status = acpi_remove_notify_handler(handle,
  365. ACPI_SYSTEM_NOTIFY,
  366. handle_hotplug_event);
  367. if (ACPI_FAILURE(status))
  368. err("failed to remove notify handler\n");
  369. }
  370. }
  371. acpiphp_unregister_hotplug_slot(slot);
  372. }
  373. mutex_lock(&bridge_mutex);
  374. list_del(&bridge->list);
  375. mutex_unlock(&bridge_mutex);
  376. }
  377. static int power_on_slot(struct acpiphp_slot *slot)
  378. {
  379. acpi_status status;
  380. struct acpiphp_func *func;
  381. int retval = 0;
  382. /* if already enabled, just skip */
  383. if (slot->flags & SLOT_POWEREDON)
  384. goto err_exit;
  385. list_for_each_entry(func, &slot->funcs, sibling) {
  386. if (func->flags & FUNC_HAS_PS0) {
  387. dbg("%s: executing _PS0\n", __func__);
  388. status = acpi_evaluate_object(func_to_handle(func),
  389. "_PS0", NULL, NULL);
  390. if (ACPI_FAILURE(status)) {
  391. warn("%s: _PS0 failed\n", __func__);
  392. retval = -1;
  393. goto err_exit;
  394. } else
  395. break;
  396. }
  397. }
  398. /* TBD: evaluate _STA to check if the slot is enabled */
  399. slot->flags |= SLOT_POWEREDON;
  400. err_exit:
  401. return retval;
  402. }
  403. static int power_off_slot(struct acpiphp_slot *slot)
  404. {
  405. acpi_status status;
  406. struct acpiphp_func *func;
  407. int retval = 0;
  408. /* if already disabled, just skip */
  409. if ((slot->flags & SLOT_POWEREDON) == 0)
  410. goto err_exit;
  411. list_for_each_entry(func, &slot->funcs, sibling) {
  412. if (func->flags & FUNC_HAS_PS3) {
  413. status = acpi_evaluate_object(func_to_handle(func),
  414. "_PS3", NULL, NULL);
  415. if (ACPI_FAILURE(status)) {
  416. warn("%s: _PS3 failed\n", __func__);
  417. retval = -1;
  418. goto err_exit;
  419. } else
  420. break;
  421. }
  422. }
  423. /* TBD: evaluate _STA to check if the slot is disabled */
  424. slot->flags &= (~SLOT_POWEREDON);
  425. err_exit:
  426. return retval;
  427. }
  428. /**
  429. * acpiphp_max_busnr - return the highest reserved bus number under the given bus.
  430. * @bus: bus to start search with
  431. */
  432. static unsigned char acpiphp_max_busnr(struct pci_bus *bus)
  433. {
  434. struct list_head *tmp;
  435. unsigned char max, n;
  436. /*
  437. * pci_bus_max_busnr will return the highest
  438. * reserved busnr for all these children.
  439. * that is equivalent to the bus->subordinate
  440. * value. We don't want to use the parent's
  441. * bus->subordinate value because it could have
  442. * padding in it.
  443. */
  444. max = bus->busn_res.start;
  445. list_for_each(tmp, &bus->children) {
  446. n = pci_bus_max_busnr(pci_bus_b(tmp));
  447. if (n > max)
  448. max = n;
  449. }
  450. return max;
  451. }
  452. /**
  453. * acpiphp_bus_trim - Trim device objects in an ACPI namespace subtree.
  454. * @handle: ACPI device object handle to start from.
  455. */
  456. static void acpiphp_bus_trim(acpi_handle handle)
  457. {
  458. struct acpi_device *adev = NULL;
  459. acpi_bus_get_device(handle, &adev);
  460. if (adev)
  461. acpi_bus_trim(adev);
  462. }
  463. /**
  464. * acpiphp_bus_add - Scan ACPI namespace subtree.
  465. * @handle: ACPI object handle to start the scan from.
  466. */
  467. static void acpiphp_bus_add(acpi_handle handle)
  468. {
  469. acpiphp_bus_trim(handle);
  470. acpi_bus_scan(handle);
  471. }
  472. static void acpiphp_set_acpi_region(struct acpiphp_slot *slot)
  473. {
  474. struct acpiphp_func *func;
  475. union acpi_object params[2];
  476. struct acpi_object_list arg_list;
  477. list_for_each_entry(func, &slot->funcs, sibling) {
  478. arg_list.count = 2;
  479. arg_list.pointer = params;
  480. params[0].type = ACPI_TYPE_INTEGER;
  481. params[0].integer.value = ACPI_ADR_SPACE_PCI_CONFIG;
  482. params[1].type = ACPI_TYPE_INTEGER;
  483. params[1].integer.value = 1;
  484. /* _REG is optional, we don't care about if there is failure */
  485. acpi_evaluate_object(func_to_handle(func), "_REG", &arg_list,
  486. NULL);
  487. }
  488. }
  489. static void check_hotplug_bridge(struct acpiphp_slot *slot, struct pci_dev *dev)
  490. {
  491. struct acpiphp_func *func;
  492. /* quirk, or pcie could set it already */
  493. if (dev->is_hotplug_bridge)
  494. return;
  495. list_for_each_entry(func, &slot->funcs, sibling) {
  496. if (PCI_FUNC(dev->devfn) == func->function) {
  497. dev->is_hotplug_bridge = 1;
  498. break;
  499. }
  500. }
  501. }
  502. /**
  503. * enable_device - enable, configure a slot
  504. * @slot: slot to be enabled
  505. *
  506. * This function should be called per *physical slot*,
  507. * not per each slot object in ACPI namespace.
  508. */
  509. static int __ref enable_device(struct acpiphp_slot *slot)
  510. {
  511. struct pci_dev *dev;
  512. struct pci_bus *bus = slot->bus;
  513. struct acpiphp_func *func;
  514. int num, max, pass;
  515. LIST_HEAD(add_list);
  516. if (slot->flags & SLOT_ENABLED)
  517. goto err_exit;
  518. list_for_each_entry(func, &slot->funcs, sibling)
  519. acpiphp_bus_add(func_to_handle(func));
  520. num = pci_scan_slot(bus, PCI_DEVFN(slot->device, 0));
  521. if (num == 0) {
  522. /* Maybe only part of funcs are added. */
  523. dbg("No new device found\n");
  524. goto err_exit;
  525. }
  526. max = acpiphp_max_busnr(bus);
  527. for (pass = 0; pass < 2; pass++) {
  528. list_for_each_entry(dev, &bus->devices, bus_list) {
  529. if (PCI_SLOT(dev->devfn) != slot->device)
  530. continue;
  531. if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
  532. dev->hdr_type == PCI_HEADER_TYPE_CARDBUS) {
  533. max = pci_scan_bridge(bus, dev, max, pass);
  534. if (pass && dev->subordinate) {
  535. check_hotplug_bridge(slot, dev);
  536. pcibios_resource_survey_bus(dev->subordinate);
  537. __pci_bus_size_bridges(dev->subordinate,
  538. &add_list);
  539. }
  540. }
  541. }
  542. }
  543. __pci_bus_assign_resources(bus, &add_list, NULL);
  544. acpiphp_sanitize_bus(bus);
  545. acpiphp_set_hpp_values(bus);
  546. acpiphp_set_acpi_region(slot);
  547. pci_enable_bridges(bus);
  548. list_for_each_entry(dev, &bus->devices, bus_list) {
  549. /* Assume that newly added devices are powered on already. */
  550. if (!dev->is_added)
  551. dev->current_state = PCI_D0;
  552. }
  553. pci_bus_add_devices(bus);
  554. slot->flags |= SLOT_ENABLED;
  555. list_for_each_entry(func, &slot->funcs, sibling) {
  556. dev = pci_get_slot(bus, PCI_DEVFN(slot->device,
  557. func->function));
  558. if (!dev) {
  559. /* Do not set SLOT_ENABLED flag if some funcs
  560. are not added. */
  561. slot->flags &= (~SLOT_ENABLED);
  562. continue;
  563. }
  564. }
  565. err_exit:
  566. return 0;
  567. }
  568. /* return first device in slot, acquiring a reference on it */
  569. static struct pci_dev *dev_in_slot(struct acpiphp_slot *slot)
  570. {
  571. struct pci_bus *bus = slot->bus;
  572. struct pci_dev *dev;
  573. struct pci_dev *ret = NULL;
  574. down_read(&pci_bus_sem);
  575. list_for_each_entry(dev, &bus->devices, bus_list)
  576. if (PCI_SLOT(dev->devfn) == slot->device) {
  577. ret = pci_dev_get(dev);
  578. break;
  579. }
  580. up_read(&pci_bus_sem);
  581. return ret;
  582. }
  583. /**
  584. * disable_device - disable a slot
  585. * @slot: ACPI PHP slot
  586. */
  587. static int disable_device(struct acpiphp_slot *slot)
  588. {
  589. struct acpiphp_func *func;
  590. struct pci_dev *pdev;
  591. /*
  592. * enable_device() enumerates all functions in this device via
  593. * pci_scan_slot(), whether they have associated ACPI hotplug
  594. * methods (_EJ0, etc.) or not. Therefore, we remove all functions
  595. * here.
  596. */
  597. while ((pdev = dev_in_slot(slot))) {
  598. pci_stop_and_remove_bus_device(pdev);
  599. pci_dev_put(pdev);
  600. }
  601. list_for_each_entry(func, &slot->funcs, sibling)
  602. acpiphp_bus_trim(func_to_handle(func));
  603. slot->flags &= (~SLOT_ENABLED);
  604. return 0;
  605. }
  606. /**
  607. * get_slot_status - get ACPI slot status
  608. * @slot: ACPI PHP slot
  609. *
  610. * If a slot has _STA for each function and if any one of them
  611. * returned non-zero status, return it.
  612. *
  613. * If a slot doesn't have _STA and if any one of its functions'
  614. * configuration space is configured, return 0x0f as a _STA.
  615. *
  616. * Otherwise return 0.
  617. */
  618. static unsigned int get_slot_status(struct acpiphp_slot *slot)
  619. {
  620. unsigned long long sta = 0;
  621. struct acpiphp_func *func;
  622. list_for_each_entry(func, &slot->funcs, sibling) {
  623. if (func->flags & FUNC_HAS_STA) {
  624. acpi_status status;
  625. status = acpi_evaluate_integer(func_to_handle(func),
  626. "_STA", NULL, &sta);
  627. if (ACPI_SUCCESS(status) && sta)
  628. break;
  629. } else {
  630. u32 dvid;
  631. pci_bus_read_config_dword(slot->bus,
  632. PCI_DEVFN(slot->device,
  633. func->function),
  634. PCI_VENDOR_ID, &dvid);
  635. if (dvid != 0xffffffff) {
  636. sta = ACPI_STA_ALL;
  637. break;
  638. }
  639. }
  640. }
  641. return (unsigned int)sta;
  642. }
  643. /**
  644. * acpiphp_check_bridge - re-enumerate devices
  645. * @bridge: where to begin re-enumeration
  646. *
  647. * Iterate over all slots under this bridge and make sure that if a
  648. * card is present they are enabled, and if not they are disabled.
  649. */
  650. static int acpiphp_check_bridge(struct acpiphp_bridge *bridge)
  651. {
  652. struct acpiphp_slot *slot;
  653. int retval = 0;
  654. int enabled, disabled;
  655. enabled = disabled = 0;
  656. list_for_each_entry(slot, &bridge->slots, node) {
  657. unsigned int status = get_slot_status(slot);
  658. if (slot->flags & SLOT_ENABLED) {
  659. if (status == ACPI_STA_ALL)
  660. continue;
  661. retval = acpiphp_disable_and_eject_slot(slot);
  662. if (retval)
  663. goto err_exit;
  664. disabled++;
  665. } else {
  666. if (status != ACPI_STA_ALL)
  667. continue;
  668. retval = acpiphp_enable_slot(slot);
  669. if (retval) {
  670. err("Error occurred in enabling\n");
  671. goto err_exit;
  672. }
  673. enabled++;
  674. }
  675. }
  676. dbg("%s: %d enabled, %d disabled\n", __func__, enabled, disabled);
  677. err_exit:
  678. return retval;
  679. }
  680. static void acpiphp_set_hpp_values(struct pci_bus *bus)
  681. {
  682. struct pci_dev *dev;
  683. list_for_each_entry(dev, &bus->devices, bus_list)
  684. pci_configure_slot(dev);
  685. }
  686. /*
  687. * Remove devices for which we could not assign resources, call
  688. * arch specific code to fix-up the bus
  689. */
  690. static void acpiphp_sanitize_bus(struct pci_bus *bus)
  691. {
  692. struct pci_dev *dev, *tmp;
  693. int i;
  694. unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM;
  695. list_for_each_entry_safe(dev, tmp, &bus->devices, bus_list) {
  696. for (i=0; i<PCI_BRIDGE_RESOURCES; i++) {
  697. struct resource *res = &dev->resource[i];
  698. if ((res->flags & type_mask) && !res->start &&
  699. res->end) {
  700. /* Could not assign a required resources
  701. * for this device, remove it */
  702. pci_stop_and_remove_bus_device(dev);
  703. break;
  704. }
  705. }
  706. }
  707. }
  708. /*
  709. * ACPI event handlers
  710. */
  711. static acpi_status
  712. check_sub_bridges(acpi_handle handle, u32 lvl, void *context, void **rv)
  713. {
  714. struct acpiphp_bridge *bridge;
  715. char objname[64];
  716. struct acpi_buffer buffer = { .length = sizeof(objname),
  717. .pointer = objname };
  718. bridge = acpiphp_handle_to_bridge(handle);
  719. if (bridge) {
  720. acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer);
  721. dbg("%s: re-enumerating slots under %s\n",
  722. __func__, objname);
  723. acpiphp_check_bridge(bridge);
  724. put_bridge(bridge);
  725. }
  726. return AE_OK ;
  727. }
  728. void acpiphp_check_host_bridge(acpi_handle handle)
  729. {
  730. struct acpiphp_bridge *bridge;
  731. bridge = acpiphp_handle_to_bridge(handle);
  732. if (bridge) {
  733. acpiphp_check_bridge(bridge);
  734. put_bridge(bridge);
  735. }
  736. acpi_walk_namespace(ACPI_TYPE_DEVICE, handle,
  737. ACPI_UINT32_MAX, check_sub_bridges, NULL, NULL, NULL);
  738. }
  739. static void hotplug_event(acpi_handle handle, u32 type, void *data)
  740. {
  741. struct acpiphp_context *context = data;
  742. struct acpiphp_func *func = &context->func;
  743. struct acpiphp_bridge *bridge;
  744. char objname[64];
  745. struct acpi_buffer buffer = { .length = sizeof(objname),
  746. .pointer = objname };
  747. mutex_lock(&acpiphp_context_lock);
  748. bridge = context->bridge;
  749. if (bridge)
  750. get_bridge(bridge);
  751. mutex_unlock(&acpiphp_context_lock);
  752. acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer);
  753. switch (type) {
  754. case ACPI_NOTIFY_BUS_CHECK:
  755. /* bus re-enumerate */
  756. dbg("%s: Bus check notify on %s\n", __func__, objname);
  757. dbg("%s: re-enumerating slots under %s\n", __func__, objname);
  758. if (bridge) {
  759. acpiphp_check_bridge(bridge);
  760. acpi_walk_namespace(ACPI_TYPE_DEVICE, handle,
  761. ACPI_UINT32_MAX, check_sub_bridges,
  762. NULL, NULL, NULL);
  763. } else {
  764. acpiphp_enable_slot(func->slot);
  765. }
  766. break;
  767. case ACPI_NOTIFY_DEVICE_CHECK:
  768. /* device check */
  769. dbg("%s: Device check notify on %s\n", __func__, objname);
  770. if (bridge)
  771. acpiphp_check_bridge(bridge);
  772. else
  773. acpiphp_check_bridge(func->parent);
  774. break;
  775. case ACPI_NOTIFY_DEVICE_WAKE:
  776. /* wake event */
  777. dbg("%s: Device wake notify on %s\n", __func__, objname);
  778. break;
  779. case ACPI_NOTIFY_EJECT_REQUEST:
  780. /* request device eject */
  781. dbg("%s: Device eject notify on %s\n", __func__, objname);
  782. acpiphp_disable_and_eject_slot(func->slot);
  783. break;
  784. case ACPI_NOTIFY_FREQUENCY_MISMATCH:
  785. printk(KERN_ERR "Device %s cannot be configured due"
  786. " to a frequency mismatch\n", objname);
  787. break;
  788. case ACPI_NOTIFY_BUS_MODE_MISMATCH:
  789. printk(KERN_ERR "Device %s cannot be configured due"
  790. " to a bus mode mismatch\n", objname);
  791. break;
  792. case ACPI_NOTIFY_POWER_FAULT:
  793. printk(KERN_ERR "Device %s has suffered a power fault\n",
  794. objname);
  795. break;
  796. default:
  797. warn("notify_handler: unknown event type 0x%x for %s\n", type,
  798. objname);
  799. break;
  800. }
  801. if (bridge)
  802. put_bridge(bridge);
  803. }
  804. static void hotplug_event_work(struct work_struct *work)
  805. {
  806. struct acpiphp_context *context;
  807. struct acpi_hp_work *hp_work;
  808. hp_work = container_of(work, struct acpi_hp_work, work);
  809. context = hp_work->context;
  810. acpi_scan_lock_acquire();
  811. hotplug_event(hp_work->handle, hp_work->type, context);
  812. acpi_scan_lock_release();
  813. kfree(hp_work); /* allocated in handle_hotplug_event() */
  814. put_bridge(context->func.parent);
  815. }
  816. /**
  817. * handle_hotplug_event - handle ACPI hotplug event
  818. * @handle: Notify()'ed acpi_handle
  819. * @type: Notify code
  820. * @data: pointer to acpiphp_context structure
  821. *
  822. * Handles ACPI event notification on slots.
  823. */
  824. static void handle_hotplug_event(acpi_handle handle, u32 type, void *data)
  825. {
  826. struct acpiphp_context *context;
  827. mutex_lock(&acpiphp_context_lock);
  828. context = acpiphp_get_context(handle);
  829. if (context) {
  830. get_bridge(context->func.parent);
  831. acpiphp_put_context(context);
  832. }
  833. mutex_unlock(&acpiphp_context_lock);
  834. /*
  835. * Currently the code adds all hotplug events to the kacpid_wq
  836. * queue when it should add hotplug events to the kacpi_hotplug_wq.
  837. * The proper way to fix this is to reorganize the code so that
  838. * drivers (dock, etc.) do not call acpi_os_execute(), etc.
  839. * For now just re-add this work to the kacpi_hotplug_wq so we
  840. * don't deadlock on hotplug actions.
  841. */
  842. if (context)
  843. alloc_acpi_hp_work(handle, type, context, hotplug_event_work);
  844. }
  845. /*
  846. * Create hotplug slots for the PCI bus.
  847. * It should always return 0 to avoid skipping following notifiers.
  848. */
  849. void acpiphp_enumerate_slots(struct pci_bus *bus)
  850. {
  851. struct acpiphp_bridge *bridge;
  852. acpi_handle handle;
  853. acpi_status status;
  854. if (acpiphp_disabled)
  855. return;
  856. handle = ACPI_HANDLE(bus->bridge);
  857. if (!handle)
  858. return;
  859. bridge = kzalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL);
  860. if (!bridge) {
  861. acpi_handle_err(handle, "No memory for bridge object\n");
  862. return;
  863. }
  864. INIT_LIST_HEAD(&bridge->slots);
  865. kref_init(&bridge->ref);
  866. bridge->pci_dev = pci_dev_get(bus->self);
  867. bridge->pci_bus = bus;
  868. /*
  869. * Grab a ref to the subordinate PCI bus in case the bus is
  870. * removed via PCI core logical hotplug. The ref pins the bus
  871. * (which we access during module unload).
  872. */
  873. get_device(&bus->dev);
  874. if (!pci_is_root_bus(bridge->pci_bus)) {
  875. struct acpiphp_context *context;
  876. /*
  877. * This bridge should have been registered as a hotplug function
  878. * under its parent, so the context has to be there. If not, we
  879. * are in deep goo.
  880. */
  881. mutex_lock(&acpiphp_context_lock);
  882. context = acpiphp_get_context(handle);
  883. if (WARN_ON(!context)) {
  884. mutex_unlock(&acpiphp_context_lock);
  885. put_device(&bus->dev);
  886. kfree(bridge);
  887. return;
  888. }
  889. bridge->context = context;
  890. context->bridge = bridge;
  891. /* Get a reference to the parent bridge. */
  892. get_bridge(context->func.parent);
  893. mutex_unlock(&acpiphp_context_lock);
  894. }
  895. /* must be added to the list prior to calling register_slot */
  896. mutex_lock(&bridge_mutex);
  897. list_add(&bridge->list, &bridge_list);
  898. mutex_unlock(&bridge_mutex);
  899. /* register all slot objects under this bridge */
  900. status = acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, 1,
  901. register_slot, NULL, bridge, NULL);
  902. if (ACPI_FAILURE(status)) {
  903. acpi_handle_err(handle, "failed to register slots\n");
  904. cleanup_bridge(bridge);
  905. put_bridge(bridge);
  906. }
  907. }
  908. /* Destroy hotplug slots associated with the PCI bus */
  909. void acpiphp_remove_slots(struct pci_bus *bus)
  910. {
  911. struct acpiphp_bridge *bridge, *tmp;
  912. if (acpiphp_disabled)
  913. return;
  914. list_for_each_entry_safe(bridge, tmp, &bridge_list, list)
  915. if (bridge->pci_bus == bus) {
  916. cleanup_bridge(bridge);
  917. put_bridge(bridge);
  918. break;
  919. }
  920. }
  921. /**
  922. * acpiphp_enable_slot - power on slot
  923. * @slot: ACPI PHP slot
  924. */
  925. int acpiphp_enable_slot(struct acpiphp_slot *slot)
  926. {
  927. int retval;
  928. mutex_lock(&slot->crit_sect);
  929. /* wake up all functions */
  930. retval = power_on_slot(slot);
  931. if (retval)
  932. goto err_exit;
  933. if (get_slot_status(slot) == ACPI_STA_ALL) {
  934. /* configure all functions */
  935. retval = enable_device(slot);
  936. if (retval)
  937. power_off_slot(slot);
  938. } else {
  939. dbg("%s: Slot status is not ACPI_STA_ALL\n", __func__);
  940. power_off_slot(slot);
  941. }
  942. err_exit:
  943. mutex_unlock(&slot->crit_sect);
  944. return retval;
  945. }
  946. /**
  947. * acpiphp_disable_and_eject_slot - power off and eject slot
  948. * @slot: ACPI PHP slot
  949. */
  950. int acpiphp_disable_and_eject_slot(struct acpiphp_slot *slot)
  951. {
  952. struct acpiphp_func *func;
  953. int retval = 0;
  954. mutex_lock(&slot->crit_sect);
  955. /* unconfigure all functions */
  956. retval = disable_device(slot);
  957. if (retval)
  958. goto err_exit;
  959. /* power off all functions */
  960. retval = power_off_slot(slot);
  961. if (retval)
  962. goto err_exit;
  963. list_for_each_entry(func, &slot->funcs, sibling)
  964. if (func->flags & FUNC_HAS_EJ0) {
  965. acpi_handle handle = func_to_handle(func);
  966. if (ACPI_FAILURE(acpi_evaluate_ej0(handle)))
  967. acpi_handle_err(handle, "_EJ0 failed\n");
  968. break;
  969. }
  970. err_exit:
  971. mutex_unlock(&slot->crit_sect);
  972. return retval;
  973. }
  974. /*
  975. * slot enabled: 1
  976. * slot disabled: 0
  977. */
  978. u8 acpiphp_get_power_status(struct acpiphp_slot *slot)
  979. {
  980. return (slot->flags & SLOT_POWEREDON);
  981. }
  982. /*
  983. * latch open: 1
  984. * latch closed: 0
  985. */
  986. u8 acpiphp_get_latch_status(struct acpiphp_slot *slot)
  987. {
  988. unsigned int sta;
  989. sta = get_slot_status(slot);
  990. return (sta & ACPI_STA_DEVICE_UI) ? 0 : 1;
  991. }
  992. /*
  993. * adapter presence : 1
  994. * absence : 0
  995. */
  996. u8 acpiphp_get_adapter_status(struct acpiphp_slot *slot)
  997. {
  998. unsigned int sta;
  999. sta = get_slot_status(slot);
  1000. return (sta == 0) ? 0 : 1;
  1001. }