lscreen_att.c 2.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970
  1. /*
  2. * Copyright (c) 2000, 2001, 2002, 2003, 2004, 2005, 2008, 2009
  3. * The President and Fellows of Harvard College.
  4. *
  5. * Redistribution and use in source and binary forms, with or without
  6. * modification, are permitted provided that the following conditions
  7. * are met:
  8. * 1. Redistributions of source code must retain the above copyright
  9. * notice, this list of conditions and the following disclaimer.
  10. * 2. Redistributions in binary form must reproduce the above copyright
  11. * notice, this list of conditions and the following disclaimer in the
  12. * documentation and/or other materials provided with the distribution.
  13. * 3. Neither the name of the University nor the names of its contributors
  14. * may be used to endorse or promote products derived from this software
  15. * without specific prior written permission.
  16. *
  17. * THIS SOFTWARE IS PROVIDED BY THE UNIVERSITY AND CONTRIBUTORS ``AS IS'' AND
  18. * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20. * ARE DISCLAIMED. IN NO EVENT SHALL THE UNIVERSITY OR CONTRIBUTORS BE LIABLE
  21. * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23. * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26. * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27. * SUCH DAMAGE.
  28. */
  29. /*
  30. * Code for probe/attach of lscreen to LAMEbus.
  31. */
  32. #include <types.h>
  33. #include <lib.h>
  34. #include <lamebus/lamebus.h>
  35. #include <lamebus/lscreen.h>
  36. #include "autoconf.h"
  37. /* Lowest revision we support */
  38. #define LOW_VERSION 1
  39. /* Highest revision we support */
  40. #define HIGH_VERSION 1
  41. struct lscreen_softc *
  42. attach_lscreen_to_lamebus(int lscreenno, struct lamebus_softc *sc)
  43. {
  44. struct lscreen_softc *ls;
  45. int slot = lamebus_probe(sc, LB_VENDOR_CS161, LBCS161_SCREEN,
  46. LOW_VERSION, HIGH_VERSION);
  47. if (slot < 0) {
  48. /* Not found */
  49. return NULL;
  50. }
  51. ls = kmalloc(sizeof(struct lscreen_softc));
  52. if (ls==NULL) {
  53. /* Out of memory */
  54. return NULL;
  55. }
  56. /* Record what it's attached to */
  57. ls->ls_busdata = sc;
  58. ls->ls_buspos = slot;
  59. /* Mark the slot in use and hook the interrupt */
  60. lamebus_mark(sc, slot);
  61. lamebus_attach_interrupt(sc, slot, ls, lscreen_irq);
  62. return ls;
  63. }