Unix.I386.Machine.Mod 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867
  1. MODULE Machine; (** AUTHOR "pjm, G.F."; PURPOSE "Bootstrapping, configuration and machine interface"; *)
  2. IMPORT S := SYSTEM, Trace, Unix, Glue;
  3. CONST
  4. DefaultConfig = "Color 0 StackSize 128";
  5. Version = "Aos (rev.6634)";
  6. DefaultObjectFileExtension* = ".Obj";
  7. Second* = 1000; (* frequency of ticks increments in Hz *)
  8. (** bits in features variable *)
  9. MTTR* = 12; MMX* = 23;
  10. AddrSize = SIZEOF( ADDRESS );
  11. SizeSize = SIZEOF( SIZE );
  12. BlockSize = 32;
  13. MemBlockSize* = 64*1024*1024;
  14. TraceOutput* = 0; (* Trace output *)
  15. Memory* = 1; (*! Virtual memory management, stack and page allocation, not used in UnixAos *)
  16. Heaps* = 2; (* Storage allocation and Garbage collection *)
  17. Interrupts* = 3; (*! Interrupt handling, not used in UnixAos *)
  18. Modules* = 4; (* Module list *)
  19. Objects* = 5; (*! Ready queue, not used in UnixAos *)
  20. Processors* = 6; (*! Interprocessor interrupts, not used in UnixAos *)
  21. KernelLog* = 7; (* Atomic output *)
  22. X11* = 8; (* XWindows I/O *)
  23. Trap* = 9;
  24. GC = 10;
  25. MaxLocks* = 11; (* { <= 32 } *)
  26. MaxCPU* = 4;
  27. TYPE
  28. Vendor* = ARRAY 13 OF CHAR;
  29. MemoryBlock* = POINTER TO MemoryBlockDesc;
  30. MemoryBlockDesc* = RECORD
  31. next- {UNTRACED}: MemoryBlock;
  32. startAdr-: ADDRESS; (* sort key in linked list of memory blocks *)
  33. size-: SIZE;
  34. beginBlockAdr-, endBlockAdr-: ADDRESS
  35. END;
  36. (** processor state, ordering of record fields is predefined! *)
  37. (*!(not used in UnixAos, for interface compatibility only)*)
  38. State* = RECORD (* offsets used in FieldInterrupt, FieldIRQ and Objects.RestoreState *)
  39. EDI*, ESI*, ERR*, ESP0*, EBX*, EDX*, ECX*, EAX*: LONGINT; (** ESP0 = ADR(s.INT) *)
  40. INT*, BP*, PC*, CS*: LONGINT; (* BP and ERR are exchanged by glue code, for procedure link *)
  41. FLAGS*: SET;
  42. SP*, SS*: LONGINT; (** only valid if (VMBit IN s.EFLAGS) OR (CS MOD 4 < s.CS MOD 4) *)
  43. ES*, DS*, FS*, GS*: LONGINT; (** only valid if (VMBit IN s.FLAGS) *)
  44. END;
  45. VAR
  46. mtx : ARRAY MaxLocks OF Unix.Mutex_t;
  47. version-: ARRAY 64 OF CHAR; (** Aos version *)
  48. features-, features2 : SET;
  49. MMXSupport- : BOOLEAN;
  50. SSESupport- : BOOLEAN;
  51. SSE2Support- : BOOLEAN;
  52. SSE3Support- : BOOLEAN;
  53. SSSE3Support- : BOOLEAN;
  54. SSE41Support- : BOOLEAN;
  55. SSE42Support- : BOOLEAN;
  56. SSE5Support- : BOOLEAN;
  57. AVXSupport- : BOOLEAN;
  58. GCacquired- : BOOLEAN;
  59. ticks-: LONGINT; (** timer ticks. Use Kernel.GetTicks() to read, don't write *)
  60. prioLow-, prioHigh-: LONGINT; (* permitted thread priorities *)
  61. fcr-: SET; (** default floating-point control register value (default rounding mode is towards -infinity, for ENTIER) *)
  62. mhz-: HUGEINT; (** clock rate of GetTimer in MHz, or 0 if not known *)
  63. standaloneAppl-: BOOLEAN;
  64. firstMemBlock: MemoryBlockDesc; (* pseudo heap *)
  65. memBlockHead-{UNTRACED}, memBlockTail-{UNTRACED}: MemoryBlock; (* head and tail of sorted list of memory blocks *)
  66. config: ARRAY 2048 OF CHAR; (* config strings *)
  67. thrInitialize : PROCEDURE {REALTIME, C} ( VAR low, high: LONGINT ): BOOLEAN;
  68. mtxInit : PROCEDURE {REALTIME, C} ( dummy: LONGINT ): Unix.Mutex_t;
  69. mtxDestroy : PROCEDURE {REALTIME, C} ( mtx: Unix.Mutex_t );
  70. mtxLock : PROCEDURE {REALTIME, C} ( mtx: Unix.Mutex_t );
  71. mtxUnlock : PROCEDURE {REALTIME, C} ( mtx: Unix.Mutex_t );
  72. conInit : PROCEDURE {REALTIME, C} ( dummy: LONGINT ): Unix.Condition_t;
  73. conDestroy : PROCEDURE {REALTIME, C} ( cond: Unix.Condition_t );
  74. conWait : PROCEDURE {REALTIME, C} ( cond: Unix.Condition_t; mtx: Unix.Mutex_t );
  75. conSignal : PROCEDURE {REALTIME, C} ( cond: Unix.Condition_t );
  76. thrSleep : PROCEDURE {REALTIME, C} ( ms: LONGINT );
  77. thrThis : PROCEDURE {REALTIME, C} ( dummy: LONGINT ): Unix.Thread_t;
  78. logfile: LONGINT;
  79. traceHeap: BOOLEAN;
  80. timer0 : HUGEINT;
  81. (** Return current processor ID (0 to MaxNum-1). *)
  82. PROCEDURE {REALTIME} ID* (): LONGINT;
  83. BEGIN
  84. RETURN 0
  85. END ID;
  86. (* insert given memory block in sorted list of memory blocks, sort key is startAdr field - called during GC *)
  87. PROCEDURE InsertMemoryBlock(memBlock: MemoryBlock);
  88. VAR cur {UNTRACED}, prev {UNTRACED}: MemoryBlock;
  89. BEGIN
  90. cur := memBlockHead;
  91. prev := NIL;
  92. WHILE (cur # NIL) & (cur.startAdr < memBlock.startAdr) DO
  93. prev := cur;
  94. cur := cur.next
  95. END;
  96. IF prev = NIL THEN (* insert at head of list *)
  97. memBlock.next := memBlockHead;
  98. memBlockHead := memBlock
  99. ELSE (* insert in middle or at end of list *)
  100. prev.next := memBlock;
  101. memBlock.next := cur;
  102. IF cur = NIL THEN
  103. memBlockTail := memBlock
  104. END
  105. END
  106. END InsertMemoryBlock;
  107. (* Free unused memory block - called during GC *)
  108. PROCEDURE FreeMemBlock*(memBlock: MemoryBlock);
  109. VAR cur {UNTRACED}, prev {UNTRACED}: MemoryBlock;
  110. BEGIN
  111. cur := memBlockHead;
  112. prev := NIL;
  113. WHILE (cur # NIL) & (cur # memBlock) DO
  114. prev := cur;
  115. cur := cur.next
  116. END;
  117. IF cur = memBlock THEN
  118. IF traceHeap THEN
  119. Trace.String( "Release memory block " ); Trace.Hex( memBlock.startAdr, -8 ); Trace.Ln
  120. END;
  121. IF prev = NIL THEN
  122. memBlockHead := cur.next
  123. ELSE
  124. prev.next := cur.next;
  125. IF cur.next = NIL THEN
  126. memBlockTail := prev
  127. END
  128. END;
  129. Unix.free( memBlock.startAdr )
  130. ELSE
  131. HALT(535) (* error in memory block management *)
  132. END;
  133. END FreeMemBlock;
  134. (* expand heap by allocating a new memory block *)
  135. PROCEDURE ExpandHeap*( dummy: LONGINT; size: SIZE; VAR beginBlockAdr, endBlockAdr: ADDRESS );
  136. VAR mBlock: MemoryBlock; alloc, s: SIZE; a, adr: ADDRESS;
  137. BEGIN
  138. IF size < (MemBlockSize - (2*BlockSize)) THEN alloc := MemBlockSize
  139. ELSE alloc := size + (2*BlockSize);
  140. END;
  141. INC( alloc, (-alloc) MOD Unix.PageSize );
  142. IF Unix.posix_memalign( adr, Unix.PageSize, alloc ) # 0 THEN
  143. Unix.Perror( "Machine.ExpandHeap: posix_memalign" );
  144. beginBlockAdr := 0;
  145. endBlockAdr := 0
  146. ELSE
  147. IF Unix.mprotect( adr, alloc, 7 (* READ WRITE EXEC *) ) # 0 THEN
  148. Unix.Perror( "Machine.ExpandHeap: mprotect" )
  149. END;
  150. mBlock := S.VAL( MemoryBlock, adr );
  151. mBlock.next := NIL;
  152. mBlock.startAdr := adr;
  153. mBlock.size := alloc;
  154. mBlock.beginBlockAdr := adr + BlockSize - AddrSize;
  155. ASSERT( (mBlock.beginBlockAdr + AddrSize) MOD BlockSize = 0 );
  156. s := adr + alloc - mBlock.beginBlockAdr - BlockSize;
  157. DEC( s, s MOD BlockSize );
  158. ASSERT( s >= size );
  159. mBlock.endBlockAdr := mBlock.beginBlockAdr + s;
  160. InsertMemoryBlock( mBlock );
  161. IF traceHeap THEN TraceHeap( mBlock ) END;
  162. a := mBlock.beginBlockAdr;
  163. S.PUT( a, a + AddrSize ); (* tag *)
  164. S.PUT( a + AddrSize, s - AddrSize ); (* size *)
  165. S.PUT( a + AddrSize + SizeSize, S.VAL( ADDRESS, 0 ) ); (* next *)
  166. beginBlockAdr := mBlock.beginBlockAdr;
  167. endBlockAdr := mBlock.endBlockAdr;
  168. END
  169. END ExpandHeap;
  170. PROCEDURE TraceHeap( new: MemoryBlock );
  171. VAR cur{UNTRACED}: MemoryBlock;
  172. BEGIN
  173. Trace.Ln;
  174. Trace.String( "Heap expanded" ); Trace.Ln;
  175. cur := memBlockHead;
  176. WHILE cur # NIL DO
  177. Trace.Hex( cur.startAdr, -8 ); Trace.String( " " ); Trace.Int( cur.size, 15 );
  178. IF cur = new THEN Trace.String( " (new)" ) END;
  179. Trace.Ln;
  180. cur := cur.next
  181. END
  182. END TraceHeap;
  183. (* returns if an address is a currently allocated heap address *)
  184. PROCEDURE ValidHeapAddress*( p: ADDRESS ): BOOLEAN;
  185. VAR mb: MemoryBlock;
  186. BEGIN
  187. mb := memBlockHead;
  188. WHILE mb # NIL DO
  189. IF (p >= mb.beginBlockAdr) & (p <= mb.endBlockAdr) THEN RETURN TRUE END;
  190. mb := mb.next;
  191. END;
  192. RETURN FALSE
  193. END ValidHeapAddress;
  194. (** Return information on free memory in Kbytes. *)
  195. PROCEDURE GetFreeK*(VAR total, lowFree, highFree: SIZE);
  196. BEGIN
  197. (*! meaningless in Unix port, for interface compatibility only *)
  198. total := 0;
  199. lowFree := 0;
  200. highFree := 0
  201. END GetFreeK;
  202. (** Fill "size" bytes at "destAdr" with "filler". "size" must be multiple of 4. *)
  203. PROCEDURE {REALTIME} Fill32* (destAdr: ADDRESS; size: SIZE; filler: LONGINT);
  204. CODE {SYSTEM.i386}
  205. MOV EDI, [EBP+destAdr]
  206. MOV ECX, [EBP+size]
  207. MOV EAX, [EBP+filler]
  208. TEST ECX, 3
  209. JZ ok
  210. PUSH 8 ; ASSERT failure
  211. INT 3
  212. ok:
  213. SHR ECX, 2
  214. CLD
  215. REP STOSD
  216. END Fill32;
  217. PROCEDURE Portin8*(port: LONGINT; VAR val: CHAR);
  218. END Portin8;
  219. PROCEDURE Portin16*(port: LONGINT; VAR val: INTEGER);
  220. END Portin16;
  221. PROCEDURE Portin32*(port: LONGINT; VAR val: LONGINT);
  222. END Portin32;
  223. PROCEDURE Portout8*(port: LONGINT; val: CHAR);
  224. END Portout8;
  225. PROCEDURE Portout16*(port: LONGINT; val: INTEGER);
  226. END Portout16;
  227. PROCEDURE Portout32*(port: LONGINT; val: LONGINT);
  228. END Portout32;
  229. (** -- Atomic operations -- *)
  230. (** Atomic INC(x). *)
  231. PROCEDURE -AtomicInc*(VAR x: LONGINT);
  232. CODE {SYSTEM.i386}
  233. POP EAX
  234. LOCK
  235. INC DWORD [EAX]
  236. END AtomicInc;
  237. (** Atomic DEC(x). *)
  238. PROCEDURE -AtomicDec*(VAR x: LONGINT);
  239. CODE {SYSTEM.i386}
  240. POP EAX
  241. LOCK
  242. DEC DWORD [EAX]
  243. END AtomicDec;
  244. (** Atomic INC(x, y). *)
  245. PROCEDURE -AtomicAdd*(VAR x: LONGINT; y: LONGINT);
  246. CODE {SYSTEM.i386}
  247. POP EBX
  248. POP EAX
  249. LOCK
  250. ADD DWORD [EAX], EBX
  251. END AtomicAdd;
  252. (** Atomic EXCL. *)
  253. PROCEDURE AtomicExcl* (VAR s: SET; bit: LONGINT);
  254. CODE {SYSTEM.i386}
  255. MOV EAX, [EBP+bit]
  256. MOV EBX, [EBP+s]
  257. LOCK
  258. BTR [EBX], EAX
  259. END AtomicExcl;
  260. (** Atomic test-and-set. Set x = TRUE and return old value of x. *)
  261. PROCEDURE -AtomicTestSet*(VAR x: BOOLEAN): BOOLEAN;
  262. CODE {SYSTEM.i386}
  263. POP EBX
  264. MOV AL, 1
  265. XCHG [EBX], AL
  266. END AtomicTestSet;
  267. (* Atomic compare-and-swap. Set x = new if x = old and return old value of x *)
  268. PROCEDURE {REALTIME} -AtomicCAS* (VAR x: LONGINT; old, new: LONGINT): LONGINT;
  269. CODE {SYSTEM.i386}
  270. POP EBX ; new
  271. POP EAX ; old
  272. POP ECX ; address of x
  273. DB 0F0X, 00FX, 0B1X, 019X ; LOCK CMPXCHG [ECX], EBX; atomicly compare x with old and set it to new if equal
  274. END AtomicCAS;
  275. (* Return current instruction pointer *)
  276. PROCEDURE {REALTIME} CurrentPC* (): ADDRESS;
  277. CODE {SYSTEM.i386}
  278. MOV EAX, [EBP+4]
  279. END CurrentPC;
  280. (* Return current frame pointer *)
  281. PROCEDURE {REALTIME} -CurrentBP* (): ADDRESS;
  282. CODE {SYSTEM.i386}
  283. MOV EAX, EBP
  284. END CurrentBP;
  285. (* Set current frame pointer *)
  286. PROCEDURE {REALTIME} -SetBP* (bp: ADDRESS);
  287. CODE {SYSTEM.i386}
  288. POP EBP
  289. END SetBP;
  290. (* Return current stack pointer *)
  291. PROCEDURE {REALTIME} -CurrentSP* (): ADDRESS;
  292. CODE {SYSTEM.i386}
  293. MOV EAX, ESP
  294. END CurrentSP;
  295. (* Set current stack pointer *)
  296. PROCEDURE {REALTIME} -SetSP* (sp: ADDRESS);
  297. CODE {SYSTEM.i386}
  298. POP ESP
  299. END SetSP;
  300. PROCEDURE {REALTIME} -GetEAX*(): LONGINT;
  301. CODE{SYSTEM.i386}
  302. END GetEAX;
  303. PROCEDURE {REALTIME} -GetECX*(): LONGINT;
  304. CODE{SYSTEM.i386}
  305. MOV EAX,ECX
  306. END GetECX;
  307. PROCEDURE {REALTIME} -GetESI*(): LONGINT;
  308. CODE{SYSTEM.i386}
  309. MOV EAX,ESI
  310. END GetESI;
  311. PROCEDURE {REALTIME} -GetEDI*(): LONGINT;
  312. CODE{SYSTEM.i386}
  313. MOV EAX,EDI
  314. END GetEDI;
  315. PROCEDURE {REALTIME} -SetEAX*(n: LONGINT);
  316. CODE{SYSTEM.i386}
  317. POP EAX
  318. END SetEAX;
  319. PROCEDURE {REALTIME} -SetEBX*(n: LONGINT);
  320. CODE{SYSTEM.i386}
  321. POP EBX
  322. END SetEBX;
  323. PROCEDURE {REALTIME} -SetECX*(n: LONGINT);
  324. CODE{SYSTEM.i386}
  325. POP ECX
  326. END SetECX;
  327. PROCEDURE {REALTIME} -SetEDX*(n: LONGINT);
  328. CODE{SYSTEM.i386}
  329. POP EDX
  330. END SetEDX;
  331. PROCEDURE {REALTIME} -SetESI*(n: LONGINT);
  332. CODE{SYSTEM.i386}
  333. POP ESI
  334. END SetESI;
  335. PROCEDURE {REALTIME} -SetEDI*(n: LONGINT);
  336. CODE{SYSTEM.i386}
  337. POP EDI
  338. END SetEDI;
  339. PROCEDURE -GetTimer* (): HUGEINT;
  340. CODE {SYSTEM.Pentium}
  341. RDTSC ; set EDX:EAX
  342. END GetTimer;
  343. (** -- Configuration and bootstrapping -- *)
  344. (** Return the value of the configuration string specified by parameter name in parameter val. Returns val = "" if the string was not found, or has an empty value. *)
  345. PROCEDURE GetConfig* (CONST name: ARRAY OF CHAR; VAR val: ARRAY OF CHAR);
  346. VAR i, src: LONGINT; ch: CHAR;
  347. BEGIN
  348. ASSERT (name[0] # "="); (* no longer supported, use GetInit instead *)
  349. src := -1;
  350. LOOP
  351. REPEAT
  352. INC( src ); ch := config[src];
  353. IF ch = 0X THEN EXIT END;
  354. UNTIL ch > ' ';
  355. i := 0;
  356. LOOP
  357. ch := config[src];
  358. IF (ch # name[i]) OR (name[i] = 0X) THEN EXIT END;
  359. INC (i); INC (src)
  360. END;
  361. IF (ch <= ' ') & (name[i] = 0X) THEN (* found *)
  362. i := 0;
  363. REPEAT
  364. INC (src); ch := config[src]; val[i] := ch; INC (i);
  365. IF i = LEN(val) THEN val[i - 1] := 0X; RETURN END (* val too short *)
  366. UNTIL ch <= ' ';
  367. IF ch = ' ' THEN val[i -1] := 0X END;
  368. RETURN
  369. ELSE
  370. WHILE ch > ' ' DO (* skip to end of name *)
  371. INC (src); ch := config[src]
  372. END;
  373. INC (src);
  374. REPEAT (* skip to end of value *)
  375. ch := config[src]; INC (src)
  376. UNTIL ch <= ' '
  377. END
  378. END;
  379. val[0] := 0X
  380. END GetConfig;
  381. (** Convert a string to an integer. Parameter i specifies where in the string scanning should begin (usually 0 in the first call). Scanning stops at the first non-valid character, and i returns the updated position. Parameter s is the string to be scanned. The value is returned as result, or 0 if not valid. Syntax: number = ["-"] digit {digit} ["H" | "h"] . digit = "0" | ... "9" | "A" .. "F" | "a" .. "f" . If the number contains any hexdecimal letter, or if it ends in "H" or "h", it is interpreted as hexadecimal. *)
  382. PROCEDURE StrToInt* (VAR i: LONGINT; CONST s: ARRAY OF CHAR): LONGINT;
  383. VAR vd, vh, sgn, d: LONGINT; hex: BOOLEAN;
  384. BEGIN
  385. vd := 0; vh := 0; hex := FALSE;
  386. IF s[i] = "-" THEN sgn := -1; INC (i) ELSE sgn := 1 END;
  387. LOOP
  388. IF (s[i] >= "0") & (s[i] <= "9") THEN d := ORD (s[i])-ORD ("0")
  389. ELSIF (CAP (s[i]) >= "A") & (CAP (s[i]) <= "F") THEN d := ORD (CAP (s[i]))-ORD ("A") + 10; hex := TRUE
  390. ELSE EXIT
  391. END;
  392. vd := 10*vd + d; vh := 16*vh + d;
  393. INC (i)
  394. END;
  395. IF CAP (s[i]) = "H" THEN hex := TRUE; INC (i) END; (* optional H *)
  396. IF hex THEN vd := vh END;
  397. RETURN sgn * vd
  398. END StrToInt;
  399. (* function returning the number of processors that are available to Aos *)
  400. PROCEDURE NumberOfProcessors*( ): LONGINT;
  401. BEGIN
  402. RETURN 1
  403. END NumberOfProcessors;
  404. (*! non portable code, for native Aos only *)
  405. PROCEDURE SetNumberOfProcessors*( num: LONGINT );
  406. BEGIN
  407. (* numberOfProcessors := num; *)
  408. END SetNumberOfProcessors;
  409. (* function for changing byte order *)
  410. PROCEDURE ChangeByteOrder* (n: LONGINT): LONGINT;
  411. CODE { SYSTEM.i486 }
  412. MOV EAX, [EBP+n] ; load n in eax
  413. BSWAP EAX ; swap byte order
  414. END ChangeByteOrder;
  415. (* Send and print character *)
  416. PROCEDURE TraceChar *(c: CHAR);
  417. BEGIN
  418. Trace.Char( c )
  419. END TraceChar;
  420. (** CPU identification *)
  421. PROCEDURE CPUID*( VAR vendor: Vendor; VAR version: LONGINT; VAR features1,features2: SET );
  422. CODE {SYSTEM.i386, SYSTEM.Pentium}
  423. MOV EAX, 0
  424. CPUID
  425. CMP EAX, 0
  426. JNE ok
  427. MOV ESI, [EBP+vendor]
  428. MOV [ESI], AL ; AL = 0
  429. MOV ESI, [EBP+version]
  430. MOV [ESI], EAX ; EAX = 0
  431. MOV ESI, [EBP+features1]
  432. MOV [ESI], EAX
  433. MOV ESI, [EBP+features2]
  434. MOV [ESI], EAX
  435. JMP end
  436. ok:
  437. MOV ESI, [EBP+vendor]
  438. MOV [ESI], EBX
  439. MOV [ESI+4], EDX
  440. MOV [ESI+8], ECX
  441. MOV BYTE [ESI+12], 0
  442. MOV EAX, 1
  443. CPUID
  444. MOV ESI, [EBP+version]
  445. MOV [ESI], EAX
  446. MOV ESI, [EBP+features1]
  447. MOV [ESI], EDX
  448. MOV ESI, [EBP+features2]
  449. MOV [ESI], ECX
  450. end:
  451. END CPUID;
  452. (* If the CPUID instruction is supported, the ID flag (bit 21) of the EFLAGS register is r/w *)
  453. PROCEDURE CpuIdSupported( ) : BOOLEAN;
  454. CODE {SYSTEM.i386}
  455. PUSHFD ; save EFLAGS
  456. POP EAX ; store EFLAGS in EAX
  457. MOV EBX, EAX ; save EBX for later testing
  458. XOR EAX, 00200000H ; toggle bit 21
  459. PUSH EAX ; push to stack
  460. POPFD ; save changed EAX to EFLAGS
  461. PUSHFD ; push EFLAGS to TOS
  462. POP EAX ; store EFLAGS in EAX
  463. CMP EAX, EBX ; see if bit 21 has changed
  464. SETNE AL; ; return TRUE if bit 21 has changed, FALSE otherwise
  465. END CpuIdSupported;
  466. (* setup MMX, SSE and SSE2..SSE5 and AVX extension *)
  467. PROCEDURE SetupSSE2Ext;
  468. CONST
  469. MMXFlag=23;(*IN features from EBX*)
  470. FXSRFlag = 24;
  471. SSEFlag = 25;
  472. SSE2Flag = 26;
  473. SSE3Flag = 0; (*IN features2 from ECX*) (*PH 04/11*)
  474. SSSE3Flag =9;
  475. SSE41Flag =19;
  476. SSE42Flag =20;
  477. SSE5Flag = 11;
  478. AVXFlag = 28;
  479. BEGIN
  480. MMXSupport := MMXFlag IN features;
  481. SSESupport := SSEFlag IN features;
  482. SSE2Support := SSESupport & (SSE2Flag IN features);
  483. SSE3Support := SSE2Support & (SSE3Flag IN features2);
  484. SSSE3Support := SSE3Support & (SSSE3Flag IN features2); (* PH 04/11*)
  485. SSE41Support := SSE3Support & (SSE41Flag IN features2);
  486. SSE42Support := SSE3Support & (SSE42Flag IN features2);
  487. SSE5Support := SSE3Support & (SSE5Flag IN features2);
  488. AVXSupport := SSE3Support & (AVXFlag IN features2);
  489. IF SSESupport & (FXSRFlag IN features) THEN
  490. (* InitSSE(); *) (*! not privileged mode in Windows and Unix, not allowed *)
  491. END;
  492. END SetupSSE2Ext;
  493. (** -- Processor initialization -- *)
  494. PROCEDURE -SetFCR( s: SET );
  495. CODE {SYSTEM.i386, SYSTEM.FPU}
  496. FLDCW [ESP] ; parameter s
  497. POP EAX
  498. END SetFCR;
  499. PROCEDURE -FCR( ): SET;
  500. CODE {SYSTEM.i386, SYSTEM.FPU}
  501. PUSH 0
  502. FNSTCW [ESP]
  503. FWAIT
  504. POP EAX
  505. END FCR;
  506. PROCEDURE -InitFPU;
  507. CODE {SYSTEM.i386, SYSTEM.FPU}
  508. FNINIT
  509. END InitFPU;
  510. (** Setup FPU control word of current processor. *)
  511. PROCEDURE SetupFPU*;
  512. BEGIN
  513. InitFPU; SetFCR( fcr )
  514. END SetupFPU;
  515. (* Initialize locks. *)
  516. PROCEDURE InitLocks;
  517. VAR i: LONGINT;
  518. BEGIN
  519. i := 0;
  520. WHILE i < MaxLocks DO mtx[i] := mtxInit(0); INC( i ) END;
  521. END InitLocks;
  522. PROCEDURE CleanupLocks*;
  523. VAR i: LONGINT;
  524. BEGIN
  525. i := 0;
  526. WHILE i < MaxLocks DO mtxDestroy( mtx[i] ); INC( i ) END;
  527. END CleanupLocks;
  528. (** Acquire a spin-lock. *)
  529. PROCEDURE Acquire*( level: LONGINT ); (* non reentrant lock *)
  530. BEGIN
  531. mtxLock( mtx[level] );
  532. END Acquire;
  533. (** Release a spin-lock. *)
  534. PROCEDURE Release*( level: LONGINT );
  535. BEGIN
  536. mtxUnlock( mtx[level] );
  537. END Release;
  538. PROCEDURE AcquireGC*( ): BOOLEAN;
  539. VAR res: BOOLEAN;
  540. BEGIN
  541. mtxLock( mtx[GC] );
  542. IF ~GCacquired THEN GCacquired := TRUE; res := TRUE ELSE res := FALSE END;
  543. mtxUnlock( mtx[GC] );
  544. RETURN res
  545. END AcquireGC;
  546. (** Release a spin-lock. *)
  547. PROCEDURE ReleaseGC*;
  548. BEGIN
  549. mtxLock( mtx[GC] );
  550. GCacquired := FALSE;
  551. mtxUnlock( mtx[GC] )
  552. END ReleaseGC;
  553. PROCEDURE Shutdown*( reboot: BOOLEAN );
  554. VAR ignore: LONGINT;
  555. BEGIN
  556. ignore := Unix.close( logfile );
  557. IF reboot THEN Unix.exit( 0 ) ELSE Unix.exit( 1 ) END;
  558. END Shutdown;
  559. PROCEDURE InitHeap;
  560. VAR heapAdr, firstBlock: ADDRESS; size: SIZE;
  561. BEGIN
  562. Unix.Dlsym( 0, "heapAdr", ADDRESSOF( heapAdr ) );
  563. Unix.Dlsym( 0, "heapSize", ADDRESSOF( size ) );
  564. firstBlock := heapAdr + ((-heapAdr - AddrSize) MOD BlockSize);
  565. size := heapAdr + size - BlockSize - firstBlock; DEC( size, size MOD BlockSize + BlockSize );
  566. firstMemBlock.next := NIL;
  567. firstMemBlock.startAdr := heapAdr;
  568. firstMemBlock.beginBlockAdr := firstBlock;
  569. firstMemBlock.endBlockAdr := firstBlock + size;
  570. firstMemBlock.size := size;
  571. memBlockHead := S.VAL( MemoryBlock, ADDRESSOF( firstMemBlock ) );
  572. memBlockTail := memBlockHead;
  573. END InitHeap;
  574. PROCEDURE InitConfig;
  575. VAR a: ADDRESS; i: LONGINT; c: CHAR;
  576. BEGIN
  577. a := Unix.getenv( ADDRESSOF( "AOSCONFIG" ) );
  578. IF a = 0 THEN config := DefaultConfig
  579. ELSE
  580. REPEAT
  581. S.GET( a, c ); INC( a ); config[i] := c; INC( i )
  582. UNTIL c = 0X
  583. END
  584. END InitConfig;
  585. PROCEDURE UpdateTicks*;
  586. BEGIN
  587. ticks := SHORT( (GetTimer() - timer0) DIV (mhz * 1000) );
  588. END UpdateTicks;
  589. PROCEDURE InitThreads;
  590. VAR res: BOOLEAN;
  591. BEGIN
  592. res := thrInitialize( prioLow, prioHigh );
  593. IF ~res THEN
  594. Trace.StringLn( "Machine.InitThreads: no threads support in boot environment. teminating" );
  595. Unix.exit( 1 )
  596. END;
  597. IF Glue.debug # {} THEN
  598. Trace.String( "Threads initialized, priorities low, high: " );
  599. Trace.Int( prioLow, 0 ); Trace.String( ", " ); Trace.Int( prioHigh, 0 );
  600. Trace.Ln
  601. END
  602. END InitThreads;
  603. PROCEDURE CPUSpeed;
  604. VAR t0, t1: HUGEINT;
  605. BEGIN
  606. t0 := GetTimer(); thrSleep( 100 ); t1 := GetTimer();
  607. mhz := (t1 - t0) DIV 100000;
  608. IF Glue.debug # {} THEN
  609. Trace.String( "CPU speed: ~" ); Trace.Int( SHORT( mhz ), 0); Trace.String( " MHz" ); Trace.Ln
  610. END
  611. END CPUSpeed;
  612. PROCEDURE Log( c: CHAR );
  613. VAR ignore: LONGINT;
  614. BEGIN
  615. ignore := Unix.write( 1, ADDRESSOF( c ), 1 );
  616. ignore := Unix.write( logfile, ADDRESSOF( c ), 1 );
  617. END Log;
  618. PROCEDURE LogFileOnly( c: CHAR );
  619. VAR ignore: LONGINT;
  620. BEGIN
  621. ignore := Unix.write( logfile, ADDRESSOF( c ), 1 );
  622. END LogFileOnly;
  623. PROCEDURE InitLog;
  624. VAR name, cmd: ARRAY 32 OF CHAR; pid, i: LONGINT;
  625. BEGIN
  626. name := "AOS.xxxxx.Log";
  627. pid := Unix.getpid(); i := 8;
  628. REPEAT
  629. name[i] := CHR( pid MOD 10 + ORD( '0' ) ); DEC( i );
  630. pid := pid DIV 10;
  631. UNTIL i = 3;
  632. logfile := Unix.open( ADDRESSOF( name ), Unix.rdwr + Unix.creat + Unix.trunc, Unix.rwrwr );
  633. IF Unix.argc > 2 THEN
  634. Unix.GetArgval( "-x", cmd );
  635. IF cmd # "" THEN SilentLog; standaloneAppl := TRUE
  636. ELSE VerboseLog
  637. END
  638. ELSE
  639. VerboseLog
  640. END
  641. END InitLog;
  642. PROCEDURE SilentLog*;
  643. BEGIN
  644. Trace.Char := LogFileOnly
  645. END SilentLog;
  646. PROCEDURE VerboseLog*;
  647. BEGIN
  648. Trace.Char := Log
  649. END VerboseLog;
  650. PROCEDURE Append( VAR a: ARRAY OF CHAR; CONST this: ARRAY OF CHAR );
  651. VAR i, j: LONGINT;
  652. BEGIN
  653. i := 0; j := 0;
  654. WHILE a[i] # 0X DO INC( i ) END;
  655. WHILE (i < LEN( a ) - 1) & (this[j] # 0X) DO a[i] := this[j]; INC( i ); INC( j ) END;
  656. a[i] := 0X
  657. END Append;
  658. PROCEDURE Init;
  659. VAR vendor: Vendor; ver: LONGINT;
  660. BEGIN
  661. Unix.Dlsym( 0, "thrInitialize", ADDRESSOF( thrInitialize ) );
  662. Unix.Dlsym( 0, "mtxInit", ADDRESSOF( mtxInit ) );
  663. Unix.Dlsym( 0, "mtxDestroy", ADDRESSOF( mtxDestroy ) );
  664. Unix.Dlsym( 0, "mtxLock", ADDRESSOF( mtxLock ) );
  665. Unix.Dlsym( 0, "mtxUnlock", ADDRESSOF( mtxUnlock ) );
  666. Unix.Dlsym( 0, "conInit", ADDRESSOF( conInit ) );
  667. Unix.Dlsym( 0, "conDestroy", ADDRESSOF( conDestroy ) );
  668. Unix.Dlsym( 0, "conWait", ADDRESSOF( conWait ) );
  669. Unix.Dlsym( 0, "conSignal", ADDRESSOF( conSignal ) );
  670. Unix.Dlsym( 0, "thrSleep", ADDRESSOF( thrSleep ) );
  671. Unix.Dlsym( 0, "thrThis", ADDRESSOF( thrThis ) );
  672. standaloneAppl := FALSE;
  673. COPY( Unix.Version, version ); Append( version, Version );
  674. timer0 := GetTimer( ); ticks := 0;
  675. InitThreads;
  676. InitLocks;
  677. traceHeap := 1 IN Glue.debug;
  678. InitHeap;
  679. InitConfig;
  680. InitLog;
  681. CPUSpeed;
  682. IF CpuIdSupported() THEN
  683. CPUID( vendor, ver, features, features2 ); SetupSSE2Ext
  684. END;
  685. fcr := (FCR() - {0,2,3,10,11}) + {0..5,8,9}; (* default FCR RC=00B *)
  686. END Init;
  687. BEGIN
  688. Init
  689. END Machine.
  690. (*
  691. 03.03.1998 pjm First version
  692. 30.06.1999 pjm ProcessorID moved to AosProcessor
  693. *)
  694. (**
  695. Notes
  696. This module defines an interface to the boot environment of the system. The facilities provided here are only intended for the lowest levels of the system, and should never be directly imported by user modules (exceptions are noted below). They are highly specific to the system hardware and firmware architecture.
  697. Typically a machine has some type of firmware that performs initial testing and setup of the system. The firmware initiates the operating system bootstrap loader, which loads the boot file. This module is the first module in the statically linked boot file that gets control.
  698. There are two more-or-less general procedures in this module: GetConfig and StrToInt. GetConfig is used to query low-level system settings, e.g., the location of the boot file system. StrToInt is a utility procedure that parses numeric strings.
  699. Config strings:
  700. ExtMemSize Specifies size of extended memory (above 1MB) in MB. This value is not checked for validity. Setting it false may cause the system to fail, possible after running for some time. The memory size is usually detected automatically, but if the detection does not work for some reason, or if you want to limit the amount of memory detected, this string can be set. For example, if the machine has 64MB of memory, this value can be set as ExtMemSize="63".
  701. *)