static void uart_pl011_init(struct uart_chip *chip)
{
if (chip->divider) {
mmio_write16(chip->base + UARTCR, 0);
while (mmio_read8(chip->base + UARTFR) & UARTFR_BUSY)
cpu_relax();
mmio_write16(chip->base + UARTIBRD, chip->divider);
mmio_write8(chip->base + UARTLCR_H, UARTLCR_H_WLEN);
mmio_write16(chip->base + UARTCR, UARTCR_EN | UARTCR_TXE |
UARTCR_Out1 | UARTCR_Out2);
}
}
/**
* Write to PCI config space.
* @param bdf 16-bit bus/device/function ID of target.
* @param address Config space access address.
* @param value Value to be written.
* @param size Access size (1, 2 or 4 bytes).
*
* @see pci_read_config
*/
void pci_write_config(u16 bdf, u16 address, u32 value, unsigned int size)
{
void *mmcfg_addr = pci_get_device_mmcfg_base(bdf) + address;
if (!pci_space || PCI_BUS(bdf) > end_bus)
return arch_pci_write_config(bdf, address, value, size);
if (size == 1)
mmio_write8(mmcfg_addr, value);
else if (size == 2)
mmio_write16(mmcfg_addr, value);
else
mmio_write32(mmcfg_addr, value);
}
static int lua_mmio_write16(lua_State *L) {
mmio_t *mmio;
uint32_t value;
uintptr_t offset;
int ret;
mmio = luaL_checkudata(L, 1, "periphery.MMIO");
lua_mmio_checktype(L, 2, LUA_TNUMBER);
lua_mmio_checktype(L, 3, LUA_TNUMBER);
offset = lua_tounsigned(L, 2);
value = lua_tounsigned(L, 3);
if (value > 0xffff)
return lua_mmio_error(L, MMIO_ERROR_ARG, 0, "Error: value out of 16-bit range");
if ((ret = mmio_write16(mmio, offset, (uint16_t)value)) < 0)
return lua_mmio_error(L, ret, mmio_errno(mmio), "Error: %s", mmio_errmsg(mmio));
return 0;
}
void mmio_perform_access(void *base, struct mmio_access *mmio)
{
void *addr = base + mmio->address;
if (mmio->is_write)
switch (mmio->size) {
case 1:
mmio_write8(addr, mmio->value);
break;
case 2:
mmio_write16(addr, mmio->value);
break;
case 4:
mmio_write32(addr, mmio->value);
break;
#if BITS_PER_LONG == 64
case 8:
mmio_write64(addr, mmio->value);
break;
#endif
}
else
switch (mmio->size) {
case 1:
mmio->value = mmio_read8(addr);
break;
case 2:
mmio->value = mmio_read16(addr);
break;
case 4:
mmio->value = mmio_read32(addr);
break;
#if BITS_PER_LONG == 64
case 8:
mmio->value = mmio_read64(addr);
break;
#endif
}
}
