86Duino demo: reading ADC0

git-svn-id: svn://kolibrios.org@6878 a494cfbc-eb01-0410-851d-a64ba20cac60
This commit is contained in:
hidnplayr 2017-03-17 19:30:51 +00:00
parent ce35591444
commit bfd672d9a4
2 changed files with 112 additions and 36 deletions

View File

@ -1,12 +1,10 @@
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;; ;;
;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;
;; Copyright (C) KolibriOS team 2015-2017. All rights reserved. ;;
;; Distributed under terms of the GNU General Public License ;;
;; ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;driver sceletone
format PE DLL native 0.05
entry START
@ -23,11 +21,15 @@ entry START
section '.flat' code readable writable executable
include 'proc32.inc'
include 'struct.inc'
include 'macros.inc'
include 'peimport.inc'
include 'fdo.inc'
include '../proc32.inc'
include '../struct.inc'
include '../macros.inc'
include '../peimport.inc'
include '../fdo.inc'
GPIO_PORT_CONFIG_ADDR = 0xF100
GPIO_DATA_ADDR = 0xF200
ADC_ADDR = 0xFE00
proc START c, state:dword, cmdline:dword
@ -43,19 +45,59 @@ proc START c, state:dword, cmdline:dword
jz .fail
; Set crossbar base address register in southbridge
invoke PciWrite16, [bus], [dev], 64h, 0x0A00 or 1
invoke PciWrite16, [bus], [dev], 0x64, 0x0A00 or 1
; Set GPIO base address register in southbridge
invoke PciWrite16, [bus], [dev], 62h, 0xF100 or 1
invoke PciWrite16, [bus], [dev], 0x62, GPIO_PORT_CONFIG_ADDR or 1
DEBUGF 1,"Setting up ADC\n"
; Enable ADC
invoke PciRead32, [bus], [dev], 0xBC
and eax, not (1 shl 28)
invoke PciWrite32, [bus], [dev], 0xBC, eax
DEBUGF 1,"1\n"
; Set ADC base address
mov ebx, [dev]
inc ebx
invoke PciRead16, [bus], ebx, 0xDE
or ax, 0x02
invoke PciWrite16, [bus], ebx, 0xDE, eax
invoke PciWrite32, [bus], ebx, 0xE0, 0x00500000 or ADC_ADDR
DEBUGF 1,"2\n"
; set up ADC
mov dx, ADC_ADDR + 1
xor al, al
out dx, al
DEBUGF 1,"3\n"
; Empty FIFO
@@:
mov dx, ADC_ADDR + 2 ; Status register
in al, dx
test al, 0x01 ; FIFO ready
jz @f
mov dx, ADC_ADDR + 4
in ax, dx
jmp @r
@@:
DEBUGF 1,"4\n"
; Enable GPIO0-9
mov dx, 0xf100
mov dx, GPIO_PORT_CONFIG_ADDR + 0 ; General-Purpose I/O Data & Direction Decode Enable
mov eax, 0x000001ff
out dx, eax
mov ecx, 10
mov dx, 0xf104
mov ax, 0xf200
mov ecx, 10 ; 10 GPIO ports total
mov dx, GPIO_PORT_CONFIG_ADDR + 4 ; General-Purpose I/O Port0 Data & Direction Decode Address
mov ax, GPIO_DATA_ADDR
.gpio_init:
; Set GPIO data port base address
out dx, ax
@ -71,18 +113,13 @@ proc START c, state:dword, cmdline:dword
; Set GPIO0 pin 0 as output
mov al, 0x01
mov dx, 0xf202
out dx, al
; Set GPIO4 pin 0 as output
mov al, 0x01
mov dx, 0xf212
mov dx, GPIO_DATA_ADDR + 0*4 + 2
out dx, al
invoke RegService, my_service, service_proc
ret
.fail:
.exit:
.fail:
.exit:
xor eax, eax
ret
endp
@ -100,23 +137,49 @@ proc service_proc stdcall, ioctl:dword
mov dword [eax], API_VERSION
xor eax, eax
ret
@@:
@@:
cmp eax, 1 ; read GPIO P0
jne @f
mov dx, 0xf200
jne .no_gpioread
mov dx, GPIO_DATA_ADDR + 0x00
in al, dx
ret
@@:
.no_gpioread:
cmp eax, 2 ; write GPIO P0
jne @f
jne .no_gpiowrite
mov eax, [ebx + IOCTL.input]
mov dx, 0xf200
mov dx, GPIO_DATA_ADDR + 0x00
out dx, al
xor eax, eax
ret
@@:
.fail:
.no_gpiowrite:
cmp eax, 3 ; read ADC channel 0
jne .no_adcread
mov dx, ADC_ADDR + 1
mov al, 1 shl 3 ; Power down ADC
out dx, al
mov dx, ADC_ADDR + 0 ; AUX channel select register
mov al, 1 shl 0 ; Enable AUX0 scan
out dx, al
mov dx, ADC_ADDR + 1
mov al, 1 shl 0 ; Single shot, no interrupts, start
out dx, al
mov dx, ADC_ADDR + 2
@@:
in al, dx
test al, 1 shl 0 ; data ready?
jz @r
mov dx, ADC_ADDR + 4
in ax, dx ; read the data and return to user call
DEBUGF 1, "ADC read: 0x%x\n", eax:4
ret
.no_adcread:
.fail:
or eax, -1
ret
endp
@ -126,14 +189,14 @@ proc detect
push ebx
invoke GetPCIList
mov ebx, eax
.next_dev:
.next_dev:
mov eax, [eax+PCIDEV.fd]
cmp eax, ebx
jz .err
mov edx, [eax+PCIDEV.vendor_device_id]
mov esi, devices
@@:
@@:
cmp dword [esi], 0
jz .next_dev
cmp edx, [esi]
@ -142,7 +205,7 @@ proc detect
add esi, STRIDE
jmp @B
.found:
.found:
movzx ebx, [eax+PCIDEV.devfn]
mov [dev], ebx
movzx ebx, [eax+PCIDEV.bus]
@ -151,7 +214,7 @@ proc detect
inc eax
pop ebx
ret
.err:
.err:
DEBUGF 1,"Could not find vortex86EX south bridge!\n"
xor eax, eax
pop ebx

View File

@ -77,7 +77,13 @@ key: ; Keypress event handler
and al, not 1 ; Clear bit 0
call write_gpio0
jmp event_wait
@@:
cmp ah, 'e'
jne @f
call read_adc0
mov ecx, eax
mcall 47, 0x00040100,,25 shl 16 + 25, 0x40000000, 0x00ffffff ; 4 digits hex number in ecx
jmp event_wait
@@:
jmp event_wait ; Just read the key, ignore it and jump to event_wait.
@ -150,6 +156,12 @@ write_gpio0:
mcall 68, 17, IOCTL
ret
; Read ADC0
read_adc0:
mov [IOCTL.io_code], 3
mcall 68, 17, IOCTL
ret
; *********************************************
; ************* DATA AREA *****************
; *********************************************
@ -159,7 +171,8 @@ write_gpio0:
text db "This is an 86DUINO GPIO demo program "
db " "
db "press q/w to toggle GPIO 0 pin 0 ", 0
db "press q/w to toggle GPIO 0 pin 0 "
db "or e to read ADC0 channel ", 0
title db "86Duino Example application", 0