WebSVN – Kolibri OS – Diff – /kernel/trunk/kernel.asm

 ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 include 'macros.inc'
-$Revision: 1304 $
+$Revision: 1306 $
      mov   [esp+32], edx                 ; eax
      ret
-set_io_access_rights:
-     pushad
+set_io_access_rights:
-     mov edi, tss._io_map_0
+      push edi eax
       mov edi, tss._io_map_0
-;     mov   ecx,eax
-;     and   ecx,7    ; offset in byte
+;     mov   ecx,eax
 ;     and   ecx,7    ; offset in byte
-;     shr   eax,3    ; number of byte
-;     add   edi,eax
+;     shr   eax,3    ; number of byte
 ;     add   edi,eax
-;     mov   ebx,1
-;     shl   ebx,cl
+;     mov   ebx,1
 ;     shl   ebx,cl
      test  ebp,ebp
-;     cmp   ebp,0                ; enable access - ebp = 0
-     jnz   siar1
+;     cmp   ebp,0                ; enable access - ebp = 0
      jnz   siar1
 ;     not   ebx
-;     and   [edi],byte bl
-     btr [edi], eax
+;     and   [edi],byte bl
-     popad
+     btr [edi], eax
-     ret
+     pop eax edi
-siar1:
+     ret
 siar1:
-     bts [edi], eax
-  ;  or    [edi],byte bl        ; disable access - ebp = 1
+     bts [edi], eax
-     popad
+  ;  or    [edi],byte bl        ; disable access - ebp = 1
+     pop eax edi
+     ret
+;reserve/free group of ports
+;  * eax = 46 - number function
+;  * ebx = 0 - reserve, 1 - free
+;  * ecx = number start arrea of ports
+;  * edx = number end arrea of ports (include last number of port)
+;Return value:
+;  * eax = 0 - succesful
+;  * eax = 1 - error
+;  * The system has reserve this ports:
-     ret
+;    0..0x2d, 0x30..0x4d, 0x50..0xdf, 0xe5..0xff (include last number of port).
+;destroys eax,ebx, ebp
 r_f_port_area:
-     test  eax, eax
+     test  ebx, ebx
      jnz   free_port_area
 ;     je    r_port_area
 ;     jmp   free_port_area
 ;   r_port_area:
-     pushad
+;     pushad
-     cmp   ebx,ecx            ; beginning > end ?
+     cmp   ecx,edx            ; beginning > end ?
      ja    rpal1
-     cmp   ecx,65536
+     cmp   edx,65536
      jae   rpal1
-     mov   esi,[RESERVED_PORTS]
+     mov   eax,[RESERVED_PORTS]
-     test  esi,esi            ; no reserved areas ?
+     test  eax,eax            ; no reserved areas ?
      je    rpal2
-     cmp   esi,255            ; max reserved
+     cmp   eax,255            ; max reserved
      jae   rpal1
  rpal3:
-     mov   edi,esi
+     mov   ebx,eax
-     shl   edi,4
+     shl   ebx,4
-     add   edi,RESERVED_PORTS
+     add   ebx,RESERVED_PORTS
-     cmp   ebx,[edi+8]
+     cmp   ecx,[ebx+8]
-     ja    rpal4
-     cmp   ecx,[edi+4]
+     ja    rpal4
-     jae   rpal1
+     cmp   edx,[ebx+4]
-;     jb    rpal4
+     jae   rpal1
-;     jmp   rpal1
+;     jb    rpal4
- rpal4:
+;     jmp   rpal1
+ rpal4:
+     dec   eax
+     jnz   rpal3
-     dec   esi
+     jmp   rpal2
-     jnz   rpal3
-     jmp   rpal2
+   rpal1:
-   rpal1:
+;     popad
-     popad
-     mov   eax,1
-     ret
+;     mov   eax,1
      xor    eax,eax
-   rpal2:
+     inc    eax
-     popad
+     ret
    rpal2:
-     ; enable port access at port IO map
+;     popad
-     cli
-     pushad                        ; start enable io map
-     cmp   ecx,65536 ;16384
+     ; enable port access at port IO map
-     jae   no_unmask_io ; jge
 	cli
+	pushad                        ; start enable io map
-     mov   eax,ebx
+	cmp   edx,65536 ;16384
-   new_port_access:
+	jae   no_unmask_io ; jge
-     pushad
+	mov   eax,ecx
+;	push	ebp
-     xor   ebp,ebp                ; enable - eax = port
+	xor	ebp,ebp                ; enable - eax = port
-     call  set_io_access_rights
+new_port_access:
 ;     pushad
-     popad
 	call	set_io_access_rights
-     inc   eax
+;     popad
-     cmp   eax,ecx
+     inc   eax
-     jbe   new_port_access
+     cmp   eax,edx
+     jbe   new_port_access
-   no_unmask_io:
+;	pop	ebp
+no_unmask_io:
-     popad                         ; end enable io map
+	popad                         ; end enable io map
      sti
-     mov   edi,[RESERVED_PORTS]
+     mov   eax,[RESERVED_PORTS]
-     add   edi,1
+     add   eax,1
-     mov   [RESERVED_PORTS],edi
+     mov   [RESERVED_PORTS],eax
-     shl   edi,4
+     shl   eax,4
-     add   edi,RESERVED_PORTS
+     add   eax,RESERVED_PORTS
-     mov   esi,[TASK_BASE]
+     mov   ebx,[TASK_BASE]
-     mov   esi,[esi+TASKDATA.pid]
-     mov   [edi],esi
+     mov   ebx,[ebx+TASKDATA.pid]
-     mov   [edi+4],ebx
+     mov   [eax],ebx
-     mov   [edi+8],ecx
+     mov   [eax+4],ecx
+     mov   [eax+8],edx
-     xor   eax, eax
-     ret
+     xor   eax, eax
+     ret
 free_port_area:
 free_port_area:
-     pushad
 ;     pushad
-     mov   esi,[RESERVED_PORTS]     ; no reserved areas ?
+     mov   eax,[RESERVED_PORTS]     ; no reserved areas ?
-     test  esi,esi
+     test  eax,eax
-     je    frpal2
+     jz    frpal2
-     mov   edx,[TASK_BASE]
+     mov   ebx,[TASK_BASE]
-     mov   edx,[edx+TASKDATA.pid]
+     mov   ebx,[ebx+TASKDATA.pid]
    frpal3:
-     mov   edi,esi
+     mov   edi,eax
      shl   edi,4
      add   edi,RESERVED_PORTS
-     cmp   edx,[edi]
+     cmp   ebx,[edi]
      jne   frpal4
-     cmp   ebx,[edi+4]
+     cmp   ecx,[edi+4]
      jne   frpal4
+     cmp   edx,[edi+8]
-     cmp   ecx,[edi+8]
+     jne   frpal4
-     jne   frpal4
+     jmp   frpal1
-     jmp   frpal1
+   frpal4:
-   frpal4:
+     dec   eax
-     dec   esi
+     jnz   frpal3
-     jnz   frpal3
+   frpal2:
-   frpal2:
+;     popad
-     popad
+     inc   eax
-     mov   eax,1
      ret
-   frpal1:
-     mov   ecx,256
-     sub   ecx,esi
+   frpal1:
-     shl   ecx,4
+	push	ecx
-     mov   esi,edi
+	mov   ecx,256
-     add   esi,16
+	sub   ecx,eax
-     cld
+	shl   ecx,4
-     rep   movsb
+	mov   esi,edi
+	add   esi,16
+	cld
-     dec   dword [RESERVED_PORTS]
+	rep   movsb
-     popad
+	dec   dword [RESERVED_PORTS]
-     ; disable port access at port IO map
+;popad
-     pushad                        ; start disable io map
+;disable port access at port IO map
      cmp   ecx,65536 ;16384
-     jge   no_mask_io
+;     pushad                        ; start disable io map
      pop	eax	;start port
-     mov   eax,ebx
      cmp   edx,65536 ;16384
-   new_port_access_disable:
+     jge   no_mask_io
-     pushad
-     mov   ebp,1                  ; disable - eax = port
+;     mov   eax,ecx
-     call  set_io_access_rights
+	xor	ebp,ebp
 align 4
 syscall_reserveportarea:                ; ReservePortArea and FreePortArea
      call  r_f_port_area
-     mov   [esp+36],eax
+     mov   [esp+32],eax
      ret

Subversion Repositories Kolibri OS

(root)/kernel/trunk/kernel.asm @ 1316 – Rev 1304 → 1306