1 /* SPDX-License-Identifier: GPL-2.0-or-later */
2
3 #include <arch/io.h>
4 #include <device/pnp_ops.h>
5 #include <device/pnp_def.h>
6 #include "wpcm450.h"
7
wpcm450_pnp_set_logical_device(u8 dev,u16 port)8 static void wpcm450_pnp_set_logical_device(u8 dev, u16 port)
9 {
10 outb(0x7, port);
11 outb(dev, port+1);
12 }
13
wpcm450_pnp_set_enable(u8 dev,u16 port,u8 enable)14 static void wpcm450_pnp_set_enable(u8 dev, u16 port, u8 enable)
15 {
16 outb(0x30, port);
17 outb(enable, port+1);
18 }
19
wpcm450_pnp_set_iobase(u8 dev,u16 port,u8 index,u16 iobase)20 static void wpcm450_pnp_set_iobase(u8 dev, u16 port, u8 index, u16 iobase)
21 {
22 outb(index, port);
23 outb((iobase>>8)&0xFF, port+1);
24 outb(index+1, port);
25 outb(iobase&0xFF, port+1);
26 }
27
wpcm450_enable_dev(u8 dev,u16 port,u16 iobase)28 void wpcm450_enable_dev(u8 dev, u16 port, u16 iobase)
29 {
30 wpcm450_pnp_set_logical_device(dev, port);
31 wpcm450_pnp_set_enable(dev, port, 0);
32 if (iobase)
33 wpcm450_pnp_set_iobase(dev, port, PNP_IDX_IO0, iobase);
34 wpcm450_pnp_set_enable(dev, port, 1);
35 }
36