qemu/roms/seabios/src/farptr.h

   1 // Code to access multiple segments within gcc.
   2 //
   3 // Copyright (C) 2008,2009  Kevin O'Connor <kevin@koconnor.net>
   4 //
   5 // This file may be distributed under the terms of the GNU LGPLv3 license.
   6 #ifndef __FARPTR_H
   7 #define __FARPTR_H
   8
   9 #include "x86.h" // insb
  10
  11 // Dummy definitions used to make sure gcc understands dependencies
  12 // between SET_SEG and GET/READ/WRITE_SEG macros.
  13 extern u16 __segment_ES, __segment_CS, __segment_DS, __segment_SS;
  14 extern u16 __segment_FS, __segment_GS;
  15
  16 // Low level macros for reading/writing memory via a segment selector.
  17 #define READ8_SEG(prefix, SEG, value, var)                      \
  18     __asm__(prefix "movb %%" #SEG ":%1, %b0" : "=Qi"(value)     \
  19             : "m"(var), "m"(__segment_ ## SEG))
  20 #define READ16_SEG(prefix, SEG, value, var)                     \
  21     __asm__(prefix "movw %%" #SEG ":%1, %w0" : "=ri"(value)     \
  22             : "m"(var), "m"(__segment_ ## SEG))
  23 #define READ32_SEG(prefix, SEG, value, var)                     \
  24     __asm__(prefix "movl %%" #SEG ":%1, %0" : "=ri"(value)      \
  25             : "m"(var), "m"(__segment_ ## SEG))
  26 #define READ64_SEG(prefix, SEG, value, var) do {                \
  27         union u64_u32_u __value;                                \
  28         union u64_u32_u *__r64_ptr = (union u64_u32_u *)&(var); \
  29         READ32_SEG(prefix, SEG, __value.lo, __r64_ptr->lo);     \
  30         READ32_SEG(prefix, SEG, __value.hi, __r64_ptr->hi);     \
  31         *(u64*)&(value) = __value.val;                          \
  32     } while (0)
  33 #define WRITE8_SEG(prefix, SEG, var, value)                     \
  34     __asm__(prefix "movb %b1, %%" #SEG ":%0" : "=m"(var)        \
  35             : "Q"(value), "m"(__segment_ ## SEG))
  36 #define WRITE16_SEG(prefix, SEG, var, value)                    \
  37     __asm__(prefix "movw %w1, %%" #SEG ":%0" : "=m"(var)        \
  38             : "r"(value), "m"(__segment_ ## SEG))
  39 #define WRITE32_SEG(prefix, SEG, var, value)                    \
  40     __asm__(prefix "movl %1, %%" #SEG ":%0" : "=m"(var)         \
  41             : "r"(value), "m"(__segment_ ## SEG))
  42 #define WRITE64_SEG(prefix, SEG, var, value) do {               \
  43         union u64_u32_u __value;                                \
  44         union u64_u32_u *__w64_ptr = (union u64_u32_u *)&(var); \
  45         typeof(var) __value_tmp = (value);                      \
  46         __value.val = *(u64*)&__value_tmp;                      \
  47         WRITE32_SEG(prefix, SEG, __w64_ptr->lo, __value.lo);    \
  48         WRITE32_SEG(prefix, SEG, __w64_ptr->hi, __value.hi);    \
  49     } while (0)
  50
  51 // Macros for automatically choosing the appropriate memory size
  52 // access method.
  53 extern void __force_link_error__unknown_type(void);
  54
  55 #define __GET_VAR(prefix, seg, var) ({          \
  56     typeof(var) __val;                          \
  57     if (sizeof(__val) == 1)                     \
  58         READ8_SEG(prefix, seg, __val, var);     \
  59     else if (sizeof(__val) == 2)                \
  60         READ16_SEG(prefix, seg, __val, var);    \
  61     else if (sizeof(__val) == 4)                \
  62         READ32_SEG(prefix, seg, __val, var);    \
  63     else if (sizeof(__val) == 8)                \
  64         READ64_SEG(prefix, seg, __val, var);    \
  65     else                                        \
  66         __force_link_error__unknown_type();     \
  67     __val; })
  68
  69 #define __SET_VAR(prefix, seg, var, val) do {           \
  70         if (sizeof(var) == 1)                           \
  71             WRITE8_SEG(prefix, seg, var, (val));        \
  72         else if (sizeof(var) == 2)                      \
  73             WRITE16_SEG(prefix, seg, var, (val));       \
  74         else if (sizeof(var) == 4)                      \
  75             WRITE32_SEG(prefix, seg, var, (val));       \
  76         else if (sizeof(var) == 8)                      \
  77             WRITE64_SEG(prefix, seg, var, (val));       \
  78         else                                            \
  79             __force_link_error__unknown_type();         \
  80     } while (0)
  81
  82 #define DECL_SEGFUNCS(SEG)                              \
  83 static inline void __set_seg_##SEG(u16 seg) {           \
  84     __asm__("movw %w1, %%" #SEG : "=m"(__segment_##SEG) \
  85             : "rm"(seg));                               \
  86 }                                                       \
  87 static inline u16 __get_seg_##SEG(void) {               \
  88     u16 res;                                            \
  89     __asm__("movw %%" #SEG ", %w0" : "=rm"(res)         \
  90             : "m"(__segment_##SEG));                    \
  91     return res;                                         \
  92 }
  93 DECL_SEGFUNCS(CS)
  94 DECL_SEGFUNCS(DS)
  95 DECL_SEGFUNCS(ES)
  96 DECL_SEGFUNCS(FS)
  97 DECL_SEGFUNCS(GS)
  98 DECL_SEGFUNCS(SS)
  99
 100 // Low level macros for getting/setting a segment register.
 101 #define __SET_SEG(SEG, value)                   \
 102     __set_seg_##SEG(value)
 103 #define __GET_SEG(SEG)                          \
 104     __get_seg_##SEG()
 105
 106 // Macros for accessing a variable in another segment.  (They
 107 // automatically update the %es segment and then make the appropriate
 108 // access.)
 109 #define __GET_FARVAR(seg, var) ({               \
 110     SET_SEG(ES, (seg));                         \
 111     GET_VAR(ES, (var)); })
 112 #define __SET_FARVAR(seg, var, val) do {        \
 113         typeof(var) __sfv_val = (val);          \
 114         SET_SEG(ES, (seg));                     \
 115         SET_VAR(ES, (var), __sfv_val);          \
 116     } while (0)
 117
 118 // Macros for accesssing a 32bit flat mode pointer from 16bit real
 119 // mode.  (They automatically update the %es segment, break the
 120 // pointer into segment/offset, and then make the access.)
 121 #define __GET_FLATPTR(ptr) ({                                   \
 122     typeof(&(ptr)) __ptr = &(ptr);                              \
 123     GET_FARVAR(FLATPTR_TO_SEG(__ptr)                            \
 124                , *(typeof(__ptr))FLATPTR_TO_OFFSET(__ptr)); })
 125 #define __SET_FLATPTR(ptr, val) do {                            \
 126         typeof (&(ptr)) __ptr = &(ptr);                         \
 127         SET_FARVAR(FLATPTR_TO_SEG(__ptr)                        \
 128                    , *(typeof(__ptr))FLATPTR_TO_OFFSET(__ptr)   \
 129                    , (val));                                    \
 130     } while (0)
 131
 132 // Macros for converting to/from 32bit flat mode pointers to their
 133 // equivalent 16bit segment/offset values.
 134 #define FLATPTR_TO_SEG(p) (((u32)(p)) >> 4)
 135 #define FLATPTR_TO_OFFSET(p) (((u32)(p)) & 0xf)
 136 #define MAKE_FLATPTR(seg,off) ((void*)(((u32)(seg)<<4)+(u32)(off)))
 137
 138
 139 #if MODESEGMENT == 1
 140
 141 // Definitions when using segmented mode.
 142 #define GET_FARVAR(seg, var) __GET_FARVAR((seg), (var))
 143 #define SET_FARVAR(seg, var, val) __SET_FARVAR((seg), (var), (val))
 144 #define GET_VAR(seg, var) __GET_VAR("", seg, (var))
 145 #define SET_VAR(seg, var, val) __SET_VAR("", seg, (var), (val))
 146 #define SET_SEG(SEG, value) __SET_SEG(SEG, (value))
 147 #define GET_SEG(SEG) __GET_SEG(SEG)
 148 #define GET_FLATPTR(ptr) __GET_FLATPTR(ptr)
 149 #define SET_FLATPTR(ptr, val) __SET_FLATPTR((ptr), (val))
 150
 151 static inline void insb_fl(u16 port, void *ptr_fl, u16 count) {
 152     SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl));
 153     insb(port, (u8*)FLATPTR_TO_OFFSET(ptr_fl), count);
 154 }
 155 static inline void insw_fl(u16 port, void *ptr_fl, u16 count) {
 156     SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl));
 157     insw(port, (u16*)FLATPTR_TO_OFFSET(ptr_fl), count);
 158 }
 159 static inline void insl_fl(u16 port, void *ptr_fl, u16 count) {
 160     SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl));
 161     insl(port, (u32*)FLATPTR_TO_OFFSET(ptr_fl), count);
 162 }
 163 static inline void outsb_fl(u16 port, void *ptr_fl, u16 count) {
 164     SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl));
 165     outsb(port, (u8*)FLATPTR_TO_OFFSET(ptr_fl), count);
 166 }
 167 static inline void outsw_fl(u16 port, void *ptr_fl, u16 count) {
 168     SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl));
 169     outsw(port, (u16*)FLATPTR_TO_OFFSET(ptr_fl), count);
 170 }
 171 static inline void outsl_fl(u16 port, void *ptr_fl, u16 count) {
 172     SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl));
 173     outsl(port, (u32*)FLATPTR_TO_OFFSET(ptr_fl), count);
 174 }
 175
 176 #else
 177
 178 // In 32-bit flat mode there is no need to mess with the segments.
 179 #define GET_FARVAR(seg, var) \
 180     (*((typeof(&(var)))MAKE_FLATPTR((seg), &(var))))
 181 #define SET_FARVAR(seg, var, val) \
 182     do { GET_FARVAR((seg), (var)) = (val); } while (0)
 183 #define GET_VAR(seg, var) (var)
 184 #define SET_VAR(seg, var, val) do { (var) = (val); } while (0)
 185 #define SET_SEG(SEG, value) ((void)(value))
 186 #define GET_SEG(SEG) 0
 187 #define GET_FLATPTR(ptr) (ptr)
 188 #define SET_FLATPTR(ptr, val) do { (ptr) = (val); } while (0)
 189
 190 #define insb_fl(port, ptr_fl, count) insb(port, ptr_fl, count)
 191 #define insw_fl(port, ptr_fl, count) insw(port, ptr_fl, count)
 192 #define insl_fl(port, ptr_fl, count) insl(port, ptr_fl, count)
 193 #define outsb_fl(port, ptr_fl, count) outsb(port, ptr_fl, count)
 194 #define outsw_fl(port, ptr_fl, count) outsw(port, ptr_fl, count)
 195 #define outsl_fl(port, ptr_fl, count) outsl(port, ptr_fl, count)
 196
 197 #endif
 198
 199 #define SEGOFF(s,o) ({struct segoff_s __so; __so.offset=(o); __so.seg=(s); __so;})
 200
 201 static inline struct segoff_s FLATPTR_TO_SEGOFF(void *p) {
 202     return SEGOFF(FLATPTR_TO_SEG(p), FLATPTR_TO_OFFSET(p));
 203 }
 204 static inline void *SEGOFF_TO_FLATPTR(struct segoff_s so) {
 205     return MAKE_FLATPTR(so.seg, so.offset);
 206 }
 207
 208 #endif // farptr.h