ide.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840
  1. /*
  2. * Copyright (C) 1994-1998 Linus Torvalds & authors (see below)
  3. * Copyright (C) 2003-2005, 2007 Bartlomiej Zolnierkiewicz
  4. */
  5. /*
  6. * Mostly written by Mark Lord <mlord@pobox.com>
  7. * and Gadi Oxman <gadio@netvision.net.il>
  8. * and Andre Hedrick <andre@linux-ide.org>
  9. *
  10. * See linux/MAINTAINERS for address of current maintainer.
  11. *
  12. * This is the multiple IDE interface driver, as evolved from hd.c.
  13. * It supports up to MAX_HWIFS IDE interfaces, on one or more IRQs
  14. * (usually 14 & 15).
  15. * There can be up to two drives per interface, as per the ATA-2 spec.
  16. *
  17. * ...
  18. *
  19. * From hd.c:
  20. * |
  21. * | It traverses the request-list, using interrupts to jump between functions.
  22. * | As nearly all functions can be called within interrupts, we may not sleep.
  23. * | Special care is recommended. Have Fun!
  24. * |
  25. * | modified by Drew Eckhardt to check nr of hd's from the CMOS.
  26. * |
  27. * | Thanks to Branko Lankester, lankeste@fwi.uva.nl, who found a bug
  28. * | in the early extended-partition checks and added DM partitions.
  29. * |
  30. * | Early work on error handling by Mika Liljeberg (liljeber@cs.Helsinki.FI).
  31. * |
  32. * | IRQ-unmask, drive-id, multiple-mode, support for ">16 heads",
  33. * | and general streamlining by Mark Lord (mlord@pobox.com).
  34. *
  35. * October, 1994 -- Complete line-by-line overhaul for linux 1.1.x, by:
  36. *
  37. * Mark Lord (mlord@pobox.com) (IDE Perf.Pkg)
  38. * Delman Lee (delman@ieee.org) ("Mr. atdisk2")
  39. * Scott Snyder (snyder@fnald0.fnal.gov) (ATAPI IDE cd-rom)
  40. *
  41. * This was a rewrite of just about everything from hd.c, though some original
  42. * code is still sprinkled about. Think of it as a major evolution, with
  43. * inspiration from lots of linux users, esp. hamish@zot.apana.org.au
  44. */
  45. #include <linux/module.h>
  46. #include <linux/types.h>
  47. #include <linux/string.h>
  48. #include <linux/kernel.h>
  49. #include <linux/interrupt.h>
  50. #include <linux/major.h>
  51. #include <linux/errno.h>
  52. #include <linux/genhd.h>
  53. #include <linux/slab.h>
  54. #include <linux/init.h>
  55. #include <linux/pci.h>
  56. #include <linux/ide.h>
  57. #include <linux/hdreg.h>
  58. #include <linux/completion.h>
  59. #include <linux/device.h>
  60. /* default maximum number of failures */
  61. #define IDE_DEFAULT_MAX_FAILURES 1
  62. struct class *ide_port_class;
  63. static const u8 ide_hwif_to_major[] = { IDE0_MAJOR, IDE1_MAJOR,
  64. IDE2_MAJOR, IDE3_MAJOR,
  65. IDE4_MAJOR, IDE5_MAJOR,
  66. IDE6_MAJOR, IDE7_MAJOR,
  67. IDE8_MAJOR, IDE9_MAJOR };
  68. DEFINE_MUTEX(ide_cfg_mtx);
  69. __cacheline_aligned_in_smp DEFINE_SPINLOCK(ide_lock);
  70. EXPORT_SYMBOL(ide_lock);
  71. static void ide_port_init_devices_data(ide_hwif_t *);
  72. /*
  73. * Do not even *think* about calling this!
  74. */
  75. void ide_init_port_data(ide_hwif_t *hwif, unsigned int index)
  76. {
  77. /* bulk initialize hwif & drive info with zeros */
  78. memset(hwif, 0, sizeof(ide_hwif_t));
  79. /* fill in any non-zero initial values */
  80. hwif->index = index;
  81. hwif->major = ide_hwif_to_major[index];
  82. hwif->name[0] = 'i';
  83. hwif->name[1] = 'd';
  84. hwif->name[2] = 'e';
  85. hwif->name[3] = '0' + index;
  86. init_completion(&hwif->gendev_rel_comp);
  87. hwif->tp_ops = &default_tp_ops;
  88. ide_port_init_devices_data(hwif);
  89. }
  90. static void ide_port_init_devices_data(ide_hwif_t *hwif)
  91. {
  92. int unit;
  93. for (unit = 0; unit < MAX_DRIVES; ++unit) {
  94. ide_drive_t *drive = &hwif->drives[unit];
  95. u8 j = (hwif->index * MAX_DRIVES) + unit;
  96. memset(drive, 0, sizeof(*drive));
  97. drive->media = ide_disk;
  98. drive->select.all = (unit<<4)|0xa0;
  99. drive->hwif = hwif;
  100. drive->ready_stat = ATA_DRDY;
  101. drive->bad_wstat = BAD_W_STAT;
  102. drive->special.b.recalibrate = 1;
  103. drive->special.b.set_geometry = 1;
  104. drive->name[0] = 'h';
  105. drive->name[1] = 'd';
  106. drive->name[2] = 'a' + j;
  107. drive->max_failures = IDE_DEFAULT_MAX_FAILURES;
  108. INIT_LIST_HEAD(&drive->list);
  109. init_completion(&drive->gendev_rel_comp);
  110. }
  111. }
  112. /* Called with ide_lock held. */
  113. static void __ide_port_unregister_devices(ide_hwif_t *hwif)
  114. {
  115. int i;
  116. for (i = 0; i < MAX_DRIVES; i++) {
  117. ide_drive_t *drive = &hwif->drives[i];
  118. if (drive->dev_flags & IDE_DFLAG_PRESENT) {
  119. spin_unlock_irq(&ide_lock);
  120. device_unregister(&drive->gendev);
  121. wait_for_completion(&drive->gendev_rel_comp);
  122. spin_lock_irq(&ide_lock);
  123. }
  124. }
  125. }
  126. void ide_port_unregister_devices(ide_hwif_t *hwif)
  127. {
  128. mutex_lock(&ide_cfg_mtx);
  129. spin_lock_irq(&ide_lock);
  130. __ide_port_unregister_devices(hwif);
  131. hwif->present = 0;
  132. ide_port_init_devices_data(hwif);
  133. spin_unlock_irq(&ide_lock);
  134. mutex_unlock(&ide_cfg_mtx);
  135. }
  136. EXPORT_SYMBOL_GPL(ide_port_unregister_devices);
  137. /**
  138. * ide_unregister - free an IDE interface
  139. * @hwif: IDE interface
  140. *
  141. * Perform the final unregister of an IDE interface. At the moment
  142. * we don't refcount interfaces so this will also get split up.
  143. *
  144. * Locking:
  145. * The caller must not hold the IDE locks
  146. * The drive present/vanishing is not yet properly locked
  147. * Take care with the callbacks. These have been split to avoid
  148. * deadlocking the IDE layer. The shutdown callback is called
  149. * before we take the lock and free resources. It is up to the
  150. * caller to be sure there is no pending I/O here, and that
  151. * the interface will not be reopened (present/vanishing locking
  152. * isn't yet done BTW). After we commit to the final kill we
  153. * call the cleanup callback with the ide locks held.
  154. *
  155. * Unregister restores the hwif structures to the default state.
  156. * This is raving bonkers.
  157. */
  158. void ide_unregister(ide_hwif_t *hwif)
  159. {
  160. ide_hwif_t *g;
  161. ide_hwgroup_t *hwgroup;
  162. int irq_count = 0;
  163. BUG_ON(in_interrupt());
  164. BUG_ON(irqs_disabled());
  165. mutex_lock(&ide_cfg_mtx);
  166. spin_lock_irq(&ide_lock);
  167. if (hwif->present) {
  168. __ide_port_unregister_devices(hwif);
  169. hwif->present = 0;
  170. }
  171. spin_unlock_irq(&ide_lock);
  172. ide_proc_unregister_port(hwif);
  173. hwgroup = hwif->hwgroup;
  174. /*
  175. * free the irq if we were the only hwif using it
  176. */
  177. g = hwgroup->hwif;
  178. do {
  179. if (g->irq == hwif->irq)
  180. ++irq_count;
  181. g = g->next;
  182. } while (g != hwgroup->hwif);
  183. if (irq_count == 1)
  184. free_irq(hwif->irq, hwgroup);
  185. ide_remove_port_from_hwgroup(hwif);
  186. device_unregister(hwif->portdev);
  187. device_unregister(&hwif->gendev);
  188. wait_for_completion(&hwif->gendev_rel_comp);
  189. /*
  190. * Remove us from the kernel's knowledge
  191. */
  192. blk_unregister_region(MKDEV(hwif->major, 0), MAX_DRIVES<<PARTN_BITS);
  193. kfree(hwif->sg_table);
  194. unregister_blkdev(hwif->major, hwif->name);
  195. if (hwif->dma_base)
  196. ide_release_dma_engine(hwif);
  197. mutex_unlock(&ide_cfg_mtx);
  198. }
  199. void ide_init_port_hw(ide_hwif_t *hwif, hw_regs_t *hw)
  200. {
  201. memcpy(&hwif->io_ports, &hw->io_ports, sizeof(hwif->io_ports));
  202. hwif->irq = hw->irq;
  203. hwif->chipset = hw->chipset;
  204. hwif->dev = hw->dev;
  205. hwif->gendev.parent = hw->parent ? hw->parent : hw->dev;
  206. hwif->ack_intr = hw->ack_intr;
  207. hwif->config_data = hw->config;
  208. }
  209. /*
  210. * Locks for IDE setting functionality
  211. */
  212. DEFINE_MUTEX(ide_setting_mtx);
  213. ide_devset_get(io_32bit, io_32bit);
  214. static int set_io_32bit(ide_drive_t *drive, int arg)
  215. {
  216. if (drive->dev_flags & IDE_DFLAG_NO_IO_32BIT)
  217. return -EPERM;
  218. if (arg < 0 || arg > 1 + (SUPPORT_VLB_SYNC << 1))
  219. return -EINVAL;
  220. drive->io_32bit = arg;
  221. return 0;
  222. }
  223. ide_devset_get_flag(ksettings, IDE_DFLAG_KEEP_SETTINGS);
  224. static int set_ksettings(ide_drive_t *drive, int arg)
  225. {
  226. if (arg < 0 || arg > 1)
  227. return -EINVAL;
  228. if (arg)
  229. drive->dev_flags |= IDE_DFLAG_KEEP_SETTINGS;
  230. else
  231. drive->dev_flags &= ~IDE_DFLAG_KEEP_SETTINGS;
  232. return 0;
  233. }
  234. ide_devset_get_flag(using_dma, IDE_DFLAG_USING_DMA);
  235. static int set_using_dma(ide_drive_t *drive, int arg)
  236. {
  237. #ifdef CONFIG_BLK_DEV_IDEDMA
  238. int err = -EPERM;
  239. if (arg < 0 || arg > 1)
  240. return -EINVAL;
  241. if (ata_id_has_dma(drive->id) == 0)
  242. goto out;
  243. if (drive->hwif->dma_ops == NULL)
  244. goto out;
  245. err = 0;
  246. if (arg) {
  247. if (ide_set_dma(drive))
  248. err = -EIO;
  249. } else
  250. ide_dma_off(drive);
  251. out:
  252. return err;
  253. #else
  254. if (arg < 0 || arg > 1)
  255. return -EINVAL;
  256. return -EPERM;
  257. #endif
  258. }
  259. static int set_pio_mode(ide_drive_t *drive, int arg)
  260. {
  261. struct request *rq;
  262. ide_hwif_t *hwif = drive->hwif;
  263. const struct ide_port_ops *port_ops = hwif->port_ops;
  264. if (arg < 0 || arg > 255)
  265. return -EINVAL;
  266. if (port_ops == NULL || port_ops->set_pio_mode == NULL ||
  267. (hwif->host_flags & IDE_HFLAG_NO_SET_MODE))
  268. return -ENOSYS;
  269. if (drive->special.b.set_tune)
  270. return -EBUSY;
  271. rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
  272. rq->cmd_type = REQ_TYPE_ATA_TASKFILE;
  273. drive->tune_req = (u8) arg;
  274. drive->special.b.set_tune = 1;
  275. blk_execute_rq(drive->queue, NULL, rq, 0);
  276. blk_put_request(rq);
  277. return 0;
  278. }
  279. ide_devset_get_flag(unmaskirq, IDE_DFLAG_UNMASK);
  280. static int set_unmaskirq(ide_drive_t *drive, int arg)
  281. {
  282. if (drive->dev_flags & IDE_DFLAG_NO_UNMASK)
  283. return -EPERM;
  284. if (arg < 0 || arg > 1)
  285. return -EINVAL;
  286. if (arg)
  287. drive->dev_flags |= IDE_DFLAG_UNMASK;
  288. else
  289. drive->dev_flags &= ~IDE_DFLAG_UNMASK;
  290. return 0;
  291. }
  292. #define ide_gen_devset_rw(_name, _func) \
  293. __IDE_DEVSET(_name, DS_SYNC, get_##_func, set_##_func)
  294. ide_gen_devset_rw(io_32bit, io_32bit);
  295. ide_gen_devset_rw(keepsettings, ksettings);
  296. ide_gen_devset_rw(unmaskirq, unmaskirq);
  297. ide_gen_devset_rw(using_dma, using_dma);
  298. __IDE_DEVSET(pio_mode, 0, NULL, set_pio_mode);
  299. static int generic_ide_suspend(struct device *dev, pm_message_t mesg)
  300. {
  301. ide_drive_t *drive = dev->driver_data, *pair = ide_get_pair_dev(drive);
  302. ide_hwif_t *hwif = HWIF(drive);
  303. struct request *rq;
  304. struct request_pm_state rqpm;
  305. ide_task_t args;
  306. int ret;
  307. /* call ACPI _GTM only once */
  308. if ((drive->dn & 1) == 0 || pair == NULL)
  309. ide_acpi_get_timing(hwif);
  310. memset(&rqpm, 0, sizeof(rqpm));
  311. memset(&args, 0, sizeof(args));
  312. rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
  313. rq->cmd_type = REQ_TYPE_PM_SUSPEND;
  314. rq->special = &args;
  315. rq->data = &rqpm;
  316. rqpm.pm_step = IDE_PM_START_SUSPEND;
  317. if (mesg.event == PM_EVENT_PRETHAW)
  318. mesg.event = PM_EVENT_FREEZE;
  319. rqpm.pm_state = mesg.event;
  320. ret = blk_execute_rq(drive->queue, NULL, rq, 0);
  321. blk_put_request(rq);
  322. /* call ACPI _PS3 only after both devices are suspended */
  323. if (ret == 0 && ((drive->dn & 1) || pair == NULL))
  324. ide_acpi_set_state(hwif, 0);
  325. return ret;
  326. }
  327. static int generic_ide_resume(struct device *dev)
  328. {
  329. ide_drive_t *drive = dev->driver_data, *pair = ide_get_pair_dev(drive);
  330. ide_hwif_t *hwif = HWIF(drive);
  331. struct request *rq;
  332. struct request_pm_state rqpm;
  333. ide_task_t args;
  334. int err;
  335. /* call ACPI _PS0 / _STM only once */
  336. if ((drive->dn & 1) == 0 || pair == NULL) {
  337. ide_acpi_set_state(hwif, 1);
  338. ide_acpi_push_timing(hwif);
  339. }
  340. ide_acpi_exec_tfs(drive);
  341. memset(&rqpm, 0, sizeof(rqpm));
  342. memset(&args, 0, sizeof(args));
  343. rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
  344. rq->cmd_type = REQ_TYPE_PM_RESUME;
  345. rq->cmd_flags |= REQ_PREEMPT;
  346. rq->special = &args;
  347. rq->data = &rqpm;
  348. rqpm.pm_step = IDE_PM_START_RESUME;
  349. rqpm.pm_state = PM_EVENT_ON;
  350. err = blk_execute_rq(drive->queue, NULL, rq, 1);
  351. blk_put_request(rq);
  352. if (err == 0 && dev->driver) {
  353. ide_driver_t *drv = to_ide_driver(dev->driver);
  354. if (drv->resume)
  355. drv->resume(drive);
  356. }
  357. return err;
  358. }
  359. /**
  360. * ide_device_get - get an additional reference to a ide_drive_t
  361. * @drive: device to get a reference to
  362. *
  363. * Gets a reference to the ide_drive_t and increments the use count of the
  364. * underlying LLDD module.
  365. */
  366. int ide_device_get(ide_drive_t *drive)
  367. {
  368. struct device *host_dev;
  369. struct module *module;
  370. if (!get_device(&drive->gendev))
  371. return -ENXIO;
  372. host_dev = drive->hwif->host->dev[0];
  373. module = host_dev ? host_dev->driver->owner : NULL;
  374. if (module && !try_module_get(module)) {
  375. put_device(&drive->gendev);
  376. return -ENXIO;
  377. }
  378. return 0;
  379. }
  380. EXPORT_SYMBOL_GPL(ide_device_get);
  381. /**
  382. * ide_device_put - release a reference to a ide_drive_t
  383. * @drive: device to release a reference on
  384. *
  385. * Release a reference to the ide_drive_t and decrements the use count of
  386. * the underlying LLDD module.
  387. */
  388. void ide_device_put(ide_drive_t *drive)
  389. {
  390. #ifdef CONFIG_MODULE_UNLOAD
  391. struct device *host_dev = drive->hwif->host->dev[0];
  392. struct module *module = host_dev ? host_dev->driver->owner : NULL;
  393. if (module)
  394. module_put(module);
  395. #endif
  396. put_device(&drive->gendev);
  397. }
  398. EXPORT_SYMBOL_GPL(ide_device_put);
  399. static int ide_bus_match(struct device *dev, struct device_driver *drv)
  400. {
  401. return 1;
  402. }
  403. static char *media_string(ide_drive_t *drive)
  404. {
  405. switch (drive->media) {
  406. case ide_disk:
  407. return "disk";
  408. case ide_cdrom:
  409. return "cdrom";
  410. case ide_tape:
  411. return "tape";
  412. case ide_floppy:
  413. return "floppy";
  414. case ide_optical:
  415. return "optical";
  416. default:
  417. return "UNKNOWN";
  418. }
  419. }
  420. static ssize_t media_show(struct device *dev, struct device_attribute *attr, char *buf)
  421. {
  422. ide_drive_t *drive = to_ide_device(dev);
  423. return sprintf(buf, "%s\n", media_string(drive));
  424. }
  425. static ssize_t drivename_show(struct device *dev, struct device_attribute *attr, char *buf)
  426. {
  427. ide_drive_t *drive = to_ide_device(dev);
  428. return sprintf(buf, "%s\n", drive->name);
  429. }
  430. static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, char *buf)
  431. {
  432. ide_drive_t *drive = to_ide_device(dev);
  433. return sprintf(buf, "ide:m-%s\n", media_string(drive));
  434. }
  435. static ssize_t model_show(struct device *dev, struct device_attribute *attr,
  436. char *buf)
  437. {
  438. ide_drive_t *drive = to_ide_device(dev);
  439. return sprintf(buf, "%s\n", (char *)&drive->id[ATA_ID_PROD]);
  440. }
  441. static ssize_t firmware_show(struct device *dev, struct device_attribute *attr,
  442. char *buf)
  443. {
  444. ide_drive_t *drive = to_ide_device(dev);
  445. return sprintf(buf, "%s\n", (char *)&drive->id[ATA_ID_FW_REV]);
  446. }
  447. static ssize_t serial_show(struct device *dev, struct device_attribute *attr,
  448. char *buf)
  449. {
  450. ide_drive_t *drive = to_ide_device(dev);
  451. return sprintf(buf, "%s\n", (char *)&drive->id[ATA_ID_SERNO]);
  452. }
  453. static struct device_attribute ide_dev_attrs[] = {
  454. __ATTR_RO(media),
  455. __ATTR_RO(drivename),
  456. __ATTR_RO(modalias),
  457. __ATTR_RO(model),
  458. __ATTR_RO(firmware),
  459. __ATTR(serial, 0400, serial_show, NULL),
  460. __ATTR_NULL
  461. };
  462. static int ide_uevent(struct device *dev, struct kobj_uevent_env *env)
  463. {
  464. ide_drive_t *drive = to_ide_device(dev);
  465. add_uevent_var(env, "MEDIA=%s", media_string(drive));
  466. add_uevent_var(env, "DRIVENAME=%s", drive->name);
  467. add_uevent_var(env, "MODALIAS=ide:m-%s", media_string(drive));
  468. return 0;
  469. }
  470. static int generic_ide_probe(struct device *dev)
  471. {
  472. ide_drive_t *drive = to_ide_device(dev);
  473. ide_driver_t *drv = to_ide_driver(dev->driver);
  474. return drv->probe ? drv->probe(drive) : -ENODEV;
  475. }
  476. static int generic_ide_remove(struct device *dev)
  477. {
  478. ide_drive_t *drive = to_ide_device(dev);
  479. ide_driver_t *drv = to_ide_driver(dev->driver);
  480. if (drv->remove)
  481. drv->remove(drive);
  482. return 0;
  483. }
  484. static void generic_ide_shutdown(struct device *dev)
  485. {
  486. ide_drive_t *drive = to_ide_device(dev);
  487. ide_driver_t *drv = to_ide_driver(dev->driver);
  488. if (dev->driver && drv->shutdown)
  489. drv->shutdown(drive);
  490. }
  491. struct bus_type ide_bus_type = {
  492. .name = "ide",
  493. .match = ide_bus_match,
  494. .uevent = ide_uevent,
  495. .probe = generic_ide_probe,
  496. .remove = generic_ide_remove,
  497. .shutdown = generic_ide_shutdown,
  498. .dev_attrs = ide_dev_attrs,
  499. .suspend = generic_ide_suspend,
  500. .resume = generic_ide_resume,
  501. };
  502. EXPORT_SYMBOL_GPL(ide_bus_type);
  503. int ide_vlb_clk;
  504. EXPORT_SYMBOL_GPL(ide_vlb_clk);
  505. module_param_named(vlb_clock, ide_vlb_clk, int, 0);
  506. MODULE_PARM_DESC(vlb_clock, "VLB clock frequency (in MHz)");
  507. int ide_pci_clk;
  508. EXPORT_SYMBOL_GPL(ide_pci_clk);
  509. module_param_named(pci_clock, ide_pci_clk, int, 0);
  510. MODULE_PARM_DESC(pci_clock, "PCI bus clock frequency (in MHz)");
  511. static int ide_set_dev_param_mask(const char *s, struct kernel_param *kp)
  512. {
  513. int a, b, i, j = 1;
  514. unsigned int *dev_param_mask = (unsigned int *)kp->arg;
  515. if (sscanf(s, "%d.%d:%d", &a, &b, &j) != 3 &&
  516. sscanf(s, "%d.%d", &a, &b) != 2)
  517. return -EINVAL;
  518. i = a * MAX_DRIVES + b;
  519. if (i >= MAX_HWIFS * MAX_DRIVES || j < 0 || j > 1)
  520. return -EINVAL;
  521. if (j)
  522. *dev_param_mask |= (1 << i);
  523. else
  524. *dev_param_mask &= (1 << i);
  525. return 0;
  526. }
  527. static unsigned int ide_nodma;
  528. module_param_call(nodma, ide_set_dev_param_mask, NULL, &ide_nodma, 0);
  529. MODULE_PARM_DESC(nodma, "disallow DMA for a device");
  530. static unsigned int ide_noflush;
  531. module_param_call(noflush, ide_set_dev_param_mask, NULL, &ide_noflush, 0);
  532. MODULE_PARM_DESC(noflush, "disable flush requests for a device");
  533. static unsigned int ide_noprobe;
  534. module_param_call(noprobe, ide_set_dev_param_mask, NULL, &ide_noprobe, 0);
  535. MODULE_PARM_DESC(noprobe, "skip probing for a device");
  536. static unsigned int ide_nowerr;
  537. module_param_call(nowerr, ide_set_dev_param_mask, NULL, &ide_nowerr, 0);
  538. MODULE_PARM_DESC(nowerr, "ignore the ATA_DF bit for a device");
  539. static unsigned int ide_cdroms;
  540. module_param_call(cdrom, ide_set_dev_param_mask, NULL, &ide_cdroms, 0);
  541. MODULE_PARM_DESC(cdrom, "force device as a CD-ROM");
  542. struct chs_geom {
  543. unsigned int cyl;
  544. u8 head;
  545. u8 sect;
  546. };
  547. static unsigned int ide_disks;
  548. static struct chs_geom ide_disks_chs[MAX_HWIFS * MAX_DRIVES];
  549. static int ide_set_disk_chs(const char *str, struct kernel_param *kp)
  550. {
  551. int a, b, c = 0, h = 0, s = 0, i, j = 1;
  552. if (sscanf(str, "%d.%d:%d,%d,%d", &a, &b, &c, &h, &s) != 5 &&
  553. sscanf(str, "%d.%d:%d", &a, &b, &j) != 3)
  554. return -EINVAL;
  555. i = a * MAX_DRIVES + b;
  556. if (i >= MAX_HWIFS * MAX_DRIVES || j < 0 || j > 1)
  557. return -EINVAL;
  558. if (c > INT_MAX || h > 255 || s > 255)
  559. return -EINVAL;
  560. if (j)
  561. ide_disks |= (1 << i);
  562. else
  563. ide_disks &= (1 << i);
  564. ide_disks_chs[i].cyl = c;
  565. ide_disks_chs[i].head = h;
  566. ide_disks_chs[i].sect = s;
  567. return 0;
  568. }
  569. module_param_call(chs, ide_set_disk_chs, NULL, NULL, 0);
  570. MODULE_PARM_DESC(chs, "force device as a disk (using CHS)");
  571. static void ide_dev_apply_params(ide_drive_t *drive, u8 unit)
  572. {
  573. int i = drive->hwif->index * MAX_DRIVES + unit;
  574. if (ide_nodma & (1 << i)) {
  575. printk(KERN_INFO "ide: disallowing DMA for %s\n", drive->name);
  576. drive->dev_flags |= IDE_DFLAG_NODMA;
  577. }
  578. if (ide_noflush & (1 << i)) {
  579. printk(KERN_INFO "ide: disabling flush requests for %s\n",
  580. drive->name);
  581. drive->dev_flags |= IDE_DFLAG_NOFLUSH;
  582. }
  583. if (ide_noprobe & (1 << i)) {
  584. printk(KERN_INFO "ide: skipping probe for %s\n", drive->name);
  585. drive->dev_flags |= IDE_DFLAG_NOPROBE;
  586. }
  587. if (ide_nowerr & (1 << i)) {
  588. printk(KERN_INFO "ide: ignoring the ATA_DF bit for %s\n",
  589. drive->name);
  590. drive->bad_wstat = BAD_R_STAT;
  591. }
  592. if (ide_cdroms & (1 << i)) {
  593. printk(KERN_INFO "ide: forcing %s as a CD-ROM\n", drive->name);
  594. drive->dev_flags |= IDE_DFLAG_PRESENT;
  595. drive->media = ide_cdrom;
  596. /* an ATAPI device ignores DRDY */
  597. drive->ready_stat = 0;
  598. }
  599. if (ide_disks & (1 << i)) {
  600. drive->cyl = drive->bios_cyl = ide_disks_chs[i].cyl;
  601. drive->head = drive->bios_head = ide_disks_chs[i].head;
  602. drive->sect = drive->bios_sect = ide_disks_chs[i].sect;
  603. printk(KERN_INFO "ide: forcing %s as a disk (%d/%d/%d)\n",
  604. drive->name,
  605. drive->cyl, drive->head, drive->sect);
  606. drive->dev_flags |= IDE_DFLAG_FORCED_GEOM | IDE_DFLAG_PRESENT;
  607. drive->media = ide_disk;
  608. drive->ready_stat = ATA_DRDY;
  609. }
  610. }
  611. static unsigned int ide_ignore_cable;
  612. static int ide_set_ignore_cable(const char *s, struct kernel_param *kp)
  613. {
  614. int i, j = 1;
  615. if (sscanf(s, "%d:%d", &i, &j) != 2 && sscanf(s, "%d", &i) != 1)
  616. return -EINVAL;
  617. if (i >= MAX_HWIFS || j < 0 || j > 1)
  618. return -EINVAL;
  619. if (j)
  620. ide_ignore_cable |= (1 << i);
  621. else
  622. ide_ignore_cable &= (1 << i);
  623. return 0;
  624. }
  625. module_param_call(ignore_cable, ide_set_ignore_cable, NULL, NULL, 0);
  626. MODULE_PARM_DESC(ignore_cable, "ignore cable detection");
  627. void ide_port_apply_params(ide_hwif_t *hwif)
  628. {
  629. int i;
  630. if (ide_ignore_cable & (1 << hwif->index)) {
  631. printk(KERN_INFO "ide: ignoring cable detection for %s\n",
  632. hwif->name);
  633. hwif->cbl = ATA_CBL_PATA40_SHORT;
  634. }
  635. for (i = 0; i < MAX_DRIVES; i++)
  636. ide_dev_apply_params(&hwif->drives[i], i);
  637. }
  638. /*
  639. * This is gets invoked once during initialization, to set *everything* up
  640. */
  641. static int __init ide_init(void)
  642. {
  643. int ret;
  644. printk(KERN_INFO "Uniform Multi-Platform E-IDE driver\n");
  645. ret = bus_register(&ide_bus_type);
  646. if (ret < 0) {
  647. printk(KERN_WARNING "IDE: bus_register error: %d\n", ret);
  648. return ret;
  649. }
  650. ide_port_class = class_create(THIS_MODULE, "ide_port");
  651. if (IS_ERR(ide_port_class)) {
  652. ret = PTR_ERR(ide_port_class);
  653. goto out_port_class;
  654. }
  655. proc_ide_create();
  656. return 0;
  657. out_port_class:
  658. bus_unregister(&ide_bus_type);
  659. return ret;
  660. }
  661. static void __exit ide_exit(void)
  662. {
  663. proc_ide_destroy();
  664. class_destroy(ide_port_class);
  665. bus_unregister(&ide_bus_type);
  666. }
  667. module_init(ide_init);
  668. module_exit(ide_exit);
  669. MODULE_LICENSE("GPL");