X-Git-Url: https://scm.lunaixsky.com/lunaix-os.git/blobdiff_plain/0eabc11fcf240415e39f3873dfce7cd9384b3042..43487eff262637a59a4c2c0272d7c4a824af3944:/lunaix-os/hal/ahci/io_event.c diff --git a/lunaix-os/hal/ahci/io_event.c b/lunaix-os/hal/ahci/io_event.c index c1bd6a5..b751cdc 100644 --- a/lunaix-os/hal/ahci/io_event.c +++ b/lunaix-os/hal/ahci/io_event.c @@ -1,21 +1,21 @@ #include #include -#include #include #include LOG_MODULE("io_evt") -extern struct llist_header ahcis; - void -__ahci_hba_isr(const isr_param* param) +ahci_hba_isr(irq_t irq, const struct hart_state* hstate) { struct ahci_hba* hba; struct ahci_driver *pos, *n; - llist_for_each(pos, n, &ahcis, ahci_drvs) + struct llist_header* ahcis; + + ahcis = irq_payload(irq, struct llist_header); + llist_for_each(pos, n, ahcis, ahci_drvs) { - if (pos->id == param->execp->vector) { + if (pos->id == hart_vector_stamp(hstate)) { hba = &pos->hba; goto proceed; } @@ -28,7 +28,7 @@ proceed: if (!hba->base[HBA_RIS]) return; - u32_t port_num = 31 - __builtin_clz(hba->base[HBA_RIS]); + u32_t port_num = msbiti - clz(hba->base[HBA_RIS]); struct hba_port* port = hba->ports[port_num]; struct hba_cmd_context* cmdctx = &port->cmdctx; u32_t processed = port->regs[HBA_RPxCI] ^ cmdctx->tracked_ci; @@ -48,7 +48,7 @@ proceed: goto done; } - u32_t slot = 31 - __builtin_clz(processed); + u32_t slot = msbiti - clz(processed); struct hba_cmd_state* cmdstate = cmdctx->issued[slot]; if (!cmdstate) { @@ -65,7 +65,7 @@ proceed: blkio_schedule(ioreq->io_ctx); blkio_complete(ioreq); - vfree(cmdstate->cmd_table); + vfree_dma(cmdstate->cmd_table); done: hba_clear_reg(port->regs[HBA_RPxIS]);