Subversion Repositories Kolibri OS

Rev

Rev 490 | Rev 520 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
425 victor 1
$Revision: 519 $
431 serge 2
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
3
;;                                                              ;;
4
;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;;
5
;; Distributed under terms of the GNU General Public License    ;;
6
;;                                                              ;;
7
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
164 serge 8
 
9
align 4
10
proc alloc_page
11
 
12
           pushfd
13
           cli
14
           mov ebx, [page_start]
15
           mov ecx, [page_end]
16
.l1:
17
           bsf eax,[ebx];
18
           jnz .found
19
           add ebx,4
20
           cmp ebx, ecx
21
           jb .l1
22
           popfd
23
           xor eax,eax
24
           ret
25
.found:
26
           btr [ebx], eax
27
           mov [page_start],ebx
28
           sub ebx, sys_pgmap
254 serge 29
           lea eax, [eax+ebx*8]
164 serge 30
           shl eax, 12
31
           dec [pg_data.pages_free]
32
           popfd
33
           ret
34
endp
35
 
36
align 4
37
proc alloc_pages stdcall, count:dword
38
           pushfd
39
           cli
40
           mov eax, [count]
41
           add eax, 7
42
           shr eax, 3
43
           mov [count], eax
44
           cmp eax, [pg_data.pages_free]
45
           ja .fail
46
 
47
           mov ecx, [page_start]
48
           mov ebx, [page_end]
49
.find:
50
           mov edx, [count]
51
           mov edi, ecx
52
.match:
53
           cmp byte [ecx], 0xFF
54
           jne .next
55
           dec edx
56
           jz .ok
57
           inc ecx
58
           cmp ecx,ebx
59
           jb .match
60
.fail:     xor eax, eax
61
           popfd
62
           ret
63
.next:
64
           inc ecx
65
           cmp ecx, ebx
66
           jb .find
67
           popfd
68
           xor eax, eax
69
           ret
70
.ok:
71
           sub ecx, edi
72
           inc ecx
73
           mov esi, edi
74
           xor eax, eax
75
           rep stosb
76
           sub esi, sys_pgmap
77
           shl esi, 3+12
78
           mov eax, esi
79
           mov ebx, [count]
80
           shl ebx, 3
81
           sub [pg_data.pages_free], ebx
82
           popfd
83
           ret
84
endp
85
 
86
align 4
87
proc map_page stdcall,lin_addr:dword,phis_addr:dword,flags:dword
321 diamond 88
           push ebx
164 serge 89
           mov eax, [phis_addr]
90
           and eax, not 0xFFF
91
           or eax, [flags]
92
           mov ebx, [lin_addr]
93
           shr ebx, 12
365 serge 94
           mov [page_tabs+ebx*4], eax
164 serge 95
           mov eax, [lin_addr]
96
           invlpg [eax]
321 diamond 97
           pop ebx
164 serge 98
           ret
99
endp
100
 
101
align 4
281 serge 102
map_space:    ;not implemented
103
 
104
 
105
           ret
106
 
107
 
108
align 4
164 serge 109
proc free_page
110
;arg:  eax  page address
111
           pushfd
112
           cli
113
           shr eax, 12              ;page index
448 diamond 114
           bts dword [sys_pgmap], eax           ;that's all!
291 serge 115
           cmc
328 serge 116
           adc [pg_data.pages_free], 0
164 serge 117
           shr eax, 3
118
           and eax, not 3           ;dword offset from page_map
448 diamond 119
           add eax, sys_pgmap
164 serge 120
           cmp [page_start], eax
121
           ja @f
122
           popfd
123
           ret
124
@@:
125
           mov [page_start], eax
126
           popfd
127
           ret
128
endp
129
 
279 serge 130
; param
328 serge 131
;  eax= page base + page flags
281 serge 132
;  ebx= liear address
133
;  ecx= count
134
 
135
align 4
328 serge 136
commit_pages:
281 serge 137
 
328 serge 138
           test ecx, ecx
139
           jz .fail
281 serge 140
 
328 serge 141
           mov edi, ebx
142
           mov ebx, pg_data.pg_mutex
143
           call wait_mutex      ;ebx
144
 
145
           mov edx, 0x1000
146
           mov ebx, edi
147
           shr ebx, 12
148
@@:
365 serge 149
           mov [page_tabs+ebx*4], eax
328 serge 150
           invlpg [edi]
151
           add edi, edx
152
           add eax, edx
153
           inc ebx
154
           dec ecx
155
           jnz @B
156
           mov [pg_data.pg_mutex],ecx
157
.fail:
281 serge 158
           ret
159
 
328 serge 160
 
281 serge 161
; param
279 serge 162
;  eax= base
281 serge 163
;  ecx= count
279 serge 164
 
164 serge 165
align 4
279 serge 166
release_pages:
321 diamond 167
 
168
           pushad
279 serge 169
           mov ebx, pg_data.pg_mutex
170
           call wait_mutex      ;ebx
171
 
172
           mov esi, eax
173
           mov edi, eax
174
 
175
           shr esi, 10
365 serge 176
           add esi, page_tabs
328 serge 177
 
178
           mov ebp, [pg_data.pages_free]
279 serge 179
           mov ebx, [page_start]
180
           mov edx, sys_pgmap
181
@@:
182
           xor eax, eax
183
           xchg eax, [esi]
184
           invlpg [edi]
185
 
186
           test eax, 1
187
           jz .next
188
 
189
           shr eax, 12
190
           bts [edx], eax
291 serge 191
           cmc
328 serge 192
           adc ebp, 0
279 serge 193
           shr eax, 3
194
           and eax, -4
195
           add eax, edx
196
           cmp eax, ebx
197
           jae .next
198
 
199
           mov ebx, eax
200
.next:
201
           add edi, 0x1000
202
           add esi, 4
203
           dec ecx
204
           jnz @B
328 serge 205
           mov [pg_data.pages_free], ebp
279 serge 206
           and [pg_data.pg_mutex],0
321 diamond 207
           popad
279 serge 208
           ret
209
 
210
align 4
188 serge 211
proc map_page_table stdcall, lin_addr:dword, phis_addr:dword
321 diamond 212
           push ebx
164 serge 213
           mov ebx, [lin_addr]
214
           shr ebx, 22
215
           mov eax, [phis_addr]
216
           and eax, not 0xFFF
217
           or eax, PG_UW          ;+PG_NOCACHE
378 serge 218
           mov dword [master_tab+ebx*4], eax
164 serge 219
           mov eax, [lin_addr]
220
           shr eax, 10
365 serge 221
           add eax, page_tabs
164 serge 222
           invlpg [eax]
321 diamond 223
           pop ebx
164 serge 224
           ret
225
endp
226
 
227
align 4
228
proc init_LFB
378 serge 229
           locals
230
             pg_count dd ?
231
           endl
232
 
164 serge 233
           cmp dword [LFBAddress], -1
234
           jne @f
412 serge 235
           mov [BOOT_VAR+0x901c],byte 2
164 serge 236
           stdcall kernel_alloc, 0x280000
237
           mov [LFBAddress], eax
238
           ret
239
@@:
240
           test [SCR_MODE],word 0100000000000000b
211 serge 241
           jnz @f
412 serge 242
           mov [BOOT_VAR+0x901c],byte 2
211 serge 243
           ret
244
@@:
490 serge 245
           call init_mtrr
246
 
378 serge 247
           mov edx, LFB_BASE
248
           mov esi, [LFBAddress]
465 serge 249
           mov edi, 0x00800000
379 serge 250
           mov dword [exp_lfb+4], edx
214 serge 251
 
164 serge 252
           shr edi, 12
253
           mov [pg_count], edi
254
           shr edi, 10
255
 
256
           bt [cpu_caps], CAPS_PSE
257
           jnc .map_page_tables
258
           or esi, PG_LARGE+PG_UW
465 serge 259
           mov edx, sys_pgdir+(LFB_BASE shr 20)
164 serge 260
@@:
465 serge 261
           mov [edx], esi
378 serge 262
           add edx, 4
164 serge 263
           add esi, 0x00400000
264
           dec edi
265
           jnz @B
266
 
207 serge 267
           bt [cpu_caps], CAPS_PGE
268
           jnc @F
465 serge 269
           or dword [sys_pgdir+(LFB_BASE shr 20)], PG_GLOBAL
207 serge 270
@@:
378 serge 271
           mov dword [LFBAddress], LFB_BASE
164 serge 272
           mov eax, cr3       ;flush TLB
273
           mov cr3, eax
274
           ret
275
 
276
.map_page_tables:
277
 
465 serge 278
@@:
164 serge 279
           call alloc_page
378 serge 280
           stdcall map_page_table, edx, eax
389 serge 281
           add edx, 0x00400000
164 serge 282
           dec edi
465 serge 283
           jnz @B
164 serge 284
 
285
           mov eax, [LFBAddress]
378 serge 286
           mov edi, page_tabs + (LFB_BASE shr 10)
164 serge 287
           or eax, PG_UW
288
           mov ecx, [pg_count]
378 serge 289
           cld
389 serge 290
@@:
291
           stosd
292
           add eax, 0x1000
293
           dec ecx
294
           jnz @B
164 serge 295
 
378 serge 296
           mov dword [LFBAddress], LFB_BASE
164 serge 297
           mov eax, cr3       ;flush TLB
298
           mov cr3, eax
299
 
300
           ret
301
endp
302
 
303
align 4
304
proc new_mem_resize stdcall, new_size:dword
305
 
276 serge 306
           mov ebx, pg_data.pg_mutex
307
           call wait_mutex    ;ebx
164 serge 308
 
309
           mov edi, [new_size]
310
           add edi,4095
311
           and edi,not 4095
312
           mov [new_size], edi
313
 
465 serge 314
           mov edx,[current_slot]
315
           cmp [edx+APPDATA.heap_base],0
172 serge 316
           jne .exit
317
 
465 serge 318
           mov esi, [edx+APPDATA.mem_size]
164 serge 319
           add esi, 4095
320
           and esi, not 4095
321
 
322
           cmp edi, esi
323
           jae .expand
324
 
325
           shr edi, 12
326
           shr esi, 12
327
@@:
378 serge 328
           mov eax, [app_page_tabs+edi*4]
164 serge 329
           test eax, 1
330
           jz .next
378 serge 331
           mov dword [app_page_tabs+edi*4], 2
164 serge 332
           mov ebx, edi
333
           shl ebx, 12
334
           invlpg [ebx+std_application_base_address]
335
           call free_page
336
 
337
.next:     add edi, 1
338
           cmp edi, esi
339
           jb @B
340
 
341
.update_size:
465 serge 342
           mov     ebx, [new_size]
343
           call    update_mem_size
164 serge 344
 
345
           xor eax, eax
346
           dec [pg_data.pg_mutex]
347
           ret
348
.expand:
349
 
350
           push esi
351
           push edi
352
 
353
           add edi, 0x3FFFFF
354
           and edi, not(0x3FFFFF)
355
           add esi, 0x3FFFFF
356
           and esi, not(0x3FFFFF)
357
 
358
           cmp esi, edi
359
           jae .grow
360
 
361
           xchg esi, edi
362
 
363
@@:
364
           call alloc_page
365
           test eax, eax
366
           jz .exit
367
 
188 serge 368
           stdcall map_page_table, edi, eax
164 serge 369
 
370
           push edi
371
           shr edi, 10
365 serge 372
           add edi, page_tabs
164 serge 373
           mov ecx, 1024
374
           xor eax, eax
375
           cld
376
           rep stosd
377
           pop edi
378
 
379
           add edi, 0x00400000
380
           cmp edi, esi
381
           jb @B
382
.grow:
383
           pop edi
384
           pop esi
385
@@:
386
           call alloc_page
387
           test eax, eax
388
           jz .exit
389
           stdcall map_page,esi,eax,dword PG_UW
390
 
391
           push edi
392
           mov edi, esi
393
           xor eax, eax
394
           mov ecx, 1024
395
           cld
396
           rep stosd
397
           pop edi
398
 
399
           add esi, 0x1000
400
           cmp esi, edi
294 diamond 401
           jb  @B
164 serge 402
 
403
           jmp .update_size
404
.exit:
405
           xor eax, eax
406
           inc eax
407
           dec [pg_data.pg_mutex]
408
           ret
409
endp
410
 
294 diamond 411
update_mem_size:
465 serge 412
; in: edx = slot base
294 diamond 413
;     ebx = new memory size
414
; destroys eax,ecx,edx
415
 
465 serge 416
           mov    [APPDATA.mem_size+edx],ebx
294 diamond 417
;search threads and update
418
;application memory size infomation
465 serge 419
           mov    ecx,[APPDATA.dir_table+edx]
294 diamond 420
           mov    eax,2
421
 
422
.search_threads:
423
;eax = current slot
424
;ebx = new memory size
425
;ecx = page directory
426
           cmp    eax,[TASK_COUNT]
427
           jg     .search_threads_end
428
           mov    edx,eax
429
           shl    edx,5
430
           cmp    word [CURRENT_TASK+edx+TASKDATA.state],9 ;if slot empty?
431
           jz     .search_threads_next
432
           shl    edx,3
380 serge 433
           cmp    [SLOT_BASE+edx+APPDATA.dir_table],ecx     ;if it is our thread?
294 diamond 434
           jnz    .search_threads_next
380 serge 435
           mov    [SLOT_BASE+edx+APPDATA.mem_size],ebx     ;update memory size
294 diamond 436
.search_threads_next:
437
           inc    eax
438
           jmp    .search_threads
439
.search_threads_end:
440
           ret
441
 
285 serge 442
; param
443
;  eax= linear address
444
;
445
; retval
446
;  eax= phisical page address
447
 
164 serge 448
align 4
285 serge 449
get_pg_addr:
450
           shr eax, 12
365 serge 451
           mov eax, [page_tabs+eax*4]
164 serge 452
           and eax, 0xFFFFF000
453
           ret
454
 
465 serge 455
 
188 serge 456
align 4
164 serge 457
proc page_fault_handler
465 serge 458
 
459
        .err_code equ ebp+32
460
        .err_addr equ ebp-4
461
 
164 serge 462
           pushad
463
           mov ebp, esp
464
           mov eax, cr2
172 serge 465
           push eax
164 serge 466
 
465 serge 467
           mov ax, app_data
164 serge 468
           mov ds, ax
188 serge 469
           mov es, ax
164 serge 470
 
188 serge 471
           inc [pg_data.pages_faults]
472
 
465 serge 473
;     push eax
474
;     push edx
475
;     mov edx, 0x400   ;bochs
476
;     mov al,0xff      ;bochs
477
;     out dx, al       ;bochs
478
;     pop edx
479
;     pop eax
164 serge 480
 
465 serge 481
           mov ebx, [.err_addr]
482
           mov eax, [.err_code]
164 serge 483
 
465 serge 484
           cmp ebx, OS_BASE
485
           jb .user_space      ;ñòðàíèöà â ïàìÿòè ïðèëîæåíèÿ ;
188 serge 486
 
378 serge 487
           cmp ebx, page_tabs
465 serge 488
           jb .kernel_space    ;ñòðàíèöà â ïàìÿòè ÿäðà
164 serge 489
 
465 serge 490
           cmp ebx, kernel_tabs
491
           jb .alloc;.app_tabs ;òàáëèöû ñòðàíèö ïðèëîæåíèÿ ;
492
                               ;ïðîñòî ñîçäàäèì îäíó
378 serge 493
 
465 serge 494
           cmp ebx, LFB_BASE
495
           jb .core_tabs       ;òàáëèöû ñòðàíèö ÿäðà
496
                               ;Îøèáêà
497
.lfb:
498
                               ;îáëàñòü LFB
499
                               ;Îøèáêà
500
           jmp .fail
164 serge 501
 
465 serge 502
align 4
164 serge 503
.user_space:
465 serge 504
           test eax, PG_MAP
505
           jnz .err_access     ;Ñòðàíèöà ïðèñóòñòâóåò
506
                               ;Îøèáêà äîñòóïà ?
507
 
164 serge 508
           shr ebx, 12
172 serge 509
           mov ecx, ebx
510
           shr ecx, 10
511
           mov edx, [master_tab+ecx*4]
465 serge 512
           test edx, PG_MAP
513
           jz .fail            ;òàáëèöà ñòðàíèö íå ñîçäàíà
514
                               ;íåâåðíûé àäðåñ â ïðîãðàììå
172 serge 515
 
365 serge 516
           mov eax, [page_tabs+ebx*4]
164 serge 517
           test eax, 2
465 serge 518
           jz .fail            ;àäðåñ íå çàðåçåðâèðîâàí äëÿ ;
519
                               ;èñïîëüçîâàíèÿ. Îøèáêà
188 serge 520
.alloc:
164 serge 521
           call alloc_page
522
           and eax, eax
465 serge 523
           jz .fail
164 serge 524
 
525
           stdcall map_page,[ebp-4],eax,dword PG_UW
526
 
188 serge 527
           mov edi, [ebp-4]
528
           and edi, 0xFFFFF000
164 serge 529
           mov ecx, 1024
530
           xor eax, eax
188 serge 531
           cld
532
           rep stosd
164 serge 533
.exit:
534
           mov esp, ebp
535
           popad
536
           add esp, 4
537
           iretd
465 serge 538
 
539
.err_access:
540
;íèêîãäà íå ïðîèñõîäèò
541
           jmp .fail
542
 
543
.kernel_space:
544
           test eax, PG_MAP
545
           jz .fail        ;ñòðàíèöà íå ïðèñóòñòâóåò
546
 
547
           test eax, 4     ;U/S
548
           jnz .fail       ;ïðèëîæåíèå îáðàòèëîñü ê ïàìÿòè
549
                           ;ÿäðà
550
           test eax, 8
551
           jnz .fail       ;óñòàíîâëåí çàðåçåðâèðîâàííûé áèò
552
                           ;â òàáëèöàõ ñòðàíèö. äîáàâëåíî â P4/Xeon
553
 
554
;ïîïûòêà çàïèñè â çàùèù¸ííóþ ñòðàíèöó ÿäðà
555
 
556
           cmp ebx, tss._io_map_0
557
           jb .fail
558
 
559
           cmp ebx, tss._io_map_0+8192
560
           jae .fail
561
 
562
; io permission map
563
; copy-on-write protection
564
 
565
           call alloc_page
566
           and eax, eax
567
           jz .fail
568
 
569
           push eax
570
           stdcall map_page,[ebp-4],eax,dword PG_SW
571
           pop eax
572
           mov edi, [.err_addr]
573
           and edi, -4096
574
           lea esi, [edi+(not tss._io_map_0)+1]; -tss._io_map_0
575
 
576
           mov ebx, esi
577
           shr ebx, 12
578
           mov edx, [current_slot]
579
           or eax, PG_SW
580
           mov [edx+APPDATA.io_map+ebx*4], eax
581
 
582
           add esi, [default_io_map]
583
           mov ecx, 4096/4
584
           cld
585
           rep movsd
586
           jmp .exit
587
 
588
 
589
;íå îáðàáàòûâàåì. Îøèáêà
590
 
591
.core_tabs:
172 serge 592
.fail:
593
           mov esp, ebp
594
           popad
595
           add esp, 4
164 serge 596
 
465 serge 597
;           iretd
598
 
172 serge 599
           save_ring3_context     ;debugger support
600
 
601
           mov bl, 14
602
           jmp exc_c
603
           iretd
164 serge 604
endp
605
 
606
align 4
607
proc map_mem stdcall, lin_addr:dword,pdir:dword,\
608
                      ofs:dword,buf_size:dword
609
           mov eax, [buf_size]
610
           test eax, eax
611
           jz .exit
612
 
613
           mov eax, [pdir]
614
           and eax, 0xFFFFF000
615
 
616
           stdcall map_page,[ipc_pdir],eax,dword PG_UW
617
           mov ebx, [ofs]
618
           shr ebx, 22
619
           mov esi, [ipc_pdir]
620
           mov edi, [ipc_ptab]
621
           mov eax, [esi+ebx*4]
622
           and eax, 0xFFFFF000
623
           test eax, eax
624
           jz .exit
625
           stdcall map_page,edi,eax,dword PG_UW
626
;           inc ebx
627
;           add edi, 0x1000
628
;           mov eax, [esi+ebx*4]
629
;           test eax, eax
630
;           jz @f
631
;          and eax, 0xFFFFF000
632
;           stdcall map_page, edi, eax
633
 
634
@@:        mov edi, [lin_addr]
635
           and edi, 0xFFFFF000
636
           mov ecx, [buf_size]
637
           add ecx, 4095
638
           shr ecx, 12
639
           inc ecx
640
 
641
           mov edx, [ofs]
642
           shr edx, 12
643
           and edx, 0x3FF
644
           mov esi, [ipc_ptab]
645
 
646
.map:      mov eax, [esi+edx*4]
647
           and eax, 0xFFFFF000
648
           test eax, eax
649
           jz .exit
650
           stdcall map_page,edi,eax,dword PG_UW
651
           add edi, 0x1000
652
           inc edx
653
           dec ecx
654
           jnz .map
655
 
656
.exit:
657
           ret
658
endp
659
 
660
align 4
661
proc map_memEx stdcall, lin_addr:dword,pdir:dword,\
662
                        ofs:dword,buf_size:dword
663
           mov eax, [buf_size]
664
           test eax, eax
665
           jz .exit
666
 
667
           mov eax, [pdir]
668
           and eax, 0xFFFFF000
669
 
670
           stdcall map_page,[proc_mem_pdir],eax,dword PG_UW
671
           mov ebx, [ofs]
672
           shr ebx, 22
673
           mov esi, [proc_mem_pdir]
674
           mov edi, [proc_mem_tab]
675
           mov eax, [esi+ebx*4]
676
           and eax, 0xFFFFF000
677
           test eax, eax
678
           jz .exit
679
           stdcall map_page,edi,eax,dword PG_UW
680
 
681
@@:        mov edi, [lin_addr]
682
           and edi, 0xFFFFF000
683
           mov ecx, [buf_size]
684
           add ecx, 4095
685
           shr ecx, 12
686
           inc ecx
687
 
688
           mov edx, [ofs]
689
           shr edx, 12
690
           and edx, 0x3FF
691
           mov esi, [proc_mem_tab]
692
 
693
.map:      mov eax, [esi+edx*4]
694
;           and eax, 0xFFFFF000
695
;           test eax, eax
696
;           jz .exit
697
           stdcall map_page,edi,eax,dword PG_UW
698
           add edi, 0x1000
699
           inc edx
700
           dec ecx
701
           jnz .map
702
.exit:
703
           ret
704
endp
705
 
706
 
707
 
708
 
709
sys_IPC:
710
;input:
711
;  eax=1 - set ipc buffer area
712
;    ebx=address of buffer
713
;    ecx=size of buffer
714
;  eax=2 - send message
715
;    ebx=PID
716
;    ecx=address of message
717
;    edx=size of message
718
 
719
           cmp  eax,1
720
           jne @f
721
           call set_ipc_buff
722
           mov [esp+36], eax
723
           ret
724
@@:
725
           cmp eax, 2
726
           jne @f
727
           stdcall sys_ipc_send, ebx, ecx, edx
728
           mov [esp+36], eax
729
           ret
730
@@:
731
           xor eax, eax
732
           not eax
733
           mov [esp+36], eax
734
           ret
735
 
736
align 4
737
proc set_ipc_buff
738
 
465 serge 739
           mov  eax,[current_slot]
164 serge 740
           pushf
741
           cli
465 serge 742
           mov  [eax+APPDATA.ipc_start],ebx     ;set fields in extended information area
743
           mov  [eax+APPDATA.ipc_size],ecx
164 serge 744
 
745
           add ecx, ebx
746
           add ecx, 4095
747
           and ecx, not 4095
748
 
749
.touch:    mov eax, [ebx]
750
           add ebx, 0x1000
751
           cmp ebx, ecx
752
           jna .touch
753
 
754
           popf
755
           xor eax, eax
756
           ret
757
endp
758
 
759
proc sys_ipc_send stdcall, PID:dword, msg_addr:dword, msg_size:dword
760
           locals
761
             dst_slot   dd ?
762
             dst_offset dd ?
763
             buf_size   dd ?
764
           endl
765
 
766
           pushf
767
           cli
768
 
769
           mov  eax, [PID]
770
           call pid_to_slot
771
           test eax,eax
772
           jz   .no_pid
773
 
774
           mov [dst_slot], eax
775
           shl  eax,8
380 serge 776
           mov  edi,[eax+SLOT_BASE+0xa0]  ;is ipc area defined?
164 serge 777
           test edi,edi
778
           jz   .no_ipc_area
779
 
780
           mov ebx, edi
465 serge 781
       ;    add edi, new_app_base
164 serge 782
           and ebx, 0xFFF
783
           mov [dst_offset], ebx
784
 
380 serge 785
           mov esi, [eax+SLOT_BASE+0xa4]
164 serge 786
           mov [buf_size], esi
787
 
380 serge 788
           stdcall map_mem, [ipc_tmp], [SLOT_BASE+eax+0xB8],\
164 serge 789
                             edi, esi
790
 
791
           mov edi, [dst_offset]
792
           add edi, [ipc_tmp]
793
           cmp dword [edi], 0
794
           jnz  .ipc_blocked          ;if dword [buffer]<>0 - ipc blocked now
227 serge 795
 
164 serge 796
           mov ebx, dword [edi+4]
797
           mov edx, ebx
798
           add ebx, 8
799
           add ebx, [msg_size]
800
           cmp ebx, [buf_size]
801
           ja .buffer_overflow         ;esi<0 - not enough memory in buffer
227 serge 802
 
164 serge 803
           mov dword [edi+4], ebx
804
           mov eax,[TASK_BASE]
805
           mov eax, [eax+0x04]         ;eax - our PID
806
           mov edi, [dst_offset]
807
           add edi, [ipc_tmp]
808
           add edi, edx
809
           mov [edi], eax
810
           mov ecx, [msg_size]
811
 
812
           mov [edi+4], ecx
813
           add edi, 8
814
           mov esi, [msg_addr]
465 serge 815
       ;    add esi, new_app_base
164 serge 816
           cld
817
           rep movsb
818
 
819
           mov ebx, [ipc_tmp]
820
           mov edx, ebx
821
           shr ebx, 12
822
           xor eax, eax
365 serge 823
           mov [page_tabs+ebx*4], eax
164 serge 824
           invlpg [edx]
825
 
826
           mov ebx, [ipc_pdir]
827
           mov edx, ebx
828
           shr ebx, 12
829
           xor eax, eax
365 serge 830
           mov [page_tabs+ebx*4], eax
164 serge 831
           invlpg [edx]
832
 
833
           mov ebx, [ipc_ptab]
834
           mov edx, ebx
835
           shr ebx, 12
836
           xor eax, eax
365 serge 837
           mov [page_tabs+ebx*4], eax
164 serge 838
           invlpg [edx]
839
 
840
           mov  eax, [dst_slot]
841
           shl eax, 8
380 serge 842
           or   [eax+SLOT_BASE+0xA8],dword 0x40
164 serge 843
           cmp  dword [check_idle_semaphore],20
844
           jge  .ipc_no_cis
845
 
846
           mov  dword [check_idle_semaphore],5
847
.ipc_no_cis:
848
           popf
849
           xor eax, eax
850
           ret
851
.no_pid:
852
           popf
853
           mov  eax, 4
854
           ret
855
.no_ipc_area:
856
           popf
857
           xor eax, eax
858
           inc eax
859
           ret
860
.ipc_blocked:
861
           popf
862
           mov  eax, 2
863
           ret
864
.buffer_overflow:
865
           popf
866
           mov  eax, 3
867
           ret
868
endp
869
 
870
align 4
170 serge 871
sysfn_meminfo:
164 serge 872
 
465 serge 873
        ;   add ebx, new_app_base
874
           cmp ebx, OS_BASE
875
           jae .fail
172 serge 876
 
164 serge 877
           mov eax, [pg_data.pages_count]
170 serge 878
           mov [ebx], eax
172 serge 879
           shl eax, 12
880
           mov [esp+36], eax
170 serge 881
           mov ecx, [pg_data.pages_free]
882
           mov [ebx+4], ecx
883
           mov edx, [pg_data.pages_faults]
884
           mov [ebx+8], edx
885
           mov esi, [heap_size]
886
           mov [ebx+12], esi
887
           mov edi, [heap_free]
888
           mov [ebx+16], edi
889
           mov eax, [heap_blocks]
890
           mov [ebx+20], eax
891
           mov ecx, [free_blocks]
892
           mov [ebx+24], ecx
164 serge 893
           ret
172 serge 894
.fail:
895
           mov dword [esp+36], -1
896
           ret
164 serge 897
 
898
align 4
899
new_services:
900
 
901
           cmp  eax,4
902
           jle  sys_sheduler
903
 
170 serge 904
           cmp eax, 11
164 serge 905
           jb .fail
906
           ja @f
907
 
188 serge 908
           call init_heap
164 serge 909
           mov [esp+36], eax
910
           ret
911
@@:
912
           cmp eax, 12
913
           ja @f
914
 
915
           stdcall user_alloc, ebx
916
           mov [esp+36], eax
917
           ret
918
@@:
919
           cmp eax, 13
920
           ja @f
921
           stdcall user_free, ebx
922
           mov [esp+36], eax
923
           ret
924
@@:
925
           cmp eax, 14
926
           ja @f
465 serge 927
           cmp ebx, OS_BASE
928
           jae .fail
227 serge 929
           stdcall get_event_ex, ebx, ecx
930
           mov [esp+36], eax
164 serge 931
           ret
932
@@:
933
           cmp eax, 15
934
           ja @f
465 serge 935
           mov ecx, [current_slot]
936
           mov eax, [ecx+APPDATA.fpu_handler]
937
           mov [ecx+APPDATA.fpu_handler], ebx
164 serge 938
           mov [esp+36], eax
939
           ret
940
@@:
941
           cmp eax, 16
942
           ja @f
943
 
188 serge 944
           test ebx, ebx
945
           jz .fail
465 serge 946
           cmp ebx, OS_BASE
947
           jae .fail
164 serge 948
           stdcall get_service, ebx
949
           mov [esp+36], eax
950
           ret
951
@@:
952
           cmp eax, 17
953
           ja @f
378 serge 954
           call srv_handlerEx   ;ebx
164 serge 955
           mov [esp+36], eax
956
           ret
168 serge 957
@@:
958
           cmp eax, 18
959
           ja @f
465 serge 960
           mov ecx, [current_slot]
961
           mov eax, [ecx+APPDATA.sse_handler]
962
           mov [ecx+APPDATA.sse_handler], ebx
168 serge 963
           mov [esp+36], eax
964
           ret
164 serge 965
@@:
198 serge 966
           cmp eax, 19
448 diamond 967
           ja @f
465 serge 968
           cmp ebx, OS_BASE
969
           jae .fail
198 serge 970
           stdcall load_library, ebx
971
           mov [esp+36], eax
972
           ret
448 diamond 973
@@:
490 serge 974
           cmp     eax, 20
975
           ja      .fail
976
           mov     eax, ecx
977
           call    user_realloc
978
           mov     [esp+36], eax
979
           ret
164 serge 980
.fail:
981
           xor eax, eax
982
           mov [esp+36], eax
983
           ret
984
 
985
align 4
986
proc init_mtrr
987
 
412 serge 988
           cmp [BOOT_VAR+0x901c],byte 2
164 serge 989
           je  .exit
990
 
211 serge 991
           bt [cpu_caps], CAPS_MTRR
992
           jnc .exit
993
 
164 serge 994
           mov eax, cr0
995
           or eax, 0x60000000   ;disable caching
996
           mov cr0, eax
997
           wbinvd               ;invalidate cache
998
 
999
           mov ecx, 0x2FF
1000
           rdmsr                ;
1001
           push eax
1002
 
1003
           xor edx, edx
1004
           xor eax, eax
1005
           mov ecx, 0x2FF
1006
           wrmsr                ;disable all MTRR
1007
 
1008
           stdcall set_mtrr, dword 0,dword 0,[MEM_AMOUNT],MEM_WB
1009
           stdcall set_mtrr, dword 1,[LFBAddress],[LFBSize],MEM_WC
1010
           xor edx, edx
1011
           xor eax, eax
1012
           mov ecx, 0x204
1013
           mov ebx, 6
1014
@@:
1015
           wrmsr                ;disable unused MTRR
1016
           inc ecx
1017
           wrmsr
1018
           inc ecx
1019
           dec ebx
1020
           jnz @b
1021
 
1022
           wbinvd               ;again invalidate
1023
 
1024
           pop eax
1025
           or eax, 0x800        ;set default memtype to UC
1026
           and al, 0xF0
1027
           mov ecx, 0x2FF
1028
           wrmsr                ;and enable MTRR
1029
 
1030
           mov eax, cr0
1031
           and eax, not 0x60000000
1032
           mov cr0, eax         ; enable caching
1033
.exit:
1034
           ret
1035
endp
1036
 
1037
align 4
1038
proc set_mtrr stdcall, reg:dword,base:dword,size:dword,mem_type:dword
1039
 
1040
           xor edx, edx
1041
           mov eax, [base]
1042
           or eax, [mem_type]
1043
           mov ecx, [reg]
1044
           lea ecx, [0x200+ecx*2]
1045
           wrmsr
1046
 
1047
           mov ebx, [size]
1048
           dec ebx
1049
           mov eax, 0xFFFFFFFF
1050
           mov edx, 0x0000000F
1051
           sub eax, ebx
1052
           sbb edx, 0
1053
           or eax, 0x800
1054
           inc ecx
1055
           wrmsr
1056
           ret
1057
endp
1058
 
465 serge 1059
 
1060
 
1061
align 4
172 serge 1062
proc stall stdcall, delay:dword
1063
           push ecx
1064
           push edx
1065
           push ebx
1066
           push eax
1067
 
1068
           mov eax, [delay]
1069
           mul [stall_mcs]
1070
           mov ebx, eax       ;low
1071
           mov ecx, edx       ;high
1072
           rdtsc
1073
           add ebx, eax
1074
           adc ecx,edx
1075
@@:
1076
           rdtsc
1077
           sub eax, ebx
1078
           sbb edx, ecx
1079
           jb @B
1080
 
1081
           pop eax
1082
           pop ebx
1083
           pop edx
1084
           pop ecx
1085
           ret
1086
endp
1087
 
237 serge 1088
 
1089
if 0
465 serge 1090
     push eax
1091
     push edx
1092
     mov edx, 0x400   ;bochs
1093
     mov al,0xff      ;bochs
1094
     out dx, al       ;bochs
1095
     pop edx
1096
     pop eax
1097
end if
1098