diff --git a/src/device/pnp_device.c b/src/device/pnp_device.c index 259d449752..699007d9ba 100644 --- a/src/device/pnp_device.c +++ b/src/device/pnp_device.c @@ -47,6 +47,15 @@ u8 pnp_read_config(struct device *dev, u8 reg) return inb(dev->path.pnp.port + 1); } +void pnp_unset_and_set_config(struct device *dev, u8 reg, u8 unset, u8 set) +{ + outb(reg, dev->path.pnp.port); + u8 value = inb(dev->path.pnp.port + 1); + value &= ~unset; + value |= set; + outb(value, dev->path.pnp.port + 1); +} + void pnp_set_logical_device(struct device *dev) { pnp_write_config(dev, 0x07, dev->path.pnp.device & 0xff); diff --git a/src/include/device/pnp.h b/src/include/device/pnp.h index 955eac29ac..770a640963 100644 --- a/src/include/device/pnp.h +++ b/src/include/device/pnp.h @@ -13,6 +13,7 @@ /* Primitive PNP resource manipulation */ void pnp_write_config(struct device *dev, u8 reg, u8 value); u8 pnp_read_config(struct device *dev, u8 reg); +void pnp_unset_and_set_config(struct device *dev, u8 reg, u8 unset, u8 set); void pnp_set_logical_device(struct device *dev); void pnp_set_enable(struct device *dev, int enable); int pnp_read_enable(struct device *dev);