data.c 9.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456
  1. /*
  2. Data access
  3. */
  4. /* $Id$ */
  5. #include <em_abs.h>
  6. #include "logging.h"
  7. #include "nofloat.h"
  8. #include "global.h"
  9. #include "log.h"
  10. #include "trap.h"
  11. #include "warn.h"
  12. #include "alloc.h"
  13. #include "memdirect.h"
  14. #include "mem.h"
  15. #include "shadow.h"
  16. #define HEAPSIZE 1000L /* initial heap size */
  17. extern size maxheap; /* from main.c */
  18. #ifdef LOGGING
  19. char *data_sh; /* shadowbytes */
  20. #endif /* LOGGING */
  21. PRIVATE warn_dtbits();
  22. init_data(hb)
  23. ptr hb;
  24. {
  25. HB = hb; /* set Heap Base */
  26. HP = HB; /* initialize Heap Pointer */
  27. HL = HB + HEAPSIZE; /* initialize Heap Limit */
  28. data = Malloc((size)p2i(HL), "data space");
  29. #ifdef LOGGING
  30. data_sh = Malloc((size)p2i(HL), "shadowspace for data");
  31. dt_clear_area(i2p(0), HL);
  32. #endif /* LOGGING */
  33. }
  34. /********************************************************
  35. * EM-register division. *
  36. ********************************************************
  37. * *
  38. * newHP(p) - check and adjust HeapPointer. *
  39. * *
  40. ********************************************************/
  41. newHP(ap)
  42. ptr ap;
  43. {
  44. register ptr p = ap;
  45. if (in_gda(p)) {
  46. wtrap(WHPGDA, EHEAP);
  47. }
  48. if (in_stack(p)) {
  49. wtrap(WHPSTACK, EHEAP);
  50. }
  51. if (!is_wordaligned(p)) {
  52. wtrap(WHPODD, EHEAP);
  53. }
  54. if (maxheap) {
  55. /* more than allowed on command line */
  56. if (p - HB > maxheap) {
  57. warning(WEHEAP);
  58. trap(EHEAP);
  59. }
  60. }
  61. if (p > HL) {
  62. /* extend heap space */
  63. HL = i2p(allocfrac(p2i(p)) - 1);
  64. data = Realloc(data, (size)(p2i(HL) + 1), "heap space");
  65. #ifdef LOGGING
  66. data_sh = Realloc(data_sh, (size)(p2i(HL) + 1),
  67. "shadowspace for heap");
  68. #endif /* LOGGING */
  69. }
  70. #ifdef LOGGING
  71. if (p > HP) {
  72. dt_clear_area(HP, p);
  73. }
  74. #endif /* LOGGING */
  75. HP = p;
  76. }
  77. /************************************************************************
  78. * Data store division. *
  79. ************************************************************************
  80. * *
  81. * dt_stdp(addr, p) - STore Data Pointer. *
  82. * dt_stn(addr, l, n) - STore N byte integer. *
  83. * dt_stw(addr, l) - STore wsize byte integer. *
  84. * dt_stf(addr, f, n) - STore n byte Floating point number. *
  85. * *
  86. ************************************************************************/
  87. dt_stdp(addr, ap)
  88. register ptr addr;
  89. ptr ap;
  90. {
  91. register int i;
  92. register long p = (long) ap;
  93. LOG(("@g6 dt_stdp(%lu, %lu)", addr, p));
  94. ch_in_data(addr, psize);
  95. ch_wordaligned(addr);
  96. for (i = (int) psize; i > 0; i--, addr++) {
  97. ch_dt_prot(addr);
  98. data_loc(addr) = (char) (p);
  99. dt_dp(addr);
  100. p = p>>8;
  101. }
  102. }
  103. dt_stip(addr, ap)
  104. register ptr addr;
  105. ptr ap;
  106. {
  107. register int i;
  108. register long p = (long) ap;
  109. LOG(("@g6 dt_stip(%lu, %lu)", addr, p));
  110. ch_in_data(addr, psize);
  111. ch_wordaligned(addr);
  112. for (i = (int) psize; i > 0; i--, addr++) {
  113. ch_dt_prot(addr);
  114. data_loc(addr) = (char) (p);
  115. dt_ip(addr);
  116. p = p>>8;
  117. }
  118. }
  119. dt_stn(addr, al, n)
  120. register ptr addr;
  121. long al;
  122. size n;
  123. {
  124. register int i;
  125. register long l = al;
  126. #ifdef LOGGING
  127. /* a psize zero is ambiguous */
  128. int sh_flags = (l == 0 && n == psize) ? (SH_INT|SH_DATAP) : SH_INT;
  129. #endif /* LOGGING */
  130. LOG(("@g6 dt_stn(%lu, %lu, %lu)", addr, l, n));
  131. ch_in_data(addr, n);
  132. ch_aligned(addr, n);
  133. for (i = (int) n; i > 0; i--, addr++) {
  134. ch_dt_prot(addr);
  135. data_loc(addr) = (char) l;
  136. #ifdef LOGGING
  137. dt_sh(addr) = sh_flags;
  138. #endif /* LOGGING */
  139. l = l>>8;
  140. }
  141. }
  142. dt_stw(addr, al)
  143. register ptr addr;
  144. long al;
  145. {
  146. register int i;
  147. register long l = al;
  148. #ifdef LOGGING
  149. /* a psize zero is ambiguous */
  150. int sh_flags = (l == 0 && wsize == psize) ? (SH_INT|SH_DATAP) : SH_INT;
  151. #endif /* LOGGING */
  152. LOG(("@g6 dt_stw(%lu, %lu)", addr, l));
  153. ch_in_data(addr, wsize);
  154. ch_wordaligned(addr);
  155. for (i = (int) wsize; i > 0; i--, addr++) {
  156. ch_dt_prot(addr);
  157. data_loc(addr) = (char) l;
  158. #ifdef LOGGING
  159. dt_sh(addr) = sh_flags;
  160. #endif /* LOGGING */
  161. l = l>>8;
  162. }
  163. }
  164. #ifndef NOFLOAT
  165. dt_stf(addr, f, n)
  166. register ptr addr;
  167. double f;
  168. register size n;
  169. {
  170. register char *cp = (char *) &f;
  171. register int i;
  172. float fl;
  173. LOG(("@g6 dt_stf(%lu, %g, %lu)", addr, f, n));
  174. ch_in_data(addr, n);
  175. ch_wordaligned(addr);
  176. if ((int) n == 4) {
  177. fl = f;
  178. cp = (char *) &fl;
  179. }
  180. for (i = (int) n; i > 0; i--, addr++) {
  181. ch_dt_prot(addr);
  182. data_loc(addr) = *cp++;
  183. dt_fl(addr);
  184. }
  185. }
  186. #endif /* NOFLOAT */
  187. /************************************************************************
  188. * Data load division. *
  189. ************************************************************************
  190. * *
  191. * dt_lddp(addr) - LoaD Data Pointer from data. *
  192. * dt_ldip(addr) - LoaD Instruction Pointer from data. *
  193. * dt_ldu(addr, n) - LoaD n Unsigned bytes from data. *
  194. * dt_lduw(addr) - LoaD wsize Unsigned bytes from data. *
  195. * dt_lds(addr, n) - LoaD n Signed bytes from data. *
  196. * dt_ldsw(addr) - LoaD wsize Signed bytes from data. *
  197. * *
  198. ************************************************************************/
  199. ptr dt_lddp(addr)
  200. register ptr addr;
  201. {
  202. register ptr p;
  203. LOG(("@g6 dt_lddp(%lu)", addr));
  204. ch_in_data(addr, psize);
  205. ch_wordaligned(addr);
  206. #ifdef LOGGING
  207. if (!is_dt_set(addr, psize, SH_DATAP)) {
  208. warning(WGDPEXP);
  209. warn_dtbits(addr, psize);
  210. }
  211. #endif /* LOGGING */
  212. p = p_in_data(addr);
  213. LOG(("@g6 dt_lddp() returns %lu", p));
  214. return (p);
  215. }
  216. ptr dt_ldip(addr)
  217. register ptr addr;
  218. {
  219. register ptr p;
  220. LOG(("@g6 dt_ldip(%lu)", addr));
  221. ch_in_data(addr, psize);
  222. ch_wordaligned(addr);
  223. #ifdef LOGGING
  224. if (!is_dt_set(addr, psize, SH_INSP)) {
  225. warning(WGIPEXP);
  226. warn_dtbits(addr, psize);
  227. }
  228. #endif /* LOGGING */
  229. p = p_in_data(addr);
  230. LOG(("@g6 dt_ldip() returns %lu", p));
  231. return (p);
  232. }
  233. unsigned long dt_ldu(addr, n)
  234. register ptr addr;
  235. size n;
  236. {
  237. register int i;
  238. register unsigned long u = 0;
  239. LOG(("@g6 dt_ldu(%lu, %lu)", addr, n));
  240. ch_in_data(addr, n);
  241. ch_aligned(addr, n);
  242. #ifdef LOGGING
  243. if (!is_dt_set(addr, n, SH_INT)) {
  244. warning(n == 1 ? WGCEXP : WGIEXP);
  245. warn_dtbits(addr, n);
  246. }
  247. #endif /* LOGGING */
  248. addr += n-1;
  249. for (i = (int) n-1; i >= 0; i--, addr--) {
  250. u = (u<<8) | btou(data_loc(addr));
  251. }
  252. LOG(("@g6 dt_ldu() returns %lu", u));
  253. return (u);
  254. }
  255. unsigned long dt_lduw(addr)
  256. register ptr addr;
  257. {
  258. register int i;
  259. register unsigned long u = 0;
  260. LOG(("@g6 dt_lduw(%lu)", addr));
  261. ch_in_data(addr, wsize);
  262. ch_wordaligned(addr);
  263. #ifdef LOGGING
  264. if (!is_dt_set(addr, wsize, SH_INT)) {
  265. warning(WGIEXP);
  266. warn_dtbits(addr, wsize);
  267. }
  268. #endif /* LOGGING */
  269. addr += wsize-1;
  270. for (i = (int) wsize-1; i >= 0; i--, addr--) {
  271. u = (u<<8) | btou(data_loc(addr));
  272. }
  273. LOG(("@g6 dt_lduw() returns %lu", u));
  274. return (u);
  275. }
  276. long dt_lds(addr, n)
  277. register ptr addr;
  278. size n;
  279. {
  280. register int i;
  281. register long l;
  282. LOG(("@g6 dt_lds(%lu, %lu)", addr, n));
  283. ch_in_data(addr, n);
  284. ch_aligned(addr, n);
  285. #ifdef LOGGING
  286. if (!is_dt_set(addr, n, SH_INT)) {
  287. warning(n == 1 ? WGCEXP : WGIEXP);
  288. warn_dtbits(addr, n);
  289. }
  290. #endif /* LOGGING */
  291. addr += n-2;
  292. l = btos(data_loc(addr + 1));
  293. for (i = n - 2; i >= 0; i--, addr--) {
  294. l = (l<<8) | btol(data_loc(addr));
  295. }
  296. LOG(("@g6 dt_lds() returns %lu", l));
  297. return (l);
  298. }
  299. long dt_ldsw(addr)
  300. register ptr addr;
  301. {
  302. register int i;
  303. register long l;
  304. LOG(("@g6 dt_ldsw(%lu)", addr));
  305. ch_in_data(addr, wsize);
  306. ch_wordaligned(addr);
  307. #ifdef LOGGING
  308. if (!is_dt_set(addr, wsize, SH_INT)) {
  309. warning(WGIEXP);
  310. warn_dtbits(addr, wsize);
  311. }
  312. #endif /* LOGGING */
  313. addr += wsize-2;
  314. l = btos(data_loc(addr + 1));
  315. for (i = wsize - 2; i >= 0; i--, addr--) {
  316. l = (l<<8) | btol(data_loc(addr));
  317. }
  318. LOG(("@g6 dt_ldsw() returns %lu", l));
  319. return (l);
  320. }
  321. /************************************************************************
  322. * Data move division *
  323. ************************************************************************
  324. * *
  325. * dt_mvd(d2, d1, n) - Move n bytes in data from d1 to d2. *
  326. * dt_mvs(d, s, n) - Move n bytes from s in stack to d in data. *
  327. * *
  328. * See st_mvs() in stack.c for a description. *
  329. * *
  330. ************************************************************************/
  331. dt_mvd(d2, d1, n) /* d1 -> d2 */
  332. register ptr d2, d1;
  333. size n;
  334. {
  335. register int i;
  336. ch_in_data(d1, n);
  337. ch_wordaligned(d1);
  338. ch_in_data(d2, n);
  339. ch_wordaligned(d2);
  340. for (i = (int) n; i > 0; i--, d1++, d2++) {
  341. ch_dt_prot(d2);
  342. data_loc(d2) = data_loc(d1);
  343. #ifdef LOGGING
  344. dt_sh(d2) = dt_sh(d1) & ~SH_PROT;
  345. #endif /* LOGGING */
  346. }
  347. }
  348. dt_mvs(d, s, n) /* s -> d */
  349. register ptr d, s;
  350. size n;
  351. {
  352. register int i;
  353. ch_in_stack(s, n);
  354. ch_wordaligned(s);
  355. ch_in_data(d, n);
  356. ch_wordaligned(d);
  357. for (i = (int) n; i > 0; i--, d++, s++) {
  358. ch_dt_prot(d);
  359. ch_st_prot(s);
  360. data_loc(d) = stack_loc(s);
  361. #ifdef LOGGING
  362. dt_sh(d) = st_sh(s) & ~SH_PROT;
  363. #endif /* LOGGING */
  364. }
  365. }
  366. #ifdef LOGGING
  367. PRIVATE warn_dtbits(addr, n)
  368. register ptr addr;
  369. register size n;
  370. {
  371. register int or_bits = 0;
  372. register int and_bits = 0xff;
  373. while (n--) {
  374. or_bits |= dt_sh(addr);
  375. and_bits &= dt_sh(addr);
  376. addr++;
  377. }
  378. if (or_bits != and_bits) {
  379. /* no use trying to diagnose */
  380. warningcont(WWASMISC);
  381. return;
  382. }
  383. if (or_bits == 0)
  384. warningcont(WWASUND);
  385. if (or_bits & SH_INT)
  386. warningcont(WWASINT);
  387. if (or_bits & SH_FLOAT)
  388. warningcont(WWASFLOAT);
  389. if (or_bits & SH_DATAP)
  390. warningcont(WWASDATAP);
  391. if (or_bits & SH_INSP)
  392. warningcont(WWASINSP);
  393. }
  394. #endif /* LOGGING */