| 40,10 → 40,16 |
|---|
| #include <mm/slab.h> |
| #include <arch/types.h> |
| #include <genarch/ofw/ofw_tree.h> |
| #include <byteorder.h> |
| |
| #define PSYCHO_IGN 0x7c0 |
| #define PSYCHO_KEYBOARD_INR 0x29 |
| #define PSYCHO_INTERNAL_REG 2 |
| |
| #define PSYCHO_OBIO_IMR_BASE (0x1000 / sizeof(uint64_t)) |
| #define PSYCHO_OBIO_IMR(ino) (PSYCHO_OBIO_IMR_BASE + ((ino) & INO_MASK)) |
| |
| #define PSYCHO_OBIO_CIR_BASE (0x1800 / sizeof(uint64_t)) |
| #define PSYCHO_OBIO_CIR(ino) (PSYCHO_OBIO_CIR_BASE + ((ino) & INO_MASK)) |
| |
| psycho_t *psycho_a = NULL; |
| psycho_t *psycho_b = NULL; |
| |
| 56,8 → 62,13 |
|---|
| |
| if (!prop || !prop->value) |
| return NULL; |
| |
| count_t regs = prop->size / sizeof(ofw_upa_reg_t); |
| if (regs < PSYCHO_INTERNAL_REG + 1) |
| return NULL; |
| |
| ofw_upa_reg_t *reg = &((ofw_upa_reg_t *) prop->value)[0]; /* XXX */ |
| ofw_upa_reg_t *reg = |
| &((ofw_upa_reg_t *) prop->value)[PSYCHO_INTERNAL_REG]; |
| |
| uintptr_t paddr; |
| if (!ofw_upa_apply_ranges(node->parent, reg, &paddr)) |
| 74,28 → 85,17 |
|---|
| |
| void psycho_enable_interrupt(psycho_t *psycho, int inr) |
| { |
| inr -= PSYCHO_IGN; |
| switch (inr) { |
| case PSYCHO_KEYBOARD_INR: |
| psycho->regs[0] = 1; /* XXX */ |
| break; |
| default: |
| panic("Unexpected INR (%d)\n", inr); |
| break; |
| } |
| int ino = inr & ~IGN_MASK; |
| uint64_t imr = psycho->regs[PSYCHO_OBIO_IMR(ino)]; |
| imr |= host2uint64_t_le(IMAP_V_MASK); |
| psycho->regs[PSYCHO_OBIO_IMR(ino)] = imr; |
| } |
| |
| void psycho_clear_interrupt(psycho_t *psycho, int inr) |
| { |
| inr -= PSYCHO_IGN; |
| switch (inr) { |
| case PSYCHO_KEYBOARD_INR: |
| psycho->regs[0] = 0; /* XXX */ |
| break; |
| default: |
| panic("Unexpected INR (%d)\n", inr); |
| break; |
| } |
| int ino = inr & ~IGN_MASK; |
| uint64_t idle = host2uint64_t_le(0); |
| psycho->regs[PSYCHO_OBIO_CIR(ino)] = idle; |
| } |
| |
| /** @} |