ide-pnp.c 2.2 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889
  1. /*
  2. * linux/drivers/ide/ide-pnp.c
  3. *
  4. * This file provides autodetection for ISA PnP IDE interfaces.
  5. * It was tested with "ESS ES1868 Plug and Play AudioDrive" IDE interface.
  6. *
  7. * Copyright (C) 2000 Andrey Panin <pazke@donpac.ru>
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2, or (at your option)
  12. * any later version.
  13. *
  14. * You should have received a copy of the GNU General Public License
  15. * (for example /usr/src/linux/COPYING); if not, write to the Free
  16. * Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  17. */
  18. #include <linux/init.h>
  19. #include <linux/pnp.h>
  20. #include <linux/ide.h>
  21. /* Add your devices here :)) */
  22. static struct pnp_device_id idepnp_devices[] = {
  23. /* Generic ESDI/IDE/ATA compatible hard disk controller */
  24. {.id = "PNP0600", .driver_data = 0},
  25. {.id = ""}
  26. };
  27. static int idepnp_probe(struct pnp_dev * dev, const struct pnp_device_id *dev_id)
  28. {
  29. hw_regs_t hw;
  30. ide_hwif_t *hwif;
  31. if (!(pnp_port_valid(dev, 0) && pnp_port_valid(dev, 1) && pnp_irq_valid(dev, 0)))
  32. return -1;
  33. memset(&hw, 0, sizeof(hw));
  34. ide_std_init_ports(&hw, pnp_port_start(dev, 0),
  35. pnp_port_start(dev, 1));
  36. hw.irq = pnp_irq(dev, 0);
  37. hwif = ide_find_port(hw.io_ports[IDE_DATA_OFFSET]);
  38. if (hwif) {
  39. u8 index = hwif->index;
  40. u8 idx[4] = { index, 0xff, 0xff, 0xff };
  41. ide_init_port_data(hwif, index);
  42. ide_init_port_hw(hwif, &hw);
  43. printk(KERN_INFO "ide%d: generic PnP IDE interface\n", index);
  44. pnp_set_drvdata(dev,hwif);
  45. ide_device_add(idx);
  46. return 0;
  47. }
  48. return -1;
  49. }
  50. static void idepnp_remove(struct pnp_dev * dev)
  51. {
  52. ide_hwif_t *hwif = pnp_get_drvdata(dev);
  53. if (hwif) {
  54. ide_unregister(hwif->index);
  55. } else
  56. printk(KERN_ERR "idepnp: Unable to remove device, please report.\n");
  57. }
  58. static struct pnp_driver idepnp_driver = {
  59. .name = "ide",
  60. .id_table = idepnp_devices,
  61. .probe = idepnp_probe,
  62. .remove = idepnp_remove,
  63. };
  64. static int __init pnpide_init(void)
  65. {
  66. return pnp_register_driver(&idepnp_driver);
  67. }
  68. static void __exit pnpide_exit(void)
  69. {
  70. pnp_unregister_driver(&idepnp_driver);
  71. }
  72. module_init(pnpide_init);
  73. module_exit(pnpide_exit);