forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
44 lines
893 B
44 lines
893 B
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* Copyright (C) 2014, Bin Meng <[email protected]> |
|
*/ |
|
|
|
#include <common.h> |
|
#include <asm/io.h> |
|
#include <asm/pnp_def.h> |
|
|
|
static void pnp_enter_conf_state(u16 dev) |
|
{ |
|
u16 port = dev >> 8; |
|
|
|
outb(0x55, port); |
|
} |
|
|
|
static void pnp_exit_conf_state(u16 dev) |
|
{ |
|
u16 port = dev >> 8; |
|
|
|
outb(0xaa, port); |
|
} |
|
|
|
void lpc47m_enable_serial(uint dev, uint iobase, uint irq) |
|
{ |
|
pnp_enter_conf_state(dev); |
|
pnp_set_logical_device(dev); |
|
pnp_set_enable(dev, 0); |
|
pnp_set_iobase(dev, PNP_IDX_IO0, iobase); |
|
pnp_set_irq(dev, PNP_IDX_IRQ0, irq); |
|
pnp_set_enable(dev, 1); |
|
pnp_exit_conf_state(dev); |
|
} |
|
|
|
void lpc47m_enable_kbc(uint dev, uint irq0, uint irq1) |
|
{ |
|
pnp_enter_conf_state(dev); |
|
pnp_set_logical_device(dev); |
|
pnp_set_enable(dev, 0); |
|
pnp_set_irq(dev, PNP_IDX_IRQ0, irq0); |
|
pnp_set_irq(dev, PNP_IDX_IRQ1, irq1); |
|
pnp_set_enable(dev, 1); |
|
pnp_exit_conf_state(dev); |
|
}
|
|
|