smsc_lpc47m.c 896 B

123456789101112131415161718192021222324252627282930313233343536373839404142434445
  1. /*
  2. * Copyright (C) 2014, Bin Meng <bmeng.cn@gmail.com>
  3. *
  4. * SPDX-License-Identifier: GPL-2.0+
  5. */
  6. #include <common.h>
  7. #include <asm/io.h>
  8. #include <asm/pnp_def.h>
  9. static void pnp_enter_conf_state(u16 dev)
  10. {
  11. u16 port = dev >> 8;
  12. outb(0x55, port);
  13. }
  14. static void pnp_exit_conf_state(u16 dev)
  15. {
  16. u16 port = dev >> 8;
  17. outb(0xaa, port);
  18. }
  19. void lpc47m_enable_serial(uint dev, uint iobase, uint irq)
  20. {
  21. pnp_enter_conf_state(dev);
  22. pnp_set_logical_device(dev);
  23. pnp_set_enable(dev, 0);
  24. pnp_set_iobase(dev, PNP_IDX_IO0, iobase);
  25. pnp_set_irq(dev, PNP_IDX_IRQ0, irq);
  26. pnp_set_enable(dev, 1);
  27. pnp_exit_conf_state(dev);
  28. }
  29. void lpc47m_enable_kbc(uint dev, uint irq0, uint irq1)
  30. {
  31. pnp_enter_conf_state(dev);
  32. pnp_set_logical_device(dev);
  33. pnp_set_enable(dev, 0);
  34. pnp_set_irq(dev, PNP_IDX_IRQ0, irq0);
  35. pnp_set_irq(dev, PNP_IDX_IRQ1, irq1);
  36. pnp_set_enable(dev, 1);
  37. pnp_exit_conf_state(dev);
  38. }