swissChili | 9b3584b | 2021-02-18 13:57:27 -0800 | [diff] [blame] | 1 | #include "io.h" |
swissChili | d813792 | 2021-02-17 15:34:07 -0800 | [diff] [blame] | 2 | |
swissChili | d813792 | 2021-02-17 15:34:07 -0800 | [diff] [blame] | 3 | void outb(ushort port, uchar val) |
| 4 | { |
swissChili | 825d46b | 2021-02-21 10:14:16 -0800 | [diff] [blame^] | 5 | asm volatile("outb %1, %0" : : "dN"(port), "a"(val)); |
swissChili | d813792 | 2021-02-17 15:34:07 -0800 | [diff] [blame] | 6 | } |
| 7 | |
| 8 | uchar inb(ushort port) |
| 9 | { |
| 10 | uchar ret; |
swissChili | 825d46b | 2021-02-21 10:14:16 -0800 | [diff] [blame^] | 11 | asm volatile("inb %1, %0" : "=a"(ret) : "dN"(port)); |
swissChili | d813792 | 2021-02-17 15:34:07 -0800 | [diff] [blame] | 12 | return ret; |
| 13 | } |
| 14 | |
| 15 | ushort inw(ushort port) |
| 16 | { |
| 17 | ushort ret; |
swissChili | 825d46b | 2021-02-21 10:14:16 -0800 | [diff] [blame^] | 18 | asm volatile("inw %1, %0" : "=a"(ret) : "dN"(port)); |
swissChili | d813792 | 2021-02-17 15:34:07 -0800 | [diff] [blame] | 19 | return ret; |
| 20 | } |
| 21 | |
| 22 | void *memset(void *s, int c, size_t n) |
| 23 | { |
| 24 | for (size_t i = 0; i < n; i++) |
| 25 | { |
| 26 | ((uchar *)s)[i] = c; |
| 27 | } |
swissChili | 825d46b | 2021-02-21 10:14:16 -0800 | [diff] [blame^] | 28 | return s; |
swissChili | d813792 | 2021-02-17 15:34:07 -0800 | [diff] [blame] | 29 | } |
| 30 | |
| 31 | void *memcpy(void *dest, const void *src, size_t n) |
| 32 | { |
| 33 | for (size_t i = 0; i < n; i++) |
| 34 | { |
| 35 | ((uchar *)dest)[i] = ((uchar *)src)[i]; |
| 36 | } |
swissChili | 825d46b | 2021-02-21 10:14:16 -0800 | [diff] [blame^] | 37 | return dest; |
swissChili | d813792 | 2021-02-17 15:34:07 -0800 | [diff] [blame] | 38 | } |
swissChili | 9b3584b | 2021-02-18 13:57:27 -0800 | [diff] [blame] | 39 | |
| 40 | void io_wait() |
| 41 | { |
swissChili | 825d46b | 2021-02-21 10:14:16 -0800 | [diff] [blame^] | 42 | asm volatile("outb %0, $0x80" ::"a"(0)); |
swissChili | 9b3584b | 2021-02-18 13:57:27 -0800 | [diff] [blame] | 43 | } |