diff options
Diffstat (limited to 'sharplhf00l04.c')
| -rw-r--r-- | sharplhf00l04.c | 40 |
1 files changed, 40 insertions, 0 deletions
diff --git a/sharplhf00l04.c b/sharplhf00l04.c index 61021d3..660142d 100644 --- a/sharplhf00l04.c +++ b/sharplhf00l04.c @@ -29,6 +29,46 @@ #include "sharplhf00l04.h" #include "debug.h" +void toggle_ready_lhf00l04(volatile uint8_t *dst) +{ + unsigned int i = 0; + uint8_t tmp1, tmp2; + + tmp1 = *dst & 0x40; + + while (i++ < 0xFFFFFF) { + tmp2 = *dst & 0x40; + if (tmp1 == tmp2) { + break; + } + tmp1 = tmp2; + } +} + +void data_polling_lhf00l04(volatile uint8_t *dst, uint8_t data) +{ + unsigned int i = 0; + uint8_t tmp; + + data &= 0x80; + + while (i++ < 0xFFFFFF) { + tmp = *dst & 0x80; + if (tmp == data) { + break; + } + } +} + +void protect_lhf00l04(volatile uint8_t *bios) +{ + *(volatile uint8_t *)(bios + 0x5555) = 0xAA; + *(volatile uint8_t *)(bios + 0x2AAA) = 0x55; + *(volatile uint8_t *)(bios + 0x5555) = 0xA0; + + usleep(200); +} + // I need that Berkeley bit-map printer void print_lhf00l04_status(uint8_t status) { |
