1)fixed bug with wrong lfb size on some old videocards

2)set fpu/sse to default state for new thread 3)added driver sceletone git-svn-id: svn://kolibrios.org@214 a494cfbc-eb01-0410-851d-a64ba20cac60
2006-11-20 07:06:00 +00:00
parent 44a74d9138
commit 00b8fb388c
18 changed files with 1236 additions and 355 deletions
--- a/kernel/trunk/drivers/sceletone.asm
+++ b/kernel/trunk/drivers/sceletone.asm
@@ -0,0 +1,173 @@
+
+;driver sceletone
+
+format MS COFF
+
+include 'proc32.inc'
+
+
+OS_BASE         equ 0;
+new_app_base    equ 0x60400000
+PROC_BASE       equ OS_BASE+0x0080000
+
+struc IOCTL
+{  .handle      dd ?
+   .io_code     dd ?
+   .input       dd ?
+   .inp_size    dd ?
+   .output      dd ?
+   .out_size    dd ?
+}
+
+virtual at 0
+  IOCTL IOCTL
+end virtual
+
+public START
+public service_proc
+
+extrn AttachIntHandler
+extrn SysMsgBoardStr
+extrn PciApi
+extrn PciRead32
+extrn PciRead8
+extrn PciWrite8
+extrn AllocKernelSpace
+extrn KernelAlloc
+extrn MapPage
+extrn GetPgAddr
+extrn RegService
+extrn ServiceHandler
+extrn SetHwCursor
+extrn LFBAddress
+extrn LoadFile
+extrn FpuSave
+extrn FpuRestore
+
+DEBUG      equ 1
+
+DRV_ENTRY  equ 1
+DRV_EXIT   equ -1
+STRIDE     equ 4      ;size of row in devices table
+
+section '.flat' code readable align 16
+
+proc START stdcall, state:dword
+
+           mov eax, [state]
+           cmp eax, 1
+           je .entry
+           jmp .exit
+.entry:
+     if DEBUG
+           mov esi, msgInit
+           call SysMsgBoardStr
+     end if
+
+           stdcall RegService, my_service, service_proc
+	   ret
+.fail:
+.exit:
+           xor eax, eax
+           ret
+endp
+
+handle     equ  IOCTL.handle
+io_code    equ  IOCTL.io_code
+input      equ  IOCTL.input
+inp_size   equ  IOCTL.inp_size
+output     equ  IOCTL.output
+out_size   equ  IOCTL.out_size
+
+align 4
+proc service_proc stdcall, ioctl:dword
+
+;           mov edi, [ioctl]
+;           mov eax, [edi+io_code]
+
+	   xor eax, eax
+	   ret
+endp
+
+restore   handle
+restore   io_code
+restore   input
+restore   inp_size
+restore   output
+restore   out_size
+
+align 4
+proc detect
+	   locals
+	     last_bus dd ?
+	   endl
+
+	   xor eax, eax
+	   mov [bus], eax
+	   inc eax
+           call PciApi
+	   cmp eax, -1
+           je .err
+
+	   mov [last_bus], eax
+
+.next_bus:
+	   and [devfn], 0
+.next_dev:
+           stdcall PciRead32, [bus], [devfn], dword 0
+	   test eax, eax
+	   jz .next
+	   cmp eax, -1
+	   je .next
+
+	   mov edi, devices
+@@:
+	   mov ebx, [edi]
+	   test ebx, ebx
+	   jz .next
+
+	   cmp eax, ebx
+	   je .found
+           add edi, STRIDE
+           jmp @B
+
+.next:	   inc [devfn]
+	   cmp [devfn], 256
+	   jb  .next_dev
+	   mov eax, [bus]
+	   inc eax
+	   mov [bus], eax
+	   cmp eax, [last_bus]
+	   jna .next_bus
+	   xor eax, eax
+	   ret
+.found:
+	   xor eax, eax
+           inc eax
+	   ret
+.err:
+           xor eax, eax
+           ret
+endp
+
+
+;DEVICE_ID equ  ; pci device id
+;VENDOR_ID equ  ; device vendor id
+
+
+;all initialized data place here
+
+align 4
+devices dd (DEVICE_ID shl 16)+VENDOR_ID
+        dd 0    ;terminator
+
+my_service   db 'MY_SERVICE',0  ;max 16 chars include zero
+
+msgInit      db 'detect hardware...',13,10,0
+msgPCI       db 'PCI accsess not supported',13,10,0
+msgFail      db 'device not found',13,10,0
+
+section '.data' data readable writable align 16
+
+;all uninitialized data place here
+