ide.c 44 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812
  1. /*
  2. * linux/drivers/ide/ide.c Version 7.00beta2 Mar 05 2003
  3. *
  4. * Copyright (C) 1994-1998 Linus Torvalds & authors (see below)
  5. */
  6. /*
  7. * Mostly written by Mark Lord <mlord@pobox.com>
  8. * and Gadi Oxman <gadio@netvision.net.il>
  9. * and Andre Hedrick <andre@linux-ide.org>
  10. *
  11. * See linux/MAINTAINERS for address of current maintainer.
  12. *
  13. * This is the multiple IDE interface driver, as evolved from hd.c.
  14. * It supports up to MAX_HWIFS IDE interfaces, on one or more IRQs
  15. * (usually 14 & 15).
  16. * There can be up to two drives per interface, as per the ATA-2 spec.
  17. *
  18. * ...
  19. *
  20. * From hd.c:
  21. * |
  22. * | It traverses the request-list, using interrupts to jump between functions.
  23. * | As nearly all functions can be called within interrupts, we may not sleep.
  24. * | Special care is recommended. Have Fun!
  25. * |
  26. * | modified by Drew Eckhardt to check nr of hd's from the CMOS.
  27. * |
  28. * | Thanks to Branko Lankester, lankeste@fwi.uva.nl, who found a bug
  29. * | in the early extended-partition checks and added DM partitions.
  30. * |
  31. * | Early work on error handling by Mika Liljeberg (liljeber@cs.Helsinki.FI).
  32. * |
  33. * | IRQ-unmask, drive-id, multiple-mode, support for ">16 heads",
  34. * | and general streamlining by Mark Lord (mlord@pobox.com).
  35. *
  36. * October, 1994 -- Complete line-by-line overhaul for linux 1.1.x, by:
  37. *
  38. * Mark Lord (mlord@pobox.com) (IDE Perf.Pkg)
  39. * Delman Lee (delman@ieee.org) ("Mr. atdisk2")
  40. * Scott Snyder (snyder@fnald0.fnal.gov) (ATAPI IDE cd-rom)
  41. *
  42. * This was a rewrite of just about everything from hd.c, though some original
  43. * code is still sprinkled about. Think of it as a major evolution, with
  44. * inspiration from lots of linux users, esp. hamish@zot.apana.org.au
  45. */
  46. #define REVISION "Revision: 7.00alpha2"
  47. #define VERSION "Id: ide.c 7.00a2 20020906"
  48. #define _IDE_C /* Tell ide.h it's really us */
  49. #include <linux/module.h>
  50. #include <linux/types.h>
  51. #include <linux/string.h>
  52. #include <linux/kernel.h>
  53. #include <linux/timer.h>
  54. #include <linux/mm.h>
  55. #include <linux/interrupt.h>
  56. #include <linux/major.h>
  57. #include <linux/errno.h>
  58. #include <linux/genhd.h>
  59. #include <linux/blkpg.h>
  60. #include <linux/slab.h>
  61. #include <linux/init.h>
  62. #include <linux/pci.h>
  63. #include <linux/delay.h>
  64. #include <linux/ide.h>
  65. #include <linux/completion.h>
  66. #include <linux/reboot.h>
  67. #include <linux/cdrom.h>
  68. #include <linux/seq_file.h>
  69. #include <linux/device.h>
  70. #include <linux/bitops.h>
  71. #include <asm/byteorder.h>
  72. #include <asm/irq.h>
  73. #include <asm/uaccess.h>
  74. #include <asm/io.h>
  75. /* default maximum number of failures */
  76. #define IDE_DEFAULT_MAX_FAILURES 1
  77. static const u8 ide_hwif_to_major[] = { IDE0_MAJOR, IDE1_MAJOR,
  78. IDE2_MAJOR, IDE3_MAJOR,
  79. IDE4_MAJOR, IDE5_MAJOR,
  80. IDE6_MAJOR, IDE7_MAJOR,
  81. IDE8_MAJOR, IDE9_MAJOR };
  82. static int idebus_parameter; /* holds the "idebus=" parameter */
  83. static int system_bus_speed; /* holds what we think is VESA/PCI bus speed */
  84. DEFINE_MUTEX(ide_cfg_mtx);
  85. __cacheline_aligned_in_smp DEFINE_SPINLOCK(ide_lock);
  86. #ifdef CONFIG_IDEPCI_PCIBUS_ORDER
  87. static int ide_scan_direction; /* THIS was formerly 2.2.x pci=reverse */
  88. #endif
  89. int noautodma = 0;
  90. EXPORT_SYMBOL(noautodma);
  91. #ifdef CONFIG_BLK_DEV_IDEACPI
  92. int ide_noacpi = 0;
  93. int ide_noacpitfs = 1;
  94. int ide_noacpionboot = 1;
  95. #endif
  96. /*
  97. * This is declared extern in ide.h, for access by other IDE modules:
  98. */
  99. ide_hwif_t ide_hwifs[MAX_HWIFS]; /* master data repository */
  100. EXPORT_SYMBOL(ide_hwifs);
  101. /*
  102. * Do not even *think* about calling this!
  103. */
  104. static void init_hwif_data(ide_hwif_t *hwif, unsigned int index)
  105. {
  106. unsigned int unit;
  107. /* bulk initialize hwif & drive info with zeros */
  108. memset(hwif, 0, sizeof(ide_hwif_t));
  109. /* fill in any non-zero initial values */
  110. hwif->index = index;
  111. hwif->major = ide_hwif_to_major[index];
  112. hwif->name[0] = 'i';
  113. hwif->name[1] = 'd';
  114. hwif->name[2] = 'e';
  115. hwif->name[3] = '0' + index;
  116. hwif->bus_state = BUSSTATE_ON;
  117. hwif->atapi_dma = 0; /* disable all atapi dma */
  118. init_completion(&hwif->gendev_rel_comp);
  119. default_hwif_iops(hwif);
  120. default_hwif_transport(hwif);
  121. for (unit = 0; unit < MAX_DRIVES; ++unit) {
  122. ide_drive_t *drive = &hwif->drives[unit];
  123. drive->media = ide_disk;
  124. drive->select.all = (unit<<4)|0xa0;
  125. drive->hwif = hwif;
  126. drive->ctl = 0x08;
  127. drive->ready_stat = READY_STAT;
  128. drive->bad_wstat = BAD_W_STAT;
  129. drive->special.b.recalibrate = 1;
  130. drive->special.b.set_geometry = 1;
  131. drive->name[0] = 'h';
  132. drive->name[1] = 'd';
  133. drive->name[2] = 'a' + (index * MAX_DRIVES) + unit;
  134. drive->max_failures = IDE_DEFAULT_MAX_FAILURES;
  135. drive->using_dma = 0;
  136. drive->vdma = 0;
  137. INIT_LIST_HEAD(&drive->list);
  138. init_completion(&drive->gendev_rel_comp);
  139. }
  140. }
  141. static void init_hwif_default(ide_hwif_t *hwif, unsigned int index)
  142. {
  143. hw_regs_t hw;
  144. memset(&hw, 0, sizeof(hw_regs_t));
  145. ide_init_hwif_ports(&hw, ide_default_io_base(index), 0, &hwif->irq);
  146. memcpy(&hwif->hw, &hw, sizeof(hw));
  147. memcpy(hwif->io_ports, hw.io_ports, sizeof(hw.io_ports));
  148. hwif->noprobe = !hwif->io_ports[IDE_DATA_OFFSET];
  149. #ifdef CONFIG_BLK_DEV_HD
  150. if (hwif->io_ports[IDE_DATA_OFFSET] == HD_DATA)
  151. hwif->noprobe = 1; /* may be overridden by ide_setup() */
  152. #endif
  153. }
  154. extern void ide_arm_init(void);
  155. /*
  156. * init_ide_data() sets reasonable default values into all fields
  157. * of all instances of the hwifs and drives, but only on the first call.
  158. * Subsequent calls have no effect (they don't wipe out anything).
  159. *
  160. * This routine is normally called at driver initialization time,
  161. * but may also be called MUCH earlier during kernel "command-line"
  162. * parameter processing. As such, we cannot depend on any other parts
  163. * of the kernel (such as memory allocation) to be functioning yet.
  164. *
  165. * This is too bad, as otherwise we could dynamically allocate the
  166. * ide_drive_t structs as needed, rather than always consuming memory
  167. * for the max possible number (MAX_HWIFS * MAX_DRIVES) of them.
  168. *
  169. * FIXME: We should stuff the setup data into __init and copy the
  170. * relevant hwifs/allocate them properly during boot.
  171. */
  172. #define MAGIC_COOKIE 0x12345678
  173. static void __init init_ide_data (void)
  174. {
  175. ide_hwif_t *hwif;
  176. unsigned int index;
  177. static unsigned long magic_cookie = MAGIC_COOKIE;
  178. if (magic_cookie != MAGIC_COOKIE)
  179. return; /* already initialized */
  180. magic_cookie = 0;
  181. /* Initialise all interface structures */
  182. for (index = 0; index < MAX_HWIFS; ++index) {
  183. hwif = &ide_hwifs[index];
  184. init_hwif_data(hwif, index);
  185. init_hwif_default(hwif, index);
  186. #if !defined(CONFIG_PPC32) || !defined(CONFIG_PCI)
  187. hwif->irq = hwif->hw.irq =
  188. ide_init_default_irq(hwif->io_ports[IDE_DATA_OFFSET]);
  189. #endif
  190. }
  191. #ifdef CONFIG_IDE_ARM
  192. ide_arm_init();
  193. #endif
  194. }
  195. /**
  196. * ide_system_bus_speed - guess bus speed
  197. *
  198. * ide_system_bus_speed() returns what we think is the system VESA/PCI
  199. * bus speed (in MHz). This is used for calculating interface PIO timings.
  200. * The default is 40 for known PCI systems, 50 otherwise.
  201. * The "idebus=xx" parameter can be used to override this value.
  202. * The actual value to be used is computed/displayed the first time
  203. * through. Drivers should only use this as a last resort.
  204. *
  205. * Returns a guessed speed in MHz.
  206. */
  207. static int ide_system_bus_speed(void)
  208. {
  209. #ifdef CONFIG_PCI
  210. static struct pci_device_id pci_default[] = {
  211. { PCI_DEVICE(PCI_ANY_ID, PCI_ANY_ID) },
  212. { }
  213. };
  214. #else
  215. #define pci_default 0
  216. #endif /* CONFIG_PCI */
  217. if (!system_bus_speed) {
  218. if (idebus_parameter) {
  219. /* user supplied value */
  220. system_bus_speed = idebus_parameter;
  221. } else if (pci_dev_present(pci_default)) {
  222. /* safe default value for PCI */
  223. system_bus_speed = 33;
  224. } else {
  225. /* safe default value for VESA and PCI */
  226. system_bus_speed = 50;
  227. }
  228. printk(KERN_INFO "ide: Assuming %dMHz system bus speed "
  229. "for PIO modes%s\n", system_bus_speed,
  230. idebus_parameter ? "" : "; override with idebus=xx");
  231. }
  232. return system_bus_speed;
  233. }
  234. static struct resource* hwif_request_region(ide_hwif_t *hwif,
  235. unsigned long addr, int num)
  236. {
  237. struct resource *res = request_region(addr, num, hwif->name);
  238. if (!res)
  239. printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX not free.\n",
  240. hwif->name, addr, addr+num-1);
  241. return res;
  242. }
  243. /**
  244. * ide_hwif_request_regions - request resources for IDE
  245. * @hwif: interface to use
  246. *
  247. * Requests all the needed resources for an interface.
  248. * Right now core IDE code does this work which is deeply wrong.
  249. * MMIO leaves it to the controller driver,
  250. * PIO will migrate this way over time.
  251. */
  252. int ide_hwif_request_regions(ide_hwif_t *hwif)
  253. {
  254. unsigned long addr;
  255. unsigned int i;
  256. if (hwif->mmio)
  257. return 0;
  258. addr = hwif->io_ports[IDE_CONTROL_OFFSET];
  259. if (addr && !hwif_request_region(hwif, addr, 1))
  260. goto control_region_busy;
  261. hwif->straight8 = 0;
  262. addr = hwif->io_ports[IDE_DATA_OFFSET];
  263. if ((addr | 7) == hwif->io_ports[IDE_STATUS_OFFSET]) {
  264. if (!hwif_request_region(hwif, addr, 8))
  265. goto data_region_busy;
  266. hwif->straight8 = 1;
  267. return 0;
  268. }
  269. for (i = IDE_DATA_OFFSET; i <= IDE_STATUS_OFFSET; i++) {
  270. addr = hwif->io_ports[i];
  271. if (!hwif_request_region(hwif, addr, 1)) {
  272. while (--i)
  273. release_region(addr, 1);
  274. goto data_region_busy;
  275. }
  276. }
  277. return 0;
  278. data_region_busy:
  279. addr = hwif->io_ports[IDE_CONTROL_OFFSET];
  280. if (addr)
  281. release_region(addr, 1);
  282. control_region_busy:
  283. /* If any errors are return, we drop the hwif interface. */
  284. return -EBUSY;
  285. }
  286. /**
  287. * ide_hwif_release_regions - free IDE resources
  288. *
  289. * Note that we only release the standard ports,
  290. * and do not even try to handle any extra ports
  291. * allocated for weird IDE interface chipsets.
  292. *
  293. * Note also that we don't yet handle mmio resources here. More
  294. * importantly our caller should be doing this so we need to
  295. * restructure this as a helper function for drivers.
  296. */
  297. void ide_hwif_release_regions(ide_hwif_t *hwif)
  298. {
  299. u32 i = 0;
  300. if (hwif->mmio)
  301. return;
  302. if (hwif->io_ports[IDE_CONTROL_OFFSET])
  303. release_region(hwif->io_ports[IDE_CONTROL_OFFSET], 1);
  304. if (hwif->straight8) {
  305. release_region(hwif->io_ports[IDE_DATA_OFFSET], 8);
  306. return;
  307. }
  308. for (i = IDE_DATA_OFFSET; i <= IDE_STATUS_OFFSET; i++)
  309. if (hwif->io_ports[i])
  310. release_region(hwif->io_ports[i], 1);
  311. }
  312. /**
  313. * ide_hwif_restore - restore hwif to template
  314. * @hwif: hwif to update
  315. * @tmp_hwif: template
  316. *
  317. * Restore hwif to a previous state by copying most settings
  318. * from the template.
  319. */
  320. static void ide_hwif_restore(ide_hwif_t *hwif, ide_hwif_t *tmp_hwif)
  321. {
  322. hwif->hwgroup = tmp_hwif->hwgroup;
  323. hwif->gendev.parent = tmp_hwif->gendev.parent;
  324. hwif->proc = tmp_hwif->proc;
  325. hwif->major = tmp_hwif->major;
  326. hwif->straight8 = tmp_hwif->straight8;
  327. hwif->bus_state = tmp_hwif->bus_state;
  328. hwif->host_flags = tmp_hwif->host_flags;
  329. hwif->pio_mask = tmp_hwif->pio_mask;
  330. hwif->atapi_dma = tmp_hwif->atapi_dma;
  331. hwif->ultra_mask = tmp_hwif->ultra_mask;
  332. hwif->mwdma_mask = tmp_hwif->mwdma_mask;
  333. hwif->swdma_mask = tmp_hwif->swdma_mask;
  334. hwif->cbl = tmp_hwif->cbl;
  335. hwif->chipset = tmp_hwif->chipset;
  336. hwif->hold = tmp_hwif->hold;
  337. #ifdef CONFIG_BLK_DEV_IDEPCI
  338. hwif->pci_dev = tmp_hwif->pci_dev;
  339. hwif->cds = tmp_hwif->cds;
  340. #endif
  341. hwif->set_pio_mode = tmp_hwif->set_pio_mode;
  342. hwif->set_dma_mode = tmp_hwif->set_dma_mode;
  343. hwif->mdma_filter = tmp_hwif->mdma_filter;
  344. hwif->udma_filter = tmp_hwif->udma_filter;
  345. hwif->selectproc = tmp_hwif->selectproc;
  346. hwif->reset_poll = tmp_hwif->reset_poll;
  347. hwif->pre_reset = tmp_hwif->pre_reset;
  348. hwif->resetproc = tmp_hwif->resetproc;
  349. hwif->intrproc = tmp_hwif->intrproc;
  350. hwif->maskproc = tmp_hwif->maskproc;
  351. hwif->quirkproc = tmp_hwif->quirkproc;
  352. hwif->busproc = tmp_hwif->busproc;
  353. hwif->ata_input_data = tmp_hwif->ata_input_data;
  354. hwif->ata_output_data = tmp_hwif->ata_output_data;
  355. hwif->atapi_input_bytes = tmp_hwif->atapi_input_bytes;
  356. hwif->atapi_output_bytes = tmp_hwif->atapi_output_bytes;
  357. hwif->dma_setup = tmp_hwif->dma_setup;
  358. hwif->dma_exec_cmd = tmp_hwif->dma_exec_cmd;
  359. hwif->dma_start = tmp_hwif->dma_start;
  360. hwif->ide_dma_end = tmp_hwif->ide_dma_end;
  361. hwif->ide_dma_check = tmp_hwif->ide_dma_check;
  362. hwif->ide_dma_on = tmp_hwif->ide_dma_on;
  363. hwif->dma_off_quietly = tmp_hwif->dma_off_quietly;
  364. hwif->ide_dma_test_irq = tmp_hwif->ide_dma_test_irq;
  365. hwif->ide_dma_clear_irq = tmp_hwif->ide_dma_clear_irq;
  366. hwif->dma_host_on = tmp_hwif->dma_host_on;
  367. hwif->dma_host_off = tmp_hwif->dma_host_off;
  368. hwif->dma_lost_irq = tmp_hwif->dma_lost_irq;
  369. hwif->dma_timeout = tmp_hwif->dma_timeout;
  370. hwif->OUTB = tmp_hwif->OUTB;
  371. hwif->OUTBSYNC = tmp_hwif->OUTBSYNC;
  372. hwif->OUTW = tmp_hwif->OUTW;
  373. hwif->OUTSW = tmp_hwif->OUTSW;
  374. hwif->OUTSL = tmp_hwif->OUTSL;
  375. hwif->INB = tmp_hwif->INB;
  376. hwif->INW = tmp_hwif->INW;
  377. hwif->INSW = tmp_hwif->INSW;
  378. hwif->INSL = tmp_hwif->INSL;
  379. hwif->sg_max_nents = tmp_hwif->sg_max_nents;
  380. hwif->mmio = tmp_hwif->mmio;
  381. hwif->rqsize = tmp_hwif->rqsize;
  382. hwif->no_lba48 = tmp_hwif->no_lba48;
  383. #ifndef CONFIG_BLK_DEV_IDECS
  384. hwif->irq = tmp_hwif->irq;
  385. #endif
  386. hwif->dma_base = tmp_hwif->dma_base;
  387. hwif->dma_master = tmp_hwif->dma_master;
  388. hwif->dma_command = tmp_hwif->dma_command;
  389. hwif->dma_vendor1 = tmp_hwif->dma_vendor1;
  390. hwif->dma_status = tmp_hwif->dma_status;
  391. hwif->dma_vendor3 = tmp_hwif->dma_vendor3;
  392. hwif->dma_prdtable = tmp_hwif->dma_prdtable;
  393. hwif->config_data = tmp_hwif->config_data;
  394. hwif->select_data = tmp_hwif->select_data;
  395. hwif->extra_base = tmp_hwif->extra_base;
  396. hwif->extra_ports = tmp_hwif->extra_ports;
  397. hwif->autodma = tmp_hwif->autodma;
  398. hwif->hwif_data = tmp_hwif->hwif_data;
  399. }
  400. /**
  401. * ide_unregister - free an IDE interface
  402. * @index: index of interface (will change soon to a pointer)
  403. *
  404. * Perform the final unregister of an IDE interface. At the moment
  405. * we don't refcount interfaces so this will also get split up.
  406. *
  407. * Locking:
  408. * The caller must not hold the IDE locks
  409. * The drive present/vanishing is not yet properly locked
  410. * Take care with the callbacks. These have been split to avoid
  411. * deadlocking the IDE layer. The shutdown callback is called
  412. * before we take the lock and free resources. It is up to the
  413. * caller to be sure there is no pending I/O here, and that
  414. * the interface will not be reopened (present/vanishing locking
  415. * isn't yet done BTW). After we commit to the final kill we
  416. * call the cleanup callback with the ide locks held.
  417. *
  418. * Unregister restores the hwif structures to the default state.
  419. * This is raving bonkers.
  420. */
  421. void ide_unregister(unsigned int index)
  422. {
  423. ide_drive_t *drive;
  424. ide_hwif_t *hwif, *g;
  425. static ide_hwif_t tmp_hwif; /* protected by ide_cfg_mtx */
  426. ide_hwgroup_t *hwgroup;
  427. int irq_count = 0, unit;
  428. BUG_ON(index >= MAX_HWIFS);
  429. BUG_ON(in_interrupt());
  430. BUG_ON(irqs_disabled());
  431. mutex_lock(&ide_cfg_mtx);
  432. spin_lock_irq(&ide_lock);
  433. hwif = &ide_hwifs[index];
  434. if (!hwif->present)
  435. goto abort;
  436. for (unit = 0; unit < MAX_DRIVES; ++unit) {
  437. drive = &hwif->drives[unit];
  438. if (!drive->present)
  439. continue;
  440. spin_unlock_irq(&ide_lock);
  441. device_unregister(&drive->gendev);
  442. wait_for_completion(&drive->gendev_rel_comp);
  443. spin_lock_irq(&ide_lock);
  444. }
  445. hwif->present = 0;
  446. spin_unlock_irq(&ide_lock);
  447. ide_proc_unregister_port(hwif);
  448. hwgroup = hwif->hwgroup;
  449. /*
  450. * free the irq if we were the only hwif using it
  451. */
  452. g = hwgroup->hwif;
  453. do {
  454. if (g->irq == hwif->irq)
  455. ++irq_count;
  456. g = g->next;
  457. } while (g != hwgroup->hwif);
  458. if (irq_count == 1)
  459. free_irq(hwif->irq, hwgroup);
  460. spin_lock_irq(&ide_lock);
  461. /*
  462. * Note that we only release the standard ports,
  463. * and do not even try to handle any extra ports
  464. * allocated for weird IDE interface chipsets.
  465. */
  466. ide_hwif_release_regions(hwif);
  467. /*
  468. * Remove us from the hwgroup, and free
  469. * the hwgroup if we were the only member
  470. */
  471. if (hwif->next == hwif) {
  472. BUG_ON(hwgroup->hwif != hwif);
  473. kfree(hwgroup);
  474. } else {
  475. /* There is another interface in hwgroup.
  476. * Unlink us, and set hwgroup->drive and ->hwif to
  477. * something sane.
  478. */
  479. g = hwgroup->hwif;
  480. while (g->next != hwif)
  481. g = g->next;
  482. g->next = hwif->next;
  483. if (hwgroup->hwif == hwif) {
  484. /* Chose a random hwif for hwgroup->hwif.
  485. * It's guaranteed that there are no drives
  486. * left in the hwgroup.
  487. */
  488. BUG_ON(hwgroup->drive != NULL);
  489. hwgroup->hwif = g;
  490. }
  491. BUG_ON(hwgroup->hwif == hwif);
  492. }
  493. /* More messed up locking ... */
  494. spin_unlock_irq(&ide_lock);
  495. device_unregister(&hwif->gendev);
  496. wait_for_completion(&hwif->gendev_rel_comp);
  497. /*
  498. * Remove us from the kernel's knowledge
  499. */
  500. blk_unregister_region(MKDEV(hwif->major, 0), MAX_DRIVES<<PARTN_BITS);
  501. kfree(hwif->sg_table);
  502. unregister_blkdev(hwif->major, hwif->name);
  503. spin_lock_irq(&ide_lock);
  504. if (hwif->dma_base) {
  505. (void) ide_release_dma(hwif);
  506. hwif->dma_base = 0;
  507. hwif->dma_master = 0;
  508. hwif->dma_command = 0;
  509. hwif->dma_vendor1 = 0;
  510. hwif->dma_status = 0;
  511. hwif->dma_vendor3 = 0;
  512. hwif->dma_prdtable = 0;
  513. hwif->extra_base = 0;
  514. hwif->extra_ports = 0;
  515. }
  516. /* copy original settings */
  517. tmp_hwif = *hwif;
  518. /* restore hwif data to pristine status */
  519. init_hwif_data(hwif, index);
  520. init_hwif_default(hwif, index);
  521. ide_hwif_restore(hwif, &tmp_hwif);
  522. abort:
  523. spin_unlock_irq(&ide_lock);
  524. mutex_unlock(&ide_cfg_mtx);
  525. }
  526. EXPORT_SYMBOL(ide_unregister);
  527. /**
  528. * ide_setup_ports - set up IDE interface ports
  529. * @hw: register descriptions
  530. * @base: base register
  531. * @offsets: table of register offsets
  532. * @ctrl: control register
  533. * @ack_irq: IRQ ack
  534. * @irq: interrupt lie
  535. *
  536. * Setup hw_regs_t structure described by parameters. You
  537. * may set up the hw structure yourself OR use this routine to
  538. * do it for you. This is basically a helper
  539. *
  540. */
  541. void ide_setup_ports ( hw_regs_t *hw,
  542. unsigned long base, int *offsets,
  543. unsigned long ctrl, unsigned long intr,
  544. ide_ack_intr_t *ack_intr,
  545. /*
  546. * ide_io_ops_t *iops,
  547. */
  548. int irq)
  549. {
  550. int i;
  551. memset(hw, 0, sizeof(hw_regs_t));
  552. for (i = 0; i < IDE_NR_PORTS; i++) {
  553. if (offsets[i] == -1) {
  554. switch(i) {
  555. case IDE_CONTROL_OFFSET:
  556. hw->io_ports[i] = ctrl;
  557. break;
  558. #if defined(CONFIG_AMIGA) || defined(CONFIG_MAC)
  559. case IDE_IRQ_OFFSET:
  560. hw->io_ports[i] = intr;
  561. break;
  562. #endif /* (CONFIG_AMIGA) || (CONFIG_MAC) */
  563. default:
  564. hw->io_ports[i] = 0;
  565. break;
  566. }
  567. } else {
  568. hw->io_ports[i] = base + offsets[i];
  569. }
  570. }
  571. hw->irq = irq;
  572. hw->dma = NO_DMA;
  573. hw->ack_intr = ack_intr;
  574. /*
  575. * hw->iops = iops;
  576. */
  577. }
  578. /**
  579. * ide_register_hw_with_fixup - register IDE interface
  580. * @hw: hardware registers
  581. * @initializing: set while initializing built-in drivers
  582. * @hwifp: pointer to returned hwif
  583. * @fixup: fixup function
  584. *
  585. * Register an IDE interface, specifying exactly the registers etc.
  586. * Set init=1 iff calling before probes have taken place.
  587. *
  588. * Returns -1 on error.
  589. */
  590. int ide_register_hw_with_fixup(hw_regs_t *hw, int initializing,
  591. ide_hwif_t **hwifp,
  592. void(*fixup)(ide_hwif_t *hwif))
  593. {
  594. int index, retry = 1;
  595. ide_hwif_t *hwif;
  596. do {
  597. for (index = 0; index < MAX_HWIFS; ++index) {
  598. hwif = &ide_hwifs[index];
  599. if (hwif->hw.io_ports[IDE_DATA_OFFSET] == hw->io_ports[IDE_DATA_OFFSET])
  600. goto found;
  601. }
  602. for (index = 0; index < MAX_HWIFS; ++index) {
  603. hwif = &ide_hwifs[index];
  604. if (hwif->hold)
  605. continue;
  606. if ((!hwif->present && !hwif->mate && !initializing) ||
  607. (!hwif->hw.io_ports[IDE_DATA_OFFSET] && initializing))
  608. goto found;
  609. }
  610. for (index = 0; index < MAX_HWIFS; index++)
  611. ide_unregister(index);
  612. } while (retry--);
  613. return -1;
  614. found:
  615. if (hwif->present)
  616. ide_unregister(index);
  617. else if (!hwif->hold) {
  618. init_hwif_data(hwif, index);
  619. init_hwif_default(hwif, index);
  620. }
  621. if (hwif->present)
  622. return -1;
  623. memcpy(&hwif->hw, hw, sizeof(*hw));
  624. memcpy(hwif->io_ports, hwif->hw.io_ports, sizeof(hwif->hw.io_ports));
  625. hwif->irq = hw->irq;
  626. hwif->noprobe = 0;
  627. hwif->chipset = hw->chipset;
  628. hwif->gendev.parent = hw->dev;
  629. if (!initializing) {
  630. probe_hwif_init_with_fixup(hwif, fixup);
  631. ide_proc_register_port(hwif);
  632. }
  633. if (hwifp)
  634. *hwifp = hwif;
  635. return (initializing || hwif->present) ? index : -1;
  636. }
  637. EXPORT_SYMBOL(ide_register_hw_with_fixup);
  638. int ide_register_hw(hw_regs_t *hw, int initializing, ide_hwif_t **hwifp)
  639. {
  640. return ide_register_hw_with_fixup(hw, initializing, hwifp, NULL);
  641. }
  642. EXPORT_SYMBOL(ide_register_hw);
  643. /*
  644. * Locks for IDE setting functionality
  645. */
  646. DEFINE_MUTEX(ide_setting_mtx);
  647. EXPORT_SYMBOL_GPL(ide_setting_mtx);
  648. /**
  649. * ide_spin_wait_hwgroup - wait for group
  650. * @drive: drive in the group
  651. *
  652. * Wait for an IDE device group to go non busy and then return
  653. * holding the ide_lock which guards the hwgroup->busy status
  654. * and right to use it.
  655. */
  656. int ide_spin_wait_hwgroup (ide_drive_t *drive)
  657. {
  658. ide_hwgroup_t *hwgroup = HWGROUP(drive);
  659. unsigned long timeout = jiffies + (3 * HZ);
  660. spin_lock_irq(&ide_lock);
  661. while (hwgroup->busy) {
  662. unsigned long lflags;
  663. spin_unlock_irq(&ide_lock);
  664. local_irq_set(lflags);
  665. if (time_after(jiffies, timeout)) {
  666. local_irq_restore(lflags);
  667. printk(KERN_ERR "%s: channel busy\n", drive->name);
  668. return -EBUSY;
  669. }
  670. local_irq_restore(lflags);
  671. spin_lock_irq(&ide_lock);
  672. }
  673. return 0;
  674. }
  675. EXPORT_SYMBOL(ide_spin_wait_hwgroup);
  676. int set_io_32bit(ide_drive_t *drive, int arg)
  677. {
  678. if (drive->no_io_32bit)
  679. return -EPERM;
  680. if (arg < 0 || arg > 1 + (SUPPORT_VLB_SYNC << 1))
  681. return -EINVAL;
  682. drive->io_32bit = arg;
  683. #ifdef CONFIG_BLK_DEV_DTC2278
  684. if (HWIF(drive)->chipset == ide_dtc2278)
  685. HWIF(drive)->drives[!drive->select.b.unit].io_32bit = arg;
  686. #endif /* CONFIG_BLK_DEV_DTC2278 */
  687. return 0;
  688. }
  689. static int set_ksettings(ide_drive_t *drive, int arg)
  690. {
  691. if (arg < 0 || arg > 1)
  692. return -EINVAL;
  693. if (ide_spin_wait_hwgroup(drive))
  694. return -EBUSY;
  695. drive->keep_settings = arg;
  696. spin_unlock_irq(&ide_lock);
  697. return 0;
  698. }
  699. int set_using_dma(ide_drive_t *drive, int arg)
  700. {
  701. #ifdef CONFIG_BLK_DEV_IDEDMA
  702. ide_hwif_t *hwif = drive->hwif;
  703. int err = -EPERM;
  704. if (arg < 0 || arg > 1)
  705. return -EINVAL;
  706. if (!drive->id || !(drive->id->capability & 1))
  707. goto out;
  708. if (hwif->ide_dma_check == NULL)
  709. goto out;
  710. err = -EBUSY;
  711. if (ide_spin_wait_hwgroup(drive))
  712. goto out;
  713. /*
  714. * set ->busy flag, unlock and let it ride
  715. */
  716. hwif->hwgroup->busy = 1;
  717. spin_unlock_irq(&ide_lock);
  718. err = 0;
  719. if (arg) {
  720. hwif->dma_off_quietly(drive);
  721. if (ide_set_dma(drive) || hwif->ide_dma_on(drive))
  722. err = -EIO;
  723. } else
  724. ide_dma_off(drive);
  725. /*
  726. * lock, clear ->busy flag and unlock before leaving
  727. */
  728. spin_lock_irq(&ide_lock);
  729. hwif->hwgroup->busy = 0;
  730. spin_unlock_irq(&ide_lock);
  731. out:
  732. return err;
  733. #else
  734. if (arg < 0 || arg > 1)
  735. return -EINVAL;
  736. return -EPERM;
  737. #endif
  738. }
  739. int set_pio_mode(ide_drive_t *drive, int arg)
  740. {
  741. struct request rq;
  742. if (arg < 0 || arg > 255)
  743. return -EINVAL;
  744. if (drive->hwif->set_pio_mode == NULL)
  745. return -ENOSYS;
  746. if (drive->special.b.set_tune)
  747. return -EBUSY;
  748. ide_init_drive_cmd(&rq);
  749. drive->tune_req = (u8) arg;
  750. drive->special.b.set_tune = 1;
  751. (void) ide_do_drive_cmd(drive, &rq, ide_wait);
  752. return 0;
  753. }
  754. static int set_unmaskirq(ide_drive_t *drive, int arg)
  755. {
  756. if (drive->no_unmask)
  757. return -EPERM;
  758. if (arg < 0 || arg > 1)
  759. return -EINVAL;
  760. if (ide_spin_wait_hwgroup(drive))
  761. return -EBUSY;
  762. drive->unmask = arg;
  763. spin_unlock_irq(&ide_lock);
  764. return 0;
  765. }
  766. /**
  767. * system_bus_clock - clock guess
  768. *
  769. * External version of the bus clock guess used by very old IDE drivers
  770. * for things like VLB timings. Should not be used.
  771. */
  772. int system_bus_clock (void)
  773. {
  774. return((int) ((!system_bus_speed) ? ide_system_bus_speed() : system_bus_speed ));
  775. }
  776. EXPORT_SYMBOL(system_bus_clock);
  777. static int generic_ide_suspend(struct device *dev, pm_message_t mesg)
  778. {
  779. ide_drive_t *drive = dev->driver_data;
  780. ide_hwif_t *hwif = HWIF(drive);
  781. struct request rq;
  782. struct request_pm_state rqpm;
  783. ide_task_t args;
  784. int ret;
  785. /* Call ACPI _GTM only once */
  786. if (!(drive->dn % 2))
  787. ide_acpi_get_timing(hwif);
  788. memset(&rq, 0, sizeof(rq));
  789. memset(&rqpm, 0, sizeof(rqpm));
  790. memset(&args, 0, sizeof(args));
  791. rq.cmd_type = REQ_TYPE_PM_SUSPEND;
  792. rq.special = &args;
  793. rq.data = &rqpm;
  794. rqpm.pm_step = ide_pm_state_start_suspend;
  795. if (mesg.event == PM_EVENT_PRETHAW)
  796. mesg.event = PM_EVENT_FREEZE;
  797. rqpm.pm_state = mesg.event;
  798. ret = ide_do_drive_cmd(drive, &rq, ide_wait);
  799. /* only call ACPI _PS3 after both drivers are suspended */
  800. if (!ret && (((drive->dn % 2) && hwif->drives[0].present
  801. && hwif->drives[1].present)
  802. || !hwif->drives[0].present
  803. || !hwif->drives[1].present))
  804. ide_acpi_set_state(hwif, 0);
  805. return ret;
  806. }
  807. static int generic_ide_resume(struct device *dev)
  808. {
  809. ide_drive_t *drive = dev->driver_data;
  810. ide_hwif_t *hwif = HWIF(drive);
  811. struct request rq;
  812. struct request_pm_state rqpm;
  813. ide_task_t args;
  814. int err;
  815. /* Call ACPI _STM only once */
  816. if (!(drive->dn % 2)) {
  817. ide_acpi_set_state(hwif, 1);
  818. ide_acpi_push_timing(hwif);
  819. }
  820. ide_acpi_exec_tfs(drive);
  821. memset(&rq, 0, sizeof(rq));
  822. memset(&rqpm, 0, sizeof(rqpm));
  823. memset(&args, 0, sizeof(args));
  824. rq.cmd_type = REQ_TYPE_PM_RESUME;
  825. rq.special = &args;
  826. rq.data = &rqpm;
  827. rqpm.pm_step = ide_pm_state_start_resume;
  828. rqpm.pm_state = PM_EVENT_ON;
  829. err = ide_do_drive_cmd(drive, &rq, ide_head_wait);
  830. if (err == 0 && dev->driver) {
  831. ide_driver_t *drv = to_ide_driver(dev->driver);
  832. if (drv->resume)
  833. drv->resume(drive);
  834. }
  835. return err;
  836. }
  837. int generic_ide_ioctl(ide_drive_t *drive, struct file *file, struct block_device *bdev,
  838. unsigned int cmd, unsigned long arg)
  839. {
  840. unsigned long flags;
  841. ide_driver_t *drv;
  842. void __user *p = (void __user *)arg;
  843. int err = 0, (*setfunc)(ide_drive_t *, int);
  844. u8 *val;
  845. switch (cmd) {
  846. case HDIO_GET_32BIT: val = &drive->io_32bit; goto read_val;
  847. case HDIO_GET_KEEPSETTINGS: val = &drive->keep_settings; goto read_val;
  848. case HDIO_GET_UNMASKINTR: val = &drive->unmask; goto read_val;
  849. case HDIO_GET_DMA: val = &drive->using_dma; goto read_val;
  850. case HDIO_SET_32BIT: setfunc = set_io_32bit; goto set_val;
  851. case HDIO_SET_KEEPSETTINGS: setfunc = set_ksettings; goto set_val;
  852. case HDIO_SET_PIO_MODE: setfunc = set_pio_mode; goto set_val;
  853. case HDIO_SET_UNMASKINTR: setfunc = set_unmaskirq; goto set_val;
  854. case HDIO_SET_DMA: setfunc = set_using_dma; goto set_val;
  855. }
  856. switch (cmd) {
  857. case HDIO_OBSOLETE_IDENTITY:
  858. case HDIO_GET_IDENTITY:
  859. if (bdev != bdev->bd_contains)
  860. return -EINVAL;
  861. if (drive->id_read == 0)
  862. return -ENOMSG;
  863. if (copy_to_user(p, drive->id, (cmd == HDIO_GET_IDENTITY) ? sizeof(*drive->id) : 142))
  864. return -EFAULT;
  865. return 0;
  866. case HDIO_GET_NICE:
  867. return put_user(drive->dsc_overlap << IDE_NICE_DSC_OVERLAP |
  868. drive->atapi_overlap << IDE_NICE_ATAPI_OVERLAP |
  869. drive->nice0 << IDE_NICE_0 |
  870. drive->nice1 << IDE_NICE_1 |
  871. drive->nice2 << IDE_NICE_2,
  872. (long __user *) arg);
  873. #ifdef CONFIG_IDE_TASK_IOCTL
  874. case HDIO_DRIVE_TASKFILE:
  875. if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  876. return -EACCES;
  877. switch(drive->media) {
  878. case ide_disk:
  879. return ide_taskfile_ioctl(drive, cmd, arg);
  880. default:
  881. return -ENOMSG;
  882. }
  883. #endif /* CONFIG_IDE_TASK_IOCTL */
  884. case HDIO_DRIVE_CMD:
  885. if (!capable(CAP_SYS_RAWIO))
  886. return -EACCES;
  887. return ide_cmd_ioctl(drive, cmd, arg);
  888. case HDIO_DRIVE_TASK:
  889. if (!capable(CAP_SYS_RAWIO))
  890. return -EACCES;
  891. return ide_task_ioctl(drive, cmd, arg);
  892. case HDIO_SCAN_HWIF:
  893. {
  894. hw_regs_t hw;
  895. int args[3];
  896. if (!capable(CAP_SYS_RAWIO)) return -EACCES;
  897. if (copy_from_user(args, p, 3 * sizeof(int)))
  898. return -EFAULT;
  899. memset(&hw, 0, sizeof(hw));
  900. ide_init_hwif_ports(&hw, (unsigned long) args[0],
  901. (unsigned long) args[1], NULL);
  902. hw.irq = args[2];
  903. if (ide_register_hw(&hw, 0, NULL) == -1)
  904. return -EIO;
  905. return 0;
  906. }
  907. case HDIO_UNREGISTER_HWIF:
  908. if (!capable(CAP_SYS_RAWIO)) return -EACCES;
  909. /* (arg > MAX_HWIFS) checked in function */
  910. ide_unregister(arg);
  911. return 0;
  912. case HDIO_SET_NICE:
  913. if (!capable(CAP_SYS_ADMIN)) return -EACCES;
  914. if (arg != (arg & ((1 << IDE_NICE_DSC_OVERLAP) | (1 << IDE_NICE_1))))
  915. return -EPERM;
  916. drive->dsc_overlap = (arg >> IDE_NICE_DSC_OVERLAP) & 1;
  917. drv = *(ide_driver_t **)bdev->bd_disk->private_data;
  918. if (drive->dsc_overlap && !drv->supports_dsc_overlap) {
  919. drive->dsc_overlap = 0;
  920. return -EPERM;
  921. }
  922. drive->nice1 = (arg >> IDE_NICE_1) & 1;
  923. return 0;
  924. case HDIO_DRIVE_RESET:
  925. {
  926. unsigned long flags;
  927. if (!capable(CAP_SYS_ADMIN)) return -EACCES;
  928. /*
  929. * Abort the current command on the
  930. * group if there is one, taking
  931. * care not to allow anything else
  932. * to be queued and to die on the
  933. * spot if we miss one somehow
  934. */
  935. spin_lock_irqsave(&ide_lock, flags);
  936. if (HWGROUP(drive)->resetting) {
  937. spin_unlock_irqrestore(&ide_lock, flags);
  938. return -EBUSY;
  939. }
  940. ide_abort(drive, "drive reset");
  941. BUG_ON(HWGROUP(drive)->handler);
  942. /* Ensure nothing gets queued after we
  943. drop the lock. Reset will clear the busy */
  944. HWGROUP(drive)->busy = 1;
  945. spin_unlock_irqrestore(&ide_lock, flags);
  946. (void) ide_do_reset(drive);
  947. return 0;
  948. }
  949. case HDIO_GET_BUSSTATE:
  950. if (!capable(CAP_SYS_ADMIN))
  951. return -EACCES;
  952. if (put_user(HWIF(drive)->bus_state, (long __user *)arg))
  953. return -EFAULT;
  954. return 0;
  955. case HDIO_SET_BUSSTATE:
  956. if (!capable(CAP_SYS_ADMIN))
  957. return -EACCES;
  958. if (HWIF(drive)->busproc)
  959. return HWIF(drive)->busproc(drive, (int)arg);
  960. return -EOPNOTSUPP;
  961. default:
  962. return -EINVAL;
  963. }
  964. read_val:
  965. mutex_lock(&ide_setting_mtx);
  966. spin_lock_irqsave(&ide_lock, flags);
  967. err = *val;
  968. spin_unlock_irqrestore(&ide_lock, flags);
  969. mutex_unlock(&ide_setting_mtx);
  970. return err >= 0 ? put_user(err, (long __user *)arg) : err;
  971. set_val:
  972. if (bdev != bdev->bd_contains)
  973. err = -EINVAL;
  974. else {
  975. if (!capable(CAP_SYS_ADMIN))
  976. err = -EACCES;
  977. else {
  978. mutex_lock(&ide_setting_mtx);
  979. err = setfunc(drive, arg);
  980. mutex_unlock(&ide_setting_mtx);
  981. }
  982. }
  983. return err;
  984. }
  985. EXPORT_SYMBOL(generic_ide_ioctl);
  986. /*
  987. * stridx() returns the offset of c within s,
  988. * or -1 if c is '\0' or not found within s.
  989. */
  990. static int __init stridx (const char *s, char c)
  991. {
  992. char *i = strchr(s, c);
  993. return (i && c) ? i - s : -1;
  994. }
  995. /*
  996. * match_parm() does parsing for ide_setup():
  997. *
  998. * 1. the first char of s must be '='.
  999. * 2. if the remainder matches one of the supplied keywords,
  1000. * the index (1 based) of the keyword is negated and returned.
  1001. * 3. if the remainder is a series of no more than max_vals numbers
  1002. * separated by commas, the numbers are saved in vals[] and a
  1003. * count of how many were saved is returned. Base10 is assumed,
  1004. * and base16 is allowed when prefixed with "0x".
  1005. * 4. otherwise, zero is returned.
  1006. */
  1007. static int __init match_parm (char *s, const char *keywords[], int vals[], int max_vals)
  1008. {
  1009. static const char *decimal = "0123456789";
  1010. static const char *hex = "0123456789abcdef";
  1011. int i, n;
  1012. if (*s++ == '=') {
  1013. /*
  1014. * Try matching against the supplied keywords,
  1015. * and return -(index+1) if we match one
  1016. */
  1017. if (keywords != NULL) {
  1018. for (i = 0; *keywords != NULL; ++i) {
  1019. if (!strcmp(s, *keywords++))
  1020. return -(i+1);
  1021. }
  1022. }
  1023. /*
  1024. * Look for a series of no more than "max_vals"
  1025. * numeric values separated by commas, in base10,
  1026. * or base16 when prefixed with "0x".
  1027. * Return a count of how many were found.
  1028. */
  1029. for (n = 0; (i = stridx(decimal, *s)) >= 0;) {
  1030. vals[n] = i;
  1031. while ((i = stridx(decimal, *++s)) >= 0)
  1032. vals[n] = (vals[n] * 10) + i;
  1033. if (*s == 'x' && !vals[n]) {
  1034. while ((i = stridx(hex, *++s)) >= 0)
  1035. vals[n] = (vals[n] * 0x10) + i;
  1036. }
  1037. if (++n == max_vals)
  1038. break;
  1039. if (*s == ',' || *s == ';')
  1040. ++s;
  1041. }
  1042. if (!*s)
  1043. return n;
  1044. }
  1045. return 0; /* zero = nothing matched */
  1046. }
  1047. #ifdef CONFIG_BLK_DEV_ALI14XX
  1048. extern int probe_ali14xx;
  1049. extern int ali14xx_init(void);
  1050. #endif
  1051. #ifdef CONFIG_BLK_DEV_UMC8672
  1052. extern int probe_umc8672;
  1053. extern int umc8672_init(void);
  1054. #endif
  1055. #ifdef CONFIG_BLK_DEV_DTC2278
  1056. extern int probe_dtc2278;
  1057. extern int dtc2278_init(void);
  1058. #endif
  1059. #ifdef CONFIG_BLK_DEV_HT6560B
  1060. extern int probe_ht6560b;
  1061. extern int ht6560b_init(void);
  1062. #endif
  1063. #ifdef CONFIG_BLK_DEV_QD65XX
  1064. extern int probe_qd65xx;
  1065. extern int qd65xx_init(void);
  1066. #endif
  1067. static int __initdata is_chipset_set[MAX_HWIFS];
  1068. /*
  1069. * ide_setup() gets called VERY EARLY during initialization,
  1070. * to handle kernel "command line" strings beginning with "hdx=" or "ide".
  1071. *
  1072. * Remember to update Documentation/ide.txt if you change something here.
  1073. */
  1074. static int __init ide_setup(char *s)
  1075. {
  1076. int i, vals[3];
  1077. ide_hwif_t *hwif;
  1078. ide_drive_t *drive;
  1079. unsigned int hw, unit;
  1080. const char max_drive = 'a' + ((MAX_HWIFS * MAX_DRIVES) - 1);
  1081. const char max_hwif = '0' + (MAX_HWIFS - 1);
  1082. if (strncmp(s,"hd",2) == 0 && s[2] == '=') /* hd= is for hd.c */
  1083. return 0; /* driver and not us */
  1084. if (strncmp(s,"ide",3) && strncmp(s,"idebus",6) && strncmp(s,"hd",2))
  1085. return 0;
  1086. printk(KERN_INFO "ide_setup: %s", s);
  1087. init_ide_data ();
  1088. #ifdef CONFIG_BLK_DEV_IDEDOUBLER
  1089. if (!strcmp(s, "ide=doubler")) {
  1090. extern int ide_doubler;
  1091. printk(" : Enabled support for IDE doublers\n");
  1092. ide_doubler = 1;
  1093. return 1;
  1094. }
  1095. #endif /* CONFIG_BLK_DEV_IDEDOUBLER */
  1096. if (!strcmp(s, "ide=nodma")) {
  1097. printk(" : Prevented DMA\n");
  1098. noautodma = 1;
  1099. return 1;
  1100. }
  1101. #ifdef CONFIG_IDEPCI_PCIBUS_ORDER
  1102. if (!strcmp(s, "ide=reverse")) {
  1103. ide_scan_direction = 1;
  1104. printk(" : Enabled support for IDE inverse scan order.\n");
  1105. return 1;
  1106. }
  1107. #endif
  1108. #ifdef CONFIG_BLK_DEV_IDEACPI
  1109. if (!strcmp(s, "ide=noacpi")) {
  1110. //printk(" : Disable IDE ACPI support.\n");
  1111. ide_noacpi = 1;
  1112. return 1;
  1113. }
  1114. if (!strcmp(s, "ide=acpigtf")) {
  1115. //printk(" : Enable IDE ACPI _GTF support.\n");
  1116. ide_noacpitfs = 0;
  1117. return 1;
  1118. }
  1119. if (!strcmp(s, "ide=acpionboot")) {
  1120. //printk(" : Call IDE ACPI methods on boot.\n");
  1121. ide_noacpionboot = 0;
  1122. return 1;
  1123. }
  1124. #endif /* CONFIG_BLK_DEV_IDEACPI */
  1125. /*
  1126. * Look for drive options: "hdx="
  1127. */
  1128. if (s[0] == 'h' && s[1] == 'd' && s[2] >= 'a' && s[2] <= max_drive) {
  1129. const char *hd_words[] = {
  1130. "none", "noprobe", "nowerr", "cdrom", "minus5",
  1131. "autotune", "noautotune", "minus8", "swapdata", "bswap",
  1132. "noflush", "remap", "remap63", "scsi", NULL };
  1133. unit = s[2] - 'a';
  1134. hw = unit / MAX_DRIVES;
  1135. unit = unit % MAX_DRIVES;
  1136. hwif = &ide_hwifs[hw];
  1137. drive = &hwif->drives[unit];
  1138. if (strncmp(s + 4, "ide-", 4) == 0) {
  1139. strlcpy(drive->driver_req, s + 4, sizeof(drive->driver_req));
  1140. goto done;
  1141. }
  1142. switch (match_parm(&s[3], hd_words, vals, 3)) {
  1143. case -1: /* "none" */
  1144. case -2: /* "noprobe" */
  1145. drive->noprobe = 1;
  1146. goto done;
  1147. case -3: /* "nowerr" */
  1148. drive->bad_wstat = BAD_R_STAT;
  1149. hwif->noprobe = 0;
  1150. goto done;
  1151. case -4: /* "cdrom" */
  1152. drive->present = 1;
  1153. drive->media = ide_cdrom;
  1154. /* an ATAPI device ignores DRDY */
  1155. drive->ready_stat = 0;
  1156. hwif->noprobe = 0;
  1157. goto done;
  1158. case -6: /* "autotune" */
  1159. drive->autotune = IDE_TUNE_AUTO;
  1160. goto obsolete_option;
  1161. case -7: /* "noautotune" */
  1162. drive->autotune = IDE_TUNE_NOAUTO;
  1163. goto obsolete_option;
  1164. case -9: /* "swapdata" */
  1165. case -10: /* "bswap" */
  1166. drive->bswap = 1;
  1167. goto done;
  1168. case -11: /* noflush */
  1169. drive->noflush = 1;
  1170. goto done;
  1171. case -12: /* "remap" */
  1172. drive->remap_0_to_1 = 1;
  1173. goto done;
  1174. case -13: /* "remap63" */
  1175. drive->sect0 = 63;
  1176. goto done;
  1177. case -14: /* "scsi" */
  1178. drive->scsi = 1;
  1179. goto done;
  1180. case 3: /* cyl,head,sect */
  1181. drive->media = ide_disk;
  1182. drive->ready_stat = READY_STAT;
  1183. drive->cyl = drive->bios_cyl = vals[0];
  1184. drive->head = drive->bios_head = vals[1];
  1185. drive->sect = drive->bios_sect = vals[2];
  1186. drive->present = 1;
  1187. drive->forced_geom = 1;
  1188. hwif->noprobe = 0;
  1189. goto done;
  1190. default:
  1191. goto bad_option;
  1192. }
  1193. }
  1194. if (s[0] != 'i' || s[1] != 'd' || s[2] != 'e')
  1195. goto bad_option;
  1196. /*
  1197. * Look for bus speed option: "idebus="
  1198. */
  1199. if (s[3] == 'b' && s[4] == 'u' && s[5] == 's') {
  1200. if (match_parm(&s[6], NULL, vals, 1) != 1)
  1201. goto bad_option;
  1202. if (vals[0] >= 20 && vals[0] <= 66) {
  1203. idebus_parameter = vals[0];
  1204. } else
  1205. printk(" -- BAD BUS SPEED! Expected value from 20 to 66");
  1206. goto done;
  1207. }
  1208. /*
  1209. * Look for interface options: "idex="
  1210. */
  1211. if (s[3] >= '0' && s[3] <= max_hwif) {
  1212. /*
  1213. * Be VERY CAREFUL changing this: note hardcoded indexes below
  1214. * (-8, -9, -10) are reserved to ease the hardcoding.
  1215. */
  1216. static const char *ide_words[] = {
  1217. "noprobe", "serialize", "minus3", "minus4",
  1218. "reset", "dma", "ata66", "minus8", "minus9",
  1219. "minus10", "four", "qd65xx", "ht6560b", "cmd640_vlb",
  1220. "dtc2278", "umc8672", "ali14xx", NULL };
  1221. hw = s[3] - '0';
  1222. hwif = &ide_hwifs[hw];
  1223. i = match_parm(&s[4], ide_words, vals, 3);
  1224. /*
  1225. * Cryptic check to ensure chipset not already set for hwif.
  1226. * Note: we can't depend on hwif->chipset here.
  1227. */
  1228. if ((i >= -18 && i <= -11) || (i > 0 && i <= 3)) {
  1229. /* chipset already specified */
  1230. if (is_chipset_set[hw])
  1231. goto bad_option;
  1232. if (i > -18 && i <= -11) {
  1233. /* these drivers are for "ide0=" only */
  1234. if (hw != 0)
  1235. goto bad_hwif;
  1236. /* chipset already specified for 2nd port */
  1237. if (is_chipset_set[hw+1])
  1238. goto bad_option;
  1239. }
  1240. is_chipset_set[hw] = 1;
  1241. printk("\n");
  1242. }
  1243. switch (i) {
  1244. #ifdef CONFIG_BLK_DEV_ALI14XX
  1245. case -17: /* "ali14xx" */
  1246. probe_ali14xx = 1;
  1247. goto done;
  1248. #endif
  1249. #ifdef CONFIG_BLK_DEV_UMC8672
  1250. case -16: /* "umc8672" */
  1251. probe_umc8672 = 1;
  1252. goto done;
  1253. #endif
  1254. #ifdef CONFIG_BLK_DEV_DTC2278
  1255. case -15: /* "dtc2278" */
  1256. probe_dtc2278 = 1;
  1257. goto done;
  1258. #endif
  1259. #ifdef CONFIG_BLK_DEV_CMD640
  1260. case -14: /* "cmd640_vlb" */
  1261. {
  1262. extern int cmd640_vlb; /* flag for cmd640.c */
  1263. cmd640_vlb = 1;
  1264. goto done;
  1265. }
  1266. #endif
  1267. #ifdef CONFIG_BLK_DEV_HT6560B
  1268. case -13: /* "ht6560b" */
  1269. probe_ht6560b = 1;
  1270. goto done;
  1271. #endif
  1272. #ifdef CONFIG_BLK_DEV_QD65XX
  1273. case -12: /* "qd65xx" */
  1274. probe_qd65xx = 1;
  1275. goto done;
  1276. #endif
  1277. #ifdef CONFIG_BLK_DEV_4DRIVES
  1278. case -11: /* "four" drives on one set of ports */
  1279. {
  1280. ide_hwif_t *mate = &ide_hwifs[hw^1];
  1281. mate->drives[0].select.all ^= 0x20;
  1282. mate->drives[1].select.all ^= 0x20;
  1283. hwif->chipset = mate->chipset = ide_4drives;
  1284. mate->irq = hwif->irq;
  1285. memcpy(mate->io_ports, hwif->io_ports, sizeof(hwif->io_ports));
  1286. hwif->mate = mate;
  1287. mate->mate = hwif;
  1288. hwif->serialized = mate->serialized = 1;
  1289. goto obsolete_option;
  1290. }
  1291. #endif /* CONFIG_BLK_DEV_4DRIVES */
  1292. case -10: /* minus10 */
  1293. case -9: /* minus9 */
  1294. case -8: /* minus8 */
  1295. case -4:
  1296. case -3:
  1297. goto bad_option;
  1298. case -7: /* ata66 */
  1299. #ifdef CONFIG_BLK_DEV_IDEPCI
  1300. /*
  1301. * Use ATA_CBL_PATA40_SHORT so drive side
  1302. * cable detection is also overriden.
  1303. */
  1304. hwif->cbl = ATA_CBL_PATA40_SHORT;
  1305. goto obsolete_option;
  1306. #else
  1307. goto bad_hwif;
  1308. #endif
  1309. case -6: /* dma */
  1310. hwif->autodma = 1;
  1311. goto obsolete_option;
  1312. case -5: /* "reset" */
  1313. hwif->reset = 1;
  1314. goto obsolete_option;
  1315. case -2: /* "serialize" */
  1316. hwif->mate = &ide_hwifs[hw^1];
  1317. hwif->mate->mate = hwif;
  1318. hwif->serialized = hwif->mate->serialized = 1;
  1319. goto obsolete_option;
  1320. case -1: /* "noprobe" */
  1321. hwif->noprobe = 1;
  1322. goto done;
  1323. case 1: /* base */
  1324. vals[1] = vals[0] + 0x206; /* default ctl */
  1325. case 2: /* base,ctl */
  1326. vals[2] = 0; /* default irq = probe for it */
  1327. case 3: /* base,ctl,irq */
  1328. hwif->hw.irq = vals[2];
  1329. ide_init_hwif_ports(&hwif->hw, (unsigned long) vals[0], (unsigned long) vals[1], &hwif->irq);
  1330. memcpy(hwif->io_ports, hwif->hw.io_ports, sizeof(hwif->io_ports));
  1331. hwif->irq = vals[2];
  1332. hwif->noprobe = 0;
  1333. hwif->chipset = ide_forced;
  1334. goto obsolete_option;
  1335. case 0: goto bad_option;
  1336. default:
  1337. printk(" -- SUPPORT NOT CONFIGURED IN THIS KERNEL\n");
  1338. return 1;
  1339. }
  1340. }
  1341. bad_option:
  1342. printk(" -- BAD OPTION\n");
  1343. return 1;
  1344. obsolete_option:
  1345. printk(" -- OBSOLETE OPTION, WILL BE REMOVED SOON!\n");
  1346. return 1;
  1347. bad_hwif:
  1348. printk("-- NOT SUPPORTED ON ide%d", hw);
  1349. done:
  1350. printk("\n");
  1351. return 1;
  1352. }
  1353. extern void __init pnpide_init(void);
  1354. extern void __exit pnpide_exit(void);
  1355. extern void __init h8300_ide_init(void);
  1356. /*
  1357. * probe_for_hwifs() finds/initializes "known" IDE interfaces
  1358. */
  1359. static void __init probe_for_hwifs (void)
  1360. {
  1361. #ifdef CONFIG_IDEPCI_PCIBUS_ORDER
  1362. ide_scan_pcibus(ide_scan_direction);
  1363. #endif
  1364. #ifdef CONFIG_ETRAX_IDE
  1365. {
  1366. extern void init_e100_ide(void);
  1367. init_e100_ide();
  1368. }
  1369. #endif /* CONFIG_ETRAX_IDE */
  1370. #ifdef CONFIG_BLK_DEV_CMD640
  1371. {
  1372. extern void ide_probe_for_cmd640x(void);
  1373. ide_probe_for_cmd640x();
  1374. }
  1375. #endif /* CONFIG_BLK_DEV_CMD640 */
  1376. #ifdef CONFIG_BLK_DEV_IDE_PMAC
  1377. {
  1378. extern int pmac_ide_probe(void);
  1379. (void)pmac_ide_probe();
  1380. }
  1381. #endif /* CONFIG_BLK_DEV_IDE_PMAC */
  1382. #ifdef CONFIG_BLK_DEV_GAYLE
  1383. {
  1384. extern void gayle_init(void);
  1385. gayle_init();
  1386. }
  1387. #endif /* CONFIG_BLK_DEV_GAYLE */
  1388. #ifdef CONFIG_BLK_DEV_FALCON_IDE
  1389. {
  1390. extern void falconide_init(void);
  1391. falconide_init();
  1392. }
  1393. #endif /* CONFIG_BLK_DEV_FALCON_IDE */
  1394. #ifdef CONFIG_BLK_DEV_MAC_IDE
  1395. {
  1396. extern void macide_init(void);
  1397. macide_init();
  1398. }
  1399. #endif /* CONFIG_BLK_DEV_MAC_IDE */
  1400. #ifdef CONFIG_BLK_DEV_Q40IDE
  1401. {
  1402. extern void q40ide_init(void);
  1403. q40ide_init();
  1404. }
  1405. #endif /* CONFIG_BLK_DEV_Q40IDE */
  1406. #ifdef CONFIG_BLK_DEV_BUDDHA
  1407. {
  1408. extern void buddha_init(void);
  1409. buddha_init();
  1410. }
  1411. #endif /* CONFIG_BLK_DEV_BUDDHA */
  1412. #ifdef CONFIG_BLK_DEV_IDEPNP
  1413. pnpide_init();
  1414. #endif
  1415. #ifdef CONFIG_H8300
  1416. h8300_ide_init();
  1417. #endif
  1418. }
  1419. /*
  1420. * Probe module
  1421. */
  1422. EXPORT_SYMBOL(ide_lock);
  1423. static int ide_bus_match(struct device *dev, struct device_driver *drv)
  1424. {
  1425. return 1;
  1426. }
  1427. static char *media_string(ide_drive_t *drive)
  1428. {
  1429. switch (drive->media) {
  1430. case ide_disk:
  1431. return "disk";
  1432. case ide_cdrom:
  1433. return "cdrom";
  1434. case ide_tape:
  1435. return "tape";
  1436. case ide_floppy:
  1437. return "floppy";
  1438. case ide_optical:
  1439. return "optical";
  1440. default:
  1441. return "UNKNOWN";
  1442. }
  1443. }
  1444. static ssize_t media_show(struct device *dev, struct device_attribute *attr, char *buf)
  1445. {
  1446. ide_drive_t *drive = to_ide_device(dev);
  1447. return sprintf(buf, "%s\n", media_string(drive));
  1448. }
  1449. static ssize_t drivename_show(struct device *dev, struct device_attribute *attr, char *buf)
  1450. {
  1451. ide_drive_t *drive = to_ide_device(dev);
  1452. return sprintf(buf, "%s\n", drive->name);
  1453. }
  1454. static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, char *buf)
  1455. {
  1456. ide_drive_t *drive = to_ide_device(dev);
  1457. return sprintf(buf, "ide:m-%s\n", media_string(drive));
  1458. }
  1459. static struct device_attribute ide_dev_attrs[] = {
  1460. __ATTR_RO(media),
  1461. __ATTR_RO(drivename),
  1462. __ATTR_RO(modalias),
  1463. __ATTR_NULL
  1464. };
  1465. static int ide_uevent(struct device *dev, struct kobj_uevent_env *env)
  1466. {
  1467. ide_drive_t *drive = to_ide_device(dev);
  1468. add_uevent_var(env, "MEDIA=%s", media_string(drive));
  1469. add_uevent_var(env, "DRIVENAME=%s", drive->name);
  1470. add_uevent_var(env, "MODALIAS=ide:m-%s", media_string(drive));
  1471. return 0;
  1472. }
  1473. static int generic_ide_probe(struct device *dev)
  1474. {
  1475. ide_drive_t *drive = to_ide_device(dev);
  1476. ide_driver_t *drv = to_ide_driver(dev->driver);
  1477. return drv->probe ? drv->probe(drive) : -ENODEV;
  1478. }
  1479. static int generic_ide_remove(struct device *dev)
  1480. {
  1481. ide_drive_t *drive = to_ide_device(dev);
  1482. ide_driver_t *drv = to_ide_driver(dev->driver);
  1483. if (drv->remove)
  1484. drv->remove(drive);
  1485. return 0;
  1486. }
  1487. static void generic_ide_shutdown(struct device *dev)
  1488. {
  1489. ide_drive_t *drive = to_ide_device(dev);
  1490. ide_driver_t *drv = to_ide_driver(dev->driver);
  1491. if (dev->driver && drv->shutdown)
  1492. drv->shutdown(drive);
  1493. }
  1494. struct bus_type ide_bus_type = {
  1495. .name = "ide",
  1496. .match = ide_bus_match,
  1497. .uevent = ide_uevent,
  1498. .probe = generic_ide_probe,
  1499. .remove = generic_ide_remove,
  1500. .shutdown = generic_ide_shutdown,
  1501. .dev_attrs = ide_dev_attrs,
  1502. .suspend = generic_ide_suspend,
  1503. .resume = generic_ide_resume,
  1504. };
  1505. EXPORT_SYMBOL_GPL(ide_bus_type);
  1506. /*
  1507. * This is gets invoked once during initialization, to set *everything* up
  1508. */
  1509. static int __init ide_init(void)
  1510. {
  1511. int ret;
  1512. printk(KERN_INFO "Uniform Multi-Platform E-IDE driver " REVISION "\n");
  1513. system_bus_speed = ide_system_bus_speed();
  1514. ret = bus_register(&ide_bus_type);
  1515. if (ret < 0) {
  1516. printk(KERN_WARNING "IDE: bus_register error: %d\n", ret);
  1517. return ret;
  1518. }
  1519. init_ide_data();
  1520. proc_ide_create();
  1521. #ifdef CONFIG_BLK_DEV_ALI14XX
  1522. if (probe_ali14xx)
  1523. (void)ali14xx_init();
  1524. #endif
  1525. #ifdef CONFIG_BLK_DEV_UMC8672
  1526. if (probe_umc8672)
  1527. (void)umc8672_init();
  1528. #endif
  1529. #ifdef CONFIG_BLK_DEV_DTC2278
  1530. if (probe_dtc2278)
  1531. (void)dtc2278_init();
  1532. #endif
  1533. #ifdef CONFIG_BLK_DEV_HT6560B
  1534. if (probe_ht6560b)
  1535. (void)ht6560b_init();
  1536. #endif
  1537. #ifdef CONFIG_BLK_DEV_QD65XX
  1538. if (probe_qd65xx)
  1539. (void)qd65xx_init();
  1540. #endif
  1541. /* Probe for special PCI and other "known" interface chipsets. */
  1542. probe_for_hwifs();
  1543. return 0;
  1544. }
  1545. #ifdef MODULE
  1546. static char *options = NULL;
  1547. module_param(options, charp, 0);
  1548. MODULE_LICENSE("GPL");
  1549. static void __init parse_options (char *line)
  1550. {
  1551. char *next = line;
  1552. if (line == NULL || !*line)
  1553. return;
  1554. while ((line = next) != NULL) {
  1555. if ((next = strchr(line,' ')) != NULL)
  1556. *next++ = 0;
  1557. if (!ide_setup(line))
  1558. printk (KERN_INFO "Unknown option '%s'\n", line);
  1559. }
  1560. }
  1561. int __init init_module (void)
  1562. {
  1563. parse_options(options);
  1564. return ide_init();
  1565. }
  1566. void __exit cleanup_module (void)
  1567. {
  1568. int index;
  1569. for (index = 0; index < MAX_HWIFS; ++index)
  1570. ide_unregister(index);
  1571. #ifdef CONFIG_BLK_DEV_IDEPNP
  1572. pnpide_exit();
  1573. #endif
  1574. proc_ide_destroy();
  1575. bus_unregister(&ide_bus_type);
  1576. }
  1577. #else /* !MODULE */
  1578. __setup("", ide_setup);
  1579. module_init(ide_init);
  1580. #endif /* MODULE */