dos/mystuff.h

   1 #ifndef MYSTUFF_H
   2 #define MYSTUFF_H
   3
   4 #include <inttypes.h>
   5 #include <stddef.h>
   6
   7 unsigned int skip_atou(const char **s);
   8 unsigned int atou(const char *s);
   9
  10 static inline int isdigit(int ch)
  11 {
  12     return (ch >= '0') && (ch <= '9');
  13 }
  14
  15 struct diskio {
  16     uint32_t startsector;
  17     uint16_t sectors;
  18     uint16_t bufoffs, bufseg;
  19 } __attribute__ ((packed));
  20 int int25_read_sector(unsigned char drive, struct diskio *dio);
  21 int int26_write_sector(unsigned char drive, struct diskio *dio);
  22
  23 struct psp {
  24     uint16_t    int20;
  25     uint16_t    nextpara;
  26     uint8_t     resv1;
  27     uint8_t     dispatcher[5];
  28     uint32_t    termvector;
  29     uint32_t    ctrlcvector;
  30     uint32_t    criterrvector;
  31     uint16_t    resv2[11];
  32     uint16_t    environment;
  33     uint16_t    resv3[23];
  34     uint8_t     fcb[2][16];
  35     uint32_t    resv4;
  36     uint8_t     cmdlen;
  37     char        cmdtail[127];
  38 } __attribute__((packed));
  39
  40 extern struct psp _PSP;
  41
  42 static inline __attribute__((const))
  43 uint16_t ds(void)
  44 {
  45     uint16_t v;
  46     asm("movw %%ds,%0":"=rm"(v));
  47     return v;
  48 }
  49
  50 static inline void set_fs(uint16_t seg)
  51 {
  52     asm volatile("movw %0,%%fs"::"rm" (seg));
  53 }
  54
  55 static inline uint8_t get_8_fs(size_t offs)
  56 {
  57     uint8_t v;
  58     asm volatile("movb %%fs:%1,%0"
  59                  : "=q" (v) : "m" (*(const uint8_t *)offs));
  60     return v;
  61 }
  62
  63 static inline uint16_t get_16_fs(size_t offs)
  64 {
  65     uint16_t v;
  66     asm volatile("movw %%fs:%1,%0"
  67                  : "=r" (v) : "m" (*(const uint16_t *)offs));
  68     return v;
  69 }
  70
  71 static inline uint32_t get_32_fs(size_t offs)
  72 {
  73     uint32_t v;
  74     asm volatile("movl %%fs:%1,%0"
  75                  : "=r" (v) : "m" (*(const uint32_t *)offs));
  76     return v;
  77 }
  78
  79 #endif /* MYSTUFF_H */