forked from KolibriOS/kolibrios
an attempt to rework threading model
git-svn-id: svn://kolibrios.org@4429 a494cfbc-eb01-0410-851d-a64ba20cac60
This commit is contained in:
Sergey Semyonov (Serge)
347
kernel/branches/kolibri-process/COPYING.TXT
Normal file
347
kernel/branches/kolibri-process/COPYING.TXT
Normal file
@@ -0,0 +1,347 @@
|
||||
|
||||
GNU GENERAL PUBLIC LICENSE
|
||||
|
||||
Version 2, June 1991
|
||||
|
||||
|
||||
Copyright (C) 1989, 1991 Free Software Foundation, Inc.
|
||||
675 Mass Ave, Cambridge, MA 02139, USA
|
||||
|
||||
Everyone is permitted to copy and distribute verbatim copies
|
||||
of this license document, but changing it is not allowed.
|
||||
|
||||
|
||||
Preamble
|
||||
|
||||
The licenses for most software are designed to take away your
|
||||
freedom to share and change it. By contrast, the GNU General Public
|
||||
License is intended to guarantee your freedom to share and change free
|
||||
software--to make sure the software is free for all its users. This
|
||||
General Public License applies to most of the Free Software
|
||||
Foundation's software and to any other program whose authors commit to
|
||||
using it. (Some other Free Software Foundation software is covered by
|
||||
the GNU Library General Public License instead.) You can apply it to
|
||||
your programs, too.
|
||||
|
||||
When we speak of free software, we are referring to freedom, not
|
||||
price. Our General Public Licenses are designed to make sure that you
|
||||
have the freedom to distribute copies of free software (and charge for
|
||||
this service if you wish), that you receive source code or can get it
|
||||
if you want it, that you can change the software or use pieces of it
|
||||
in new free programs; and that you know you can do these things.
|
||||
|
||||
To protect your rights, we need to make restrictions that forbid
|
||||
anyone to deny you these rights or to ask you to surrender the rights.
|
||||
These restrictions translate to certain responsibilities for you if you
|
||||
distribute copies of the software, or if you modify it.
|
||||
|
||||
For example, if you distribute copies of such a program, whether
|
||||
gratis or for a fee, you must give the recipients all the rights that
|
||||
you have. You must make sure that they, too, receive or can get the
|
||||
source code. And you must show them these terms so they know their
|
||||
rights.
|
||||
|
||||
We protect your rights with two steps: (1) copyright the software, and
|
||||
(2) offer you this license which gives you legal permission to copy,
|
||||
distribute and/or modify the software.
|
||||
|
||||
Also, for each author's protection and ours, we want to make certain
|
||||
that everyone understands that there is no warranty for this free
|
||||
software. If the software is modified by someone else and passed on, we
|
||||
want its recipients to know that what they have is not the original, so
|
||||
that any problems introduced by others will not reflect on the original
|
||||
authors' reputations.
|
||||
|
||||
Finally, any free program is threatened constantly by software
|
||||
patents. We wish to avoid the danger that redistributors of a free
|
||||
program will individually obtain patent licenses, in effect making the
|
||||
program proprietary. To prevent this, we have made it clear that any
|
||||
patent must be licensed for everyone's free use or not licensed at all.
|
||||
|
||||
The precise terms and conditions for copying, distribution and
|
||||
modification follow.
|
||||
|
||||
|
||||
GNU GENERAL PUBLIC LICENSE
|
||||
|
||||
TERMS AND CONDITIONS FOR COPYING, DISTRIBUTION AND MODIFICATION
|
||||
|
||||
|
||||
0. This License applies to any program or other work which contains
|
||||
a notice placed by the copyright holder saying it may be distributed
|
||||
under the terms of this General Public License. The "Program", below,
|
||||
refers to any such program or work, and a "work based on the Program"
|
||||
means either the Program or any derivative work under copyright law:
|
||||
that is to say, a work containing the Program or a portion of it,
|
||||
either verbatim or with modifications and/or translated into another
|
||||
language. (Hereinafter, translation is included without limitation in
|
||||
the term "modification".) Each licensee is addressed as "you".
|
||||
|
||||
Activities other than copying, distribution and modification are not
|
||||
covered by this License; they are outside its scope. The act of
|
||||
running the Program is not restricted, and the output from the Program
|
||||
is covered only if its contents constitute a work based on the
|
||||
Program (independent of having been made by running the Program).
|
||||
Whether that is true depends on what the Program does.
|
||||
|
||||
1. You may copy and distribute verbatim copies of the Program's
|
||||
source code as you receive it, in any medium, provided that you
|
||||
conspicuously and appropriately publish on each copy an appropriate
|
||||
copyright notice and disclaimer of warranty; keep intact all the
|
||||
notices that refer to this License and to the absence of any warranty;
|
||||
and give any other recipients of the Program a copy of this License
|
||||
along with the Program.
|
||||
|
||||
You may charge a fee for the physical act of transferring a copy, and
|
||||
you may at your option offer warranty protection in exchange for a fee.
|
||||
|
||||
2. You may modify your copy or copies of the Program or any portion
|
||||
of it, thus forming a work based on the Program, and copy and
|
||||
distribute such modifications or work under the terms of Section 1
|
||||
above, provided that you also meet all of these conditions:
|
||||
|
||||
a) You must cause the modified files to carry prominent notices
|
||||
stating that you changed the files and the date of any change.
|
||||
|
||||
b) You must cause any work that you distribute or publish, that in
|
||||
whole or in part contains or is derived from the Program or any
|
||||
part thereof, to be licensed as a whole at no charge to all third
|
||||
parties under the terms of this License.
|
||||
|
||||
c) If the modified program normally reads commands interactively
|
||||
when run, you must cause it, when started running for such
|
||||
interactive use in the most ordinary way, to print or display an
|
||||
announcement including an appropriate copyright notice and a
|
||||
notice that there is no warranty (or else, saying that you provide
|
||||
a warranty) and that users may redistribute the program under
|
||||
these conditions, and telling the user how to view a copy of this
|
||||
License. (Exception: if the Program itself is interactive but
|
||||
does not normally print such an announcement, your work based on
|
||||
the Program is not required to print an announcement.)
|
||||
|
||||
These requirements apply to the modified work as a whole. If
|
||||
identifiable sections of that work are not derived from the Program,
|
||||
and can be reasonably considered independent and separate works in
|
||||
themselves, then this License, and its terms, do not apply to those
|
||||
sections when you distribute them as separate works. But when you
|
||||
distribute the same sections as part of a whole which is a work based
|
||||
on the Program, the distribution of the whole must be on the terms of
|
||||
this License, whose permissions for other licensees extend to the
|
||||
entire whole, and thus to each and every part regardless of who wrote it.
|
||||
|
||||
Thus, it is not the intent of this section to claim rights or contest
|
||||
your rights to work written entirely by you; rather, the intent is to
|
||||
exercise the right to control the distribution of derivative or
|
||||
collective works based on the Program.
|
||||
|
||||
In addition, mere aggregation of another work not based on the Program
|
||||
with the Program (or with a work based on the Program) on a volume of
|
||||
a storage or distribution medium does not bring the other work under
|
||||
the scope of this License.
|
||||
|
||||
3. You may copy and distribute the Program (or a work based on it,
|
||||
under Section 2) in object code or executable form under the terms of
|
||||
Sections 1 and 2 above provided that you also do one of the following:
|
||||
|
||||
a) Accompany it with the complete corresponding machine-readable
|
||||
source code, which must be distributed under the terms of Sections
|
||||
1 and 2 above on a medium customarily used for software interchange; or,
|
||||
|
||||
b) Accompany it with a written offer, valid for at least three
|
||||
years, to give any third party, for a charge no more than your
|
||||
cost of physically performing source distribution, a complete
|
||||
machine-readable copy of the corresponding source code, to be
|
||||
distributed under the terms of Sections 1 and 2 above on a medium
|
||||
customarily used for software interchange; or,
|
||||
|
||||
c) Accompany it with the information you received as to the offer
|
||||
to distribute corresponding source code. (This alternative is
|
||||
allowed only for noncommercial distribution and only if you
|
||||
received the program in object code or executable form with such
|
||||
an offer, in accord with Subsection b above.)
|
||||
|
||||
The source code for a work means the preferred form of the work for
|
||||
making modifications to it. For an executable work, complete source
|
||||
code means all the source code for all modules it contains, plus any
|
||||
associated interface definition files, plus the scripts used to
|
||||
control compilation and installation of the executable. However, as a
|
||||
special exception, the source code distributed need not include
|
||||
anything that is normally distributed (in either source or binary
|
||||
form) with the major components (compiler, kernel, and so on) of the
|
||||
operating system on which the executable runs, unless that component
|
||||
itself accompanies the executable.
|
||||
|
||||
If distribution of executable or object code is made by offering
|
||||
access to copy from a designated place, then offering equivalent
|
||||
access to copy the source code from the same place counts as
|
||||
distribution of the source code, even though third parties are not
|
||||
compelled to copy the source along with the object code.
|
||||
|
||||
4. You may not copy, modify, sublicense, or distribute the Program
|
||||
except as expressly provided under this License. Any attempt
|
||||
otherwise to copy, modify, sublicense or distribute the Program is
|
||||
void, and will automatically terminate your rights under this License.
|
||||
However, parties who have received copies, or rights, from you under
|
||||
this License will not have their licenses terminated so long as such
|
||||
parties remain in full compliance.
|
||||
|
||||
5. You are not required to accept this License, since you have not
|
||||
signed it. However, nothing else grants you permission to modify or
|
||||
distribute the Program or its derivative works. These actions are
|
||||
prohibited by law if you do not accept this License. Therefore, by
|
||||
modifying or distributing the Program (or any work based on the
|
||||
Program), you indicate your acceptance of this License to do so, and
|
||||
all its terms and conditions for copying, distributing or modifying
|
||||
the Program or works based on it.
|
||||
|
||||
6. Each time you redistribute the Program (or any work based on the
|
||||
Program), the recipient automatically receives a license from the
|
||||
original licensor to copy, distribute or modify the Program subject to
|
||||
these terms and conditions. You may not impose any further
|
||||
restrictions on the recipients' exercise of the rights granted herein.
|
||||
You are not responsible for enforcing compliance by third parties to
|
||||
this License.
|
||||
|
||||
7. If, as a consequence of a court judgment or allegation of patent
|
||||
infringement or for any other reason (not limited to patent issues),
|
||||
conditions are imposed on you (whether by court order, agreement or
|
||||
otherwise) that contradict the conditions of this License, they do not
|
||||
excuse you from the conditions of this License. If you cannot
|
||||
distribute so as to satisfy simultaneously your obligations under this
|
||||
License and any other pertinent obligations, then as a consequence you
|
||||
may not distribute the Program at all. For example, if a patent
|
||||
license would not permit royalty-free redistribution of the Program by
|
||||
all those who receive copies directly or indirectly through you, then
|
||||
the only way you could satisfy both it and this License would be to
|
||||
refrain entirely from distribution of the Program.
|
||||
|
||||
If any portion of this section is held invalid or unenforceable under
|
||||
any particular circumstance, the balance of the section is intended to
|
||||
apply and the section as a whole is intended to apply in other
|
||||
circumstances.
|
||||
|
||||
It is not the purpose of this section to induce you to infringe any
|
||||
patents or other property right claims or to contest validity of any
|
||||
such claims; this section has the sole purpose of protecting the
|
||||
integrity of the free software distribution system, which is
|
||||
implemented by public license practices. Many people have made
|
||||
generous contributions to the wide range of software distributed
|
||||
through that system in reliance on consistent application of that
|
||||
system; it is up to the author/donor to decide if he or she is willing
|
||||
to distribute software through any other system and a licensee cannot
|
||||
impose that choice.
|
||||
|
||||
This section is intended to make thoroughly clear what is believed to
|
||||
be a consequence of the rest of this License.
|
||||
|
||||
8. If the distribution and/or use of the Program is restricted in
|
||||
certain countries either by patents or by copyrighted interfaces, the
|
||||
original copyright holder who places the Program under this License
|
||||
may add an explicit geographical distribution limitation excluding
|
||||
those countries, so that distribution is permitted only in or among
|
||||
countries not thus excluded. In such case, this License incorporates
|
||||
the limitation as if written in the body of this License.
|
||||
|
||||
9. The Free Software Foundation may publish revised and/or new versions
|
||||
of the General Public License from time to time. Such new versions will
|
||||
be similar in spirit to the present version, but may differ in detail to
|
||||
address new problems or concerns.
|
||||
|
||||
Each version is given a distinguishing version number. If the Program
|
||||
specifies a version number of this License which applies to it and "any
|
||||
later version", you have the option of following the terms and conditions
|
||||
either of that version or of any later version published by the Free
|
||||
Software Foundation. If the Program does not specify a version number of
|
||||
this License, you may choose any version ever published by the Free Software
|
||||
Foundation.
|
||||
|
||||
10. If you wish to incorporate parts of the Program into other free
|
||||
programs whose distribution conditions are different, write to the author
|
||||
to ask for permission. For software which is copyrighted by the Free
|
||||
Software Foundation, write to the Free Software Foundation; we sometimes
|
||||
make exceptions for this. Our decision will be guided by the two goals
|
||||
of preserving the free status of all derivatives of our free software and
|
||||
of promoting the sharing and reuse of software generally.
|
||||
|
||||
NO WARRANTY
|
||||
|
||||
11. BECAUSE THE PROGRAM IS LICENSED FREE OF CHARGE, THERE IS NO WARRANTY
|
||||
FOR THE PROGRAM, TO THE EXTENT PERMITTED BY APPLICABLE LAW. EXCEPT WHEN
|
||||
OTHERWISE STATED IN WRITING THE COPYRIGHT HOLDERS AND/OR OTHER PARTIES
|
||||
PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESSED
|
||||
OR IMPLIED, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
||||
MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. THE ENTIRE RISK AS
|
||||
TO THE QUALITY AND PERFORMANCE OF THE PROGRAM IS WITH YOU. SHOULD THE
|
||||
PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF ALL NECESSARY SERVICING,
|
||||
REPAIR OR CORRECTION.
|
||||
|
||||
12. IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING
|
||||
WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MAY MODIFY AND/OR
|
||||
REDISTRIBUTE THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES,
|
||||
INCLUDING ANY GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING
|
||||
OUT OF THE USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED
|
||||
TO LOSS OF DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY
|
||||
YOU OR THIRD PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER
|
||||
PROGRAMS), EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGES.
|
||||
|
||||
END OF TERMS AND CONDITIONS
|
||||
|
||||
Appendix: How to Apply These Terms to Your New Programs
|
||||
|
||||
If you develop a new program, and you want it to be of the greatest
|
||||
possible use to the public, the best way to achieve this is to make it
|
||||
free software which everyone can redistribute and change under these terms.
|
||||
|
||||
To do so, attach the following notices to the program. It is safest
|
||||
to attach them to the start of each source file to most effectively
|
||||
convey the exclusion of warranty; and each file should have at least
|
||||
the "copyright" line and a pointer to where the full notice is found.
|
||||
|
||||
<one line to give the program's name and a brief idea of what it does.>
|
||||
Copyright (C) 19yy <name of author>
|
||||
|
||||
This program is free software; you can redistribute it and/or modify
|
||||
it under the terms of the GNU General Public License as published by
|
||||
the Free Software Foundation; either version 2 of the License, or
|
||||
(at your option) any later version.
|
||||
|
||||
This program is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with this program; if not, write to the Free Software
|
||||
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
|
||||
Also add information on how to contact you by electronic and paper mail.
|
||||
|
||||
If the program is interactive, make it output a short notice like this
|
||||
when it starts in an interactive mode:
|
||||
|
||||
Gnomovision version 69, Copyright (C) 19yy name of author
|
||||
Gnomovision comes with ABSOLUTELY NO WARRANTY; for details type `show w'.
|
||||
This is free software, and you are welcome to redistribute it
|
||||
under certain conditions; type `show c' for details.
|
||||
|
||||
The hypothetical commands `show w' and `show c' should show the appropriate
|
||||
parts of the General Public License. Of course, the commands you use may
|
||||
be called something other than `show w' and `show c'; they could even be
|
||||
mouse-clicks or menu items--whatever suits your program.
|
||||
|
||||
You should also get your employer (if you work as a programmer) or your
|
||||
school, if any, to sign a "copyright disclaimer" for the program, if
|
||||
necessary. Here is a sample; alter the names:
|
||||
|
||||
Yoyodyne, Inc., hereby disclaims all copyright interest in the program
|
||||
`Gnomovision' (which makes passes at compilers) written by James Hacker.
|
||||
|
||||
<signature of Ty Coon>, 1 April 1989
|
||||
Ty Coon, President of Vice
|
||||
|
||||
This General Public License does not permit incorporating your program into
|
||||
proprietary programs. If your program is a subroutine library, you may
|
||||
consider it more useful to permit linking proprietary applications with the
|
||||
library. If this is what you want to do, use the GNU Library General
|
||||
Public License instead of this License.
|
||||
293
kernel/branches/kolibri-process/blkdev/bd_drv.inc
Normal file
293
kernel/branches/kolibri-process/blkdev/bd_drv.inc
Normal file
@@ -0,0 +1,293 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4420 $
|
||||
|
||||
|
||||
; Access through BIOS by diamond
|
||||
iglobal
|
||||
align 4
|
||||
bd_callbacks:
|
||||
dd bd_callbacks.end - bd_callbacks ; strucsize
|
||||
dd 0 ; no close function
|
||||
dd 0 ; no closemedia function
|
||||
dd bd_querymedia
|
||||
dd bd_read_interface
|
||||
dd bd_write_interface
|
||||
dd 0 ; no flush function
|
||||
dd 0 ; use default cache size
|
||||
.end:
|
||||
endg
|
||||
|
||||
proc bd_read_interface stdcall uses edi, \
|
||||
userdata, buffer, startsector:qword, numsectors
|
||||
; userdata = old [hdpos] = 80h + index in NumBiosDisks
|
||||
; buffer = pointer to buffer for data
|
||||
; startsector = 64-bit start sector
|
||||
; numsectors = pointer to number of sectors on input,
|
||||
; must be filled with number of sectors really read
|
||||
locals
|
||||
sectors_todo dd ?
|
||||
endl
|
||||
; 1. Initialize number of sectors: get number of requested sectors
|
||||
; and say that no sectors were read yet.
|
||||
mov ecx, [numsectors]
|
||||
mov eax, [ecx]
|
||||
mov dword [ecx], 0
|
||||
mov [sectors_todo], eax
|
||||
; 2. Acquire the global lock.
|
||||
mov ecx, ide_mutex
|
||||
call mutex_lock
|
||||
; 3. Convert parameters to the form suitable for worker procedures.
|
||||
; Underlying procedures do not know about 64-bit sectors.
|
||||
; Worker procedures use global variables and edi for [buffer].
|
||||
cmp dword [startsector+4], 0
|
||||
jnz .fail
|
||||
and [hd_error], 0
|
||||
mov eax, [userdata]
|
||||
mov [hdpos], eax
|
||||
mov eax, dword [startsector]
|
||||
mov edi, [buffer]
|
||||
; 4. Worker procedures take one sectors per time, so loop over all sectors to read.
|
||||
.sectors_loop:
|
||||
call bd_read
|
||||
cmp [hd_error], 0
|
||||
jnz .fail
|
||||
mov ecx, [numsectors]
|
||||
inc dword [ecx] ; one more sector is read
|
||||
dec [sectors_todo]
|
||||
jz .done
|
||||
inc eax
|
||||
jnz .sectors_loop
|
||||
; 5. Loop is done, either due to error or because everything is done.
|
||||
; Release the global lock and return the corresponding status.
|
||||
.fail:
|
||||
mov ecx, ide_mutex
|
||||
call mutex_unlock
|
||||
or eax, -1
|
||||
ret
|
||||
.done:
|
||||
mov ecx, ide_mutex
|
||||
call mutex_unlock
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
proc bd_write_interface stdcall uses esi edi, \
|
||||
userdata, buffer, startsector:qword, numsectors
|
||||
; userdata = old [hdpos] = 80h + index in NumBiosDisks
|
||||
; buffer = pointer to buffer with data
|
||||
; startsector = 64-bit start sector
|
||||
; numsectors = pointer to number of sectors on input,
|
||||
; must be filled with number of sectors really written
|
||||
locals
|
||||
sectors_todo dd ?
|
||||
endl
|
||||
; 1. Initialize number of sectors: get number of requested sectors
|
||||
; and say that no sectors were read yet.
|
||||
mov ecx, [numsectors]
|
||||
mov eax, [ecx]
|
||||
mov dword [ecx], 0
|
||||
mov [sectors_todo], eax
|
||||
; 2. Acquire the global lock.
|
||||
mov ecx, ide_mutex
|
||||
call mutex_lock
|
||||
; 3. Convert parameters to the form suitable for worker procedures.
|
||||
; Underlying procedures do not know about 64-bit sectors.
|
||||
; Worker procedures use global variables and esi for [buffer].
|
||||
cmp dword [startsector+4], 0
|
||||
jnz .fail
|
||||
and [hd_error], 0
|
||||
mov eax, [userdata]
|
||||
mov [hdpos], eax
|
||||
mov esi, [buffer]
|
||||
lea edi, [startsector]
|
||||
mov [cache_chain_ptr], edi
|
||||
; 4. Worker procedures take max 16 sectors per time,
|
||||
; loop until all sectors will be processed.
|
||||
.sectors_loop:
|
||||
mov ecx, 16
|
||||
cmp ecx, [sectors_todo]
|
||||
jbe @f
|
||||
mov ecx, [sectors_todo]
|
||||
@@:
|
||||
mov [cache_chain_size], cl
|
||||
call bd_write_cache_chain
|
||||
cmp [hd_error], 0
|
||||
jnz .fail
|
||||
movzx ecx, [cache_chain_size]
|
||||
mov eax, [numsectors]
|
||||
add [eax], ecx
|
||||
sub [sectors_todo], ecx
|
||||
jz .done
|
||||
add [edi], ecx
|
||||
jc .fail
|
||||
shl ecx, 9
|
||||
add esi, ecx
|
||||
jmp .sectors_loop
|
||||
; 5. Loop is done, either due to error or because everything is done.
|
||||
; Release the global lock and return the corresponding status.
|
||||
.fail:
|
||||
mov ecx, ide_mutex
|
||||
call mutex_unlock
|
||||
or eax, -1
|
||||
ret
|
||||
.done:
|
||||
mov ecx, ide_mutex
|
||||
call mutex_unlock
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
; This is a stub.
|
||||
proc bd_querymedia stdcall, hd_data, mediainfo
|
||||
mov eax, [mediainfo]
|
||||
mov [eax+DISKMEDIAINFO.Flags], 0
|
||||
mov [eax+DISKMEDIAINFO.SectorSize], 512
|
||||
or dword [eax+DISKMEDIAINFO.Capacity], 0xFFFFFFFF
|
||||
or dword [eax+DISKMEDIAINFO.Capacity+4], 0xFFFFFFFF
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
; \begin{diamond}
|
||||
uglobal
|
||||
bios_hdpos dd 0 ; 0 is invalid value for [hdpos]
|
||||
bios_cur_sector dd ?
|
||||
bios_read_len dd ?
|
||||
endg
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
bd_read:
|
||||
push eax
|
||||
push edx
|
||||
mov edx, [bios_hdpos]
|
||||
cmp edx, [hdpos]
|
||||
jne .notread
|
||||
mov edx, [bios_cur_sector]
|
||||
cmp eax, edx
|
||||
jb .notread
|
||||
add edx, [bios_read_len]
|
||||
dec edx
|
||||
cmp eax, edx
|
||||
ja .notread
|
||||
sub eax, [bios_cur_sector]
|
||||
shl eax, 9
|
||||
add eax, (OS_BASE+0x9A000)
|
||||
push ecx esi
|
||||
mov esi, eax
|
||||
mov ecx, 512/4
|
||||
cld
|
||||
rep movsd
|
||||
pop esi ecx
|
||||
pop edx
|
||||
pop eax
|
||||
ret
|
||||
.notread:
|
||||
push ecx
|
||||
mov dl, 42h
|
||||
mov ecx, 16
|
||||
call int13_call
|
||||
pop ecx
|
||||
test eax, eax
|
||||
jnz .v86err
|
||||
test edx, edx
|
||||
jz .readerr
|
||||
mov [bios_read_len], edx
|
||||
mov edx, [hdpos]
|
||||
mov [bios_hdpos], edx
|
||||
pop edx
|
||||
pop eax
|
||||
mov [bios_cur_sector], eax
|
||||
jmp bd_read
|
||||
.readerr:
|
||||
.v86err:
|
||||
mov [hd_error], 1
|
||||
jmp hd_read_error
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
bd_write_cache_chain:
|
||||
pusha
|
||||
mov edi, OS_BASE + 0x9A000
|
||||
movzx ecx, [cache_chain_size]
|
||||
push ecx
|
||||
shl ecx, 9-2
|
||||
rep movsd
|
||||
pop ecx
|
||||
mov dl, 43h
|
||||
mov eax, [cache_chain_ptr]
|
||||
mov eax, [eax]
|
||||
call int13_call
|
||||
test eax, eax
|
||||
jnz .v86err
|
||||
cmp edx, ecx
|
||||
jnz .writeerr
|
||||
popa
|
||||
ret
|
||||
.v86err:
|
||||
.writeerr:
|
||||
popa
|
||||
mov [hd_error], 1
|
||||
jmp hd_write_error
|
||||
;-----------------------------------------------------------------------------
|
||||
uglobal
|
||||
int13_regs_in rb sizeof.v86_regs
|
||||
int13_regs_out rb sizeof.v86_regs
|
||||
endg
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
int13_call:
|
||||
; Because this code uses fixed addresses,
|
||||
; it can not be run simultaniously by many threads.
|
||||
; In current implementation it is protected by common mutex 'ide_status'
|
||||
mov word [OS_BASE + 510h], 10h ; packet length
|
||||
mov word [OS_BASE + 512h], cx ; number of sectors
|
||||
mov dword [OS_BASE + 514h], 9A000000h ; buffer 9A00:0000
|
||||
mov dword [OS_BASE + 518h], eax
|
||||
and dword [OS_BASE + 51Ch], 0
|
||||
push ebx ecx esi edi
|
||||
mov ebx, int13_regs_in
|
||||
mov edi, ebx
|
||||
mov ecx, sizeof.v86_regs/4
|
||||
xor eax, eax
|
||||
rep stosd
|
||||
mov byte [ebx+v86_regs.eax+1], dl
|
||||
mov eax, [hdpos]
|
||||
lea eax, [BiosDisksData+(eax-80h)*4]
|
||||
mov dl, [eax]
|
||||
mov byte [ebx+v86_regs.edx], dl
|
||||
movzx edx, byte [eax+1]
|
||||
; mov dl, 5
|
||||
test edx, edx
|
||||
jnz .hasirq
|
||||
dec edx
|
||||
jmp @f
|
||||
.hasirq:
|
||||
pushad
|
||||
stdcall enable_irq, edx
|
||||
popad
|
||||
@@:
|
||||
mov word [ebx+v86_regs.esi], 510h
|
||||
mov word [ebx+v86_regs.ss], 9000h
|
||||
mov word [ebx+v86_regs.esp], 0A000h
|
||||
mov word [ebx+v86_regs.eip], 500h
|
||||
mov [ebx+v86_regs.eflags], 20200h
|
||||
mov esi, [sys_v86_machine]
|
||||
mov ecx, 0x502
|
||||
push fs
|
||||
call v86_start
|
||||
pop fs
|
||||
and [bios_hdpos], 0
|
||||
pop edi esi ecx ebx
|
||||
movzx edx, byte [OS_BASE + 512h]
|
||||
test byte [int13_regs_out+v86_regs.eflags], 1
|
||||
jnz @f
|
||||
mov edx, ecx
|
||||
@@:
|
||||
ret
|
||||
; \end{diamond}
|
||||
953
kernel/branches/kolibri-process/blkdev/cd_drv.inc
Normal file
953
kernel/branches/kolibri-process/blkdev/cd_drv.inc
Normal file
@@ -0,0 +1,953 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3742 $
|
||||
|
||||
|
||||
;**********************************************************
|
||||
; Непосредственная работа с устройством СD (ATAPI)
|
||||
;**********************************************************
|
||||
; Автор части исходного текста Кулаков Владимир Геннадьевич
|
||||
; Адаптация, доработка и разработка Mario79,<Lrz>
|
||||
|
||||
; Максимальное количество повторений операции чтения
|
||||
MaxRetr equ 10
|
||||
; Предельное время ожидания готовности к приему команды
|
||||
; (в тиках)
|
||||
BSYWaitTime equ 1000 ;2
|
||||
NoTickWaitTime equ 0xfffff
|
||||
CDBlockSize equ 2048
|
||||
;********************************************
|
||||
;* ЧТЕНИЕ СЕКТОРА С ПОВТОРАМИ *
|
||||
;* Многократное повторение чтения при сбоях *
|
||||
;********************************************
|
||||
ReadCDWRetr:
|
||||
;-----------------------------------------------------------
|
||||
; input : eax = block to read
|
||||
; ebx = destination
|
||||
;-----------------------------------------------------------
|
||||
pushad
|
||||
mov eax, [CDSectorAddress]
|
||||
mov ebx, [CDDataBuf_pointer]
|
||||
call cd_calculate_cache
|
||||
xor edi, edi
|
||||
add esi, 8
|
||||
inc edi
|
||||
.hdreadcache:
|
||||
; cmp dword [esi+4],0 ; empty
|
||||
; je .nohdcache
|
||||
cmp [esi], eax ; correct sector
|
||||
je .yeshdcache
|
||||
.nohdcache:
|
||||
add esi, 8
|
||||
inc edi
|
||||
dec ecx
|
||||
jnz .hdreadcache
|
||||
call find_empty_slot_CD_cache ; ret in edi
|
||||
|
||||
push edi
|
||||
push eax
|
||||
call cd_calculate_cache_2
|
||||
shl edi, 11
|
||||
add edi, eax
|
||||
mov [CDDataBuf_pointer], edi
|
||||
pop eax
|
||||
pop edi
|
||||
|
||||
call ReadCDWRetr_1
|
||||
cmp [DevErrorCode], 0
|
||||
jne .exit
|
||||
|
||||
mov [CDDataBuf_pointer], ebx
|
||||
call cd_calculate_cache_1
|
||||
lea esi, [edi*8+esi]
|
||||
mov [esi], eax ; sector number
|
||||
; mov dword [esi+4],1 ; hd read - mark as same as in hd
|
||||
.yeshdcache:
|
||||
mov esi, edi
|
||||
shl esi, 11;9
|
||||
push eax
|
||||
call cd_calculate_cache_2
|
||||
add esi, eax
|
||||
pop eax
|
||||
mov edi, ebx;[CDDataBuf_pointer]
|
||||
mov ecx, 512;/4
|
||||
cld
|
||||
rep movsd ; move data
|
||||
.exit:
|
||||
popad
|
||||
ret
|
||||
|
||||
ReadCDWRetr_1:
|
||||
pushad
|
||||
|
||||
; Цикл, пока команда не выполнена успешно или не
|
||||
; исчерпано количество попыток
|
||||
mov ECX, MaxRetr
|
||||
@@NextRetr:
|
||||
; Подать команду
|
||||
;*************************************************
|
||||
;* ПОЛНОЕ ЧТЕНИЕ СЕКТОРА КОМПАКТ-ДИСКА *
|
||||
;* Считываются данные пользователя, информация *
|
||||
;* субканала и контрольная информация *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* перменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале; *
|
||||
;* CDSectorAddress - адрес считываемого сектора. *
|
||||
;* Данные считывается в массив CDDataBuf. *
|
||||
;*************************************************
|
||||
;ReadCD:
|
||||
push ecx
|
||||
; pusha
|
||||
; Задать размер сектора
|
||||
; mov [CDBlockSize],2048 ;2352
|
||||
; Очистить буфер пакетной команды
|
||||
call clear_packet_buffer
|
||||
; Сформировать пакетную команду для считывания
|
||||
; сектора данных
|
||||
; Задать код команды Read CD
|
||||
mov [PacketCommand], byte 0x28;0xBE
|
||||
; Задать адрес сектора
|
||||
mov AX, word [CDSectorAddress+2]
|
||||
xchg AL, AH
|
||||
mov word [PacketCommand+2], AX
|
||||
mov AX, word [CDSectorAddress]
|
||||
xchg AL, AH
|
||||
mov word [PacketCommand+4], AX
|
||||
; mov eax,[CDSectorAddress]
|
||||
; mov [PacketCommand+2],eax
|
||||
; Задать количество считываемых секторов
|
||||
mov [PacketCommand+8], byte 1
|
||||
; Задать считывание данных в полном объеме
|
||||
; mov [PacketCommand+9],byte 0xF8
|
||||
; Подать команду
|
||||
call SendPacketDatCommand
|
||||
pop ecx
|
||||
; ret
|
||||
|
||||
; cmp [DevErrorCode],0
|
||||
test eax, eax
|
||||
jz @@End_4
|
||||
|
||||
or ecx, ecx ;{SPraid.simba} (for cd load)
|
||||
jz @@End_4
|
||||
dec ecx
|
||||
|
||||
cmp [timer_ticks_enable], 0
|
||||
jne @f
|
||||
mov eax, NoTickWaitTime
|
||||
.wait:
|
||||
dec eax
|
||||
; test eax,eax
|
||||
jz @@NextRetr
|
||||
jmp .wait
|
||||
@@:
|
||||
; Задержка на 2,5 секунды
|
||||
; mov EAX,[timer_ticks]
|
||||
; add EAX,50 ;250
|
||||
;@@Wait:
|
||||
; call change_task
|
||||
; cmp EAX,[timer_ticks]
|
||||
; ja @@Wait
|
||||
loop @@NextRetr
|
||||
@@End_4:
|
||||
mov dword [DevErrorCode], eax
|
||||
popad
|
||||
ret
|
||||
|
||||
|
||||
; Универсальные процедуры, обеспечивающие выполнение
|
||||
; пакетных команд в режиме PIO
|
||||
|
||||
; Максимально допустимое время ожидания реакции
|
||||
; устройства на пакетную команду (в тиках)
|
||||
|
||||
MaxCDWaitTime equ 1000 ;200 ;10 секунд
|
||||
uglobal
|
||||
; Область памяти для формирования пакетной команды
|
||||
PacketCommand:
|
||||
rb 12 ;DB 12 DUP (?)
|
||||
; Область памяти для приема данных от дисковода
|
||||
;CDDataBuf DB 4096 DUP (0)
|
||||
; Размер принимаемого блока данных в байтах
|
||||
;CDBlockSize DW ?
|
||||
; Адрес считываемого сектора данных
|
||||
CDSectorAddress:
|
||||
DD ?
|
||||
; Время начала очередной операции с диском
|
||||
TickCounter_1 DD 0
|
||||
; Время начала ожидания готовности устройства
|
||||
WURStartTime DD 0
|
||||
; указатель буфера для считывания
|
||||
CDDataBuf_pointer dd 0
|
||||
endg
|
||||
;****************************************************
|
||||
;* ПОСЛАТЬ УСТРОЙСТВУ ATAPI ПАКЕТНУЮ КОМАНДУ, *
|
||||
;* ПРЕДУСМАТРИВАЮЩУЮ ПЕРЕДАЧУ ОДНОГО СЕКТОРА ДАННЫХ *
|
||||
;* РАЗМЕРОМ 2048 БАЙТ ОТ УСТРОЙСТВА К ХОСТУ *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* перменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале; *
|
||||
;* PacketCommand - 12-байтный командный пакет; *
|
||||
;* CDBlockSize - размер принимаемого блока данных. *
|
||||
; return eax DevErrorCode
|
||||
;****************************************************
|
||||
SendPacketDatCommand:
|
||||
xor eax, eax
|
||||
; mov byte [DevErrorCode],al
|
||||
; Задать режим CHS
|
||||
mov byte [ATAAddressMode], al
|
||||
; Послать ATA-команду передачи пакетной команды
|
||||
mov byte [ATAFeatures], al
|
||||
mov byte [ATASectorCount], al
|
||||
mov byte [ATASectorNumber], al
|
||||
; Загрузить размер передаваемого блока
|
||||
mov [ATAHead], al
|
||||
; mov AX,[CDBlockSize]
|
||||
mov [ATACylinder], CDBlockSize
|
||||
mov [ATACommand], 0A0h
|
||||
call SendCommandToHDD_1
|
||||
test eax, eax
|
||||
; cmp [DevErrorCode],0 ;проверить код ошибки
|
||||
jnz @@End_8 ;закончить, сохранив код ошибки
|
||||
|
||||
; Ожидание готовности дисковода к приему
|
||||
; пакетной команды
|
||||
mov DX, [ATABasePortAddr]
|
||||
add DX, 7 ;порт 1х7h
|
||||
mov ecx, NoTickWaitTime
|
||||
@@WaitDevice0:
|
||||
cmp [timer_ticks_enable], 0
|
||||
jne @f
|
||||
dec ecx
|
||||
; test ecx,ecx
|
||||
jz @@Err1_1
|
||||
jmp .test
|
||||
@@:
|
||||
call change_task
|
||||
; Проверить время выполнения команды
|
||||
mov EAX, [timer_ticks]
|
||||
sub EAX, [TickCounter_1]
|
||||
cmp EAX, BSYWaitTime
|
||||
ja @@Err1_1 ;ошибка тайм-аута
|
||||
; Проверить готовность
|
||||
.test:
|
||||
in AL, DX
|
||||
test AL, 80h ;состояние сигнала BSY
|
||||
jnz @@WaitDevice0
|
||||
test AL, 1 ;состояние сигнала ERR
|
||||
jnz @@Err6
|
||||
test AL, 08h ;состояние сигнала DRQ
|
||||
jz @@WaitDevice0
|
||||
; Послать пакетную команду
|
||||
cli
|
||||
mov DX, [ATABasePortAddr]
|
||||
mov AX, [PacketCommand]
|
||||
out DX, AX
|
||||
mov AX, [PacketCommand+2]
|
||||
out DX, AX
|
||||
mov AX, [PacketCommand+4]
|
||||
out DX, AX
|
||||
mov AX, [PacketCommand+6]
|
||||
out DX, AX
|
||||
mov AX, [PacketCommand+8]
|
||||
out DX, AX
|
||||
mov AX, [PacketCommand+10]
|
||||
out DX, AX
|
||||
sti
|
||||
; Ожидание готовности данных
|
||||
mov DX, [ATABasePortAddr]
|
||||
add DX, 7 ;порт 1х7h
|
||||
mov ecx, NoTickWaitTime
|
||||
@@WaitDevice1:
|
||||
cmp [timer_ticks_enable], 0
|
||||
jne @f
|
||||
dec ecx
|
||||
; test ecx,ecx
|
||||
jz @@Err1_1
|
||||
jmp .test_1
|
||||
@@:
|
||||
call change_task
|
||||
; Проверить время выполнения команды
|
||||
mov EAX, [timer_ticks]
|
||||
sub EAX, [TickCounter_1]
|
||||
cmp EAX, MaxCDWaitTime
|
||||
ja @@Err1_1 ;ошибка тайм-аута
|
||||
; Проверить готовность
|
||||
.test_1:
|
||||
in AL, DX
|
||||
test AL, 80h ;состояние сигнала BSY
|
||||
jnz @@WaitDevice1
|
||||
test AL, 1 ;состояние сигнала ERR
|
||||
jnz @@Err6_temp
|
||||
test AL, 08h ;состояние сигнала DRQ
|
||||
jz @@WaitDevice1
|
||||
; Принять блок данных от контроллера
|
||||
mov EDI, [CDDataBuf_pointer];0x7000 ;CDDataBuf
|
||||
; Загрузить адрес регистра данных контроллера
|
||||
mov DX, [ATABasePortAddr];порт 1x0h
|
||||
; Загрузить в счетчик размер блока в байтах
|
||||
xor ecx, ecx
|
||||
mov CX, CDBlockSize
|
||||
; Вычислить размер блока в 16-разрядных словах
|
||||
shr CX, 1;разделить размер блока на 2
|
||||
; Принять блок данных
|
||||
cli
|
||||
cld
|
||||
rep insw
|
||||
sti
|
||||
; Успешное завершение приема данных
|
||||
@@End_8:
|
||||
xor eax, eax
|
||||
ret
|
||||
|
||||
; Записать код ошибки
|
||||
@@Err1_1:
|
||||
xor eax, eax
|
||||
inc eax
|
||||
ret
|
||||
; mov [DevErrorCode],1
|
||||
; ret
|
||||
@@Err6_temp:
|
||||
mov eax, 7
|
||||
ret
|
||||
; mov [DevErrorCode],7
|
||||
; ret
|
||||
@@Err6:
|
||||
mov eax, 6
|
||||
ret
|
||||
; mov [DevErrorCode],6
|
||||
;@@End_8:
|
||||
; ret
|
||||
|
||||
|
||||
|
||||
;***********************************************
|
||||
;* ПОСЛАТЬ УСТРОЙСТВУ ATAPI ПАКЕТНУЮ КОМАНДУ, *
|
||||
;* НЕ ПРЕДУСМАТРИВАЮЩУЮ ПЕРЕДАЧИ ДАННЫХ *
|
||||
;* Входные параметры передаются через *
|
||||
;* глобальные перменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале; *
|
||||
;* PacketCommand - 12-байтный командный пакет. *
|
||||
;***********************************************
|
||||
SendPacketNoDatCommand:
|
||||
pushad
|
||||
xor eax, eax
|
||||
; mov byte [DevErrorCode],al
|
||||
; Задать режим CHS
|
||||
mov byte [ATAAddressMode], al
|
||||
; Послать ATA-команду передачи пакетной команды
|
||||
mov byte [ATAFeatures], al
|
||||
mov byte [ATASectorCount], al
|
||||
mov byte [ATASectorNumber], al
|
||||
mov word [ATACylinder], ax
|
||||
mov byte [ATAHead], al
|
||||
mov [ATACommand], 0A0h
|
||||
call SendCommandToHDD_1
|
||||
; cmp [DevErrorCode],0 ;проверить код ошибки
|
||||
test eax, eax
|
||||
jnz @@End_9 ;закончить, сохранив код ошибки
|
||||
; Ожидание готовности дисковода к приему
|
||||
; пакетной команды
|
||||
mov DX, [ATABasePortAddr]
|
||||
add DX, 7 ;порт 1х7h
|
||||
@@WaitDevice0_1:
|
||||
call change_task
|
||||
; Проверить время ожидания
|
||||
mov EAX, [timer_ticks]
|
||||
sub EAX, [TickCounter_1]
|
||||
cmp EAX, BSYWaitTime
|
||||
ja @@Err1_3 ;ошибка тайм-аута
|
||||
; Проверить готовность
|
||||
in AL, DX
|
||||
test AL, 80h ;состояние сигнала BSY
|
||||
jnz @@WaitDevice0_1
|
||||
test AL, 1 ;состояние сигнала ERR
|
||||
jnz @@Err6_1
|
||||
test AL, 08h ;состояние сигнала DRQ
|
||||
jz @@WaitDevice0_1
|
||||
; Послать пакетную команду
|
||||
; cli
|
||||
mov DX, [ATABasePortAddr]
|
||||
mov AX, word [PacketCommand]
|
||||
out DX, AX
|
||||
mov AX, word [PacketCommand+2]
|
||||
out DX, AX
|
||||
mov AX, word [PacketCommand+4]
|
||||
out DX, AX
|
||||
mov AX, word [PacketCommand+6]
|
||||
out DX, AX
|
||||
mov AX, word [PacketCommand+8]
|
||||
out DX, AX
|
||||
mov AX, word [PacketCommand+10]
|
||||
out DX, AX
|
||||
; sti
|
||||
cmp [ignore_CD_eject_wait], 1
|
||||
je @@clear_DEC
|
||||
; Ожидание подтверждения приема команды
|
||||
mov DX, [ATABasePortAddr]
|
||||
add DX, 7 ;порт 1х7h
|
||||
@@WaitDevice1_1:
|
||||
call change_task
|
||||
; Проверить время выполнения команды
|
||||
mov EAX, [timer_ticks]
|
||||
sub EAX, [TickCounter_1]
|
||||
cmp EAX, MaxCDWaitTime
|
||||
ja @@Err1_3 ;ошибка тайм-аута
|
||||
; Ожидать освобождения устройства
|
||||
in AL, DX
|
||||
test AL, 80h ;состояние сигнала BSY
|
||||
jnz @@WaitDevice1_1
|
||||
test AL, 1 ;состояние сигнала ERR
|
||||
jnz @@Err6_1
|
||||
test AL, 40h ;состояние сигнала DRDY
|
||||
jz @@WaitDevice1_1
|
||||
@@clear_DEC:
|
||||
and [DevErrorCode], 0
|
||||
popad
|
||||
ret
|
||||
; Записать код ошибки
|
||||
@@Err1_3:
|
||||
xor eax, eax
|
||||
inc eax
|
||||
jmp @@End_9
|
||||
@@Err6_1:
|
||||
mov eax, 6
|
||||
@@End_9:
|
||||
mov [DevErrorCode], eax
|
||||
popad
|
||||
ret
|
||||
|
||||
;****************************************************
|
||||
;* ПОСЛАТЬ КОМАНДУ ЗАДАННОМУ ДИСКУ *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* переменные: *
|
||||
;* ChannelNumber - номер канала (1 или 2); *
|
||||
;* DiskNumber - номер диска (0 или 1); *
|
||||
;* ATAFeatures - "особенности"; *
|
||||
;* ATASectorCount - количество секторов; *
|
||||
;* ATASectorNumber - номер начального сектора; *
|
||||
;* ATACylinder - номер начального цилиндра; *
|
||||
;* ATAHead - номер начальной головки; *
|
||||
;* ATAAddressMode - режим адресации (0-CHS, 1-LBA); *
|
||||
;* ATACommand - код команды. *
|
||||
;* После успешного выполнения функции: *
|
||||
;* в ATABasePortAddr - базовый адрес HDD; *
|
||||
;* в DevErrorCode - ноль. *
|
||||
;* При возникновении ошибки в DevErrorCode будет *
|
||||
;* возвращен код ошибки в eax *
|
||||
;****************************************************
|
||||
SendCommandToHDD_1:
|
||||
; pushad
|
||||
; mov [DevErrorCode],0 not need
|
||||
; Проверить значение кода режима
|
||||
cmp [ATAAddressMode], 1
|
||||
ja @@Err2_4
|
||||
; Проверить корректность номера канала
|
||||
mov BX, [ChannelNumber]
|
||||
cmp BX, 1
|
||||
jb @@Err3_4
|
||||
cmp BX, 2
|
||||
ja @@Err3_4
|
||||
; Установить базовый адрес
|
||||
dec BX
|
||||
shl BX, 1
|
||||
movzx ebx, bx
|
||||
mov AX, [ebx+StandardATABases]
|
||||
mov [ATABasePortAddr], AX
|
||||
; Ожидание готовности HDD к приему команды
|
||||
; Выбрать нужный диск
|
||||
mov DX, [ATABasePortAddr]
|
||||
add DX, 6 ;адрес регистра головок
|
||||
mov AL, [DiskNumber]
|
||||
cmp AL, 1 ;проверить номера диска
|
||||
ja @@Err4_4
|
||||
shl AL, 4
|
||||
or AL, 10100000b
|
||||
out DX, AL
|
||||
; Ожидать, пока диск не будет готов
|
||||
inc DX
|
||||
mov eax, [timer_ticks]
|
||||
mov [TickCounter_1], eax
|
||||
mov ecx, NoTickWaitTime
|
||||
@@WaitHDReady_2:
|
||||
cmp [timer_ticks_enable], 0
|
||||
jne @f
|
||||
dec ecx
|
||||
; test ecx,ecx
|
||||
jz @@Err1_4
|
||||
jmp .test
|
||||
@@:
|
||||
call change_task
|
||||
; Проверить время ожидания
|
||||
mov eax, [timer_ticks]
|
||||
sub eax, [TickCounter_1]
|
||||
cmp eax, BSYWaitTime;300 ;ожидать 3 сек.
|
||||
ja @@Err1_4 ;ошибка тайм-аута
|
||||
; Прочитать регистр состояния
|
||||
.test:
|
||||
in AL, DX
|
||||
; Проверить состояние сигнала BSY
|
||||
test AL, 80h
|
||||
jnz @@WaitHDReady_2
|
||||
; Проверить состояние сигнала DRQ
|
||||
test AL, 08h
|
||||
jnz @@WaitHDReady_2
|
||||
|
||||
; Загрузить команду в регистры контроллера
|
||||
cli
|
||||
mov DX, [ATABasePortAddr]
|
||||
inc DX ;регистр "особенностей"
|
||||
mov AL, [ATAFeatures]
|
||||
out DX, AL
|
||||
inc DX ;счетчик секторов
|
||||
mov AL, [ATASectorCount]
|
||||
out DX, AL
|
||||
inc DX ;регистр номера сектора
|
||||
mov AL, [ATASectorNumber]
|
||||
out DX, AL
|
||||
inc DX ;номер цилиндра (младший байт)
|
||||
mov AX, [ATACylinder]
|
||||
out DX, AL
|
||||
inc DX ;номер цилиндра (старший байт)
|
||||
mov AL, AH
|
||||
out DX, AL
|
||||
inc DX ;номер головки/номер диска
|
||||
mov AL, [DiskNumber]
|
||||
shl AL, 4
|
||||
cmp [ATAHead], 0Fh;проверить номер головки
|
||||
ja @@Err5_4
|
||||
or AL, [ATAHead]
|
||||
or AL, 10100000b
|
||||
mov AH, [ATAAddressMode]
|
||||
shl AH, 6
|
||||
or AL, AH
|
||||
out DX, AL
|
||||
; Послать команду
|
||||
mov AL, [ATACommand]
|
||||
inc DX ;регистр команд
|
||||
out DX, AL
|
||||
sti
|
||||
; Сбросить признак ошибки
|
||||
; mov [DevErrorCode],0
|
||||
@@End_10:
|
||||
xor eax, eax
|
||||
ret
|
||||
; Записать код ошибки
|
||||
@@Err1_4:
|
||||
xor eax, eax
|
||||
inc eax
|
||||
; mov [DevErrorCode],1
|
||||
ret
|
||||
@@Err2_4:
|
||||
mov eax, 2
|
||||
; mov [DevErrorCode],2
|
||||
ret
|
||||
@@Err3_4:
|
||||
mov eax, 3
|
||||
; mov [DevErrorCode],3
|
||||
ret
|
||||
@@Err4_4:
|
||||
mov eax, 4
|
||||
; mov [DevErrorCode],4
|
||||
ret
|
||||
@@Err5_4:
|
||||
mov eax, 5
|
||||
; mov [DevErrorCode],5
|
||||
; Завершение работы программы
|
||||
ret
|
||||
; sti
|
||||
; popad
|
||||
|
||||
;*************************************************
|
||||
;* ОЖИДАНИЕ ГОТОВНОСТИ УСТРОЙСТВА К РАБОТЕ *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* перменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале. *
|
||||
;*************************************************
|
||||
WaitUnitReady:
|
||||
pusha
|
||||
; Запомнить время начала операции
|
||||
mov EAX, [timer_ticks]
|
||||
mov [WURStartTime], EAX
|
||||
; Очистить буфер пакетной команды
|
||||
call clear_packet_buffer
|
||||
; Сформировать команду TEST UNIT READY
|
||||
mov [PacketCommand], word 00h
|
||||
; ЦИКЛ ОЖИДАНИЯ ГОТОВНОСТИ УСТРОЙСТВА
|
||||
mov ecx, NoTickWaitTime
|
||||
@@SendCommand:
|
||||
; Подать команду проверки готовности
|
||||
call SendPacketNoDatCommand
|
||||
cmp [timer_ticks_enable], 0
|
||||
jne @f
|
||||
cmp [DevErrorCode], 0
|
||||
je @@End_11
|
||||
dec ecx
|
||||
; cmp ecx,0
|
||||
jz .Error
|
||||
jmp @@SendCommand
|
||||
@@:
|
||||
call change_task
|
||||
; Проверить код ошибки
|
||||
cmp [DevErrorCode], 0
|
||||
je @@End_11
|
||||
; Проверить время ожидания готовности
|
||||
mov EAX, [timer_ticks]
|
||||
sub EAX, [WURStartTime]
|
||||
cmp EAX, MaxCDWaitTime
|
||||
jb @@SendCommand
|
||||
.Error:
|
||||
; Ошибка тайм-аута
|
||||
mov [DevErrorCode], 1
|
||||
@@End_11:
|
||||
popa
|
||||
ret
|
||||
|
||||
;*************************************************
|
||||
;* ЗАПРЕТИТЬ СМЕНУ ДИСКА *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* перменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале. *
|
||||
;*************************************************
|
||||
prevent_medium_removal:
|
||||
pusha
|
||||
; Очистить буфер пакетной команды
|
||||
call clear_packet_buffer
|
||||
; Задать код команды
|
||||
mov [PacketCommand], byte 0x1E
|
||||
; Задать код запрета
|
||||
mov [PacketCommand+4], byte 11b
|
||||
; Подать команду
|
||||
call SendPacketNoDatCommand
|
||||
mov eax, ATAPI_IDE0_lock
|
||||
add eax, [cdpos]
|
||||
dec eax
|
||||
mov [eax], byte 1
|
||||
popa
|
||||
ret
|
||||
|
||||
;*************************************************
|
||||
;* РАЗРЕШИТЬ СМЕНУ ДИСКА *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* перменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале. *
|
||||
;*************************************************
|
||||
allow_medium_removal:
|
||||
pusha
|
||||
; Очистить буфер пакетной команды
|
||||
call clear_packet_buffer
|
||||
; Задать код команды
|
||||
mov [PacketCommand], byte 0x1E
|
||||
; Задать код запрета
|
||||
mov [PacketCommand+4], byte 00b
|
||||
; Подать команду
|
||||
call SendPacketNoDatCommand
|
||||
mov eax, ATAPI_IDE0_lock
|
||||
add eax, [cdpos]
|
||||
dec eax
|
||||
mov [eax], byte 0
|
||||
popa
|
||||
ret
|
||||
|
||||
;*************************************************
|
||||
;* ЗАГРУЗИТЬ НОСИТЕЛЬ В ДИСКОВОД *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* перменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале. *
|
||||
;*************************************************
|
||||
LoadMedium:
|
||||
pusha
|
||||
; Очистить буфер пакетной команды
|
||||
call clear_packet_buffer
|
||||
; Сформировать команду START/STOP UNIT
|
||||
; Задать код команды
|
||||
mov [PacketCommand], word 1Bh
|
||||
; Задать операцию загрузки носителя
|
||||
mov [PacketCommand+4], word 00000011b
|
||||
; Подать команду
|
||||
call SendPacketNoDatCommand
|
||||
popa
|
||||
ret
|
||||
|
||||
;*************************************************
|
||||
;* ИЗВЛЕЧЬ НОСИТЕЛЬ ИЗ ДИСКОВОДА *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* перменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале. *
|
||||
;*************************************************
|
||||
EjectMedium:
|
||||
pusha
|
||||
; Очистить буфер пакетной команды
|
||||
call clear_packet_buffer
|
||||
; Сформировать команду START/STOP UNIT
|
||||
; Задать код команды
|
||||
mov [PacketCommand], word 1Bh
|
||||
; Задать операцию извлечения носителя
|
||||
mov [PacketCommand+4], word 00000010b
|
||||
; Подать команду
|
||||
call SendPacketNoDatCommand
|
||||
popa
|
||||
ret
|
||||
|
||||
;*************************************************
|
||||
;* Проверить событие нажатия кнопки извлечения *
|
||||
;* диска *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* переменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале. *
|
||||
;*************************************************
|
||||
proc check_ATAPI_device_event_has_work?
|
||||
mov eax, [timer_ticks]
|
||||
sub eax, [timer_ATAPI_check]
|
||||
cmp eax, 100
|
||||
jb .no
|
||||
.yes:
|
||||
xor eax, eax
|
||||
inc eax
|
||||
ret
|
||||
.no:
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
align 4
|
||||
check_ATAPI_device_event:
|
||||
pusha
|
||||
mov eax, [timer_ticks]
|
||||
sub eax, [timer_ATAPI_check]
|
||||
cmp eax, 100
|
||||
jb .end_1
|
||||
mov al, [DRIVE_DATA+1]
|
||||
and al, 11b
|
||||
cmp al, 10b
|
||||
jz .ide3
|
||||
.ide2_1:
|
||||
mov al, [DRIVE_DATA+1]
|
||||
and al, 1100b
|
||||
cmp al, 1000b
|
||||
jz .ide2
|
||||
.ide1_1:
|
||||
mov al, [DRIVE_DATA+1]
|
||||
and al, 110000b
|
||||
cmp al, 100000b
|
||||
jz .ide1
|
||||
.ide0_1:
|
||||
mov al, [DRIVE_DATA+1]
|
||||
and al, 11000000b
|
||||
cmp al, 10000000b
|
||||
jz .ide0
|
||||
.end:
|
||||
|
||||
sti
|
||||
mov eax, [timer_ticks]
|
||||
mov [timer_ATAPI_check], eax
|
||||
.end_1:
|
||||
popa
|
||||
ret
|
||||
|
||||
.ide3:
|
||||
cli
|
||||
cmp [ATAPI_IDE3_lock], 1
|
||||
jne .ide2_1
|
||||
cmp [IDE_Channel_2], 0
|
||||
jne .ide1_1
|
||||
cmp [cd_status], 0
|
||||
jne .end
|
||||
mov [IDE_Channel_2], 1
|
||||
mov ecx, ide_channel2_mutex
|
||||
call mutex_lock
|
||||
call reserve_ok2
|
||||
mov [ChannelNumber], 2
|
||||
mov [DiskNumber], 1
|
||||
mov [cdpos], 4
|
||||
call GetEvent_StatusNotification
|
||||
cmp [CDDataBuf+4], byte 1
|
||||
je .eject_ide3
|
||||
call syscall_cdaudio.free
|
||||
jmp .ide2_1
|
||||
.eject_ide3:
|
||||
call .eject
|
||||
call syscall_cdaudio.free
|
||||
jmp .ide2_1
|
||||
|
||||
.ide2:
|
||||
cli
|
||||
cmp [ATAPI_IDE2_lock], 1
|
||||
jne .ide1_1
|
||||
cmp [IDE_Channel_2], 0
|
||||
jne .ide1_1
|
||||
cmp [cd_status], 0
|
||||
jne .end
|
||||
mov [IDE_Channel_2], 1
|
||||
mov ecx, ide_channel2_mutex
|
||||
call mutex_lock
|
||||
call reserve_ok2
|
||||
mov [ChannelNumber], 2
|
||||
mov [DiskNumber], 0
|
||||
mov [cdpos], 3
|
||||
call GetEvent_StatusNotification
|
||||
cmp [CDDataBuf+4], byte 1
|
||||
je .eject_ide2
|
||||
call syscall_cdaudio.free
|
||||
jmp .ide1_1
|
||||
.eject_ide2:
|
||||
call .eject
|
||||
call syscall_cdaudio.free
|
||||
jmp .ide1_1
|
||||
|
||||
.ide1:
|
||||
cli
|
||||
cmp [ATAPI_IDE1_lock], 1
|
||||
jne .ide0_1
|
||||
cmp [IDE_Channel_1], 0
|
||||
jne .end
|
||||
cmp [cd_status], 0
|
||||
jne .end
|
||||
mov [IDE_Channel_1], 1
|
||||
mov ecx, ide_channel1_mutex
|
||||
call mutex_lock
|
||||
call reserve_ok2
|
||||
mov [ChannelNumber], 1
|
||||
mov [DiskNumber], 1
|
||||
mov [cdpos], 2
|
||||
call GetEvent_StatusNotification
|
||||
cmp [CDDataBuf+4], byte 1
|
||||
je .eject_ide1
|
||||
call syscall_cdaudio.free
|
||||
jmp .ide0_1
|
||||
.eject_ide1:
|
||||
call .eject
|
||||
call syscall_cdaudio.free
|
||||
jmp .ide0_1
|
||||
|
||||
.ide0:
|
||||
cli
|
||||
cmp [ATAPI_IDE0_lock], 1
|
||||
jne .end
|
||||
cmp [IDE_Channel_1], 0
|
||||
jne .end
|
||||
cmp [cd_status], 0
|
||||
jne .end
|
||||
mov [IDE_Channel_1], 1
|
||||
mov ecx, ide_channel1_mutex
|
||||
call mutex_lock
|
||||
call reserve_ok2
|
||||
mov [ChannelNumber], 1
|
||||
mov [DiskNumber], 0
|
||||
mov [cdpos], 1
|
||||
call GetEvent_StatusNotification
|
||||
cmp [CDDataBuf+4], byte 1
|
||||
je .eject_ide0
|
||||
call syscall_cdaudio.free
|
||||
jmp .end
|
||||
.eject_ide0:
|
||||
call .eject
|
||||
call syscall_cdaudio.free
|
||||
jmp .end
|
||||
|
||||
.eject:
|
||||
call clear_CD_cache
|
||||
call allow_medium_removal
|
||||
mov [ignore_CD_eject_wait], 1
|
||||
call EjectMedium
|
||||
mov [ignore_CD_eject_wait], 0
|
||||
ret
|
||||
iglobal
|
||||
timer_ATAPI_check dd 0
|
||||
ATAPI_IDE0_lock db 0
|
||||
ATAPI_IDE1_lock db 0
|
||||
ATAPI_IDE2_lock db 0
|
||||
ATAPI_IDE3_lock db 0
|
||||
ignore_CD_eject_wait db 0
|
||||
endg
|
||||
;*************************************************
|
||||
;* Получить сообщение о событии или состоянии *
|
||||
;* устройства *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* переменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале. *
|
||||
;*************************************************
|
||||
GetEvent_StatusNotification:
|
||||
pusha
|
||||
mov [CDDataBuf_pointer], CDDataBuf
|
||||
; Очистить буфер пакетной команды
|
||||
call clear_packet_buffer
|
||||
; Задать код команды
|
||||
mov [PacketCommand], byte 4Ah
|
||||
mov [PacketCommand+1], byte 00000001b
|
||||
; Задать запрос класса сообщений
|
||||
mov [PacketCommand+4], byte 00010000b
|
||||
; Размер выделенной области
|
||||
mov [PacketCommand+7], byte 8h
|
||||
mov [PacketCommand+8], byte 0h
|
||||
; Подать команду
|
||||
call SendPacketDatCommand
|
||||
popa
|
||||
ret
|
||||
|
||||
;*************************************************
|
||||
; прочитать информацию из TOC
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* переменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале. *
|
||||
;*************************************************
|
||||
Read_TOC:
|
||||
pusha
|
||||
mov [CDDataBuf_pointer], CDDataBuf
|
||||
; Очистить буфер пакетной команды
|
||||
call clear_packet_buffer
|
||||
; Сформировать пакетную команду для считывания
|
||||
; сектора данных
|
||||
mov [PacketCommand], byte 0x43
|
||||
; Задать формат
|
||||
mov [PacketCommand+2], byte 1
|
||||
; Размер выделенной области
|
||||
mov [PacketCommand+7], byte 0xFF
|
||||
mov [PacketCommand+8], byte 0h
|
||||
; Подать команду
|
||||
call SendPacketDatCommand
|
||||
popa
|
||||
ret
|
||||
|
||||
;*************************************************
|
||||
;* ОПРЕДЕЛИТЬ ОБЩЕЕ КОЛИЧЕСТВО СЕКТОРОВ НА ДИСКЕ *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* переменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале. *
|
||||
;*************************************************
|
||||
;ReadCapacity:
|
||||
; pusha
|
||||
;; Очистить буфер пакетной команды
|
||||
; call clear_packet_buffer
|
||||
;; Задать размер буфера в байтах
|
||||
; mov [CDBlockSize],8
|
||||
;; Сформировать команду READ CAPACITY
|
||||
; mov [PacketCommand],word 25h
|
||||
;; Подать команду
|
||||
; call SendPacketDatCommand
|
||||
; popa
|
||||
; ret
|
||||
|
||||
clear_packet_buffer:
|
||||
; Очистить буфер пакетной команды
|
||||
and [PacketCommand], dword 0
|
||||
and [PacketCommand+4], dword 0
|
||||
and [PacketCommand+8], dword 0
|
||||
ret
|
||||
271
kernel/branches/kolibri-process/blkdev/cdrom.inc
Normal file
271
kernel/branches/kolibri-process/blkdev/cdrom.inc
Normal file
@@ -0,0 +1,271 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Copyright (C) MenuetOS 2000-2004 Ville Mikael Turjanmaa ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
sys_cd_audio:
|
||||
|
||||
cmp word [cdbase], word 0
|
||||
jnz @f
|
||||
mov eax, 1
|
||||
ret
|
||||
@@:
|
||||
|
||||
; eax=1 cdplay at ebx 0x00FFSSMM
|
||||
; eax=2 get tracklist size of ecx to [ebx]
|
||||
; eax=3 stop/pause playing
|
||||
|
||||
cmp eax, 1
|
||||
jnz nocdp
|
||||
call sys_cdplay
|
||||
ret
|
||||
nocdp:
|
||||
|
||||
cmp eax, 2
|
||||
jnz nocdtl
|
||||
mov edi, [TASK_BASE]
|
||||
add edi, TASKDATA.mem_start
|
||||
add ebx, [edi]
|
||||
call sys_cdtracklist
|
||||
ret
|
||||
nocdtl:
|
||||
|
||||
cmp eax, 3
|
||||
jnz nocdpause
|
||||
call sys_cdpause
|
||||
ret
|
||||
nocdpause:
|
||||
|
||||
mov eax, 0xffffff01
|
||||
ret
|
||||
|
||||
|
||||
|
||||
sys_cd_atapi_command:
|
||||
|
||||
pushad
|
||||
|
||||
mov dx, word [cdbase]
|
||||
add dx, 6
|
||||
mov ax, word [cdid]
|
||||
out dx, al
|
||||
mov esi, 10
|
||||
call delay_ms
|
||||
mov dx, word [cdbase]
|
||||
add dx, 7
|
||||
in al, dx
|
||||
and al, 0x80
|
||||
cmp al, 0
|
||||
jnz res
|
||||
jmp cdl6
|
||||
res:
|
||||
mov dx, word [cdbase]
|
||||
add dx, 7
|
||||
mov al, 0x8
|
||||
out dx, al
|
||||
mov dx, word [cdbase]
|
||||
add dx, 0x206
|
||||
mov al, 0xe
|
||||
out dx, al
|
||||
mov esi, 1
|
||||
call delay_ms
|
||||
mov dx, word [cdbase]
|
||||
add dx, 0x206
|
||||
mov al, 0x8
|
||||
out dx, al
|
||||
mov esi, 30
|
||||
call delay_ms
|
||||
xor cx, cx
|
||||
cdl5:
|
||||
inc cx
|
||||
cmp cx, 10
|
||||
jz cdl6
|
||||
mov dx, word [cdbase]
|
||||
add dx, 7
|
||||
in al, dx
|
||||
and al, 0x88
|
||||
cmp al, 0x00
|
||||
jz cdl5
|
||||
mov esi, 100
|
||||
call delay_ms
|
||||
jmp cdl5
|
||||
cdl6:
|
||||
mov dx, word [cdbase]
|
||||
add dx, 4
|
||||
mov al, 0
|
||||
out dx, al
|
||||
mov dx, word [cdbase]
|
||||
add dx, 5
|
||||
mov al, 0
|
||||
out dx, al
|
||||
mov dx, word [cdbase]
|
||||
add dx, 7
|
||||
mov al, 0xec
|
||||
out dx, al
|
||||
mov esi, 5
|
||||
call delay_ms
|
||||
mov dx, word [cdbase]
|
||||
add dx, 1
|
||||
mov al, 0
|
||||
out dx, al
|
||||
add dx, 1
|
||||
mov al, 0
|
||||
out dx, al
|
||||
add dx, 1
|
||||
mov al, 0
|
||||
out dx, al
|
||||
add dx, 1
|
||||
mov al, 0
|
||||
out dx, al
|
||||
add dx, 1
|
||||
mov al, 128
|
||||
out dx, al
|
||||
add dx, 2
|
||||
mov al, 0xa0
|
||||
out dx, al
|
||||
xor cx, cx
|
||||
mov dx, word [cdbase]
|
||||
add dx, 7
|
||||
cdl1:
|
||||
inc cx
|
||||
cmp cx, 100
|
||||
jz cdl2
|
||||
in al, dx
|
||||
and ax, 0x88
|
||||
cmp al, 0x8
|
||||
jz cdl2
|
||||
mov esi, 2
|
||||
call delay_ms
|
||||
jmp cdl1
|
||||
cdl2:
|
||||
|
||||
popad
|
||||
ret
|
||||
|
||||
|
||||
sys_cdplay:
|
||||
|
||||
mov ax, 5
|
||||
push ax
|
||||
push ebx
|
||||
cdplay:
|
||||
call sys_cd_atapi_command
|
||||
cli
|
||||
mov dx, word [cdbase]
|
||||
mov ax, 0x0047
|
||||
out dx, ax
|
||||
mov al, 1
|
||||
mov ah, [esp+0]; min xx
|
||||
out dx, ax
|
||||
mov ax, [esp+1]; fr sec
|
||||
out dx, ax
|
||||
mov ax, 256+99
|
||||
out dx, ax
|
||||
mov ax, 0x0001
|
||||
out dx, ax
|
||||
mov ax, 0x0000
|
||||
out dx, ax
|
||||
mov esi, 10
|
||||
call delay_ms
|
||||
sti
|
||||
add dx, 7
|
||||
in al, dx
|
||||
test al, 1
|
||||
jz cdplayok
|
||||
mov ax, [esp+4]
|
||||
dec ax
|
||||
mov [esp+4], ax
|
||||
cmp ax, 0
|
||||
jz cdplayfail
|
||||
jmp cdplay
|
||||
cdplayfail:
|
||||
cdplayok:
|
||||
pop ebx
|
||||
pop ax
|
||||
xor eax, eax
|
||||
ret
|
||||
|
||||
|
||||
sys_cdtracklist:
|
||||
|
||||
push ebx
|
||||
tcdplay:
|
||||
call sys_cd_atapi_command
|
||||
mov dx, word [cdbase]
|
||||
mov ax, 0x43+2*256
|
||||
out dx, ax
|
||||
mov ax, 0x0
|
||||
out dx, ax
|
||||
mov ax, 0x0
|
||||
out dx, ax
|
||||
mov ax, 0x0
|
||||
out dx, ax
|
||||
mov ax, 200
|
||||
out dx, ax
|
||||
mov ax, 0x0
|
||||
out dx, ax
|
||||
in al, dx
|
||||
mov cx, 1000
|
||||
mov dx, word [cdbase]
|
||||
add dx, 7
|
||||
cld
|
||||
cdtrnwewait:
|
||||
mov esi, 10
|
||||
call delay_ms
|
||||
in al, dx
|
||||
and al, 128
|
||||
cmp al, 0
|
||||
jz cdtrl1
|
||||
loop cdtrnwewait
|
||||
cdtrl1:
|
||||
; read the result
|
||||
mov ecx, [esp+0]
|
||||
mov dx, word [cdbase]
|
||||
cdtrread:
|
||||
add dx, 7
|
||||
in al, dx
|
||||
and al, 8
|
||||
cmp al, 8
|
||||
jnz cdtrdone
|
||||
sub dx, 7
|
||||
in ax, dx
|
||||
mov [ecx], ax
|
||||
add ecx, 2
|
||||
jmp cdtrread
|
||||
cdtrdone:
|
||||
pop ecx
|
||||
xor eax, eax
|
||||
ret
|
||||
|
||||
|
||||
sys_cdpause:
|
||||
|
||||
call sys_cd_atapi_command
|
||||
|
||||
mov dx, word [cdbase]
|
||||
mov ax, 0x004B
|
||||
out dx, ax
|
||||
mov ax, 0
|
||||
out dx, ax
|
||||
mov ax, 0
|
||||
out dx, ax
|
||||
mov ax, 0
|
||||
out dx, ax
|
||||
mov ax, 0
|
||||
out dx, ax
|
||||
mov ax, 0
|
||||
out dx, ax
|
||||
|
||||
mov esi, 10
|
||||
call delay_ms
|
||||
add dx, 7
|
||||
in al, dx
|
||||
|
||||
xor eax, eax
|
||||
ret
|
||||
|
||||
1330
kernel/branches/kolibri-process/blkdev/disk.inc
Normal file
1330
kernel/branches/kolibri-process/blkdev/disk.inc
Normal file
File diff suppressed because it is too large
Load Diff
588
kernel/branches/kolibri-process/blkdev/disk_cache.inc
Normal file
588
kernel/branches/kolibri-process/blkdev/disk_cache.inc
Normal file
@@ -0,0 +1,588 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2011-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4133 $
|
||||
|
||||
; This function is intended to replace the old 'hd_read' function when
|
||||
; [hdd_appl_data] = 0, so its input/output parameters are the same, except
|
||||
; that it can't use the global variables 'hd_error' and 'hdd_appl_data'.
|
||||
; in: eax = sector, ebx = buffer, ebp = pointer to PARTITION structure
|
||||
; eax is relative to partition start
|
||||
; out: eax = error code; 0 = ok
|
||||
fs_read32_sys:
|
||||
; Save ecx, set ecx to SysCache and let the common part do its work.
|
||||
push ecx
|
||||
mov ecx, [ebp+PARTITION.Disk]
|
||||
add ecx, DISK.SysCache
|
||||
jmp fs_read32_common
|
||||
|
||||
; This function is intended to replace the old 'hd_read' function when
|
||||
; [hdd_appl_data] = 1, so its input/output parameters are the same, except
|
||||
; that it can't use the global variables 'hd_error' and 'hdd_appl_data'.
|
||||
; in: eax = sector, ebx = buffer, ebp = pointer to PARTITION structure
|
||||
; eax is relative to partition start
|
||||
; out: eax = error code; 0 = ok
|
||||
fs_read32_app:
|
||||
; Save ecx, set ecx to AppCache and let the common part do its work.
|
||||
push ecx
|
||||
mov ecx, [ebp+PARTITION.Disk]
|
||||
add ecx, DISK.AppCache
|
||||
|
||||
; This label is the common part of fs_read32_sys and fs_read32_app.
|
||||
fs_read32_common:
|
||||
; 1. Check that the required sector is inside the partition. If no, return
|
||||
; DISK_STATUS_END_OF_MEDIA.
|
||||
cmp dword [ebp+PARTITION.Length+4], 0
|
||||
jnz @f
|
||||
cmp dword [ebp+PARTITION.Length], eax
|
||||
ja @f
|
||||
mov eax, DISK_STATUS_END_OF_MEDIA
|
||||
pop ecx
|
||||
ret
|
||||
@@:
|
||||
; 2. Get the absolute sector on the disk.
|
||||
push edx esi
|
||||
xor edx, edx
|
||||
add eax, dword [ebp+PARTITION.FirstSector]
|
||||
adc edx, dword [ebp+PARTITION.FirstSector+4]
|
||||
; 3. If there is no cache for this disk, just pass the request to the driver.
|
||||
cmp [ecx+DISKCACHE.pointer], 0
|
||||
jnz .scancache
|
||||
push 1
|
||||
push esp ; numsectors
|
||||
push edx ; startsector
|
||||
push eax ; startsector
|
||||
push ebx ; buffer
|
||||
mov esi, [ebp+PARTITION.Disk]
|
||||
mov al, DISKFUNC.read
|
||||
call disk_call_driver
|
||||
pop ecx
|
||||
pop esi edx
|
||||
pop ecx
|
||||
ret
|
||||
.scancache:
|
||||
; 4. Scan the cache.
|
||||
push edi ecx ; scan cache
|
||||
push edx eax
|
||||
virtual at esp
|
||||
.sector_lo dd ?
|
||||
.sector_hi dd ?
|
||||
.cache dd ?
|
||||
end virtual
|
||||
; The following code is inherited from hd_read. The differences are:
|
||||
; all code is protected by the cache lock; instead of static calls
|
||||
; to hd_read_dma/hd_read_pio/bd_read the dynamic call to DISKFUNC.read is used;
|
||||
; sector is 64-bit, not 32-bit.
|
||||
call mutex_lock
|
||||
mov eax, [.sector_lo]
|
||||
mov edx, [.sector_hi]
|
||||
mov esi, [ecx+DISKCACHE.pointer]
|
||||
mov ecx, [ecx+DISKCACHE.sad_size]
|
||||
add esi, 12
|
||||
|
||||
mov edi, 1
|
||||
|
||||
.hdreadcache:
|
||||
|
||||
cmp dword [esi+8], 0 ; empty
|
||||
je .nohdcache
|
||||
|
||||
cmp [esi], eax ; correct sector
|
||||
jne .nohdcache
|
||||
cmp [esi+4], edx ; correct sector
|
||||
je .yeshdcache
|
||||
|
||||
.nohdcache:
|
||||
|
||||
add esi, 12
|
||||
inc edi
|
||||
dec ecx
|
||||
jnz .hdreadcache
|
||||
|
||||
mov esi, [.cache]
|
||||
call find_empty_slot64 ; ret in edi
|
||||
test eax, eax
|
||||
jnz .read_done
|
||||
|
||||
push 1
|
||||
push esp
|
||||
push edx
|
||||
push [.sector_lo+12]
|
||||
mov ecx, [.cache+16]
|
||||
mov eax, edi
|
||||
shl eax, 9
|
||||
add eax, [ecx+DISKCACHE.data]
|
||||
push eax
|
||||
mov esi, [ebp+PARTITION.Disk]
|
||||
mov al, DISKFUNC.read
|
||||
call disk_call_driver
|
||||
pop ecx
|
||||
dec ecx
|
||||
jnz .read_done
|
||||
|
||||
mov ecx, [.cache]
|
||||
lea eax, [edi*3]
|
||||
mov esi, [ecx+DISKCACHE.pointer]
|
||||
lea esi, [eax*4+esi]
|
||||
|
||||
mov eax, [.sector_lo]
|
||||
mov edx, [.sector_hi]
|
||||
mov [esi], eax ; sector number
|
||||
mov [esi+4], edx ; sector number
|
||||
mov dword [esi+8], 1; hd read - mark as same as in hd
|
||||
|
||||
.yeshdcache:
|
||||
|
||||
mov esi, edi
|
||||
mov ecx, [.cache]
|
||||
shl esi, 9
|
||||
add esi, [ecx+DISKCACHE.data]
|
||||
|
||||
mov edi, ebx
|
||||
mov ecx, 512/4
|
||||
rep movsd ; move data
|
||||
xor eax, eax ; successful read
|
||||
.read_done:
|
||||
mov ecx, [.cache]
|
||||
push eax
|
||||
call mutex_unlock
|
||||
pop eax
|
||||
add esp, 12
|
||||
pop edi esi edx ecx
|
||||
ret
|
||||
|
||||
; This function is intended to replace the old 'hd_write' function when
|
||||
; [hdd_appl_data] = 0, so its input/output parameters are the same, except
|
||||
; that it can't use the global variables 'hd_error' and 'hdd_appl_data'.
|
||||
; in: eax = sector, ebx = buffer, ebp = pointer to PARTITION structure
|
||||
; eax is relative to partition start
|
||||
; out: eax = error code; 0 = ok
|
||||
fs_write32_sys:
|
||||
; Save ecx, set ecx to SysCache and let the common part do its work.
|
||||
push ecx
|
||||
mov ecx, [ebp+PARTITION.Disk]
|
||||
add ecx, DISK.SysCache
|
||||
jmp fs_write32_common
|
||||
|
||||
; This function is intended to replace the old 'hd_write' function when
|
||||
; [hdd_appl_data] = 1, so its input/output parameters are the same, except
|
||||
; that it can't use the global variables 'hd_error' and 'hdd_appl_data'.
|
||||
; in: eax = sector, ebx = buffer, ebp = pointer to PARTITION structure
|
||||
; eax is relative to partition start
|
||||
; out: eax = error code; 0 = ok
|
||||
fs_write32_app:
|
||||
; Save ecx, set ecx to AppCache and let the common part do its work.
|
||||
push ecx
|
||||
mov ecx, [ebp+PARTITION.Disk]
|
||||
add ecx, DISK.AppCache
|
||||
|
||||
; This label is the common part of fs_read32_sys and fs_read32_app.
|
||||
fs_write32_common:
|
||||
; 1. Check that the required sector is inside the partition. If no, return
|
||||
; DISK_STATUS_END_OF_MEDIA.
|
||||
cmp dword [ebp+PARTITION.Length+4], 0
|
||||
jnz @f
|
||||
cmp dword [ebp+PARTITION.Length], eax
|
||||
ja @f
|
||||
mov eax, DISK_STATUS_END_OF_MEDIA
|
||||
pop ecx
|
||||
ret
|
||||
@@:
|
||||
push edx esi
|
||||
; 2. Get the absolute sector on the disk.
|
||||
xor edx, edx
|
||||
add eax, dword [ebp+PARTITION.FirstSector]
|
||||
adc edx, dword [ebp+PARTITION.FirstSector+4]
|
||||
; 3. If there is no cache for this disk, just pass request to the driver.
|
||||
cmp [ecx+DISKCACHE.pointer], 0
|
||||
jnz .scancache
|
||||
push 1
|
||||
push esp ; numsectors
|
||||
push edx ; startsector
|
||||
push eax ; startsector
|
||||
push ebx ; buffer
|
||||
mov esi, [ebp+PARTITION.Disk]
|
||||
mov al, DISKFUNC.write
|
||||
call disk_call_driver
|
||||
pop ecx
|
||||
pop esi edx
|
||||
pop ecx
|
||||
ret
|
||||
.scancache:
|
||||
; 4. Scan the cache.
|
||||
push edi ecx ; scan cache
|
||||
push edx eax
|
||||
virtual at esp
|
||||
.sector_lo dd ?
|
||||
.sector_hi dd ?
|
||||
.cache dd ?
|
||||
end virtual
|
||||
; The following code is inherited from hd_write. The differences are:
|
||||
; all code is protected by the cache lock;
|
||||
; sector is 64-bit, not 32-bit.
|
||||
call mutex_lock
|
||||
|
||||
; check if the cache already has the sector and overwrite it
|
||||
mov eax, [.sector_lo]
|
||||
mov edx, [.sector_hi]
|
||||
mov esi, [ecx+DISKCACHE.pointer]
|
||||
mov ecx, [ecx+DISKCACHE.sad_size]
|
||||
add esi, 12
|
||||
|
||||
mov edi, 1
|
||||
|
||||
.hdwritecache:
|
||||
cmp dword [esi+8], 0 ; if cache slot is empty
|
||||
je .not_in_cache_write
|
||||
|
||||
cmp [esi], eax ; if the slot has the sector
|
||||
jne .not_in_cache_write
|
||||
cmp [esi+4], edx ; if the slot has the sector
|
||||
je .yes_in_cache_write
|
||||
|
||||
.not_in_cache_write:
|
||||
|
||||
add esi, 12
|
||||
inc edi
|
||||
dec ecx
|
||||
jnz .hdwritecache
|
||||
|
||||
; sector not found in cache
|
||||
; write the block to a new location
|
||||
|
||||
mov esi, [.cache]
|
||||
call find_empty_slot64 ; ret in edi
|
||||
test eax, eax
|
||||
jne .hd_write_access_denied
|
||||
|
||||
mov ecx, [.cache]
|
||||
lea eax, [edi*3]
|
||||
mov esi, [ecx+DISKCACHE.pointer]
|
||||
lea esi, [eax*4+esi]
|
||||
|
||||
mov eax, [.sector_lo]
|
||||
mov edx, [.sector_hi]
|
||||
mov [esi], eax ; sector number
|
||||
mov [esi+4], edx ; sector number
|
||||
|
||||
.yes_in_cache_write:
|
||||
|
||||
mov dword [esi+8], 2 ; write - differs from hd
|
||||
|
||||
shl edi, 9
|
||||
mov ecx, [.cache]
|
||||
add edi, [ecx+DISKCACHE.data]
|
||||
|
||||
mov esi, ebx
|
||||
mov ecx, 512/4
|
||||
rep movsd ; move data
|
||||
xor eax, eax ; success
|
||||
.hd_write_access_denied:
|
||||
mov ecx, [.cache]
|
||||
push eax
|
||||
call mutex_unlock
|
||||
pop eax
|
||||
add esp, 12
|
||||
pop edi esi edx ecx
|
||||
ret
|
||||
|
||||
; This internal function is called from fs_read32_* and fs_write32_*. It is the
|
||||
; analogue of find_empty_slot for 64-bit sectors.
|
||||
find_empty_slot64:
|
||||
;-----------------------------------------------------------
|
||||
; find empty or read slot, flush cache if next 12.5% is used by write
|
||||
; output : edi = cache slot
|
||||
;-----------------------------------------------------------
|
||||
.search_again:
|
||||
mov ecx, [esi+DISKCACHE.sad_size]
|
||||
mov edi, [esi+DISKCACHE.search_start]
|
||||
shr ecx, 3
|
||||
.search_for_empty:
|
||||
inc edi
|
||||
cmp edi, [esi+DISKCACHE.sad_size]
|
||||
jbe .inside_cache
|
||||
mov edi, 1
|
||||
.inside_cache:
|
||||
lea eax, [edi*3]
|
||||
shl eax, 2
|
||||
add eax, [esi+DISKCACHE.pointer]
|
||||
cmp dword [eax+8], 2
|
||||
jb .found_slot ; it's empty or read
|
||||
dec ecx
|
||||
jnz .search_for_empty
|
||||
stdcall write_cache64, [ebp+PARTITION.Disk] ; no empty slots found, write all
|
||||
test eax, eax
|
||||
jne .found_slot_access_denied
|
||||
jmp .search_again ; and start again
|
||||
.found_slot:
|
||||
mov [esi+DISKCACHE.search_start], edi
|
||||
xor eax, eax ; success
|
||||
.found_slot_access_denied:
|
||||
ret
|
||||
|
||||
; This function is intended to replace the old 'write_cache' function.
|
||||
proc write_cache64 uses ecx edx esi edi, disk:dword
|
||||
locals
|
||||
cache_chain_started dd 0
|
||||
cache_chain_size dd ?
|
||||
cache_chain_pos dd ?
|
||||
cache_chain_ptr dd ?
|
||||
endl
|
||||
saved_esi_pos = 16+12 ; size of local variables + size of registers before esi
|
||||
; If there is no cache for this disk, nothing to do.
|
||||
cmp [esi+DISKCACHE.pointer], 0
|
||||
jz .flush
|
||||
;-----------------------------------------------------------
|
||||
; write all changed sectors to disk
|
||||
;-----------------------------------------------------------
|
||||
|
||||
; write difference ( 2 ) from cache to DISK
|
||||
mov ecx, [esi+DISKCACHE.sad_size]
|
||||
mov esi, [esi+DISKCACHE.pointer]
|
||||
add esi, 12
|
||||
mov edi, 1
|
||||
.write_cache_more:
|
||||
cmp dword [esi+8], 2 ; if cache slot is not different
|
||||
jne .write_chain
|
||||
mov dword [esi+8], 1 ; same as in hd
|
||||
mov eax, [esi]
|
||||
mov edx, [esi+4] ; edx:eax = sector to write
|
||||
; Объединяем запись цепочки последовательных секторов в одно обращение к диску
|
||||
cmp ecx, 1
|
||||
jz .nonext
|
||||
cmp dword [esi+12+8], 2
|
||||
jnz .nonext
|
||||
push eax edx
|
||||
add eax, 1
|
||||
adc edx, 0
|
||||
cmp eax, [esi+12]
|
||||
jnz @f
|
||||
cmp edx, [esi+12+4]
|
||||
@@:
|
||||
pop edx eax
|
||||
jnz .nonext
|
||||
cmp [cache_chain_started], 1
|
||||
jz @f
|
||||
mov [cache_chain_started], 1
|
||||
mov [cache_chain_size], 0
|
||||
mov [cache_chain_pos], edi
|
||||
mov [cache_chain_ptr], esi
|
||||
@@:
|
||||
inc [cache_chain_size]
|
||||
cmp [cache_chain_size], 16
|
||||
jnz .continue
|
||||
jmp .write_chain
|
||||
.nonext:
|
||||
call .flush_cache_chain
|
||||
test eax, eax
|
||||
jnz .nothing
|
||||
mov [cache_chain_size], 1
|
||||
mov [cache_chain_ptr], esi
|
||||
call .write_cache_sector
|
||||
test eax, eax
|
||||
jnz .nothing
|
||||
jmp .continue
|
||||
.write_chain:
|
||||
call .flush_cache_chain
|
||||
test eax, eax
|
||||
jnz .nothing
|
||||
.continue:
|
||||
add esi, 12
|
||||
inc edi
|
||||
dec ecx
|
||||
jnz .write_cache_more
|
||||
call .flush_cache_chain
|
||||
test eax, eax
|
||||
jnz .nothing
|
||||
.flush:
|
||||
mov esi, [disk]
|
||||
mov al, DISKFUNC.flush
|
||||
call disk_call_driver
|
||||
.nothing:
|
||||
ret
|
||||
|
||||
.flush_cache_chain:
|
||||
xor eax, eax
|
||||
cmp [cache_chain_started], eax
|
||||
jz @f
|
||||
call .write_cache_chain
|
||||
mov [cache_chain_started], 0
|
||||
@@:
|
||||
retn
|
||||
|
||||
.write_cache_sector:
|
||||
mov [cache_chain_size], 1
|
||||
mov [cache_chain_pos], edi
|
||||
.write_cache_chain:
|
||||
pusha
|
||||
mov edi, [cache_chain_pos]
|
||||
mov ecx, [ebp-saved_esi_pos]
|
||||
shl edi, 9
|
||||
add edi, [ecx+DISKCACHE.data]
|
||||
mov ecx, [cache_chain_size]
|
||||
push ecx
|
||||
push esp ; numsectors
|
||||
mov eax, [cache_chain_ptr]
|
||||
pushd [eax+4]
|
||||
pushd [eax] ; startsector
|
||||
push edi ; buffer
|
||||
mov esi, [ebp]
|
||||
mov esi, [esi+PARTITION.Disk]
|
||||
mov al, DISKFUNC.write
|
||||
call disk_call_driver
|
||||
pop ecx
|
||||
mov [esp+28], eax
|
||||
popa
|
||||
retn
|
||||
endp
|
||||
|
||||
; This internal function is called from disk_add to initialize the caching for
|
||||
; a new DISK.
|
||||
; The algorithm is inherited from getcache.inc: take 1/32 part of the available
|
||||
; physical memory, round down to 8 pages, limit by 128K from below and by 1M
|
||||
; from above. Reserve 1/8 part of the cache for system data and 7/8 for app
|
||||
; data.
|
||||
; After the size is calculated, but before the cache is allocated, the device
|
||||
; driver can adjust the size. In particular, setting size to zero disables
|
||||
; caching: there is no sense in a cache for a ramdisk. In fact, such action
|
||||
; is most useful example of a non-trivial adjustment.
|
||||
; esi = pointer to DISK structure
|
||||
disk_init_cache:
|
||||
; 1. Calculate the suggested cache size.
|
||||
; 1a. Get the size of free physical memory in pages.
|
||||
mov eax, [pg_data.pages_free]
|
||||
; 1b. Use the value to calculate the size.
|
||||
shl eax, 12 - 5 ; 1/32 of it in bytes
|
||||
and eax, -8*4096 ; round down to the multiple of 8 pages
|
||||
; 1c. Force lower and upper limits.
|
||||
cmp eax, 1024*1024
|
||||
jb @f
|
||||
mov eax, 1024*1024
|
||||
@@:
|
||||
cmp eax, 128*1024
|
||||
ja @f
|
||||
mov eax, 128*1024
|
||||
@@:
|
||||
; 1d. Give a chance to the driver to adjust the size.
|
||||
push eax
|
||||
mov al, DISKFUNC.adjust_cache_size
|
||||
call disk_call_driver
|
||||
; Cache size calculated.
|
||||
mov [esi+DISK.cache_size], eax
|
||||
test eax, eax
|
||||
jz .nocache
|
||||
; 2. Allocate memory for the cache.
|
||||
; 2a. Call the allocator.
|
||||
stdcall kernel_alloc, eax
|
||||
test eax, eax
|
||||
jnz @f
|
||||
; 2b. If it failed, say a message and return with eax = 0.
|
||||
dbgstr 'no memory for disk cache'
|
||||
jmp .nothing
|
||||
@@:
|
||||
; 3. Fill two DISKCACHE structures.
|
||||
mov [esi+DISK.SysCache.pointer], eax
|
||||
lea ecx, [esi+DISK.SysCache.mutex]
|
||||
call mutex_init
|
||||
lea ecx, [esi+DISK.AppCache.mutex]
|
||||
call mutex_init
|
||||
; The following code is inherited from getcache.inc.
|
||||
mov edx, [esi+DISK.SysCache.pointer]
|
||||
and [esi+DISK.SysCache.search_start], 0
|
||||
and [esi+DISK.AppCache.search_start], 0
|
||||
mov eax, [esi+DISK.cache_size]
|
||||
shr eax, 3
|
||||
mov [esi+DISK.SysCache.data_size], eax
|
||||
add edx, eax
|
||||
imul eax, 7
|
||||
mov [esi+DISK.AppCache.data_size], eax
|
||||
mov [esi+DISK.AppCache.pointer], edx
|
||||
|
||||
mov eax, [esi+DISK.SysCache.data_size]
|
||||
push ebx
|
||||
call calculate_for_hd64
|
||||
pop ebx
|
||||
add eax, [esi+DISK.SysCache.pointer]
|
||||
mov [esi+DISK.SysCache.data], eax
|
||||
mov [esi+DISK.SysCache.sad_size], ecx
|
||||
|
||||
push edi
|
||||
mov edi, [esi+DISK.SysCache.pointer]
|
||||
lea ecx, [(ecx+1)*3]
|
||||
xor eax, eax
|
||||
rep stosd
|
||||
pop edi
|
||||
|
||||
mov eax, [esi+DISK.AppCache.data_size]
|
||||
push ebx
|
||||
call calculate_for_hd64
|
||||
pop ebx
|
||||
add eax, [esi+DISK.AppCache.pointer]
|
||||
mov [esi+DISK.AppCache.data], eax
|
||||
mov [esi+DISK.AppCache.sad_size], ecx
|
||||
|
||||
push edi
|
||||
mov edi, [esi+DISK.AppCache.pointer]
|
||||
lea ecx, [(ecx+1)*3]
|
||||
xor eax, eax
|
||||
rep stosd
|
||||
pop edi
|
||||
|
||||
; 4. Return with nonzero al.
|
||||
mov al, 1
|
||||
; 5. Return.
|
||||
.nothing:
|
||||
ret
|
||||
; No caching is required for this driver. Zero cache pointers and return with
|
||||
; nonzero al.
|
||||
.nocache:
|
||||
mov [esi+DISK.SysCache.pointer], eax
|
||||
mov [esi+DISK.AppCache.pointer], eax
|
||||
mov al, 1
|
||||
ret
|
||||
|
||||
calculate_for_hd64:
|
||||
push eax
|
||||
mov ebx, eax
|
||||
shr eax, 9
|
||||
lea eax, [eax*3]
|
||||
shl eax, 2
|
||||
sub ebx, eax
|
||||
shr ebx, 9
|
||||
mov ecx, ebx
|
||||
shl ebx, 9
|
||||
pop eax
|
||||
sub eax, ebx
|
||||
dec ecx
|
||||
ret
|
||||
|
||||
|
||||
; This internal function is called from disk_media_dereference to free the
|
||||
; allocated cache, if there is one.
|
||||
; esi = pointer to DISK structure
|
||||
disk_free_cache:
|
||||
; The algorithm is straightforward.
|
||||
mov eax, [esi+DISK.SysCache.pointer]
|
||||
test eax, eax
|
||||
jz .nothing
|
||||
stdcall kernel_free, eax
|
||||
.nothing:
|
||||
ret
|
||||
|
||||
; This function flushes all modified data from both caches for the given DISK.
|
||||
; esi = pointer to DISK
|
||||
disk_sync:
|
||||
; The algorithm is straightforward.
|
||||
push esi
|
||||
push esi ; for second write_cache64
|
||||
push esi ; for first write_cache64
|
||||
add esi, DISK.SysCache
|
||||
call write_cache64
|
||||
add esi, DISK.AppCache - DISK.SysCache
|
||||
call write_cache64
|
||||
pop esi
|
||||
ret
|
||||
68
kernel/branches/kolibri-process/blkdev/fdc.inc
Normal file
68
kernel/branches/kolibri-process/blkdev/fdc.inc
Normal file
@@ -0,0 +1,68 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Copyright (C) MenuetOS 2000-2004 Ville Mikael Turjanmaa ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4273 $
|
||||
|
||||
|
||||
uglobal
|
||||
dmasize db 0x0
|
||||
dmamode db 0x0
|
||||
endg
|
||||
|
||||
fdc_init: ;start with clean tracks.
|
||||
mov edi, OS_BASE+0xD201
|
||||
mov al, 0
|
||||
mov ecx, 160
|
||||
rep stosb
|
||||
ret
|
||||
|
||||
save_image:
|
||||
cmp [ramdisk_actual_size], FLOPPY_CAPACITY
|
||||
jnz .fail
|
||||
pusha
|
||||
mov ecx, floppy_mutex
|
||||
call mutex_lock
|
||||
mov [flp_number], bl
|
||||
call floppy_read_bootsector
|
||||
cmp [FDC_Status], 0
|
||||
jne .unnecessary_save_image
|
||||
mov [FDD_Track], 0; Цилиндр
|
||||
mov [FDD_Head], 0; Сторона
|
||||
mov [FDD_Sector], 1; Сектор
|
||||
mov esi, RAMDISK
|
||||
call SeekTrack
|
||||
.save_image_1:
|
||||
call take_data_from_application_1
|
||||
call WriteSectWithRetr
|
||||
; call WriteSector
|
||||
cmp [FDC_Status], 0
|
||||
jne .unnecessary_save_image
|
||||
inc [FDD_Sector]
|
||||
cmp [FDD_Sector], 19
|
||||
jne .save_image_1
|
||||
mov [FDD_Sector], 1
|
||||
inc [FDD_Head]
|
||||
cmp [FDD_Head], 2
|
||||
jne .save_image_1
|
||||
mov [FDD_Head], 0
|
||||
inc [FDD_Track]
|
||||
call SeekTrack
|
||||
cmp [FDD_Track], 80
|
||||
jne .save_image_1
|
||||
.unnecessary_save_image:
|
||||
cmp [FDC_Status], 0
|
||||
pushf
|
||||
mov ecx, floppy_mutex
|
||||
call mutex_unlock
|
||||
popf
|
||||
popa
|
||||
jnz .fail
|
||||
xor eax, eax
|
||||
ret
|
||||
.fail:
|
||||
movi eax, 1
|
||||
ret
|
||||
949
kernel/branches/kolibri-process/blkdev/flp_drv.inc
Normal file
949
kernel/branches/kolibri-process/blkdev/flp_drv.inc
Normal file
@@ -0,0 +1,949 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4273 $
|
||||
|
||||
|
||||
;**********************************************************
|
||||
; Непосредственная работа с контроллером гибкого диска
|
||||
;**********************************************************
|
||||
; Автор исходного текста Кулаков Владимир Геннадьевич.
|
||||
; Адаптация и доработка Mario79
|
||||
|
||||
;give_back_application_data: ; переслать приложению
|
||||
; mov edi,[TASK_BASE]
|
||||
; mov edi,[edi+TASKDATA.mem_start]
|
||||
; add edi,ecx
|
||||
give_back_application_data_1:
|
||||
mov esi, FDD_BUFF;FDD_DataBuffer ;0x40000
|
||||
mov ecx, 128
|
||||
cld
|
||||
rep movsd
|
||||
ret
|
||||
|
||||
;take_data_from_application: ; взять из приложени
|
||||
; mov esi,[TASK_BASE]
|
||||
; mov esi,[esi+TASKDATA.mem_start]
|
||||
; add esi,ecx
|
||||
take_data_from_application_1:
|
||||
mov edi, FDD_BUFF;FDD_DataBuffer ;0x40000
|
||||
mov ecx, 128
|
||||
cld
|
||||
rep movsd
|
||||
ret
|
||||
|
||||
; Коды завершения операции с контроллером (FDC_Status)
|
||||
FDC_Normal equ 0 ;нормальное завершение
|
||||
FDC_TimeOut equ 1 ;ошибка тайм-аута
|
||||
FDC_DiskNotFound equ 2 ;в дисководе нет диска
|
||||
FDC_TrackNotFound equ 3 ;дорожка не найдена
|
||||
FDC_SectorNotFound equ 4 ;сектор не найден
|
||||
|
||||
; Максимальные значения координат сектора (заданные
|
||||
; значения соответствуют параметрам стандартного
|
||||
; трехдюймового гибкого диска объемом 1,44 Мб)
|
||||
MAX_Track equ 79
|
||||
MAX_Head equ 1
|
||||
MAX_Sector equ 18
|
||||
|
||||
uglobal
|
||||
; Счетчик тиков таймера
|
||||
TickCounter dd ?
|
||||
; Код завершения операции с контроллером НГМД
|
||||
FDC_Status DB ?
|
||||
; Флаг прерывания от НГМД
|
||||
FDD_IntFlag DB ?
|
||||
; Момент начала последней операции с НГМД
|
||||
FDD_Time DD ?
|
||||
; Номер дисковода
|
||||
FDD_Type db 0
|
||||
; Координаты сектора
|
||||
FDD_Track DB ?
|
||||
FDD_Head DB ?
|
||||
FDD_Sector DB ?
|
||||
|
||||
; Блок результата операции
|
||||
FDC_ST0 DB ?
|
||||
FDC_ST1 DB ?
|
||||
FDC_ST2 DB ?
|
||||
FDC_C DB ?
|
||||
FDC_H DB ?
|
||||
FDC_R DB ?
|
||||
FDC_N DB ?
|
||||
; Счетчик повторения операции чтени
|
||||
ReadRepCounter DB ?
|
||||
; Счетчик повторения операции рекалибровки
|
||||
RecalRepCounter DB ?
|
||||
endg
|
||||
; Область памяти для хранения прочитанного сектора
|
||||
;FDD_DataBuffer: times 512 db 0 ;DB 512 DUP (?)
|
||||
fdd_motor_status db 0
|
||||
timer_fdd_motor dd 0
|
||||
|
||||
;*************************************
|
||||
;* ИНИЦИАЛИЗАЦИЯ РЕЖИМА ПДП ДЛЯ НГМД *
|
||||
;*************************************
|
||||
Init_FDC_DMA:
|
||||
pushad
|
||||
mov al, 0
|
||||
out 0x0c, al; reset the flip-flop to a known state.
|
||||
mov al, 6 ; mask channel 2 so we can reprogram it.
|
||||
out 0x0a, al
|
||||
mov al, [dmamode]; 0x46 -> Read from floppy - 0x4A Write to floppy
|
||||
out 0x0b, al
|
||||
mov al, 0
|
||||
out 0x0c, al; reset the flip-flop to a known state.
|
||||
mov eax, 0xD000
|
||||
out 0x04, al; set the channel 2 starting address to 0
|
||||
shr eax, 8
|
||||
out 0x04, al
|
||||
shr eax, 8
|
||||
out 0x81, al
|
||||
mov al, 0
|
||||
out 0x0c, al; reset flip-flop
|
||||
mov al, 0xff;set count (actual size -1)
|
||||
out 0x5, al
|
||||
mov al, 0x1;[dmasize] ;(0x1ff = 511 / 0x23ff =9215)
|
||||
out 0x5, al
|
||||
mov al, 2
|
||||
out 0xa, al
|
||||
popad
|
||||
ret
|
||||
|
||||
;***********************************
|
||||
;* ЗАПИСАТЬ БАЙТ В ПОРТ ДАННЫХ FDC *
|
||||
;* Параметры: *
|
||||
;* AL - выводимый байт. *
|
||||
;***********************************
|
||||
FDCDataOutput:
|
||||
; DEBUGF 1,'K : FDCDataOutput(%x)',al
|
||||
; pusha
|
||||
push eax ecx edx
|
||||
mov AH, AL ;запомнить байт в AH
|
||||
; Сбросить переменную состояния контроллера
|
||||
mov [FDC_Status], FDC_Normal
|
||||
; Проверить готовность контроллера к приему данных
|
||||
mov DX, 3F4h ;(порт состояния FDC)
|
||||
mov ecx, 0x10000 ;установить счетчик тайм-аута
|
||||
@@TestRS:
|
||||
in AL, DX ;прочитать регистр RS
|
||||
and AL, 0C0h ;выделить разряды 6 и 7
|
||||
cmp AL, 80h ;проверить разряды 6 и 7
|
||||
je @@OutByteToFDC
|
||||
loop @@TestRS
|
||||
; Ошибка тайм-аута
|
||||
; DEBUGF 1,' timeout\n'
|
||||
mov [FDC_Status], FDC_TimeOut
|
||||
jmp @@End_5
|
||||
; Вывести байт в порт данных
|
||||
@@OutByteToFDC:
|
||||
inc DX
|
||||
mov AL, AH
|
||||
out DX, AL
|
||||
; DEBUGF 1,' ok\n'
|
||||
@@End_5:
|
||||
; popa
|
||||
pop edx ecx eax
|
||||
ret
|
||||
|
||||
;******************************************
|
||||
;* ПРОЧИТАТЬ БАЙТ ИЗ ПОРТА ДАННЫХ FDC *
|
||||
;* Процедура не имеет входных параметров. *
|
||||
;* Выходные данные: *
|
||||
;* AL - считанный байт. *
|
||||
;******************************************
|
||||
FDCDataInput:
|
||||
push ECX
|
||||
push DX
|
||||
; Сбросить переменную состояния контроллера
|
||||
mov [FDC_Status], FDC_Normal
|
||||
; Проверить готовность контроллера к передаче данных
|
||||
mov DX, 3F4h ;(порт состояния FDC)
|
||||
mov ecx, 0x10000 ;установить счетчик тайм-аута
|
||||
@@TestRS_1:
|
||||
in AL, DX ;прочитать регистр RS
|
||||
and AL, 0C0h ;выдлить разряды 6 и 7
|
||||
cmp AL, 0C0h ;проверить разряды 6 и 7
|
||||
je @@GetByteFromFDC
|
||||
loop @@TestRS_1
|
||||
; Ошибка тайм-аута
|
||||
; DEBUGF 1,'K : FDCDataInput: timeout\n'
|
||||
mov [FDC_Status], FDC_TimeOut
|
||||
jmp @@End_6
|
||||
; Ввести байт из порта данных
|
||||
@@GetByteFromFDC:
|
||||
inc DX
|
||||
in AL, DX
|
||||
; DEBUGF 1,'K : FDCDataInput: %x\n',al
|
||||
@@End_6:
|
||||
pop DX
|
||||
pop ECX
|
||||
ret
|
||||
|
||||
;*********************************************
|
||||
;* ОБРАБОТЧИК ПРЕРЫВАНИЯ ОТ КОНТРОЛЛЕРА НГМД *
|
||||
;*********************************************
|
||||
FDCInterrupt:
|
||||
; dbgstr 'FDCInterrupt'
|
||||
; Установить флаг прерывания
|
||||
mov [FDD_IntFlag], 1
|
||||
mov al, 1
|
||||
ret
|
||||
|
||||
;*******************************************
|
||||
;* ОЖИДАНИЕ ПРЕРЫВАНИЯ ОТ КОНТРОЛЛЕРА НГМД *
|
||||
;*******************************************
|
||||
WaitFDCInterrupt:
|
||||
pusha
|
||||
; Сбросить байт состояния операции
|
||||
mov [FDC_Status], FDC_Normal
|
||||
; Обнулить счетчик тиков
|
||||
mov eax, [timer_ticks]
|
||||
mov [TickCounter], eax
|
||||
; Ожидать установки флага прерывания НГМД
|
||||
@@TestRS_2:
|
||||
call change_task
|
||||
cmp [FDD_IntFlag], 0
|
||||
jnz @@End_7 ;прерывание произошло
|
||||
mov eax, [timer_ticks]
|
||||
sub eax, [TickCounter]
|
||||
cmp eax, 200;50 ;25 ;5 ;ожидать 5 тиков
|
||||
jb @@TestRS_2
|
||||
; jl @@TestRS_2
|
||||
; Ошибка тайм-аута
|
||||
; dbgstr 'WaitFDCInterrupt: timeout'
|
||||
mov [FDC_Status], FDC_TimeOut
|
||||
@@End_7:
|
||||
popa
|
||||
ret
|
||||
|
||||
;*********************************
|
||||
;* ВКЛЮЧИТЬ МОТОР ДИСКОВОДА "A:" *
|
||||
;*********************************
|
||||
FDDMotorON:
|
||||
; dbgstr 'FDDMotorON'
|
||||
pusha
|
||||
; cmp [fdd_motor_status],1
|
||||
; je fdd_motor_on
|
||||
mov al, [flp_number]
|
||||
cmp [fdd_motor_status], al
|
||||
je fdd_motor_on
|
||||
; Произвести сброс контроллера НГМД
|
||||
mov DX, 3F2h;порт управления двигателями
|
||||
mov AL, 0
|
||||
out DX, AL
|
||||
; Выбрать и включить мотор дисковода
|
||||
cmp [flp_number], 1
|
||||
jne FDDMotorON_B
|
||||
; call FDDMotorOFF_B
|
||||
mov AL, 1Ch ; Floppy A
|
||||
jmp FDDMotorON_1
|
||||
FDDMotorON_B:
|
||||
; call FDDMotorOFF_A
|
||||
mov AL, 2Dh ; Floppy B
|
||||
FDDMotorON_1:
|
||||
out DX, AL
|
||||
; Обнулить счетчик тиков
|
||||
mov eax, [timer_ticks]
|
||||
mov [TickCounter], eax
|
||||
; Ожидать 0,5 с
|
||||
@@dT:
|
||||
call change_task
|
||||
mov eax, [timer_ticks]
|
||||
sub eax, [TickCounter]
|
||||
cmp eax, 50 ;10
|
||||
jb @@dT
|
||||
; Read results of RESET command
|
||||
push 4
|
||||
; DEBUGF 1,'K : floppy reset results:'
|
||||
@@:
|
||||
mov al, 8
|
||||
call FDCDataOutput
|
||||
call FDCDataInput
|
||||
; DEBUGF 1,' %x',al
|
||||
call FDCDataInput
|
||||
; DEBUGF 1,' %x',al
|
||||
dec dword [esp]
|
||||
jnz @b
|
||||
; DEBUGF 1,'\n'
|
||||
pop eax
|
||||
cmp [flp_number], 1
|
||||
jne fdd_motor_on_B
|
||||
mov [fdd_motor_status], 1
|
||||
jmp fdd_motor_on
|
||||
fdd_motor_on_B:
|
||||
mov [fdd_motor_status], 2
|
||||
fdd_motor_on:
|
||||
call save_timer_fdd_motor
|
||||
popa
|
||||
ret
|
||||
|
||||
;*****************************************
|
||||
;* СОХРАНЕНИЕ УКАЗАТЕЛЯ ВРЕМЕНИ *
|
||||
;*****************************************
|
||||
save_timer_fdd_motor:
|
||||
mov eax, [timer_ticks]
|
||||
mov [timer_fdd_motor], eax
|
||||
ret
|
||||
|
||||
;*****************************************
|
||||
;* ПРОВЕРКА ЗАДЕРЖКИ ВЫКЛЮЧЕНИЯ МОТОРА *
|
||||
;*****************************************
|
||||
proc check_fdd_motor_status_has_work?
|
||||
cmp [fdd_motor_status], 0
|
||||
jz .no
|
||||
mov eax, [timer_ticks]
|
||||
sub eax, [timer_fdd_motor]
|
||||
cmp eax, 500
|
||||
jb .no
|
||||
.yes:
|
||||
xor eax, eax
|
||||
inc eax
|
||||
ret
|
||||
.no:
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
align 4
|
||||
check_fdd_motor_status:
|
||||
cmp [fdd_motor_status], 0
|
||||
je end_check_fdd_motor_status_1
|
||||
mov eax, [timer_ticks]
|
||||
sub eax, [timer_fdd_motor]
|
||||
cmp eax, 500
|
||||
jb end_check_fdd_motor_status
|
||||
call FDDMotorOFF
|
||||
mov [fdd_motor_status], 0
|
||||
end_check_fdd_motor_status_1:
|
||||
end_check_fdd_motor_status:
|
||||
ret
|
||||
|
||||
;**********************************
|
||||
;* ВЫКЛЮЧИТЬ МОТОР ДИСКОВОДА *
|
||||
;**********************************
|
||||
FDDMotorOFF:
|
||||
; dbgstr 'FDDMotorOFF'
|
||||
push AX
|
||||
push DX
|
||||
cmp [flp_number], 1
|
||||
jne FDDMotorOFF_1
|
||||
call FDDMotorOFF_A
|
||||
jmp FDDMotorOFF_2
|
||||
FDDMotorOFF_1:
|
||||
call FDDMotorOFF_B
|
||||
FDDMotorOFF_2:
|
||||
pop DX
|
||||
pop AX
|
||||
; сброс флагов кеширования в связи с устареванием информации
|
||||
or [floppy_media_flags+0], FLOPPY_MEDIA_NEED_RESCAN
|
||||
or [floppy_media_flags+1], FLOPPY_MEDIA_NEED_RESCAN
|
||||
ret
|
||||
|
||||
FDDMotorOFF_A:
|
||||
mov DX, 3F2h;порт управления двигателями
|
||||
mov AL, 0Ch ; Floppy A
|
||||
out DX, AL
|
||||
ret
|
||||
|
||||
FDDMotorOFF_B:
|
||||
mov DX, 3F2h;порт управления двигателями
|
||||
mov AL, 5h ; Floppy B
|
||||
out DX, AL
|
||||
ret
|
||||
|
||||
;*******************************
|
||||
;* РЕКАЛИБРОВКА ДИСКОВОДА "A:" *
|
||||
;*******************************
|
||||
RecalibrateFDD:
|
||||
; dbgstr 'RecalibrateFDD'
|
||||
pusha
|
||||
call save_timer_fdd_motor
|
||||
; Сбросить флаг прерывания
|
||||
mov [FDD_IntFlag], 0
|
||||
; Подать команду "Рекалибровка"
|
||||
mov AL, 07h
|
||||
call FDCDataOutput
|
||||
mov AL, 00h
|
||||
call FDCDataOutput
|
||||
; Ожидать завершения операции
|
||||
call WaitFDCInterrupt
|
||||
cmp [FDC_Status], 0
|
||||
jne .fail
|
||||
; Read results of RECALIBRATE command
|
||||
; DEBUGF 1,'K : floppy recalibrate results:'
|
||||
mov al, 8
|
||||
call FDCDataOutput
|
||||
call FDCDataInput
|
||||
; DEBUGF 1,' %x',al
|
||||
call FDCDataInput
|
||||
; DEBUGF 1,' %x',al
|
||||
; DEBUGF 1,'\n'
|
||||
.fail:
|
||||
call save_timer_fdd_motor
|
||||
popa
|
||||
ret
|
||||
|
||||
;*****************************************************
|
||||
;* ПОИСК ДОРОЖКИ *
|
||||
;* Параметры передаются через глобальные переменные: *
|
||||
;* FDD_Track - номер дорожки (0-79); *
|
||||
;* FDD_Head - номер головки (0-1). *
|
||||
;* Результат операции заносится в FDC_Status. *
|
||||
;*****************************************************
|
||||
SeekTrack:
|
||||
; dbgstr 'SeekTrack'
|
||||
pusha
|
||||
call save_timer_fdd_motor
|
||||
; Сбросить флаг прерывания
|
||||
mov [FDD_IntFlag], 0
|
||||
; Подать команду "Поиск"
|
||||
mov AL, 0Fh
|
||||
call FDCDataOutput
|
||||
; Передать байт номера головки/накопител
|
||||
mov AL, [FDD_Head]
|
||||
shl AL, 2
|
||||
call FDCDataOutput
|
||||
; Передать байт номера дорожки
|
||||
mov AL, [FDD_Track]
|
||||
call FDCDataOutput
|
||||
; Ожидать завершения операции
|
||||
call WaitFDCInterrupt
|
||||
cmp [FDC_Status], FDC_Normal
|
||||
jne @@Exit
|
||||
; Сохранить результат поиска
|
||||
mov AL, 08h
|
||||
call FDCDataOutput
|
||||
call FDCDataInput
|
||||
mov [FDC_ST0], AL
|
||||
call FDCDataInput
|
||||
mov [FDC_C], AL
|
||||
; Проверить результат поиска
|
||||
; Поиск завершен?
|
||||
test [FDC_ST0], 100000b
|
||||
je @@Err
|
||||
; Заданный трек найден?
|
||||
mov AL, [FDC_C]
|
||||
cmp AL, [FDD_Track]
|
||||
jne @@Err
|
||||
; Номер головки совпадает с заданным?
|
||||
; The H bit (Head Address) in ST0 will always return a "0" (c) 82077AA datasheet,
|
||||
; description of SEEK command. So we can not verify the proper head.
|
||||
; mov AL, [FDC_ST0]
|
||||
; and AL, 100b
|
||||
; shr AL, 2
|
||||
; cmp AL, [FDD_Head]
|
||||
; jne @@Err
|
||||
; Операция завершена успешно
|
||||
; dbgstr 'SeekTrack: FDC_Normal'
|
||||
mov [FDC_Status], FDC_Normal
|
||||
jmp @@Exit
|
||||
@@Err: ; Трек не найден
|
||||
; dbgstr 'SeekTrack: FDC_TrackNotFound'
|
||||
mov [FDC_Status], FDC_TrackNotFound
|
||||
@@Exit:
|
||||
call save_timer_fdd_motor
|
||||
popa
|
||||
ret
|
||||
|
||||
;*******************************************************
|
||||
;* ЧТЕНИЕ СЕКТОРА ДАННЫХ *
|
||||
;* Параметры передаются через глобальные переменные: *
|
||||
;* FDD_Track - номер дорожки (0-79); *
|
||||
;* FDD_Head - номер головки (0-1); *
|
||||
;* FDD_Sector - номер сектора (1-18). *
|
||||
;* Результат операции заносится в FDC_Status. *
|
||||
;* В случае успешного выполнения операции чтения *
|
||||
;* содержимое сектора будет занесено в FDD_DataBuffer. *
|
||||
;*******************************************************
|
||||
ReadSector:
|
||||
; dbgstr 'ReadSector'
|
||||
pushad
|
||||
call save_timer_fdd_motor
|
||||
; Сбросить флаг прерывания
|
||||
mov [FDD_IntFlag], 0
|
||||
; Установить скорость передачи 500 Кбайт/с
|
||||
mov AX, 0
|
||||
mov DX, 03F7h
|
||||
out DX, AL
|
||||
; Инициализировать канал прямого доступа к памяти
|
||||
mov [dmamode], 0x46
|
||||
call Init_FDC_DMA
|
||||
; Подать команду "Чтение данных"
|
||||
mov AL, 0E6h ;чтение в мультитрековом режиме
|
||||
call FDCDataOutput
|
||||
mov AL, [FDD_Head]
|
||||
shl AL, 2
|
||||
call FDCDataOutput
|
||||
mov AL, [FDD_Track]
|
||||
call FDCDataOutput
|
||||
mov AL, [FDD_Head]
|
||||
call FDCDataOutput
|
||||
mov AL, [FDD_Sector]
|
||||
call FDCDataOutput
|
||||
mov AL, 2 ;код размера сектора (512 байт)
|
||||
call FDCDataOutput
|
||||
mov AL, 18 ;+1; 3Fh ;число секторов на дорожке
|
||||
call FDCDataOutput
|
||||
mov AL, 1Bh ;значение GPL
|
||||
call FDCDataOutput
|
||||
mov AL, 0FFh;значение DTL
|
||||
call FDCDataOutput
|
||||
; Ожидаем прерывание по завершении операции
|
||||
call WaitFDCInterrupt
|
||||
cmp [FDC_Status], FDC_Normal
|
||||
jne @@Exit_1
|
||||
; Считываем статус завершения операции
|
||||
call GetStatusInfo
|
||||
test [FDC_ST0], 11011000b
|
||||
jnz @@Err_1
|
||||
; dbgstr 'ReadSector: FDC_Normal'
|
||||
mov [FDC_Status], FDC_Normal
|
||||
jmp @@Exit_1
|
||||
@@Err_1:
|
||||
; dbgstr 'ReadSector: FDC_SectorNotFound'
|
||||
mov [FDC_Status], FDC_SectorNotFound
|
||||
@@Exit_1:
|
||||
call save_timer_fdd_motor
|
||||
popad
|
||||
ret
|
||||
|
||||
;*******************************************************
|
||||
;* ЧТЕНИЕ СЕКТОРА (С ПОВТОРЕНИЕМ ОПЕРАЦИИ ПРИ СБОЕ) *
|
||||
;* Параметры передаются через глобальные переменные: *
|
||||
;* FDD_Track - номер дорожки (0-79); *
|
||||
;* FDD_Head - номер головки (0-1); *
|
||||
;* FDD_Sector - номер сектора (1-18). *
|
||||
;* Результат операции заносится в FDC_Status. *
|
||||
;* В случае успешного выполнения операции чтения *
|
||||
;* содержимое сектора будет занесено в FDD_DataBuffer. *
|
||||
;*******************************************************
|
||||
ReadSectWithRetr:
|
||||
pusha
|
||||
; Обнулить счетчик повторения операции рекалибровки
|
||||
mov [RecalRepCounter], 0
|
||||
@@TryAgain:
|
||||
; Обнулить счетчик повторения операции чтени
|
||||
mov [ReadRepCounter], 0
|
||||
@@ReadSector_1:
|
||||
call ReadSector
|
||||
cmp [FDC_Status], 0
|
||||
je @@Exit_2
|
||||
cmp [FDC_Status], 1
|
||||
je @@Err_3
|
||||
; Троекратное повторение чтени
|
||||
inc [ReadRepCounter]
|
||||
cmp [ReadRepCounter], 3
|
||||
jb @@ReadSector_1
|
||||
; Троекратное повторение рекалибровки
|
||||
call RecalibrateFDD
|
||||
call SeekTrack
|
||||
inc [RecalRepCounter]
|
||||
cmp [RecalRepCounter], 3
|
||||
jb @@TryAgain
|
||||
@@Exit_2:
|
||||
popa
|
||||
ret
|
||||
@@Err_3:
|
||||
popa
|
||||
ret
|
||||
|
||||
;*******************************************************
|
||||
;* ЗАПИСЬ СЕКТОРА ДАННЫХ *
|
||||
;* Параметры передаются через глобальные переменные: *
|
||||
;* FDD_Track - номер дорожки (0-79); *
|
||||
;* FDD_Head - номер головки (0-1); *
|
||||
;* FDD_Sector - номер сектора (1-18). *
|
||||
;* Результат операции заносится в FDC_Status. *
|
||||
;* В случае успешного выполнения операции записи *
|
||||
;* содержимое FDD_DataBuffer будет занесено в сектор. *
|
||||
;*******************************************************
|
||||
WriteSector:
|
||||
; dbgstr 'WriteSector'
|
||||
pushad
|
||||
call save_timer_fdd_motor
|
||||
; Сбросить флаг прерывания
|
||||
mov [FDD_IntFlag], 0
|
||||
; Установить скорость передачи 500 Кбайт/с
|
||||
mov AX, 0
|
||||
mov DX, 03F7h
|
||||
out DX, AL
|
||||
; Инициализировать канал прямого доступа к памяти
|
||||
mov [dmamode], 0x4A
|
||||
call Init_FDC_DMA
|
||||
; Подать команду "Запись данных"
|
||||
mov AL, 0xC5 ;0x45 ;запись в мультитрековом режиме
|
||||
call FDCDataOutput
|
||||
mov AL, [FDD_Head]
|
||||
shl AL, 2
|
||||
call FDCDataOutput
|
||||
mov AL, [FDD_Track]
|
||||
call FDCDataOutput
|
||||
mov AL, [FDD_Head]
|
||||
call FDCDataOutput
|
||||
mov AL, [FDD_Sector]
|
||||
call FDCDataOutput
|
||||
mov AL, 2 ;код размера сектора (512 байт)
|
||||
call FDCDataOutput
|
||||
mov AL, 18; 3Fh ;число секторов на дорожке
|
||||
call FDCDataOutput
|
||||
mov AL, 1Bh ;значение GPL
|
||||
call FDCDataOutput
|
||||
mov AL, 0FFh;значение DTL
|
||||
call FDCDataOutput
|
||||
; Ожидаем прерывание по завершении операции
|
||||
call WaitFDCInterrupt
|
||||
cmp [FDC_Status], FDC_Normal
|
||||
jne @@Exit_3
|
||||
; Считываем статус завершения операции
|
||||
call GetStatusInfo
|
||||
test [FDC_ST0], 11000000b ;11011000b
|
||||
jnz @@Err_2
|
||||
mov [FDC_Status], FDC_Normal
|
||||
jmp @@Exit_3
|
||||
@@Err_2:
|
||||
mov [FDC_Status], FDC_SectorNotFound
|
||||
@@Exit_3:
|
||||
call save_timer_fdd_motor
|
||||
popad
|
||||
ret
|
||||
|
||||
;*******************************************************
|
||||
;* ЗАПИСЬ СЕКТОРА (С ПОВТОРЕНИЕМ ОПЕРАЦИИ ПРИ СБОЕ) *
|
||||
;* Параметры передаются через глобальные переменные: *
|
||||
;* FDD_Track - номер дорожки (0-79); *
|
||||
;* FDD_Head - номер головки (0-1); *
|
||||
;* FDD_Sector - номер сектора (1-18). *
|
||||
;* Результат операции заносится в FDC_Status. *
|
||||
;* В случае успешного выполнения операции записи *
|
||||
;* содержимое FDD_DataBuffer будет занесено в сектор. *
|
||||
;*******************************************************
|
||||
WriteSectWithRetr:
|
||||
pusha
|
||||
; Обнулить счетчик повторения операции рекалибровки
|
||||
mov [RecalRepCounter], 0
|
||||
@@TryAgain_1:
|
||||
; Обнулить счетчик повторения операции чтени
|
||||
mov [ReadRepCounter], 0
|
||||
@@WriteSector_1:
|
||||
call WriteSector
|
||||
cmp [FDC_Status], 0
|
||||
je @@Exit_4
|
||||
cmp [FDC_Status], 1
|
||||
je @@Err_4
|
||||
; Троекратное повторение чтени
|
||||
inc [ReadRepCounter]
|
||||
cmp [ReadRepCounter], 3
|
||||
jb @@WriteSector_1
|
||||
; Троекратное повторение рекалибровки
|
||||
call RecalibrateFDD
|
||||
call SeekTrack
|
||||
inc [RecalRepCounter]
|
||||
cmp [RecalRepCounter], 3
|
||||
jb @@TryAgain_1
|
||||
@@Exit_4:
|
||||
popa
|
||||
ret
|
||||
@@Err_4:
|
||||
popa
|
||||
ret
|
||||
|
||||
;*********************************************
|
||||
;* ПОЛУЧИТЬ ИНФОРМАЦИЮ О РЕЗУЛЬТАТЕ ОПЕРАЦИИ *
|
||||
;*********************************************
|
||||
GetStatusInfo:
|
||||
push AX
|
||||
call FDCDataInput
|
||||
mov [FDC_ST0], AL
|
||||
call FDCDataInput
|
||||
mov [FDC_ST1], AL
|
||||
call FDCDataInput
|
||||
mov [FDC_ST2], AL
|
||||
call FDCDataInput
|
||||
mov [FDC_C], AL
|
||||
call FDCDataInput
|
||||
mov [FDC_H], AL
|
||||
call FDCDataInput
|
||||
mov [FDC_R], AL
|
||||
call FDCDataInput
|
||||
mov [FDC_N], AL
|
||||
pop AX
|
||||
ret
|
||||
|
||||
; Interface for disk subsystem.
|
||||
; Assume fixed capacity for 1.44M.
|
||||
FLOPPY_CAPACITY = 2880 ; in sectors
|
||||
|
||||
iglobal
|
||||
align 4
|
||||
floppy_functions:
|
||||
dd .size
|
||||
dd 0 ; no close() function
|
||||
dd 0 ; no closemedia() function
|
||||
dd floppy_querymedia
|
||||
dd floppy_read
|
||||
dd floppy_write
|
||||
dd 0 ; no flush() function
|
||||
dd 0 ; no adjust_cache_size() function
|
||||
.size = $ - floppy_functions
|
||||
endg
|
||||
|
||||
uglobal
|
||||
floppy_media_flags rb 2
|
||||
n_sector dd 0 ; temporary save for sector value
|
||||
flp_number db 0 ; 1- Floppy A, 2-Floppy B
|
||||
old_track db 0 ; old value track
|
||||
flp_label rb 15*2 ; Label and ID of inserted floppy disk
|
||||
align 4
|
||||
; Hardware does not allow to work with two floppies in parallel,
|
||||
; so there is one mutex guarding access to any floppy.
|
||||
floppy_mutex MUTEX
|
||||
endg
|
||||
; Meaning of bits in floppy_media_flags
|
||||
FLOPPY_MEDIA_PRESENT = 1 ; media was present when last asked
|
||||
FLOPPY_MEDIA_NEED_RESCAN = 2 ; media was possibly changed, need to rescan
|
||||
FLOPPY_MEDIA_LABEL_CHANGED = 4 ; temporary state
|
||||
|
||||
iglobal
|
||||
floppy1_name db 'fd',0
|
||||
floppy2_name db 'fd2',0
|
||||
endg
|
||||
|
||||
; This function is called in boot process.
|
||||
; It creates filesystems /fd and/or /fd2, if the system has one/two floppy drives.
|
||||
proc floppy_init
|
||||
mov ecx, floppy_mutex
|
||||
call mutex_init
|
||||
; First floppy is present if [DRIVE_DATA] and 0xF0 is nonzero.
|
||||
test byte [DRIVE_DATA], 0xF0
|
||||
jz .no1
|
||||
stdcall disk_add, floppy_functions, floppy1_name, 1, DISK_NO_INSERT_NOTIFICATION
|
||||
.no1:
|
||||
; Second floppy is present if [DRIVE_DATA] and 0x0F is nonzero.
|
||||
test byte [DRIVE_DATA], 0x0F
|
||||
jz .no2
|
||||
stdcall disk_add, floppy_functions, floppy2_name, 2, DISK_NO_INSERT_NOTIFICATION
|
||||
.no2:
|
||||
ret
|
||||
endp
|
||||
|
||||
; Returns information about disk media.
|
||||
; Floppy drives do not support insert notifications,
|
||||
; DISK_NO_INSERT_NOTIFICATION is set,
|
||||
; the disk subsystem calls this function before each filesystem operation.
|
||||
; If the media has changed, return error for the first call as signal
|
||||
; to finalize work with old media and the true geometry for the second call.
|
||||
; Assume that media is (possibly) changed anytime when motor is off.
|
||||
proc floppy_querymedia
|
||||
virtual at esp+4
|
||||
.userdata dd ?
|
||||
.info dd ?
|
||||
end virtual
|
||||
; 1. Acquire the global lock.
|
||||
mov ecx, floppy_mutex
|
||||
call mutex_lock
|
||||
mov edx, [.userdata] ; 1 for /fd, 2 for /fd2
|
||||
; 2. If the media was reported and has been changed, forget it and report an error.
|
||||
mov al, [floppy_media_flags+edx-1]
|
||||
and al, FLOPPY_MEDIA_PRESENT + FLOPPY_MEDIA_NEED_RESCAN
|
||||
cmp al, FLOPPY_MEDIA_PRESENT + FLOPPY_MEDIA_NEED_RESCAN
|
||||
jnz .not_reported
|
||||
.no_media:
|
||||
mov [floppy_media_flags+edx-1], 0
|
||||
.return_no_media:
|
||||
mov ecx, floppy_mutex
|
||||
call mutex_unlock
|
||||
mov eax, DISK_STATUS_NO_MEDIA
|
||||
retn 8
|
||||
.not_reported:
|
||||
; 3. If we are in the temporary state LABEL_CHANGED, this is the second call
|
||||
; after intermediate DISK_STATUS_NO_MEDIA due to media change;
|
||||
; clear the flag and return the current geometry without rereading the bootsector.
|
||||
cmp [floppy_media_flags+edx-1], FLOPPY_MEDIA_LABEL_CHANGED
|
||||
jz .report_geometry
|
||||
; 4. Try to read the bootsector.
|
||||
mov [flp_number], dl
|
||||
mov [FDC_Status], 0
|
||||
call floppy_read_bootsector
|
||||
; 5. If reading bootsector failed, assume that media is not present.
|
||||
mov edx, [.userdata]
|
||||
cmp [FDC_Status], 0
|
||||
jnz .no_media
|
||||
; 6. Check whether the previous status is "present". If not, go to 10.
|
||||
push esi edi
|
||||
imul edi, edx, 15
|
||||
add edi, flp_label-15
|
||||
mov esi, FDD_BUFF+39
|
||||
mov ecx, 15
|
||||
test [floppy_media_flags+edx-1], FLOPPY_MEDIA_PRESENT
|
||||
jz .set_label
|
||||
; 7. Compare the old label with the current one.
|
||||
rep cmpsb
|
||||
; 8. If the label has not changed, go to 11.
|
||||
jz .ok
|
||||
; 9. If the label has changed, store it, enter temporary state LABEL_CHANGED
|
||||
; and report DISK_STATUS_NO_MEDIA.
|
||||
; dbgstr 'floppy label changed'
|
||||
add esi, ecx
|
||||
add edi, ecx
|
||||
mov ecx, 15
|
||||
sub esi, ecx
|
||||
sub edi, ecx
|
||||
rep movsb
|
||||
mov [floppy_media_flags+edx-1], FLOPPY_MEDIA_LABEL_CHANGED
|
||||
pop edi esi
|
||||
jmp .return_no_media
|
||||
.set_label:
|
||||
; 10. The previous state was "not present". Copy the label.
|
||||
rep movsb
|
||||
.ok:
|
||||
pop edi esi
|
||||
.report_geometry:
|
||||
; 11. Fill DISKMEDIAINFO structure.
|
||||
mov ecx, [.info]
|
||||
and [ecx+DISKMEDIAINFO.Flags], 0
|
||||
mov [ecx+DISKMEDIAINFO.SectorSize], 512
|
||||
mov dword [ecx+DISKMEDIAINFO.Capacity], FLOPPY_CAPACITY
|
||||
and dword [ecx+DISKMEDIAINFO.Capacity+4], 0
|
||||
; 12. Update state: media is present, data are actual.
|
||||
mov [floppy_media_flags+edx-1], FLOPPY_MEDIA_PRESENT
|
||||
; 13. Release the global lock and return successful status.
|
||||
mov ecx, floppy_mutex
|
||||
call mutex_unlock
|
||||
xor eax, eax
|
||||
retn 8
|
||||
endp
|
||||
|
||||
proc floppy_read_bootsector
|
||||
pushad
|
||||
mov [FDD_Track], 0; Цилиндр
|
||||
mov [FDD_Head], 0; Сторона
|
||||
mov [FDD_Sector], 1; Сектор
|
||||
call FDDMotorON
|
||||
call RecalibrateFDD
|
||||
cmp [FDC_Status], 0
|
||||
jne .nothing
|
||||
call SeekTrack
|
||||
cmp [FDC_Status], 0
|
||||
jne .nothing
|
||||
call ReadSectWithRetr
|
||||
.nothing:
|
||||
popad
|
||||
ret
|
||||
endp
|
||||
|
||||
read_chs_sector:
|
||||
call calculate_chs
|
||||
call ReadSectWithRetr
|
||||
ret
|
||||
|
||||
save_chs_sector:
|
||||
call calculate_chs
|
||||
call WriteSectWithRetr
|
||||
ret
|
||||
|
||||
calculate_chs:
|
||||
mov bl, [FDD_Track]
|
||||
mov [old_track], bl
|
||||
mov ebx, 18
|
||||
xor edx, edx
|
||||
div ebx
|
||||
inc edx
|
||||
mov [FDD_Sector], dl
|
||||
mov edx, eax
|
||||
shr eax, 1
|
||||
and edx, 1
|
||||
mov [FDD_Track], al
|
||||
mov [FDD_Head], dl
|
||||
mov dl, [old_track]
|
||||
cmp dl, [FDD_Track]
|
||||
je no_seek_track_1
|
||||
call SeekTrack
|
||||
no_seek_track_1:
|
||||
ret
|
||||
|
||||
; Writes one or more sectors to the device.
|
||||
proc floppy_write
|
||||
mov dl, 1
|
||||
jmp floppy_read_write
|
||||
endp
|
||||
|
||||
; Reads one or more sectors from the device.
|
||||
proc floppy_read
|
||||
mov dl, 0
|
||||
endp
|
||||
|
||||
; Common part of floppy_read and floppy_write.
|
||||
proc floppy_read_write userdata:dword, buffer:dword, start_sector:qword, numsectors_ptr:dword
|
||||
virtual at ebp-8
|
||||
.sectors_todo dd ?
|
||||
.operation db ?
|
||||
end virtual
|
||||
push edx ; save operation code to [.operation]
|
||||
; 1. Get number of sectors to read/write
|
||||
; and zero number of sectors that were actually read/written.
|
||||
mov eax, [numsectors_ptr]
|
||||
push dword [eax] ; initialize [.sectors_todo]
|
||||
and dword [eax], 0
|
||||
push ebx esi edi ; save used registers to be stdcall
|
||||
; 2. Acquire the global lock.
|
||||
mov ecx, floppy_mutex
|
||||
call mutex_lock
|
||||
; 3. Set floppy number for this operation.
|
||||
mov edx, [userdata]
|
||||
mov [flp_number], dl
|
||||
; 4. Read/write sector-by-sector.
|
||||
.operation_loop:
|
||||
; 4a. Check that the sector is inside the media.
|
||||
cmp dword [start_sector+4], 0
|
||||
jnz .end_of_media
|
||||
mov eax, dword [start_sector]
|
||||
cmp eax, FLOPPY_CAPACITY
|
||||
jae .end_of_media
|
||||
; 4b. For read operation, call read_chs_sector and then move data from FDD_BUFF to [buffer].
|
||||
; For write operation, move data from [buffer] to FDD_BUFF and then call save_chs_sector.
|
||||
cmp [.operation], 0
|
||||
jz .read
|
||||
mov esi, [buffer]
|
||||
mov edi, FDD_BUFF
|
||||
mov ecx, 512/4
|
||||
rep movsd
|
||||
mov [buffer], esi
|
||||
call save_chs_sector
|
||||
jmp @f
|
||||
.read:
|
||||
call read_chs_sector
|
||||
mov esi, FDD_BUFF
|
||||
mov edi, [buffer]
|
||||
mov ecx, 512/4
|
||||
rep movsd
|
||||
mov [buffer], edi
|
||||
@@:
|
||||
; 4c. If there was an error, propagate it to the caller.
|
||||
cmp [FDC_Status], 0
|
||||
jnz .fail
|
||||
; 4d. Otherwise, increment number of sectors processed and continue the loop.
|
||||
mov eax, [numsectors_ptr]
|
||||
inc dword [eax]
|
||||
inc dword [start_sector]
|
||||
dec [.sectors_todo]
|
||||
jnz .operation_loop
|
||||
; 5. Release the global lock and return with the correct status.
|
||||
push 0
|
||||
.return:
|
||||
mov ecx, floppy_mutex
|
||||
call mutex_unlock
|
||||
pop eax
|
||||
pop edi esi ebx ; restore used registers to be stdcall
|
||||
ret ; this translates to leave/retn N and purges local variables
|
||||
.fail:
|
||||
push -1
|
||||
jmp .return
|
||||
.end_of_media:
|
||||
push DISK_STATUS_END_OF_MEDIA
|
||||
jmp .return
|
||||
endp
|
||||
1185
kernel/branches/kolibri-process/blkdev/hd_drv.inc
Normal file
1185
kernel/branches/kolibri-process/blkdev/hd_drv.inc
Normal file
File diff suppressed because it is too large
Load Diff
367
kernel/branches/kolibri-process/blkdev/ide_cache.inc
Normal file
367
kernel/branches/kolibri-process/blkdev/ide_cache.inc
Normal file
@@ -0,0 +1,367 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;**************************************************************************
|
||||
;
|
||||
; [cache_ide[X]_pointer]
|
||||
; or [cache_ide[X]_data_pointer] first entry in cache list
|
||||
;
|
||||
; +0 - lba sector
|
||||
; +4 - state of cache sector
|
||||
; 0 = empty
|
||||
; 1 = used for read ( same as in hd )
|
||||
; 2 = used for write ( differs from hd )
|
||||
;
|
||||
; [cache_ide[X]_system_data]
|
||||
; or [cache_ide[x]_appl_data] - cache entries
|
||||
;
|
||||
;**************************************************************************
|
||||
|
||||
$Revision: 3742 $
|
||||
|
||||
align 4
|
||||
find_empty_slot_CD_cache:
|
||||
;-----------------------------------------------------------
|
||||
; find empty or read slot, flush cache if next 10% is used by write
|
||||
; output : edi = cache slot
|
||||
;-----------------------------------------------------------
|
||||
.search_again:
|
||||
call cd_calculate_cache_3
|
||||
.search_for_empty:
|
||||
inc edi
|
||||
call cd_calculate_cache_4
|
||||
jbe .inside_cache
|
||||
mov edi, 1
|
||||
.inside_cache:
|
||||
call cd_calculate_cache_5
|
||||
ret
|
||||
;--------------------------------------------------------------------
|
||||
clear_CD_cache:
|
||||
pusha
|
||||
.ide0:
|
||||
xor eax, eax
|
||||
cmp [cdpos], 1
|
||||
jne .ide1
|
||||
mov [cache_ide0_search_start], eax
|
||||
mov ecx, [cache_ide0_system_sad_size]
|
||||
mov edi, [cache_ide0_pointer]
|
||||
call .clear
|
||||
mov [cache_ide0_appl_search_start], eax
|
||||
mov ecx, [cache_ide0_appl_sad_size]
|
||||
mov edi, [cache_ide0_data_pointer]
|
||||
jmp .continue
|
||||
.ide1:
|
||||
cmp [cdpos], 2
|
||||
jne .ide2
|
||||
mov [cache_ide1_search_start], eax
|
||||
mov ecx, [cache_ide1_system_sad_size]
|
||||
mov edi, [cache_ide1_pointer]
|
||||
call .clear
|
||||
mov [cache_ide1_appl_search_start], eax
|
||||
mov ecx, [cache_ide1_appl_sad_size]
|
||||
mov edi, [cache_ide1_data_pointer]
|
||||
jmp .continue
|
||||
.ide2:
|
||||
cmp [cdpos], 3
|
||||
jne .ide3
|
||||
mov [cache_ide2_search_start], eax
|
||||
mov ecx, [cache_ide2_system_sad_size]
|
||||
mov edi, [cache_ide2_pointer]
|
||||
call .clear
|
||||
mov [cache_ide2_appl_search_start], eax
|
||||
mov ecx, [cache_ide2_appl_sad_size]
|
||||
mov edi, [cache_ide2_data_pointer]
|
||||
jmp .continue
|
||||
.ide3:
|
||||
mov [cache_ide3_search_start], eax
|
||||
mov ecx, [cache_ide3_system_sad_size]
|
||||
mov edi, [cache_ide3_pointer]
|
||||
call .clear
|
||||
mov [cache_ide3_appl_search_start], eax
|
||||
mov ecx, [cache_ide3_appl_sad_size]
|
||||
mov edi, [cache_ide3_data_pointer]
|
||||
.continue:
|
||||
call .clear
|
||||
popa
|
||||
ret
|
||||
.clear:
|
||||
shl ecx, 1
|
||||
cld
|
||||
rep stosd
|
||||
ret
|
||||
;--------------------------------------------------------------------
|
||||
align 4
|
||||
cd_calculate_cache:
|
||||
; 1 - IDE0 ... 4 - IDE3
|
||||
.ide0:
|
||||
cmp [cdpos], 1
|
||||
jne .ide1
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide0_appl_data
|
||||
mov ecx, [cache_ide0_system_sad_size]
|
||||
mov esi, [cache_ide0_pointer]
|
||||
ret
|
||||
.ide0_appl_data:
|
||||
mov ecx, [cache_ide0_appl_sad_size]
|
||||
mov esi, [cache_ide0_data_pointer]
|
||||
ret
|
||||
.ide1:
|
||||
cmp [cdpos], 2
|
||||
jne .ide2
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide1_appl_data
|
||||
mov ecx, [cache_ide1_system_sad_size]
|
||||
mov esi, [cache_ide1_pointer]
|
||||
ret
|
||||
.ide1_appl_data:
|
||||
mov ecx, [cache_ide1_appl_sad_size]
|
||||
mov esi, [cache_ide1_data_pointer]
|
||||
ret
|
||||
.ide2:
|
||||
cmp [cdpos], 3
|
||||
jne .ide3
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide2_appl_data
|
||||
mov ecx, [cache_ide2_system_sad_size]
|
||||
mov esi, [cache_ide2_pointer]
|
||||
ret
|
||||
.ide2_appl_data:
|
||||
mov ecx, [cache_ide2_appl_sad_size]
|
||||
mov esi, [cache_ide2_data_pointer]
|
||||
ret
|
||||
.ide3:
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide3_appl_data
|
||||
mov ecx, [cache_ide3_system_sad_size]
|
||||
mov esi, [cache_ide3_pointer]
|
||||
ret
|
||||
.ide3_appl_data:
|
||||
mov ecx, [cache_ide3_appl_sad_size]
|
||||
mov esi, [cache_ide3_data_pointer]
|
||||
ret
|
||||
;--------------------------------------------------------------------
|
||||
align 4
|
||||
cd_calculate_cache_1:
|
||||
; 1 - IDE0 ... 4 - IDE3
|
||||
.ide0:
|
||||
cmp [cdpos], 1
|
||||
jne .ide1
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide0_appl_data
|
||||
mov esi, [cache_ide0_pointer]
|
||||
ret
|
||||
.ide0_appl_data:
|
||||
mov esi, [cache_ide0_data_pointer]
|
||||
ret
|
||||
.ide1:
|
||||
cmp [cdpos], 2
|
||||
jne .ide2
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide1_appl_data
|
||||
mov esi, [cache_ide1_pointer]
|
||||
ret
|
||||
.ide1_appl_data:
|
||||
mov esi, [cache_ide1_data_pointer]
|
||||
ret
|
||||
.ide2:
|
||||
cmp [cdpos], 3
|
||||
jne .ide3
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide2_appl_data
|
||||
mov esi, [cache_ide2_pointer]
|
||||
ret
|
||||
.ide2_appl_data:
|
||||
mov esi, [cache_ide2_data_pointer]
|
||||
ret
|
||||
.ide3:
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide3_appl_data
|
||||
mov esi, [cache_ide3_pointer]
|
||||
ret
|
||||
.ide3_appl_data:
|
||||
mov esi, [cache_ide3_data_pointer]
|
||||
ret
|
||||
;--------------------------------------------------------------------
|
||||
align 4
|
||||
cd_calculate_cache_2:
|
||||
; 1 - IDE0 ... 4 - IDE3
|
||||
.ide0:
|
||||
cmp [cdpos], 1
|
||||
jne .ide1
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide0_appl_data
|
||||
mov eax, [cache_ide0_system_data]
|
||||
ret
|
||||
.ide0_appl_data:
|
||||
mov eax, [cache_ide0_appl_data]
|
||||
ret
|
||||
.ide1:
|
||||
cmp [cdpos], 2
|
||||
jne .ide2
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide1_appl_data
|
||||
mov eax, [cache_ide1_system_data]
|
||||
ret
|
||||
.ide1_appl_data:
|
||||
mov eax, [cache_ide1_appl_data]
|
||||
ret
|
||||
.ide2:
|
||||
cmp [cdpos], 3
|
||||
jne .ide3
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide2_appl_data
|
||||
mov eax, [cache_ide2_system_data]
|
||||
ret
|
||||
.ide2_appl_data:
|
||||
mov eax, [cache_ide2_appl_data]
|
||||
ret
|
||||
.ide3:
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide3_appl_data
|
||||
mov eax, [cache_ide3_system_data]
|
||||
ret
|
||||
.ide3_appl_data:
|
||||
mov eax, [cache_ide3_appl_data]
|
||||
ret
|
||||
;--------------------------------------------------------------------
|
||||
align 4
|
||||
cd_calculate_cache_3:
|
||||
; mov ecx,cache_max*10/100
|
||||
; mov edi,[cache_search_start]
|
||||
|
||||
; 1 - IDE0 ... 4 - IDE3
|
||||
.ide0:
|
||||
cmp [cdpos], 1
|
||||
jne .ide1
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide0_appl_data
|
||||
mov edi, [cache_ide0_search_start]
|
||||
ret
|
||||
.ide0_appl_data:
|
||||
mov edi, [cache_ide0_appl_search_start]
|
||||
ret
|
||||
.ide1:
|
||||
cmp [cdpos], 2
|
||||
jne .ide2
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide1_appl_data
|
||||
mov edi, [cache_ide1_search_start]
|
||||
ret
|
||||
.ide1_appl_data:
|
||||
mov edi, [cache_ide1_appl_search_start]
|
||||
ret
|
||||
.ide2:
|
||||
cmp [cdpos], 3
|
||||
jne .ide3
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide2_appl_data
|
||||
mov edi, [cache_ide2_search_start]
|
||||
ret
|
||||
.ide2_appl_data:
|
||||
mov edi, [cache_ide2_appl_search_start]
|
||||
ret
|
||||
.ide3:
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide3_appl_data
|
||||
mov edi, [cache_ide3_search_start]
|
||||
ret
|
||||
.ide3_appl_data:
|
||||
mov edi, [cache_ide3_appl_search_start]
|
||||
ret
|
||||
;--------------------------------------------------------------------
|
||||
align 4
|
||||
cd_calculate_cache_4:
|
||||
; cmp edi,cache_max
|
||||
; 1 - IDE0 ... 4 - IDE3
|
||||
.ide0:
|
||||
cmp [cdpos], 1
|
||||
jne .ide1
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide0_appl_data
|
||||
cmp edi, [cache_ide0_system_sad_size]
|
||||
ret
|
||||
.ide0_appl_data:
|
||||
cmp edi, [cache_ide0_appl_sad_size]
|
||||
ret
|
||||
.ide1:
|
||||
cmp [cdpos], 2
|
||||
jne .ide2
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide1_appl_data
|
||||
cmp edi, [cache_ide1_system_sad_size]
|
||||
ret
|
||||
.ide1_appl_data:
|
||||
cmp edi, [cache_ide1_appl_sad_size]
|
||||
ret
|
||||
.ide2:
|
||||
cmp [cdpos], 3
|
||||
jne .ide3
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide2_appl_data
|
||||
cmp edi, [cache_ide2_system_sad_size]
|
||||
ret
|
||||
.ide2_appl_data:
|
||||
cmp edi, [cache_ide2_appl_sad_size]
|
||||
ret
|
||||
.ide3:
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide3_appl_data
|
||||
cmp edi, [cache_ide3_system_sad_size]
|
||||
ret
|
||||
.ide3_appl_data:
|
||||
cmp edi, [cache_ide3_appl_sad_size]
|
||||
ret
|
||||
;--------------------------------------------------------------------
|
||||
align 4
|
||||
cd_calculate_cache_5:
|
||||
; mov [cache_search_start],edi
|
||||
; 1 - IDE0 ... 4 - IDE3
|
||||
.ide0:
|
||||
cmp [cdpos], 1
|
||||
jne .ide1
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide0_appl_data
|
||||
mov [cache_ide0_search_start], edi
|
||||
ret
|
||||
.ide0_appl_data:
|
||||
mov [cache_ide0_appl_search_start], edi
|
||||
ret
|
||||
.ide1:
|
||||
cmp [cdpos], 2
|
||||
jne .ide2
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide1_appl_data
|
||||
mov [cache_ide1_search_start], edi
|
||||
ret
|
||||
.ide1_appl_data:
|
||||
mov [cache_ide1_appl_search_start], edi
|
||||
ret
|
||||
.ide2:
|
||||
cmp [cdpos], 3
|
||||
jne .ide3
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide2_appl_data
|
||||
mov [cache_ide2_search_start], edi
|
||||
ret
|
||||
.ide2_appl_data:
|
||||
mov [cache_ide2_appl_search_start], edi
|
||||
ret
|
||||
.ide3:
|
||||
cmp [cd_appl_data], 0
|
||||
jne .ide3_appl_data
|
||||
mov [cache_ide3_search_start], edi
|
||||
ret
|
||||
.ide3_appl_data:
|
||||
mov [cache_ide3_appl_search_start], edi
|
||||
ret
|
||||
;--------------------------------------------------------------------
|
||||
;align 4
|
||||
;calculate_linear_to_real:
|
||||
; shr eax, 12
|
||||
; mov eax, [page_tabs+eax*4]
|
||||
; and eax, 0xFFFFF000
|
||||
; ret
|
||||
195
kernel/branches/kolibri-process/blkdev/rd.inc
Normal file
195
kernel/branches/kolibri-process/blkdev/rd.inc
Normal file
@@ -0,0 +1,195 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2013. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;; RAMDISK functions ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4273 $
|
||||
|
||||
iglobal
|
||||
align 4
|
||||
ramdisk_functions:
|
||||
dd .size
|
||||
dd 0 ; no close() function
|
||||
dd 0 ; no closemedia() function
|
||||
dd ramdisk_querymedia
|
||||
dd ramdisk_read
|
||||
dd ramdisk_write
|
||||
dd 0 ; no flush() function
|
||||
dd ramdisk_adjust_cache_size
|
||||
.size = $ - ramdisk_functions
|
||||
endg
|
||||
|
||||
; See memmap.inc.
|
||||
; Currently size of memory allocated for the ramdisk is fixed.
|
||||
; This should be revisited when/if memory map would become more dynamic.
|
||||
RAMDISK_CAPACITY = 2880 ; in sectors
|
||||
|
||||
iglobal
|
||||
align 4
|
||||
ramdisk_actual_size dd RAMDISK_CAPACITY
|
||||
endg
|
||||
|
||||
; This function is called early in boot process.
|
||||
; It creates filesystem /rd/1 based on raw image data loaded by somebody before
|
||||
; to memory named as RAMDISK with max size RAMDISK_CAPACITY, may be less.
|
||||
proc ramdisk_init
|
||||
iglobal
|
||||
ramdisk_name db 'rd',0
|
||||
endg
|
||||
push ebx esi ; save used registers to be stdcall
|
||||
; 1. Register the device and the (always inserted) media in the disk subsystem.
|
||||
stdcall disk_add, ramdisk_functions, ramdisk_name, 0, 0
|
||||
test eax, eax
|
||||
jz .fail
|
||||
mov ebx, eax
|
||||
stdcall disk_media_changed, eax, 1
|
||||
; 2. We don't know actual size of loaded image,
|
||||
; so try to calculate it using partition structure,
|
||||
; assuming that file systems fill the real size based on contents of the partition.
|
||||
; 2a. Prepare for loop over partitions.
|
||||
xor ecx, ecx
|
||||
xor edx, edx
|
||||
; 2b. Check that at least one partition was recognized.
|
||||
cmp [ebx+DISK.NumPartitions], ecx
|
||||
jz .fail
|
||||
; 2c. Loop over partitions.
|
||||
.partitions:
|
||||
; For every partition, set edx to maximum between edx and end of partition.
|
||||
mov esi, [ebx+DISK.Partitions]
|
||||
mov esi, [esi+ecx*4]
|
||||
mov eax, dword [esi+PARTITION.FirstSector]
|
||||
add eax, dword [esi+PARTITION.Length]
|
||||
cmp eax, edx
|
||||
jb @f
|
||||
mov edx, eax
|
||||
@@:
|
||||
inc ecx
|
||||
cmp ecx, [ebx+DISK.NumPartitions]
|
||||
jb .partitions
|
||||
; 3. Reclaim unused memory, if any.
|
||||
mov [ramdisk_actual_size], edx
|
||||
add edx, 7 ; aligning up
|
||||
shr edx, 3 ; 512-byte sectors -> 4096-byte pages
|
||||
mov esi, RAMDISK_CAPACITY / 8 ; aligning down
|
||||
sub esi, edx
|
||||
jbe .no_reclaim
|
||||
shl edx, 12
|
||||
add edx, RAMDISK - OS_BASE
|
||||
@@:
|
||||
mov eax, edx
|
||||
call free_page
|
||||
add edx, 0x1000
|
||||
dec esi
|
||||
jnz @b
|
||||
.no_reclaim:
|
||||
pop esi ebx ; restore used registers to be stdcall
|
||||
ret
|
||||
.fail:
|
||||
dbgstr 'Failed to initialize ramdisk'
|
||||
pop esi ebx ; restore used registers to be stdcall
|
||||
ret
|
||||
endp
|
||||
|
||||
; Returns information about disk media.
|
||||
proc ramdisk_querymedia
|
||||
virtual at esp+4
|
||||
.userdata dd ?
|
||||
.info dd ?
|
||||
end virtual
|
||||
; Media is always present, sector size is always 512 bytes.
|
||||
mov edx, [.userdata]
|
||||
mov ecx, [.info]
|
||||
mov [ecx+DISKMEDIAINFO.Flags], 0
|
||||
mov [ecx+DISKMEDIAINFO.SectorSize], 512
|
||||
mov eax, [ramdisk_actual_size]
|
||||
mov dword [ecx+DISKMEDIAINFO.Capacity], eax
|
||||
mov dword [ecx+DISKMEDIAINFO.Capacity+4], 0
|
||||
; Return zero as an indicator of success.
|
||||
xor eax, eax
|
||||
retn 8
|
||||
endp
|
||||
|
||||
; Common procedure for reading and writing.
|
||||
; operation = 0 for reading, operation = 1 for writing.
|
||||
; Arguments of ramdisk_read and ramdisk_write are the same.
|
||||
macro ramdisk_read_write operation
|
||||
{
|
||||
push esi edi ; save used registers to be stdcall
|
||||
mov esi, [userdata]
|
||||
mov edi, [numsectors_ptr]
|
||||
; 1. Determine number of sectors to be transferred.
|
||||
; This is either the requested number of sectors or number of sectors
|
||||
; up to the disk boundary, depending of what is less.
|
||||
xor ecx, ecx
|
||||
; 1a. Test whether [start_sector] is less than RAMDISK_CAPACITY.
|
||||
; If so, calculate number of sectors between [start_sector] and RAMDISK_CAPACITY.
|
||||
; Otherwise, the actual number of sectors is zero.
|
||||
cmp dword [start_sector+4], ecx
|
||||
jnz .got_number
|
||||
mov eax, [ramdisk_actual_size]
|
||||
sub eax, dword [start_sector]
|
||||
jbe .got_number
|
||||
; 1b. Get the requested number of sectors.
|
||||
mov ecx, [edi]
|
||||
; 1c. If it is greater than number of sectors calculated in 1a, use the value
|
||||
; from 1a.
|
||||
cmp ecx, eax
|
||||
jb .got_number
|
||||
mov ecx, eax
|
||||
.got_number:
|
||||
; 2. Compare the actual number of sectors with requested. If they are
|
||||
; equal, set eax (it will be the returned value) to zero. Otherwise,
|
||||
; use DISK_STATUS_END_OF_MEDIA.
|
||||
xor eax, eax
|
||||
cmp ecx, [edi]
|
||||
jz @f
|
||||
mov al, DISK_STATUS_END_OF_MEDIA
|
||||
@@:
|
||||
; 3. Store the actual number of sectors.
|
||||
mov [edi], ecx
|
||||
; 4. Calculate source and destination addresses.
|
||||
if operation = 0 ; reading?
|
||||
mov esi, dword [start_sector]
|
||||
shl esi, 9
|
||||
add esi, RAMDISK
|
||||
mov edi, [buffer]
|
||||
else ; writing?
|
||||
mov edi, dword [start_sector]
|
||||
shl edi, 9
|
||||
add edi, RAMDISK
|
||||
mov esi, [buffer]
|
||||
end if
|
||||
; 5. Calculate number of dwords to be transferred.
|
||||
shl ecx, 9-2
|
||||
; 6. Copy data.
|
||||
rep movsd
|
||||
; 7. Return. The value in eax was calculated in step 2.
|
||||
pop edi esi ; restore used registers to be stdcall
|
||||
}
|
||||
|
||||
; Reads one or more sectors from the device.
|
||||
proc ramdisk_read userdata:dword, buffer:dword, start_sector:qword, numsectors_ptr:dword
|
||||
ramdisk_read_write 0
|
||||
ret
|
||||
endp
|
||||
|
||||
; Writes one or more sectors to the device.
|
||||
proc ramdisk_write userdata:dword, buffer:dword, start_sector:qword, numsectors_ptr:dword
|
||||
ramdisk_read_write 1
|
||||
ret
|
||||
endp
|
||||
|
||||
; The kernel calls this function when initializing cache subsystem for
|
||||
; the media. This call allows the driver to adjust the cache size.
|
||||
proc ramdisk_adjust_cache_size
|
||||
virtual at esp+4
|
||||
.userdata dd ?
|
||||
.suggested_size dd ?
|
||||
end virtual
|
||||
; Since ramdisk does not need cache, just return 0.
|
||||
xor eax, eax
|
||||
retn 8
|
||||
endp
|
||||
33
kernel/branches/kolibri-process/blkdev/rdsave.inc
Normal file
33
kernel/branches/kolibri-process/blkdev/rdsave.inc
Normal file
@@ -0,0 +1,33 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4273 $
|
||||
|
||||
|
||||
iglobal
|
||||
saverd_fileinfo:
|
||||
dd 2 ; subfunction: write
|
||||
dd 0 ; (reserved)
|
||||
dd 0 ; (reserved)
|
||||
.size:
|
||||
dd 0
|
||||
dd RAMDISK
|
||||
db 0
|
||||
.name:
|
||||
dd ?
|
||||
endg
|
||||
sysfn_saveramdisk: ; 18.6 = SAVE FLOPPY IMAGE (HD version only)
|
||||
mov ebx, saverd_fileinfo
|
||||
mov [ebx+21], ecx
|
||||
mov eax, [ramdisk_actual_size]
|
||||
shl eax, 9
|
||||
mov [ebx+12], eax
|
||||
pushad
|
||||
call file_system_lfn_protected ;in ebx
|
||||
popad
|
||||
mov [esp+32], eax
|
||||
ret
|
||||
BIN
kernel/branches/kolibri-process/boot/ETFONT.FNT
Normal file
BIN
kernel/branches/kolibri-process/boot/ETFONT.FNT
Normal file
Binary file not shown.
1520
kernel/branches/kolibri-process/boot/bootcode.inc
Normal file
1520
kernel/branches/kolibri-process/boot/bootcode.inc
Normal file
File diff suppressed because it is too large
Load Diff
106
kernel/branches/kolibri-process/boot/booten.inc
Normal file
106
kernel/branches/kolibri-process/boot/booten.inc
Normal file
@@ -0,0 +1,106 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;======================================================================
|
||||
;
|
||||
; BOOT DATA
|
||||
;
|
||||
;======================================================================
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
d80x25_bottom:
|
||||
db 186,' KolibriOS comes with ABSOLUTELY NO WARRANTY. See file COPYING for details ',186
|
||||
db 186,' If you find any bugs, please report them at: http://board.kolibrios.org ',186
|
||||
line_full_bottom
|
||||
d80x25_bottom_num = 3
|
||||
|
||||
msg_apm db " APM x.x ", 0
|
||||
novesa db "Display: EGA/CGA",13,10,0
|
||||
s_vesa db "Version of VESA: "
|
||||
.ver db "?.?",13,10,0
|
||||
|
||||
gr_mode db "Select a videomode: ",13,10,0
|
||||
|
||||
ask_bd db "Add disks visible by BIOS emulated in V86-mode? [1-yes, 2-no]: ",0
|
||||
|
||||
if defined extended_primary_loader
|
||||
bdev db "Load ramdisk from [1-floppy; 2-kolibri.img]: ",0
|
||||
else
|
||||
bdev db "Load ramdisk from [1-floppy; 2-C:\kolibri.img (FAT32);"
|
||||
db 13,10,186," "
|
||||
db "3-use preloaded ram-image from kernel restart;"
|
||||
db 13,10,186," "
|
||||
db "4-create blank image]: ",0
|
||||
end if
|
||||
|
||||
prnotfnd db "Fatal - Videomode not found.",0
|
||||
|
||||
not386 db "Fatal - CPU 386+ required.",0
|
||||
fatalsel db "Fatal - Graphics mode not supported by hardware.",0
|
||||
pres_key db "Press any key to choose a new videomode.",0
|
||||
badsect db 13,10,186," Fatal - Bad sector. Replace floppy.",0
|
||||
memmovefailed db 13,10,186," Fatal - Int 0x15 move failed.",0
|
||||
okt db " ... OK"
|
||||
linef db 13,10,0
|
||||
diskload db "Loading diskette: 00 %",8,8,8,8,0
|
||||
pros db "00"
|
||||
backspace2 db 8,8,0
|
||||
boot_dev db 0 ; 0=floppy, 1=hd
|
||||
start_msg db "Press [abcde] to change settings, press [Enter] to continue booting",13,10,0
|
||||
time_msg db " or wait "
|
||||
time_str db " 5 seconds"
|
||||
db " before automatical continuation",13,10,0
|
||||
current_cfg_msg db "Current settings:",13,10,0
|
||||
curvideo_msg db " [a] Videomode: ",0
|
||||
|
||||
mode0 db "320x200, EGA/CGA 256 colors",13,10,0
|
||||
mode9 db "640x480, VGA 16 colors",13,10,0
|
||||
|
||||
usebd_msg db " [b] Add disks visible by BIOS:",0
|
||||
on_msg db " on",13,10,0
|
||||
off_msg db " off",13,10,0
|
||||
|
||||
debug_mode_msg db " [c] Duplicate debug output to the screen:",0
|
||||
ask_debug db "Duplicate debug output to the screen? [1-yes, 2-no]: ",0
|
||||
|
||||
launcher_msg db " [d] Start LAUNCHER after kernel is loaded:",0
|
||||
ask_launcher db "Start first application (LAUNCHER) after kernel is loaded? [1-yes, 2-no]: ",0
|
||||
|
||||
preboot_device_msg db " [e] Floppy image: ",0
|
||||
|
||||
if defined extended_primary_loader
|
||||
preboot_device_msgs dw 0,pdm1,pdm2,0
|
||||
pdm1 db "real floppy",13,10,0
|
||||
pdm2 db "C:\kolibri.img (FAT32)",13,10,0
|
||||
else
|
||||
preboot_device_msgs dw 0,pdm1,pdm2,pdm3,pdm4,0
|
||||
pdm1 db "real floppy",13,10,0
|
||||
pdm2 db "C:\kolibri.img (FAT32)",13,10,0
|
||||
pdm3 db "use already loaded image",13,10,0
|
||||
pdm4 db "create blank image",13,10,0
|
||||
end if
|
||||
|
||||
loading_msg db "Loading KolibriOS...",0
|
||||
|
||||
if ~ defined extended_primary_loader
|
||||
save_quest db "Remember current settings? [y/n]: ",0
|
||||
loader_block_error db "Bootloader data invalid, I cannot continue. Stopped.",0
|
||||
end if
|
||||
|
||||
_st latin1 '║ ┌───────────────────────────────┬─┐',13,10,0
|
||||
_r1 latin1 '║ │ 320x200 EGA/CGA 256 colors │ │',13,10,0
|
||||
_r2 latin1 '║ │ 640x480 VGA 16 colors │ │',13,10,0
|
||||
_rs latin1 '║ │ ????x????@?? SVGA VESA │ │',13,10,0
|
||||
_bt latin1 '║ └───────────────────────────────┴─┘',13,10,0
|
||||
|
||||
remark1 db "Default values were selected to match most of configurations, but not all.",0
|
||||
remark2 db "If the system does not boot, try to disable option [b]. If the system gets",0
|
||||
remark3 db "stuck after booting, enable option [c], disable option [d] and make photo.",0
|
||||
remarks dw remark1, remark2, remark3
|
||||
num_remarks = 3
|
||||
106
kernel/branches/kolibri-process/boot/bootet.inc
Normal file
106
kernel/branches/kolibri-process/boot/bootet.inc
Normal file
@@ -0,0 +1,106 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;======================================================================
|
||||
;
|
||||
; BOOT DATA
|
||||
;
|
||||
;======================================================================
|
||||
|
||||
$Revision: 4135 $
|
||||
|
||||
|
||||
d80x25_bottom:
|
||||
latin1 '║ KolibriOS on IGASUGUSE GARANTIITA. Vaata faili COPYING info saamiseks. Kui ║'
|
||||
latin1 '║ leiate vigu, anna neist palun teada aadressil: http://board.kolibrios.org ║'
|
||||
line_full_bottom
|
||||
d80x25_bottom_num = 3
|
||||
|
||||
msg_apm latin1 " APM x.x ", 0
|
||||
novesa latin1 "Ekraan: EGA/CGA",13,10,0
|
||||
s_vesa latin1 "Vesa versioon: "
|
||||
.ver db "?.?",13,10,0
|
||||
|
||||
gr_mode latin1 "Vali video resolutsioon: ",13,10,0
|
||||
|
||||
ask_bd latin1 "Lisa V86 reziimis BIOSle nähtavad kettad? [1-jah, 2-ei]: ",0
|
||||
|
||||
if defined extended_primary_loader
|
||||
bdev latin1 "Paigalda mäluketas [1-diskett; 2-kolibri.img]: ",0
|
||||
else
|
||||
bdev latin1 "Paigalda mäluketas [1-diskett; 2-C:\kolibri.img (FAT32);"
|
||||
latin1 13,10,"║ "
|
||||
latin1 "3-kasuta eellaaditud mäluketast kerneli restardist;"
|
||||
latin1 13,10,"║ "
|
||||
latin1 "4-loo tühi pilt]: ",0
|
||||
end if
|
||||
|
||||
prnotfnd latin1 "Fataalne - Video resolutsiooni ei leitud.",0
|
||||
|
||||
not386 latin1 "Fataalne - CPU 386+ on vajalik.",0
|
||||
fatalsel latin1 "Fataalne - Riistvara ei toeta graafilist resolutsiooni.",0
|
||||
pres_key latin1 "Vajutage suvalist klahvi, et valida uus videomode.",0
|
||||
badsect latin1 13,10,"║ Fataalne - Vigane sektor. Asenda diskett.",0
|
||||
memmovefailed latin1 13,10,"║ Fataalne - Int 0x15 liigutamine ebaõnnestus.",0
|
||||
okt latin1 " ... OK"
|
||||
linef latin1 13,10,0
|
||||
diskload latin1 "Loen disketti: 00 %",8,8,8,8,0
|
||||
pros latin1 "00"
|
||||
backspace2 latin1 8,8,0
|
||||
boot_dev db 0 ; 0=floppy, 1=hd
|
||||
start_msg latin1 "Vajuta [abcde] seadete muutmiseks, vajuta [Enter] laadimise jätkamiseks",13,10,0
|
||||
time_msg latin1 " või oota "
|
||||
time_str latin1 " 5 sekundit"
|
||||
latin1 " automaatseks jätkamiseks",13,10,0
|
||||
current_cfg_msg latin1 "Praegused seaded:",13,10,0
|
||||
curvideo_msg latin1 " [a] Video resolutsioon: ",0
|
||||
|
||||
mode0 latin1 "320x200, EGA/CGA 256 värvi",0
|
||||
mode9 latin1 "640x480, VGA 16 värvi",0
|
||||
|
||||
usebd_msg latin1 " [b] Lisa BIOSle nähtavad kettad:",0
|
||||
on_msg latin1 " sees",13,10,0
|
||||
off_msg latin1 " väljas",13,10,0
|
||||
|
||||
debug_mode_msg latin1 " [c] Dubleeri silumisinfo ekraanile:",0
|
||||
ask_debug latin1 "Dubleeri silumisinfo ekraanile? [1-jah, 2-ei]: ",0
|
||||
|
||||
launcher_msg latin1 " [d] Käivita LAUNCHER pärast kerneli laadimist:",0
|
||||
ask_launcher latin1 "Käivita esimese programm (LAUNCHER) peale kerneli laadimist? [1-jah, 2-ei]: ",0
|
||||
|
||||
preboot_device_msg latin1 " [e] Disketi kujutis: ",0
|
||||
|
||||
if defined extended_primary_loader
|
||||
preboot_device_msgs dw 0,pdm1,pdm2,0
|
||||
pdm1 latin1 "reaalne diskett",13,10,0
|
||||
pdm2 latin1 "kolibri.img",13,10,0
|
||||
else
|
||||
preboot_device_msgs dw 0,pdm1,pdm2,pdm3,pdm4,0
|
||||
pdm1 latin1 "reaalne diskett",13,10,0
|
||||
pdm2 latin1 "C:\kolibri.img (FAT32)",13,10,0
|
||||
pdm3 latin1 "kasuta juba laaditud kujutist",13,10,0
|
||||
pdm4 latin1 "loo tühi pilt",13,10,0
|
||||
end if
|
||||
|
||||
loading_msg latin1 "Laadin KolibriOS...",0
|
||||
|
||||
if ~ defined extended_primary_loader
|
||||
save_quest latin1 "Jäta meelde praegused seaded? [y/n]: ",0
|
||||
loader_block_error latin1 "Alglaaduri andmed vigased, ei saa jätkata. Peatatud.",0
|
||||
end if
|
||||
|
||||
_st latin1 '║ ┌───────────────────────────────┬─┐',13,10,0
|
||||
_r1 latin1 '║ │ 320x200 EGA/CGA 256 colors │ │',13,10,0
|
||||
_r2 latin1 '║ │ 640x480 VGA 16 colors │ │',13,10,0
|
||||
_rs latin1 '║ │ ????x????@?? SVGA VESA │ │',13,10,0
|
||||
_bt latin1 '║ └───────────────────────────────┴─┘',13,10,0
|
||||
|
||||
remark1 latin1 "Vaikimisi väärtused on kasutatavad enamikes arvutites, kuid mitte kõigis.",0
|
||||
remark2 latin1 "Kui süsteem ei käivitu, proovige lülitada kirje [b] välja. Kui see läheb",0
|
||||
remark3 latin1 "kinni pärast käivitamist, võimaldama valik [c], keelake [d] ja teha foto.",0
|
||||
remarks dw remark1, remark2, remark3
|
||||
num_remarks = 3
|
||||
107
kernel/branches/kolibri-process/boot/bootge.inc
Normal file
107
kernel/branches/kolibri-process/boot/bootge.inc
Normal file
@@ -0,0 +1,107 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;======================================================================
|
||||
;
|
||||
; BOOT DATA
|
||||
;
|
||||
;======================================================================
|
||||
|
||||
$Revision: 4135 $
|
||||
|
||||
|
||||
d80x25_bottom:
|
||||
db 186,' KolibriOS wird ohne jegliche Garantie vertrieben. Details stehen in der ',186
|
||||
db 186,' Datei COPYING. Bitte melden Sie Fehler bei: http://board.kolibrios.org ',186
|
||||
line_full_bottom
|
||||
d80x25_bottom_num = 3
|
||||
|
||||
msg_apm db " APM x.x ", 0
|
||||
novesa db "Anzeige: EGA/CGA ",13,10,0
|
||||
s_vesa db "Vesa-Version: "
|
||||
.ver db "?.?",13,10,0
|
||||
|
||||
gr_mode db "Wahlen Sie einen videomode: ",13,10,0
|
||||
|
||||
ask_bd db "Add-Festplatten sichtbar BIOS in V86-Modus emuliert? [1-ja, 2 nein]: ",0
|
||||
|
||||
if defined extended_primary_loader
|
||||
bdev db "Lade die Ramdisk von [1-Diskette; 2-kolibri.img]: ",0
|
||||
else
|
||||
bdev db "Lade die Ramdisk von [1-Diskette; 2-C:\kolibri.img (FAT32);"
|
||||
db 13,10,186," "
|
||||
db "3-benutze ein bereits geladenes Kernel image;"
|
||||
db 13,10,186," "
|
||||
db "4-create blank image]: ",0
|
||||
end if
|
||||
|
||||
prnotfnd db "Fatal - Videomodus nicht gefunden.",0
|
||||
|
||||
not386 db "Fatal - CPU 386+ benoetigt.",0
|
||||
fatalsel db "Fatal - Grafikmodus nicht unterstuetzt.",0
|
||||
pres_key db "Drucken Sie eine beliebige Taste, um eine neue videomode wahlen.",0
|
||||
badsect db 13,10,186," Fatal - Sektorfehler, Andere Diskette neutzen.",0
|
||||
memmovefailed db 13,10,186," Fatal - Int 0x15 Fehler.",0
|
||||
okt db " ... OK"
|
||||
linef db 13,10,0
|
||||
diskload db "Lade Diskette: 00 %",8,8,8,8,0
|
||||
pros db "00"
|
||||
backspace2 db 8,8,0
|
||||
boot_dev db 0 ; 0=floppy, 1=hd
|
||||
start_msg db "Druecke [abcde], um die Einstellungen zu aendern, druecke [Enter] zum starten",13,10,0
|
||||
time_msg db " oder warte "
|
||||
time_str db " 5 Sekunden"
|
||||
db " bis zum automatischen Start",13,10,0
|
||||
current_cfg_msg db "Aktuelle Einstellungen:",13,10,0
|
||||
curvideo_msg db " [a] Videomodus: ",0
|
||||
|
||||
mode0 db "320x200, EGA/CGA 256 colors",13,10,0
|
||||
mode9 db "640x480, VGA 16 colors",13,10,0
|
||||
|
||||
usebd_msg db " [b] Add-Festplatten sichtbar durch das BIOS:",0
|
||||
on_msg db " an",13,10,0
|
||||
off_msg db " aus",13,10,0
|
||||
|
||||
debug_mode_msg db " [c] Duplizieren debuggen Ausgabe auf dem Bildschirm:",0
|
||||
ask_debug db "Duplizieren debuggen Ausgabe auf dem Bildschirm? [1-ja, 2 nein]: ",0
|
||||
|
||||
launcher_msg db " [d] Start LAUNCHER nach Kernel geladen wird:",0
|
||||
ask_launcher db "Starten erste Anwendung nach Kernel geladen wird? [1-ja, 2 nein]: ",0
|
||||
|
||||
preboot_device_msg db " [e] Diskettenimage: ",0
|
||||
|
||||
if defined extended_primary_loader
|
||||
preboot_device_msgs dw 0,pdm1,pdm2,0
|
||||
pdm1 db "Echte Diskette",13,10,0
|
||||
pdm2 db "kolibri.img",13,10,0
|
||||
else
|
||||
preboot_device_msgs dw 0,pdm1,pdm2,pdm3,pdm4,0
|
||||
pdm1 db "Echte Diskette",13,10,0
|
||||
pdm2 db "C:\kolibri.img (FAT32)",13,10,0
|
||||
pdm3 db "Nutze bereits geladenes Image",13,10,0
|
||||
pdm4 db "create blank image",13,10,0
|
||||
end if
|
||||
|
||||
loading_msg db "Lade KolibriOS...",0
|
||||
|
||||
if ~ defined extended_primary_loader
|
||||
save_quest db "Aktuelle Einstellungen speichern? [y/n]: ",0
|
||||
loader_block_error db "Bootloader Daten ungueltig, Kann nicht fortfahren. Angehalten.",0
|
||||
end if
|
||||
|
||||
_st latin1 '║ ┌───────────────────────────────┬─┐',13,10,0
|
||||
_r1 latin1 '║ │ 320x200 EGA/CGA 256 colors │ │',13,10,0
|
||||
_r2 latin1 '║ │ 640x480 VGA 16 colors │ │',13,10,0
|
||||
_rs latin1 '║ │ ????x????@?? SVGA VESA │ │',13,10,0
|
||||
_bt latin1 '║ └───────────────────────────────┴─┘',13,10,0
|
||||
|
||||
remark1 db "Die Standardwerte sind fur die meisten gewahlt, aber nicht fur jedermann.",0
|
||||
remark2 db "Wenn das System nicht bootet, das Option [b] deaktivieren versuchen. Wenn es",0
|
||||
remark3 db "nach dem Booten hangen bleibt, aktivieren Sie Option [c], deaktivieren [d]",0
|
||||
remark4 db "und machen Fotos.",0
|
||||
remarks dw remark1, remark2, remark3, remark4
|
||||
num_remarks = 4
|
||||
104
kernel/branches/kolibri-process/boot/bootru.inc
Normal file
104
kernel/branches/kolibri-process/boot/bootru.inc
Normal file
@@ -0,0 +1,104 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;=================================================================
|
||||
;
|
||||
; BOOT DATA
|
||||
;
|
||||
;=================================================================
|
||||
|
||||
$Revision: 4135 $
|
||||
|
||||
|
||||
d80x25_bottom:
|
||||
cp866 '║ KolibriOS НЕ ПРЕДОСТАВЛЯЕТ НИКАКИХ ГАРAНТИЙ. Подробнее смотрите в файле ║'
|
||||
cp866 '║ COPYING.TXT. О найденных ошибках сообщайте на http://board.kolibrios.org ║'
|
||||
line_full_bottom
|
||||
d80x25_bottom_num = 3
|
||||
|
||||
msg_apm cp866 " APM x.x ", 0
|
||||
novesa cp866 "Видеокарта: EGA/CGA",13,10,0
|
||||
s_vesa cp866 "Версия VESA: "
|
||||
.ver db "?.?",13,10,0
|
||||
|
||||
gr_mode cp866 "Выберите видеорежим: ",13,10,0
|
||||
|
||||
ask_bd cp866 "Добавить диски, видимые через BIOS в режиме V86? [1-да, 2-нет]: ",0
|
||||
|
||||
if defined extended_primary_loader
|
||||
bdev cp866 "Загрузить образ из [1-дискета; 2-kolibri.img из папки загрузки]: ",0
|
||||
else
|
||||
bdev cp866 "Загрузить образ из [1-дискета; 2-C:\kolibri.img (FAT32);",13,10
|
||||
cp866 "║ 3-использовать уже загруженный образ;",13,10
|
||||
cp866 "║ 4-создать чистый образ]: ",0
|
||||
end if
|
||||
|
||||
prnotfnd cp866 "Ошибка - Видеорежим не найден.",0
|
||||
|
||||
not386 cp866 "Ошибка - Требуется процессор 386+.",0
|
||||
fatalsel cp866 "Ошибка - Выбранный видеорежим не поддерживается.",0
|
||||
pres_key cp866 "Нажимите любую клавишу, для перехода в выбор режимов.",0
|
||||
badsect cp866 13,10,"║ Ошибка - Дискета повреждена. Попробуйте другую.",0
|
||||
memmovefailed cp866 13,10,"║ Ошибка - Int 0x15 move failed.",0
|
||||
okt cp866 " ... OK"
|
||||
linef cp866 13,10,0
|
||||
diskload cp866 "Загрузка дискеты: 00 %",8,8,8,8,0
|
||||
pros cp866 "00"
|
||||
backspace2 cp866 8,8,0
|
||||
boot_dev db 0
|
||||
start_msg cp866 "Нажмите [abcde] для изменения настроек, [Enter] для продолжения загрузки",13,10,0
|
||||
time_msg cp866 " или подождите "
|
||||
time_str cp866 " 5 секунд "
|
||||
cp866 " до автоматического продолжения",13,10,0
|
||||
current_cfg_msg cp866 "Текущие настройки:",13,10,0
|
||||
curvideo_msg cp866 " [a] Видеорежим: ",0
|
||||
|
||||
mode0 cp866 "320x200, EGA/CGA 256 цветов",13,10,0
|
||||
mode9 cp866 "640x480, VGA 16 цветов",13,10,0
|
||||
|
||||
usebd_msg cp866 " [b] Добавить диски, видимые через BIOS:",0
|
||||
on_msg cp866 " вкл",13,10,0
|
||||
off_msg cp866 " выкл",13,10,0
|
||||
|
||||
debug_mode_msg cp866 " [c] Дублировать дебаг-вывод на экран монитора:",0
|
||||
ask_debug cp866 "Дублировать дебаг-вывод на экран монитора? [1-да, 2-нет]: ",0
|
||||
|
||||
launcher_msg cp866 " [d] Запустить программу LAUNCHER после загрузки ядра:",0
|
||||
ask_launcher cp866 "Запустить первую программу (LAUNCHER) после загрузки ядра? [1-да, 2-нет]: ",0
|
||||
|
||||
preboot_device_msg cp866 " [e] Образ дискеты: ",0
|
||||
|
||||
if defined extended_primary_loader
|
||||
preboot_device_msgs dw 0,pdm1,pdm2,0
|
||||
pdm1 cp866 "настоящая дискета",13,10,0
|
||||
pdm2 cp866 "kolibri.img из папки загрузки",13,10,0
|
||||
else
|
||||
preboot_device_msgs dw 0,pdm1,pdm2,pdm3,pdm4,0
|
||||
pdm1 cp866 "настоящая дискета",13,10,0
|
||||
pdm2 cp866 "C:\kolibri.img (FAT32)",13,10,0
|
||||
pdm3 cp866 "использовать уже загруженный образ",13,10,0
|
||||
pdm4 cp866 "создать чистый образ",13,10,0
|
||||
end if
|
||||
|
||||
loading_msg cp866 "Идёт загрузка KolibriOS...",0
|
||||
|
||||
if ~ defined extended_primary_loader ; saving not supported in this case
|
||||
save_quest cp866 "Запомнить текущие настройки? [y/n]: ",0
|
||||
loader_block_error cp866 "Ошибка в данных начального загрузчика, продолжение невозможно.",0
|
||||
end if
|
||||
|
||||
_st cp866 '║ ┌───────────────────────────────┬─┐ ',13,10,0
|
||||
_r1 cp866 '║ │ 320x200 EGA/CGA 256 цветов │ │ ',13,10,0
|
||||
_r2 cp866 '║ │ 640x480 VGA 16 цветов │ │ ',13,10,0
|
||||
_rs cp866 '║ │ ????x????@?? SVGA VESA │ │ ',13,10,0
|
||||
_bt cp866 '║ └───────────────────────────────┴─┘ ',13,10,0
|
||||
|
||||
remark1 cp866 "Значения по умолчанию выбраны для удобства большинства, но не всех. Если у",0
|
||||
remark2 cp866 "Вас не грузится система, попробуйте отключить пункт [b]. Если она зависла",0
|
||||
remark3 cp866 "после запуска, включите пункт [c], отключите пункт [d] и сделайте фото лога.",0
|
||||
remarks dw remark1, remark2, remark3
|
||||
num_remarks = 3
|
||||
108
kernel/branches/kolibri-process/boot/bootsp.inc
Normal file
108
kernel/branches/kolibri-process/boot/bootsp.inc
Normal file
@@ -0,0 +1,108 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;======================================================================
|
||||
;
|
||||
; BOOT DATA
|
||||
;
|
||||
;======================================================================
|
||||
|
||||
; Para modificar éste archivo es necesario abrirlo con codificación CP850
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
d80x25_bottom:
|
||||
cp850 '║ KolibriOS viene ABSOLUTAMENTE SIN GARANTíA. Lee el archivo COPYING por más ║'
|
||||
cp850 '║ detalles. Por favor, informar de los errores en: http://board.kolibrios.org ║'
|
||||
line_full_bottom
|
||||
d80x25_bottom_num = 3
|
||||
|
||||
msg_apm cp850 " APM x.x ", 0
|
||||
novesa cp850 "Monitor: EGA/CGA",13,10,0
|
||||
s_vesa cp850 "Versión de VESA: "
|
||||
.ver db "?.?",13,10,0
|
||||
|
||||
gr_mode cp850 "Selecciona un modo de video: ",13,10,0
|
||||
|
||||
ask_bd cp850 "¿Agregar discos visibles por el BIOS emulados en modo V86? [1-si, 2-no]: ",0
|
||||
|
||||
if defined extended_primary_loader
|
||||
bdev cp850 "Cargar unidad ram desde [1-disquete; 2-kolibri.img]: ",0
|
||||
else
|
||||
bdev cp850 "Cargar unidad ram desde [1-disquete; 2-C:\kolibri.img (FAT32);"
|
||||
cp850 13,10,"║ "
|
||||
cp850 "3-usar imagen precargada en el reinicio del núcleo;"
|
||||
cp850 13,10,"║ "
|
||||
cp850 "4-crear imagen vacía]: ",0
|
||||
end if
|
||||
|
||||
prnotfnd cp850 "Fatal - Modo de video no encontrado.",0
|
||||
|
||||
not386 cp850 "Fatal - CPU 386+ requerido.",0
|
||||
fatalsel cp850 "Fatal - Modo de gráficos no soportado por hardware.",0
|
||||
pres_key cp850 "Presiona una tecla para seleccionar otro modo de video.",0
|
||||
badsect cp850 13,10,"║ Fatal - Sector mal. Reemplaze el disquete.",0
|
||||
memmovefailed cp850 13,10,"║ Fatal - Int 0x15 move failed.",0
|
||||
okt cp850 " ... BIEN"
|
||||
linef cp850 13,10,0
|
||||
diskload cp850 "Cargando disquete: 00 %",8,8,8,8,0
|
||||
pros cp850 "00"
|
||||
backspace2 cp850 8,8,0
|
||||
boot_dev db 0 ; 0=floppy, 1=hd
|
||||
start_msg cp850 "Presiona [abcde] para cambiar la configuración, [Enter] para continuar",13,10,0
|
||||
time_msg cp850 " o espera "
|
||||
time_str cp850 " 5 segundos"
|
||||
cp850 " para que inicie automáticamente",13,10,0
|
||||
current_cfg_msg cp850 "Configuración actual:",13,10,0
|
||||
curvideo_msg cp850 " [a] Modo de video: ",0
|
||||
|
||||
mode0 cp850 "320x200, EGA/CGA 256 colores",13,10,0
|
||||
mode9 cp850 "640x480, VGA 16 colores",13,10,0
|
||||
|
||||
usebd_msg cp850 " [b] Agregar discos visibles por el BIOS:",0
|
||||
on_msg cp850 " activado",13,10,0
|
||||
off_msg cp850 " desactivado",13,10,0
|
||||
|
||||
debug_mode_msg cp850 " [c] Duplicar depurar salida a la pantalla:",0
|
||||
ask_debug cp850 "¿Duplicar depurar la salida a la pantalla? [1-si, 2-no]: ",0
|
||||
|
||||
launcher_msg cp850 " [d] Iniciar LAUNCHER después de cargar kernel:",0
|
||||
ask_launcher cp850 "¿Inicie la primera aplicación después de cargar el kernel? [1-si, 2-no]: ",0
|
||||
|
||||
preboot_device_msg cp850 " [e] Imagen de disquete: ",0
|
||||
|
||||
if defined extended_primary_loader
|
||||
preboot_device_msgs dw 0,pdm1,pdm2,0
|
||||
pdm1 cp850 "disquete real",13,10,0
|
||||
pdm2 cp850 "C:\kolibri.img (FAT32)",13,10,0
|
||||
else
|
||||
preboot_device_msgs dw 0,pdm1,pdm2,pdm3,pdm4,0
|
||||
pdm1 cp850 "disquete real",13,10,0
|
||||
pdm2 cp850 "C:\kolibri.img (FAT32)",13,10,0
|
||||
pdm3 cp850 "usar imagen ya cargada",13,10,0
|
||||
pdm4 cp850 "crear imagen vacía",13,10,0
|
||||
end if
|
||||
|
||||
loading_msg cp850 "Cargando KolibriOS...",0
|
||||
|
||||
if ~ defined extended_primary_loader
|
||||
save_quest cp850 "¿Recordar configuración actual? [s/n]: ",0
|
||||
loader_block_error cp850 "Bootloader inválido, no puedo continuar. Detenido.",0
|
||||
end if
|
||||
|
||||
_st cp850 '║ ┌───────────────────────────────┬─┐',13,10,0
|
||||
_r1 cp850 '║ │ 320x200 EGA/CGA 256 colores │ │',13,10,0
|
||||
_r2 cp850 '║ │ 640x480 VGA 16 colores │ │',13,10,0
|
||||
_rs cp850 '║ │ ????x????@?? SVGA VESA │ │',13,10,0
|
||||
_bt cp850 '║ └───────────────────────────────┴─┘',13,10,0
|
||||
|
||||
remark1 cp850 "Los valores por defecto puede que no funcionen en algunas configuraciones.",0
|
||||
remark2 cp850 "Si el sistema no inicia, prueba deshabilitar la opción [b]. Si se bloquea",0
|
||||
remark3 cp850 "después de arrancar, habilite la opción [c], desactivar [d] y hacer fotos.",0
|
||||
remarks dw remark1, remark2, remark3
|
||||
num_remarks = 3
|
||||
63
kernel/branches/kolibri-process/boot/bootstr.inc
Normal file
63
kernel/branches/kolibri-process/boot/bootstr.inc
Normal file
@@ -0,0 +1,63 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
; boot data: common strings (for all languages)
|
||||
macro line_full_top {
|
||||
db 201
|
||||
times 78 db 205
|
||||
db 187
|
||||
}
|
||||
macro line_full_bottom {
|
||||
db 200
|
||||
times 78 db 205
|
||||
db 188
|
||||
}
|
||||
macro line_half {
|
||||
db 186,' '
|
||||
times 76 db 0xc4
|
||||
db ' ',186
|
||||
}
|
||||
macro line_space {
|
||||
db 186
|
||||
times 78 db 32
|
||||
db 186
|
||||
}
|
||||
d80x25_top:
|
||||
line_full_top
|
||||
cur_line_pos = 75
|
||||
store byte ' ' at d80x25_top+cur_line_pos+1
|
||||
rev_var = __REV__
|
||||
while rev_var > 0
|
||||
store byte rev_var mod 10 + '0' at d80x25_top+cur_line_pos
|
||||
cur_line_pos = cur_line_pos - 1
|
||||
rev_var = rev_var / 10
|
||||
end while
|
||||
store byte ' ' at d80x25_top+cur_line_pos
|
||||
store dword ' SVN' at d80x25_top+cur_line_pos-4
|
||||
|
||||
space_msg:
|
||||
line_space
|
||||
verstr:
|
||||
; line_space
|
||||
; version string
|
||||
db 186,32
|
||||
repeat 78
|
||||
load a byte from version+%-1
|
||||
if a = 13
|
||||
break
|
||||
end if
|
||||
db a
|
||||
end repeat
|
||||
repeat 78 - ($-verstr)
|
||||
db ' '
|
||||
end repeat
|
||||
db 32,186
|
||||
line_half
|
||||
d80x25_top_num = 4
|
||||
795
kernel/branches/kolibri-process/boot/bootvesa.inc
Normal file
795
kernel/branches/kolibri-process/boot/bootvesa.inc
Normal file
@@ -0,0 +1,795 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3999 $
|
||||
|
||||
struc VBE_VGAInfo {
|
||||
.VESASignature dd ? ; char
|
||||
.VESAVersion dw ? ; short
|
||||
.OemStringPtr dd ? ; char *
|
||||
.Capabilities dd ? ; ulong
|
||||
.VideoModePtr dd ? ; ulong
|
||||
.TotalMemory dw ? ; short
|
||||
; VBE 2.0+
|
||||
.OemSoftwareRev db ? ; short
|
||||
.OemVendorNamePtr dw ? ; char *
|
||||
.OemProductNamePtr dw ? ; char *
|
||||
.OemProductRevPtr dw ? ; char *
|
||||
.reserved rb 222 ; char
|
||||
.OemData rb 256 ; char
|
||||
}
|
||||
|
||||
struc VBE_ModeInfo {
|
||||
.ModeAttributes dw ? ; short
|
||||
.WinAAttributes db ? ; char
|
||||
.WinBAttributes db ? ; char
|
||||
.WinGranularity dw ? ; short
|
||||
.WinSize dw ? ; short
|
||||
.WinASegment dw ? ; ushort
|
||||
.WinBSegment dw ? ; ushort
|
||||
.WinFuncPtr dd ? ; void *
|
||||
.BytesPerScanLine dw ? ; short
|
||||
.XRes dw ? ; short
|
||||
.YRes dw ? ; short
|
||||
.XCharSize db ? ; char
|
||||
.YCharSize db ? ; char
|
||||
.NumberOfPlanes db ? ; char
|
||||
.BitsPerPixel db ? ; char
|
||||
.NumberOfBanks db ? ; char
|
||||
.MemoryModel db ? ; char
|
||||
.BankSize db ? ; char
|
||||
.NumberOfImagePages db ? ; char
|
||||
.res1 db ? ; char
|
||||
.RedMaskSize db ? ; char
|
||||
.RedFieldPosition db ? ; char
|
||||
.GreenMaskSize db ? ; char
|
||||
.GreenFieldPosition db ? ; char
|
||||
.BlueMaskSize db ? ; char
|
||||
.BlueFieldPosition db ? ; char
|
||||
.RsvedMaskSize db ? ; char
|
||||
.RsvedFieldPosition db ? ; char
|
||||
.DirectColorModeInfo db ? ; char ; MISSED IN THIS TUTORIAL!! SEE ABOVE
|
||||
; VBE 2.0+
|
||||
.PhysBasePtr dd ? ; ulong
|
||||
.OffScreenMemOffset dd ? ; ulong
|
||||
.OffScreenMemSize dw ? ; short
|
||||
; VBE 3.0+
|
||||
.LinbytesPerScanLine dw ? ; short
|
||||
.BankNumberOfImagePages db ? ; char
|
||||
.LinNumberOfImagePages db ? ; char
|
||||
.LinRedMaskSize db ? ; char
|
||||
.LinRedFieldPosition db ? ; char
|
||||
.LingreenMaskSize db ? ; char
|
||||
.LinGreenFieldPosition db ? ; char
|
||||
.LinBlueMaskSize db ? ; char
|
||||
.LinBlueFieldPosition db ? ; char
|
||||
.LinRsvdMaskSize db ? ; char
|
||||
.LinRsvdFieldPosition db ? ; char
|
||||
.MaxPixelClock dd ? ; ulong
|
||||
.res2 rb 190 ; char
|
||||
}
|
||||
|
||||
virtual at $A000
|
||||
vi VBE_VGAInfo
|
||||
mi VBE_ModeInfo
|
||||
modes_table:
|
||||
end virtual
|
||||
cursor_pos dw 0 ;временное хранение курсора.
|
||||
cursor_pos_old dw 0
|
||||
home_cursor dw 0 ;current shows rows a table
|
||||
end_cursor dw 0 ;end of position current shows rows a table
|
||||
scroll_start dw 0 ;start position of scroll bar
|
||||
scroll_end dw 0 ;end position of scroll bar
|
||||
long_v_table equ 9 ;long of visible video table
|
||||
size_of_step equ 10
|
||||
scroll_area_size equ (long_v_table-2)
|
||||
int2str:
|
||||
dec bl
|
||||
jz @f
|
||||
xor edx, edx
|
||||
div ecx
|
||||
push edx
|
||||
call int2str
|
||||
pop eax
|
||||
@@:
|
||||
or al, 0x30
|
||||
mov [ds:di], al
|
||||
inc di
|
||||
ret
|
||||
|
||||
int2strnz:
|
||||
cmp eax, ecx
|
||||
jb @f
|
||||
xor edx, edx
|
||||
div ecx
|
||||
push edx
|
||||
call int2strnz
|
||||
pop eax
|
||||
@@:
|
||||
or al, 0x30
|
||||
mov [es:di], al
|
||||
inc di
|
||||
ret
|
||||
|
||||
;-------------------------------------------------------
|
||||
;Write message about incorrect v_mode and write message about jmp on swith v_mode
|
||||
v_mode_error:
|
||||
_setcursor 19,2
|
||||
mov si, fatalsel
|
||||
call printplain
|
||||
_setcursor 20,2
|
||||
mov si, pres_key
|
||||
call printplain
|
||||
xor eax, eax
|
||||
int 16h
|
||||
jmp cfgmanager.d
|
||||
;-------------------------------------------------------
|
||||
;
|
||||
|
||||
|
||||
|
||||
;-------------------------------------------------------
|
||||
print_vesa_info:
|
||||
_setcursor 5,2
|
||||
|
||||
mov [es:vi.VESASignature], 'VBE2'
|
||||
mov ax, 0x4F00
|
||||
mov di, vi ;0xa000
|
||||
int 0x10
|
||||
or ah, ah
|
||||
jz @f
|
||||
mov [es:vi.VESASignature], 'VESA'
|
||||
mov ax, $4F00
|
||||
mov di, vi
|
||||
int 0x10
|
||||
or ah, ah
|
||||
jnz .exit
|
||||
@@:
|
||||
cmp [es:vi.VESASignature], 'VESA'
|
||||
jne .exit
|
||||
cmp [es:vi.VESAVersion], 0x0100
|
||||
jb .exit
|
||||
jmp .vesaok2
|
||||
|
||||
.exit:
|
||||
mov si, novesa
|
||||
call printplain
|
||||
ret
|
||||
|
||||
.vesaok2:
|
||||
mov ax, [es:vi.VESAVersion]
|
||||
add ax, '00'
|
||||
|
||||
mov [s_vesa.ver], ah
|
||||
mov [s_vesa.ver+2], al
|
||||
mov si, s_vesa
|
||||
call printplain
|
||||
|
||||
_setcursor 4,2
|
||||
mov si, word[es:vi.OemStringPtr]
|
||||
mov di, si
|
||||
|
||||
push ds
|
||||
mov ds, word[es:vi.OemStringPtr+2]
|
||||
call printplain
|
||||
pop ds
|
||||
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
|
||||
calc_vmodes_table:
|
||||
pushad
|
||||
|
||||
; push 0
|
||||
; pop es
|
||||
|
||||
lfs si, [es:vi.VideoModePtr]
|
||||
|
||||
mov bx, modes_table
|
||||
;save no vesa mode of work 320x200, EGA/CGA 256 梥⮢ and 640x480, VGA 16 梥⮢
|
||||
mov word [es:bx], 640
|
||||
mov word [es:bx+2], 480
|
||||
mov word [es:bx+6], 0x13
|
||||
|
||||
mov word [es:bx+10], 640
|
||||
mov word [es:bx+12], 480
|
||||
mov word [es:bx+16], 0x12
|
||||
add bx, 20
|
||||
.next_mode:
|
||||
mov cx, word [fs:si]; mode number
|
||||
cmp cx, -1
|
||||
je .modes_ok.2
|
||||
|
||||
mov ax, 0x4F01
|
||||
mov di, mi
|
||||
int 0x10
|
||||
|
||||
or ah, ah
|
||||
jnz .modes_ok.2;vesa_info.exit
|
||||
|
||||
test [es:mi.ModeAttributes], 00000001b ;videomode support ?
|
||||
jz @f
|
||||
test [es:mi.ModeAttributes], 00010000b ;picture ?
|
||||
jz @f
|
||||
test [es:mi.ModeAttributes], 10000000b ;LFB ?
|
||||
jz @f
|
||||
|
||||
cmp [es:mi.BitsPerPixel], 24 ;It show only videomodes to have support 24 and 32 bpp
|
||||
jb @f
|
||||
|
||||
; cmp [es:mi.BitsPerPixel],16
|
||||
; jne .l0
|
||||
; cmp [es:mi.GreenMaskSize],5
|
||||
; jne .l0
|
||||
; mov [es:mi.BitsPerPixel],15
|
||||
|
||||
|
||||
.l0:
|
||||
cmp [es:mi.XRes], 640
|
||||
jb @f
|
||||
cmp [es:mi.YRes], 480
|
||||
jb @f
|
||||
; cmp [es:mi.BitsPerPixel],8
|
||||
; jb @f
|
||||
|
||||
mov ax, [es:mi.XRes]
|
||||
mov [es:bx+0], ax ; +0[2] : resolution X
|
||||
mov ax, [es:mi.YRes]
|
||||
mov [es:bx+2], ax ; +2[2] : resolution Y
|
||||
mov ax, [es:mi.ModeAttributes]
|
||||
mov [es:bx+4], ax ; +4[2] : attributes
|
||||
|
||||
cmp [s_vesa.ver], '2'
|
||||
; jb .lp1
|
||||
jb @f ; We do not use Vesa 1.2 mode is now
|
||||
|
||||
or cx, 0x4000 ; use LFB
|
||||
.lp1:
|
||||
mov [es:bx+6], cx ; +6 : mode number
|
||||
movzx ax, byte [es:mi.BitsPerPixel]
|
||||
mov word [es:bx+8], ax ; +8 : bits per pixel
|
||||
add bx, size_of_step ; size of record
|
||||
|
||||
@@:
|
||||
add si, 2
|
||||
jmp .next_mode
|
||||
|
||||
.modes_ok.2:
|
||||
|
||||
mov word[es:bx], -1 ;end video table
|
||||
mov word[end_cursor], bx ;save end cursor position
|
||||
;;;;;;;;;;;;;;;;;;
|
||||
;Sort array
|
||||
; mov si,modes_table
|
||||
;.new_mode:
|
||||
; mov ax,word [es:si]
|
||||
; cmp ax,-1
|
||||
; je .exxit
|
||||
; add ax,word [es:si+2]
|
||||
; add ax,word [es:si+8]
|
||||
; mov bp,si
|
||||
;.again:
|
||||
; add bp,12
|
||||
; mov bx,word [es:bp]
|
||||
; cmp bx,-1
|
||||
; je .exit
|
||||
; add bx,word [es:bp+2]
|
||||
; add bx,word [es:bp+8]
|
||||
;
|
||||
; cmp ax,bx
|
||||
; ja .loops
|
||||
; jmp .again
|
||||
;.loops:
|
||||
; push dword [es:si]
|
||||
; push dword [es:si+4]
|
||||
; push dword [es:si+8]
|
||||
; push dword [es:bp]
|
||||
; push dword [es:bp+4]
|
||||
; push dword [es:bp+8]
|
||||
;
|
||||
; pop dword [es:si+8]
|
||||
; pop dword [es:si+4]
|
||||
; pop dword [es:si]
|
||||
; pop dword [es:bp+8]
|
||||
; pop dword [es:bp+4]
|
||||
; pop dword [es:bp]
|
||||
; jmp .new_mode
|
||||
;
|
||||
;.exit: add si,12
|
||||
; jmp .new_mode
|
||||
;.exxit:
|
||||
popad
|
||||
ret
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
|
||||
draw_current_vmode:
|
||||
push 0
|
||||
pop es
|
||||
|
||||
mov si, word [cursor_pos]
|
||||
|
||||
cmp word [es:si+6], 0x12
|
||||
je .no_vesa_0x12
|
||||
|
||||
cmp word [es:si+6], 0x13
|
||||
je .no_vesa_0x13
|
||||
|
||||
if defined extended_primary_loader
|
||||
mov di, config_file_variables
|
||||
else
|
||||
mov di, loader_block_error
|
||||
end if
|
||||
movzx eax, word[es:si+0]
|
||||
mov ecx, 10
|
||||
call int2strnz
|
||||
mov byte[es:di], 'x'
|
||||
inc di
|
||||
movzx eax, word[es:si+2]
|
||||
call int2strnz
|
||||
mov byte[es:di], 'x'
|
||||
inc di
|
||||
movzx eax, word[es:si+8]
|
||||
call int2strnz
|
||||
mov dword[es:di], 0x00000d0a
|
||||
if defined extended_primary_loader
|
||||
mov si, config_file_variables
|
||||
else
|
||||
mov si, loader_block_error
|
||||
end if
|
||||
push ds
|
||||
push es
|
||||
pop ds
|
||||
call printplain
|
||||
pop ds
|
||||
ret
|
||||
.no_vesa_0x13:
|
||||
mov si, mode0
|
||||
jmp .print
|
||||
.no_vesa_0x12:
|
||||
mov si, mode9
|
||||
.print:
|
||||
call printplain
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
check_first_parm:
|
||||
if defined extended_primary_loader
|
||||
mov cx, [number_vm]
|
||||
jcxz .novbemode
|
||||
mov si, modes_table
|
||||
.findvbemode:
|
||||
cmp [es:si+6], cx
|
||||
jnz @f
|
||||
cmp word [es:si+8], 32
|
||||
je .ok_found_mode
|
||||
cmp word [es:si+8], 24
|
||||
je .ok_found_mode
|
||||
@@:
|
||||
add si, size_of_step
|
||||
cmp word [es:si], -1
|
||||
jnz .findvbemode
|
||||
.novbemode:
|
||||
mov ax, [x_save]
|
||||
test ax, ax
|
||||
jz .zerro
|
||||
mov bx, [y_save]
|
||||
mov si, modes_table
|
||||
call .loops
|
||||
test ax, ax
|
||||
jz .ok_found_mode
|
||||
else
|
||||
mov si, word [preboot_graph]
|
||||
test si, si
|
||||
jnz .no_zero ;if no zero
|
||||
end if
|
||||
.zerro:
|
||||
; mov ax,modes_table
|
||||
; mov word [cursor_pos],ax
|
||||
; mov word [home_cursor],ax
|
||||
; mov word [preboot_graph],ax
|
||||
;SET default video of mode first probe will fined a move of work 1024x768@32
|
||||
|
||||
mov ax, 1024
|
||||
mov bx, 768
|
||||
mov si, modes_table
|
||||
call .loops
|
||||
test ax, ax
|
||||
jz .ok_found_mode
|
||||
mov ax, 800
|
||||
mov bx, 600
|
||||
mov si, modes_table
|
||||
call .loops
|
||||
test ax, ax
|
||||
jz .ok_found_mode
|
||||
mov ax, 640
|
||||
mov bx, 480
|
||||
mov si, modes_table
|
||||
call .loops
|
||||
test ax, ax
|
||||
jz .ok_found_mode
|
||||
|
||||
mov si, modes_table
|
||||
if ~ defined extended_primary_loader
|
||||
jmp .ok_found_mode
|
||||
|
||||
|
||||
|
||||
.no_zero:
|
||||
mov bp, word [number_vm]
|
||||
cmp bp, word [es:si+6]
|
||||
jz .ok_found_mode
|
||||
mov ax, word [x_save]
|
||||
mov bx, word [y_save]
|
||||
mov si, modes_table
|
||||
call .loops
|
||||
test ax, ax
|
||||
jz .ok_found_mode
|
||||
|
||||
mov si, modes_table
|
||||
; cmp ax,modes_table
|
||||
; jb .zerro ;check on correct if bellow
|
||||
; cmp ax,word [end_cursor]
|
||||
; ja .zerro ;check on correct if anymore
|
||||
end if
|
||||
|
||||
.ok_found_mode:
|
||||
mov word [home_cursor], si
|
||||
; mov word [cursor_pos],si
|
||||
mov word [preboot_graph], si
|
||||
mov ax, si
|
||||
|
||||
mov ecx, long_v_table
|
||||
|
||||
.loop:
|
||||
add ax, size_of_step
|
||||
cmp ax, word [end_cursor]
|
||||
jae .next_step
|
||||
loop .loop
|
||||
.next_step:
|
||||
sub ax, size_of_step*long_v_table
|
||||
cmp ax, modes_table
|
||||
jae @f
|
||||
mov ax, modes_table
|
||||
@@:
|
||||
|
||||
mov word [home_cursor], ax
|
||||
mov si, [preboot_graph]
|
||||
mov word [cursor_pos], si
|
||||
|
||||
push word [es:si]
|
||||
pop word [x_save]
|
||||
push word [es:si+2]
|
||||
pop word [y_save]
|
||||
push word [es:si+6]
|
||||
pop word [number_vm]
|
||||
|
||||
ret
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
.loops:
|
||||
cmp ax, word [es:si]
|
||||
jne .next
|
||||
cmp bx, word [es:si+2]
|
||||
jne .next
|
||||
cmp word [es:si+8], 32
|
||||
je .ok
|
||||
cmp word [es:si+8], 24
|
||||
je .ok
|
||||
.next:
|
||||
add si, size_of_step
|
||||
cmp word [es:si], -1
|
||||
je .exit
|
||||
jmp .loops
|
||||
.ok:
|
||||
xor ax, ax
|
||||
ret
|
||||
.exit:
|
||||
or ax, -1
|
||||
ret
|
||||
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
|
||||
;default_vmode:
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
draw_vmodes_table:
|
||||
_setcursor 9, 2
|
||||
mov si, gr_mode
|
||||
call printplain
|
||||
|
||||
mov si, _st
|
||||
call printplain
|
||||
|
||||
push word [cursor_pos]
|
||||
pop ax
|
||||
push word [home_cursor]
|
||||
pop si
|
||||
mov cx, si
|
||||
|
||||
cmp ax, si
|
||||
je .ok
|
||||
jb .low
|
||||
|
||||
|
||||
add cx, size_of_step*long_v_table
|
||||
|
||||
cmp ax, cx
|
||||
jb .ok
|
||||
|
||||
sub cx, size_of_step*long_v_table
|
||||
add cx, size_of_step
|
||||
cmp cx, word[end_cursor]
|
||||
jae .ok
|
||||
add si, size_of_step
|
||||
push si
|
||||
pop word [home_cursor]
|
||||
jmp .ok
|
||||
|
||||
|
||||
.low:
|
||||
sub cx, size_of_step
|
||||
cmp cx, modes_table
|
||||
jb .ok
|
||||
push cx
|
||||
push cx
|
||||
pop word [home_cursor]
|
||||
pop si
|
||||
|
||||
|
||||
.ok:
|
||||
; calculate scroll position
|
||||
push si
|
||||
mov ax, [end_cursor]
|
||||
sub ax, modes_table
|
||||
mov bx, size_of_step
|
||||
cwd
|
||||
div bx
|
||||
mov si, ax ; si = size of list
|
||||
mov ax, [home_cursor]
|
||||
sub ax, modes_table
|
||||
cwd
|
||||
div bx
|
||||
mov di, ax
|
||||
mov ax, scroll_area_size*long_v_table
|
||||
cwd
|
||||
div si
|
||||
test ax, ax
|
||||
jnz @f
|
||||
inc ax
|
||||
@@:
|
||||
cmp al, scroll_area_size
|
||||
jb @f
|
||||
mov al, scroll_area_size
|
||||
@@:
|
||||
mov cx, ax
|
||||
; cx = scroll height
|
||||
; calculate scroll pos
|
||||
xor bx, bx ; initialize scroll pos
|
||||
sub al, scroll_area_size+1
|
||||
neg al
|
||||
sub si, long_v_table-1
|
||||
jbe @f
|
||||
mul di
|
||||
div si
|
||||
mov bx, ax
|
||||
@@:
|
||||
inc bx
|
||||
imul ax, bx, size_of_step
|
||||
add ax, [home_cursor]
|
||||
mov [scroll_start], ax
|
||||
imul cx, size_of_step
|
||||
add ax, cx
|
||||
mov [scroll_end], ax
|
||||
pop si
|
||||
mov bp, long_v_table ;show rows
|
||||
.@@_next_bit:
|
||||
;clear cursor
|
||||
mov ax, ' '
|
||||
mov word[ds:_r1+21], ax
|
||||
mov word[ds:_r1+50], ax
|
||||
|
||||
mov word[ds:_r2+21], ax
|
||||
mov word[ds:_r2+45], ax
|
||||
|
||||
mov word[ds:_rs+21], ax
|
||||
mov word[ds:_rs+46], ax
|
||||
; draw string
|
||||
cmp word [es:si+6], 0x12
|
||||
je .show_0x12
|
||||
cmp word [es:si+6], 0x13
|
||||
je .show_0x13
|
||||
|
||||
movzx eax, word[es:si]
|
||||
cmp ax, -1
|
||||
je .@@_end
|
||||
mov di, _rs+23
|
||||
mov ecx, 10
|
||||
mov bl, 4
|
||||
call int2str
|
||||
movzx eax, word[es:si+2]
|
||||
inc di
|
||||
mov bl, 4
|
||||
call int2str
|
||||
|
||||
movzx eax, word[es:si+8]
|
||||
inc di
|
||||
mov bl, 2
|
||||
call int2str
|
||||
|
||||
cmp si, word [cursor_pos]
|
||||
jne .next
|
||||
;draw cursor
|
||||
mov word[ds:_rs+21], '>>'
|
||||
mov word[ds:_rs+46], '<<'
|
||||
|
||||
|
||||
|
||||
.next:
|
||||
push si
|
||||
mov si, _rs
|
||||
.@@_sh:
|
||||
; add to the string pseudographics for scrollbar
|
||||
pop bx
|
||||
push bx
|
||||
mov byte [si+53], ' '
|
||||
cmp bx, [scroll_start]
|
||||
jb @f
|
||||
cmp bx, [scroll_end]
|
||||
jae @f
|
||||
mov byte [si+53], 0xDB ; filled bar
|
||||
@@:
|
||||
push bx
|
||||
add bx, size_of_step
|
||||
cmp bx, [end_cursor]
|
||||
jnz @f
|
||||
mov byte [si+53], 31 ; 'down arrow' symbol
|
||||
@@:
|
||||
sub bx, [home_cursor]
|
||||
cmp bx, size_of_step*long_v_table
|
||||
jnz @f
|
||||
mov byte [si+53], 31 ; 'down arrow' symbol
|
||||
@@:
|
||||
pop bx
|
||||
cmp bx, [home_cursor]
|
||||
jnz @f
|
||||
mov byte [si+53], 30 ; 'up arrow' symbol
|
||||
@@:
|
||||
call printplain
|
||||
pop si
|
||||
add si, size_of_step
|
||||
|
||||
dec bp
|
||||
jnz .@@_next_bit
|
||||
|
||||
.@@_end:
|
||||
mov si, _bt
|
||||
call printplain
|
||||
ret
|
||||
.show_0x13:
|
||||
push si
|
||||
|
||||
cmp si, word [cursor_pos]
|
||||
jne @f
|
||||
mov word[ds:_r1+21], '>>'
|
||||
mov word[ds:_r1+50], '<<'
|
||||
@@:
|
||||
mov si, _r1
|
||||
jmp .@@_sh
|
||||
.show_0x12:
|
||||
push si
|
||||
cmp si, word [cursor_pos]
|
||||
jne @f
|
||||
|
||||
mov word[ds:_r2+21], '>>'
|
||||
mov word[ds:_r2+45], '<<'
|
||||
@@:
|
||||
mov si, _r2
|
||||
jmp .@@_sh
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
;Clear arrea of current video page (0xb800)
|
||||
clear_vmodes_table:
|
||||
pusha
|
||||
; draw frames
|
||||
push es
|
||||
push 0xb800
|
||||
pop es
|
||||
mov di, 1444
|
||||
xor ax, ax
|
||||
mov ah, 1*16+15
|
||||
mov cx, 77
|
||||
mov bp, 12
|
||||
.loop_start:
|
||||
rep stosw
|
||||
mov cx, 77
|
||||
add di, 6
|
||||
dec bp
|
||||
jns .loop_start
|
||||
pop es
|
||||
popa
|
||||
ret
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
|
||||
set_vmode:
|
||||
push 0 ;0;x1000
|
||||
pop es
|
||||
|
||||
mov si, word [preboot_graph] ;[preboot_graph]
|
||||
mov cx, word [es:si+6] ; number of mode
|
||||
|
||||
|
||||
mov ax, word [es:si+0] ; resolution X
|
||||
mov bx, word [es:si+2] ; resolution Y
|
||||
|
||||
|
||||
mov word [es:BOOT_X_RES], ax ; resolution X
|
||||
mov word [es:BOOT_Y_RES], bx ; resolution Y
|
||||
mov word [es:BOOT_VESA_MODE], cx ; number of mode
|
||||
|
||||
cmp cx, 0x12
|
||||
je .mode0x12_0x13
|
||||
cmp cx, 0x13
|
||||
je .mode0x12_0x13
|
||||
|
||||
|
||||
; cmp byte [s_vesa.ver], '2'
|
||||
; jb .vesa12
|
||||
|
||||
; VESA 2 and Vesa 3
|
||||
|
||||
mov ax, 0x4f01
|
||||
and cx, 0xfff
|
||||
mov di, mi;0xa000
|
||||
int 0x10
|
||||
; LFB
|
||||
mov eax, [es:mi.PhysBasePtr];di+0x28]
|
||||
mov [es:BOOT_LFB], eax
|
||||
; ---- vbe voodoo
|
||||
BytesPerLine equ 0x10
|
||||
mov ax, [es:di+BytesPerLine]
|
||||
mov [es:BOOT_PITCH], ax
|
||||
; BPP
|
||||
cmp [es:mi.BitsPerPixel], 16
|
||||
jne .l0
|
||||
cmp [es:mi.GreenMaskSize], 5
|
||||
jne .l0
|
||||
mov [es:mi.BitsPerPixel], 15
|
||||
.l0:
|
||||
mov al, byte [es:di+0x19]
|
||||
mov [es:BOOT_BPP], al
|
||||
jmp .exit
|
||||
|
||||
.mode0x12_0x13:
|
||||
mov byte [es:BOOT_BPP], 32
|
||||
or dword [es:BOOT_LFB], 0xFFFFFFFF; 0x800000
|
||||
|
||||
|
||||
; VESA 1.2 PM BANK SWITCH ADDRESS
|
||||
|
||||
;.vesa12:
|
||||
; mov ax, 0x4f0A
|
||||
; xor bx, bx
|
||||
; int 0x10
|
||||
; xor eax, eax
|
||||
; xor ebx, ebx
|
||||
; mov ax, es
|
||||
; shl eax, 4
|
||||
; mov bx, di
|
||||
; add eax, ebx
|
||||
; movzx ebx, word[es:di]
|
||||
; add eax, ebx
|
||||
; push 0x0000
|
||||
; pop es
|
||||
; mov [es:0x9014], eax
|
||||
.exit:
|
||||
ret
|
||||
|
||||
;=============================================================================
|
||||
;=============================================================================
|
||||
;=============================================================================
|
||||
|
||||
16
kernel/branches/kolibri-process/boot/et.inc
Normal file
16
kernel/branches/kolibri-process/boot/et.inc
Normal file
@@ -0,0 +1,16 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3927 $
|
||||
|
||||
|
||||
; Full ASCII code font
|
||||
; only õ,ä,ü added
|
||||
; Kaitz
|
||||
ET_FNT:
|
||||
fontfile file "ETFONT.FNT"
|
||||
|
||||
170
kernel/branches/kolibri-process/boot/parsers.inc
Normal file
170
kernel/branches/kolibri-process/boot/parsers.inc
Normal file
@@ -0,0 +1,170 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2288 $
|
||||
|
||||
; All parsers are called with ds:si -> value of the variable,
|
||||
; possibly with spaces before, and dx = limit of config file.
|
||||
|
||||
; Three subroutines parse_char, parse_number and parse_bool set CF
|
||||
; if something has failed, otherwise return the value in al/ax.
|
||||
|
||||
parse_timeout:
|
||||
; timeout is a number not greater than 9
|
||||
call parse_number
|
||||
jc .nothing
|
||||
cmp ax, 9
|
||||
jbe @f
|
||||
mov ax, 9
|
||||
@@:
|
||||
imul ax, 18
|
||||
mov [es:preboot_timeout], ax
|
||||
.nothing:
|
||||
ret
|
||||
|
||||
parse_resolution:
|
||||
; resolution is <width>*<height>, 'x' can be used instead of '*'
|
||||
; parse width
|
||||
call parse_number
|
||||
jc .nothing
|
||||
; save width
|
||||
xchg ax, bx
|
||||
; test for 'x' or '*'
|
||||
call parse_char
|
||||
cmp al, 'x'
|
||||
jz @f
|
||||
cmp al, '*'
|
||||
jnz .nothing
|
||||
@@:
|
||||
; parse height
|
||||
call parse_number
|
||||
jc .nothing
|
||||
; write width and height
|
||||
mov [es:x_save], bx
|
||||
mov [es:y_save], ax
|
||||
.nothing:
|
||||
ret
|
||||
|
||||
parse_vbemode:
|
||||
; vbemode is a number
|
||||
call parse_number
|
||||
jc .nothing
|
||||
mov [es:number_vm], ax
|
||||
.nothing:
|
||||
ret
|
||||
|
||||
;parse_vrr:
|
||||
;; vrr is a boolean setting
|
||||
; call parse_bool
|
||||
; jc .nothing
|
||||
;; convert 0 to 2, 1 to 1
|
||||
; inc ax
|
||||
; xor al, 3
|
||||
; mov [es:preboot_vrrm], al
|
||||
;.nothing:
|
||||
; ret
|
||||
|
||||
parse_biosdisks:
|
||||
; using biosdisks is a boolean setting
|
||||
call parse_bool
|
||||
jc .nothing
|
||||
; convert 0 to 2, 1 to 1
|
||||
inc ax
|
||||
xor al, 3
|
||||
mov [es:preboot_biosdisk], al
|
||||
.nothing:
|
||||
ret
|
||||
|
||||
parse_imgfrom:
|
||||
; boot device (1-floppy 2-kolibri.img using primary loader)
|
||||
call parse_number
|
||||
jc .nothing
|
||||
cmp al, 1
|
||||
jb .nothing
|
||||
cmp al, 2
|
||||
ja .nothing
|
||||
mov [es:preboot_device], al
|
||||
.nothing:
|
||||
ret
|
||||
|
||||
parse_char:
|
||||
; skip spaces and return the next character or CF if EOF.
|
||||
cmp si, dx
|
||||
jae .eof
|
||||
lodsb
|
||||
cmp al, ' '
|
||||
jbe parse_char
|
||||
ret
|
||||
.eof:
|
||||
stc
|
||||
ret
|
||||
|
||||
parse_number:
|
||||
; initialize high part of ax to zero
|
||||
xor ax, ax
|
||||
; skip spaces
|
||||
call parse_char
|
||||
jc .bad
|
||||
; al should be a digit
|
||||
sub al, '0'
|
||||
cmp al, 9
|
||||
ja .bad
|
||||
; accumulate the value in cx
|
||||
xchg cx, ax
|
||||
@@:
|
||||
cmp si, dx
|
||||
jae .eof
|
||||
lodsb
|
||||
sub al, '0'
|
||||
cmp al, 9
|
||||
ja .end
|
||||
imul cx, 10
|
||||
add cx, ax
|
||||
jmp @b
|
||||
; if the end is caused by non-digit, unwind the last character
|
||||
.end:
|
||||
dec si
|
||||
.eof:
|
||||
xchg cx, ax
|
||||
clc
|
||||
ret
|
||||
.bad:
|
||||
stc
|
||||
ret
|
||||
|
||||
parse_bool:
|
||||
; skip spaces
|
||||
call parse_char
|
||||
jc .bad
|
||||
; Boolean false can be represented as 0=no=off,
|
||||
; boolean true can be represented as 1=yes=on.
|
||||
cmp al, '0'
|
||||
jz .false
|
||||
cmp al, '1'
|
||||
jz .true
|
||||
mov ah, al
|
||||
cmp si, dx
|
||||
jae .bad
|
||||
lodsb
|
||||
cmp ax, 'n'*256 + 'o'
|
||||
jz .false
|
||||
cmp ax, 'o'*256 + 'f'
|
||||
jz .false
|
||||
cmp ax, 'y'*256 + 'e'
|
||||
jz .true
|
||||
cmp ax, 'o'*256 + 'n'
|
||||
jz .true
|
||||
.bad:
|
||||
stc
|
||||
ret
|
||||
.true:
|
||||
xor ax, ax
|
||||
inc ax
|
||||
ret
|
||||
.false:
|
||||
xor ax, ax
|
||||
ret
|
||||
44
kernel/branches/kolibri-process/boot/preboot.inc
Normal file
44
kernel/branches/kolibri-process/boot/preboot.inc
Normal file
@@ -0,0 +1,44 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3777 $
|
||||
|
||||
|
||||
display_modechg db 0 ; display mode change for text, yes/no (0 or 2)
|
||||
;
|
||||
; !! Important note !!
|
||||
;
|
||||
; Must be set to 2, to avoid two screenmode
|
||||
; changes within a very short period of time.
|
||||
|
||||
display_atboot db 0 ; show boot screen messages ( 2-no )
|
||||
|
||||
preboot_graph dw 0 ; graph mode
|
||||
x_save dw 0 ; x
|
||||
y_save dw 0 ; y
|
||||
number_vm dw 0 ;
|
||||
;pixel_save dw 0 ; per to pixel
|
||||
preboot_gprobe db 0 ; probe vesa3 videomodes (1-no, 2-yes)
|
||||
;preboot_vrrm db 0 ; use VRR_M (1-yes, 2- no)
|
||||
preboot_debug db 0 ; load kernel in debug mode? (1-yes, 2-no)
|
||||
preboot_launcher db 0 ; start launcher after kernel is loaded? (1-yes, 2-no)
|
||||
preboot_dma db 0 ; use DMA for access to HDD (1-always, 2-only for read, 3-never)
|
||||
preboot_device db 0 ; boot device
|
||||
; (1-floppy 2-harddisk 3-kernel restart 4-format ram disk)
|
||||
;!!!! 0 - autodetect !!!!
|
||||
preboot_blogesc = 0 ; start immediately after bootlog
|
||||
preboot_biosdisk db 0 ; use V86 to access disks through BIOS (1-yes, 2-no)
|
||||
if defined extended_primary_loader
|
||||
preboot_timeout dw 5*18 ; timeout in 1/18th of second for config settings screen
|
||||
end if
|
||||
|
||||
if $>0x200
|
||||
ERROR:
|
||||
prebooting parameters must fit in first sector!!!
|
||||
end if
|
||||
hdsysimage db 'KOLIBRI.IMG',0 ; load from
|
||||
image_save db 'KOLIBRI.IMG',0 ; save to
|
||||
123
kernel/branches/kolibri-process/boot/rdload.inc
Normal file
123
kernel/branches/kolibri-process/boot/rdload.inc
Normal file
@@ -0,0 +1,123 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3744 $
|
||||
|
||||
|
||||
read_ramdisk:
|
||||
; READ RAMDISK IMAGE FROM HD
|
||||
|
||||
cmp [boot_dev+OS_BASE+0x10000], 1
|
||||
jne no_sys_on_hd
|
||||
|
||||
xor ebp, ebp
|
||||
.hd_loop:
|
||||
lea eax, [ebp+'0']
|
||||
mov [read_image_fsinfo.name_digit], al
|
||||
movzx eax, byte [DRIVE_DATA+2+ebp]
|
||||
test eax, eax
|
||||
jz .next_hd
|
||||
push eax
|
||||
mov esi, 1
|
||||
.partition_loop:
|
||||
mov eax, esi
|
||||
push -'0'
|
||||
@@:
|
||||
xor edx, edx
|
||||
div [_10]
|
||||
push edx
|
||||
test eax, eax
|
||||
jnz @b
|
||||
mov edi, read_image_fsinfo.partition
|
||||
@@:
|
||||
pop eax
|
||||
add al, '0'
|
||||
stosb
|
||||
jnz @b
|
||||
mov byte [edi-1], '/'
|
||||
push esi edi
|
||||
mov esi, bootpath1
|
||||
mov ecx, bootpath1.len
|
||||
rep movsb
|
||||
call read_image
|
||||
test eax, eax
|
||||
jz .yes
|
||||
cmp eax, 6
|
||||
jz .yes
|
||||
pop edi
|
||||
push edi
|
||||
mov esi, bootpath2
|
||||
mov ecx, bootpath2.len
|
||||
rep movsb
|
||||
call read_image
|
||||
test eax, eax
|
||||
jz .yes
|
||||
cmp eax, 6
|
||||
jz .yes
|
||||
pop edi esi
|
||||
inc esi
|
||||
cmp esi, [esp]
|
||||
jbe .partition_loop
|
||||
pop eax
|
||||
.next_hd:
|
||||
inc ebp
|
||||
cmp ebp, 4
|
||||
jb .hd_loop
|
||||
jmp no_sys_on_hd
|
||||
.yes:
|
||||
pop edi esi eax
|
||||
jmp yes_sys_on_hd
|
||||
|
||||
iglobal
|
||||
align 4
|
||||
read_image_fsinfo:
|
||||
dd 0 ; function: read
|
||||
dq 0 ; offset: zero
|
||||
dd 1474560 ; size
|
||||
dd RAMDISK ; buffer
|
||||
db '/hd'
|
||||
.name_digit db '0'
|
||||
db '/'
|
||||
.partition:
|
||||
rb 64 ; should be enough for '255/KOLIBRI/KOLIBRI.IMG'
|
||||
|
||||
bootpath1 db 'KOLIBRI.IMG',0
|
||||
.len = $ - bootpath1
|
||||
bootpath2 db 'KOLIBRI/KOLIBRI.IMG',0
|
||||
.len = $ - bootpath2
|
||||
endg
|
||||
|
||||
read_image:
|
||||
mov ebx, read_image_fsinfo
|
||||
pushad
|
||||
call file_system_lfn_protected
|
||||
popad
|
||||
ret
|
||||
|
||||
no_sys_on_hd:
|
||||
; test_to_format_ram_disk (need if not using ram disk)
|
||||
cmp [boot_dev+OS_BASE+0x10000], 3
|
||||
jne not_format_ram_disk
|
||||
; format_ram_disk
|
||||
mov edi, RAMDISK
|
||||
mov ecx, 0x1080
|
||||
xor eax, eax
|
||||
@@:
|
||||
stosd
|
||||
loop @b
|
||||
|
||||
mov ecx, 0x58F7F
|
||||
mov eax, 0xF6F6F6F6
|
||||
@@:
|
||||
stosd
|
||||
loop @b
|
||||
|
||||
mov [RAMDISK+0x200], dword 0xFFFFF0 ; fat table
|
||||
mov [RAMDISK+0x4200], dword 0xFFFFF0
|
||||
|
||||
not_format_ram_disk:
|
||||
yes_sys_on_hd:
|
||||
102
kernel/branches/kolibri-process/boot/ru.inc
Normal file
102
kernel/branches/kolibri-process/boot/ru.inc
Normal file
@@ -0,0 +1,102 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3539 $
|
||||
|
||||
|
||||
; Generated by RUFNT.EXE
|
||||
; By BadBugsKiller (C)
|
||||
; Modifyed by BadBugsKiller 12.01.2004 17:45
|
||||
; Шрифт уменьшен в размере и теперь состоит из 2-ух частей,
|
||||
; содержащих только символы русского алфавита.
|
||||
; символы в кодировке ASCII (ДОС'овская), кодовая страница 866.
|
||||
RU_FNT1:
|
||||
db 0x00, 0x00, 0x1E, 0x36, 0x66, 0xC6, 0xC6, 0xFE, 0xC6, 0xC6, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xFE, 0x62, 0x60, 0x60, 0x7C, 0x66, 0x66, 0x66, 0x66, 0xFC, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xFC, 0x66, 0x66, 0x66, 0x7C, 0x66, 0x66, 0x66, 0x66, 0xFC, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xFE, 0x66, 0x62, 0x60, 0x60, 0x60, 0x60, 0x60, 0x60, 0xF0, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x1E, 0x36, 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0xFF, 0xC3, 0x81, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xFE, 0x66, 0x62, 0x68, 0x78, 0x68, 0x60, 0x62, 0x66, 0xFE, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xDB, 0xDB, 0x5A, 0x5A, 0x7E, 0x7E, 0x5A, 0xDB, 0xDB, 0xDB, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x7C, 0xC6, 0x06, 0x06, 0x3C, 0x06, 0x06, 0x06, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xC6, 0xC6, 0xC6, 0xCE, 0xDE, 0xF6, 0xE6, 0xC6, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x6C, 0x38, 0xC6, 0xC6, 0xC6, 0xCE, 0xDE, 0xF6, 0xE6, 0xC6, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xE6, 0x66, 0x6C, 0x6C, 0x78, 0x78, 0x6C, 0x6C, 0x66, 0xE6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x1F, 0x36, 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0xCF, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xC6, 0xEE, 0xFE, 0xFE, 0xD6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xC6, 0xC6, 0xC6, 0xC6, 0xFE, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x7C, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xFE, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
|
||||
db 0x00, 0x00, 0xFC, 0x66, 0x66, 0x66, 0x66, 0x7C, 0x60, 0x60, 0x60, 0xF0, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x7C, 0xC6, 0xC6, 0xC0, 0xC0, 0xC0, 0xC0, 0xC2, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xFF, 0xDB, 0x99, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x7E, 0x06, 0x06, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x7E, 0xDB, 0xDB, 0xDB, 0xDB, 0xDB, 0xDB, 0x7E, 0x18, 0x3C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xC6, 0xC6, 0x6C, 0x7C, 0x38, 0x38, 0x7C, 0x6C, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xFF, 0x03, 0x03, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x7E, 0x06, 0x06, 0x06, 0x06, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xFE, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xFF, 0x03, 0x03, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xF8, 0xF0, 0xB0, 0x30, 0x3E, 0x33, 0x33, 0x33, 0x33, 0x7E, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xC3, 0xC3, 0xC3, 0xC3, 0xF3, 0xDB, 0xDB, 0xDB, 0xDB, 0xF3, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xF0, 0x60, 0x60, 0x60, 0x7C, 0x66, 0x66, 0x66, 0x66, 0xFC, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x7C, 0xC6, 0x06, 0x26, 0x3E, 0x26, 0x06, 0x06, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xCE, 0xDB, 0xDB, 0xDB, 0xFB, 0xDB, 0xDB, 0xDB, 0xDB, 0xCE, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x3F, 0x66, 0x66, 0x66, 0x3E, 0x3E, 0x66, 0x66, 0x66, 0xE7, 0x00, 0x00, 0x00, 0x00
|
||||
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x78, 0x0C, 0x7C, 0xCC, 0xCC, 0xCC, 0x76, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x02, 0x06, 0x7C, 0xC0, 0xC0, 0xFC, 0xC6, 0xC6, 0xC6, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xFC, 0x66, 0x66, 0x7C, 0x66, 0x66, 0xFC, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xFE, 0x62, 0x62, 0x60, 0x60, 0x60, 0xF0, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x1E, 0x36, 0x66, 0x66, 0x66, 0x66, 0xFF, 0xC3, 0xC3, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x7C, 0xC6, 0xC6, 0xFE, 0xC0, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xD6, 0xD6, 0x54, 0x7C, 0x54, 0xD6, 0xD6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x7C, 0xC6, 0x06, 0x3C, 0x06, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xC6, 0xC6, 0xCE, 0xD6, 0xE6, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x6C, 0x38, 0xC6, 0xC6, 0xCE, 0xD6, 0xE6, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xE6, 0x6C, 0x78, 0x78, 0x6C, 0x66, 0xE6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x1E, 0x36, 0x66, 0x66, 0x66, 0x66, 0xE6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xC6, 0xEE, 0xFE, 0xFE, 0xD6, 0xD6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xC6, 0xC6, 0xC6, 0xFE, 0xC6, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x7C, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xFE, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
|
||||
RU_FNT2:
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xDC, 0x66, 0x66, 0x66, 0x66, 0x66, 0x7C, 0x60, 0x60, 0xF0, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x7C, 0xC6, 0xC0, 0xC0, 0xC0, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x7E, 0x5A, 0x18, 0x18, 0x18, 0x18, 0x3C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x7E, 0x06, 0x06, 0xC6, 0x7C, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x3C, 0x18, 0x7E, 0xDB, 0xDB, 0xDB, 0xDB, 0xDB, 0x7E, 0x18, 0x18, 0x3C, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xC6, 0x6C, 0x38, 0x38, 0x38, 0x6C, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xFF, 0x03, 0x03, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xC6, 0xC6, 0xC6, 0xC6, 0x7E, 0x06, 0x06, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xFE, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xD6, 0xFE, 0x03, 0x03, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xF8, 0xB0, 0xB0, 0x3E, 0x33, 0x33, 0x7E, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xC6, 0xC6, 0xC6, 0xF6, 0xDE, 0xDE, 0xF6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x60, 0x60, 0x7C, 0x66, 0x66, 0xFC, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x7C, 0xC6, 0x06, 0x3E, 0x06, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0xCE, 0xDB, 0xDB, 0xFB, 0xDB, 0xDB, 0xCE, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xC6, 0xC6, 0x7E, 0x36, 0x66, 0xE7, 0x00, 0x00, 0x00, 0x00
|
||||
|
||||
db 0x6C, 0x00, 0xFE, 0x66, 0x62, 0x68, 0x78, 0x68, 0x60, 0x62, 0x66, 0xFE, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x6C, 0x00, 0x7C, 0xC6, 0xC6, 0xFC, 0xC0, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x7C, 0xC6, 0xC0, 0xC8, 0xF8, 0xC8, 0xC0, 0xC0, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x7C, 0xC6, 0xC0, 0xF8, 0xC0, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x66, 0x00, 0x3C, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x6C, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x6C, 0x38, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x7E, 0x06, 0x06, 0xC6, 0x7C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x6C, 0x38, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x7E, 0x06, 0x06, 0xC6, 0x7C, 0x00
|
||||
db 0x00, 0x38, 0x6C, 0x6C, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x0E, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0xEC, 0x6C, 0x3C, 0x1C, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0xCF, 0xCD, 0xEF, 0xEC, 0xFF, 0xDC, 0xDC, 0xCC, 0xCC, 0xCC, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0xC6, 0x7C, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x7C, 0xC6, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x7E, 0x7E, 0x7E, 0x7E, 0x7E, 0x7E, 0x7E, 0x00, 0x00, 0x00, 0x00, 0x00
|
||||
db 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
|
||||
212
kernel/branches/kolibri-process/boot/shutdown.inc
Normal file
212
kernel/branches/kolibri-process/boot/shutdown.inc
Normal file
@@ -0,0 +1,212 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;; Shutdown for Menuet ;;
|
||||
;; ;;
|
||||
;; Distributed under General Public License ;;
|
||||
;; See file COPYING for details. ;;
|
||||
;; Copyright 2003 Ville Turjanmaa ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
align 4
|
||||
pr_mode_exit:
|
||||
|
||||
; setup stack
|
||||
mov ax, 0x3000
|
||||
mov ss, ax
|
||||
mov esp, 0x0EC00
|
||||
; setup ds
|
||||
push cs
|
||||
pop ds
|
||||
|
||||
lidt [old_ints_h]
|
||||
;remap IRQs
|
||||
mov al, 0x11
|
||||
out 0x20, al
|
||||
call rdelay
|
||||
out 0xA0, al
|
||||
call rdelay
|
||||
|
||||
mov al, 0x08
|
||||
out 0x21, al
|
||||
call rdelay
|
||||
mov al, 0x70
|
||||
out 0xA1, al
|
||||
call rdelay
|
||||
|
||||
mov al, 0x04
|
||||
out 0x21, al
|
||||
call rdelay
|
||||
mov al, 0x02
|
||||
out 0xA1, al
|
||||
call rdelay
|
||||
|
||||
mov al, 0x01
|
||||
out 0x21, al
|
||||
call rdelay
|
||||
out 0xA1, al
|
||||
call rdelay
|
||||
|
||||
mov al, 0xB8
|
||||
out 0x21, al
|
||||
call rdelay
|
||||
mov al, 0xBD
|
||||
out 0xA1, al
|
||||
sti
|
||||
|
||||
temp_3456:
|
||||
xor ax, ax
|
||||
mov es, ax
|
||||
mov al, byte [es:0x9030]
|
||||
cmp al, 1
|
||||
jl nbw
|
||||
cmp al, 4
|
||||
jle nbw32
|
||||
|
||||
nbw:
|
||||
in al, 0x60
|
||||
cmp al, 6
|
||||
jae nbw
|
||||
mov bl, al
|
||||
nbw2:
|
||||
in al, 0x60
|
||||
cmp al, bl
|
||||
je nbw2
|
||||
cmp al, 240;ax,240
|
||||
jne nbw31
|
||||
mov al, bl
|
||||
dec ax
|
||||
jmp nbw32
|
||||
nbw31:
|
||||
add bl, 128
|
||||
cmp al, bl
|
||||
jne nbw
|
||||
sub al, 129
|
||||
|
||||
nbw32:
|
||||
|
||||
dec ax
|
||||
dec ax ; 2 = power off
|
||||
jnz no_apm_off
|
||||
call APM_PowerOff
|
||||
jmp $
|
||||
no_apm_off:
|
||||
|
||||
if ~ defined extended_primary_loader ; kernel restarting is not supported
|
||||
dec ax ; 3 = reboot
|
||||
jnz restart_kernel ; 4 = restart kernel
|
||||
end if
|
||||
push 0x40
|
||||
pop ds
|
||||
mov word[0x0072], 0x1234
|
||||
jmp 0xF000:0xFFF0
|
||||
|
||||
|
||||
rdelay:
|
||||
ret
|
||||
|
||||
APM_PowerOff:
|
||||
mov ax, 5304h
|
||||
xor bx, bx
|
||||
int 15h
|
||||
;!!!!!!!!!!!!!!!!!!!!!!!!
|
||||
mov ax, 0x5300
|
||||
xor bx, bx
|
||||
int 0x15
|
||||
push ax
|
||||
|
||||
mov ax, 0x5301
|
||||
xor bx, bx
|
||||
int 0x15
|
||||
|
||||
mov ax, 0x5308
|
||||
mov bx, 1
|
||||
mov cx, bx
|
||||
int 0x15
|
||||
|
||||
mov ax, 0x530E
|
||||
xor bx, bx
|
||||
pop cx
|
||||
int 0x15
|
||||
|
||||
mov ax, 0x530D
|
||||
mov bx, 1
|
||||
mov cx, bx
|
||||
int 0x15
|
||||
|
||||
mov ax, 0x530F
|
||||
mov bx, 1
|
||||
mov cx, bx
|
||||
int 0x15
|
||||
|
||||
mov ax, 0x5307
|
||||
mov bx, 1
|
||||
mov cx, 3
|
||||
int 0x15
|
||||
;!!!!!!!!!!!!!!!!!!!!!!!!
|
||||
ret
|
||||
|
||||
if ~ defined extended_primary_loader
|
||||
restart_kernel:
|
||||
|
||||
mov ax, 0x0003 ; set text mode for screen
|
||||
int 0x10
|
||||
jmp 0x4000:0000
|
||||
|
||||
restart_kernel_4000:
|
||||
cli
|
||||
|
||||
push ds
|
||||
pop es
|
||||
mov cx, 0x8000
|
||||
push cx
|
||||
push 0x7000
|
||||
pop ds
|
||||
xor si, si
|
||||
xor di, di
|
||||
rep movsw
|
||||
pop cx
|
||||
mov ds, cx
|
||||
push 0x2000
|
||||
pop es
|
||||
rep movsw
|
||||
push 0x9000
|
||||
pop ds
|
||||
push 0x3000
|
||||
pop es
|
||||
mov cx, 0xE000/2
|
||||
rep movsw
|
||||
|
||||
wbinvd ; write and invalidate cache
|
||||
|
||||
mov al, 00110100b
|
||||
out 43h, al
|
||||
jcxz $+2
|
||||
mov al, 0xFF
|
||||
out 40h, al
|
||||
jcxz $+2
|
||||
out 40h, al
|
||||
jcxz $+2
|
||||
sti
|
||||
|
||||
; (hint by Black_mirror)
|
||||
; We must read data from keyboard port,
|
||||
; because there may be situation when previous keyboard interrupt is lost
|
||||
; (due to return to real mode and IRQ reprogramming)
|
||||
; and next interrupt will not be generated (as keyboard waits for handling)
|
||||
in al, 0x60
|
||||
|
||||
; bootloader interface
|
||||
push 0x1000
|
||||
pop ds
|
||||
mov si, kernel_restart_bootblock
|
||||
mov ax, 'KL'
|
||||
jmp 0x1000:0000
|
||||
end if
|
||||
|
||||
119
kernel/branches/kolibri-process/bus/pci/PCIe.inc
Normal file
119
kernel/branches/kolibri-process/bus/pci/PCIe.inc
Normal file
@@ -0,0 +1,119 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2010-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;; ;;
|
||||
;; PCIe.INC ;;
|
||||
;; ;;
|
||||
;; Extended PCI express services ;;
|
||||
;; ;;
|
||||
;; art_zh <artem@jerdev.co.uk> ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 1463 $
|
||||
|
||||
;***************************************************************************
|
||||
; Function
|
||||
; pci_ext_config:
|
||||
;
|
||||
; Description
|
||||
; PCIe extended (memory-mapped) config space detection
|
||||
;
|
||||
; WARNINGs:
|
||||
; 1) Very Experimental!
|
||||
; 2) direct HT-detection (no ACPI or BIOS service used)
|
||||
; 3) Only AMD/HT processors currently supported
|
||||
;
|
||||
;***************************************************************************
|
||||
|
||||
PCIe_CONFIG_SPACE equ 0xF0000000 ; to be moved to const.inc
|
||||
mmio_pcie_cfg_addr dd 0x0 ; intel pcie space may be defined here
|
||||
mmio_pcie_cfg_lim dd 0x0 ; upper pcie space address
|
||||
|
||||
|
||||
align 4
|
||||
|
||||
pci_ext_config:
|
||||
|
||||
mov ebx, [mmio_pcie_cfg_addr]
|
||||
or ebx, ebx
|
||||
jz @f
|
||||
or ebx, 0x7FFFFFFF ; required by PCI-SIG standards
|
||||
jnz .pcie_failed
|
||||
add ebx, 0x0FFFFC
|
||||
cmp ebx, [mmio_pcie_cfg_lim]; is the space limit correct?
|
||||
ja .pcie_failed
|
||||
jmp .pcie_cfg_mapped
|
||||
@@:
|
||||
mov ebx, [cpu_vendor]
|
||||
cmp ebx, dword [AMD_str]
|
||||
jne .pcie_failed
|
||||
mov bx, 0xC184 ; dev = 24, fn = 01, reg = 84h
|
||||
|
||||
.check_HT_mmio:
|
||||
mov cx, bx
|
||||
mov ax, 0x0002 ; bus = 0, 1dword to read
|
||||
call pci_read_reg
|
||||
mov bx, cx
|
||||
sub bl, 4
|
||||
and al, 0x80 ; check the NP bit
|
||||
jz .no_pcie_cfg
|
||||
shl eax, 8 ; bus:[27..20], dev:[19:15]
|
||||
or eax, 0x00007FFC ; fun:[14..12], reg:[11:2]
|
||||
mov [mmio_pcie_cfg_lim], eax
|
||||
mov cl, bl
|
||||
mov ax, 0x0002 ; bus = 0, 1dword to read
|
||||
call pci_read_reg
|
||||
mov bx, cx
|
||||
test al, 0x03 ; MMIO Base RW enabled?
|
||||
jz .no_pcie_cfg
|
||||
test al, 0x0C ; MMIO Base locked?
|
||||
jnz .no_pcie_cfg
|
||||
xor al, al
|
||||
shl eax, 8
|
||||
test eax, 0x000F0000 ; MMIO Base must be bus0-aligned
|
||||
jnz .no_pcie_cfg
|
||||
mov [mmio_pcie_cfg_addr], eax
|
||||
add eax, 0x000FFFFC
|
||||
sub eax, [mmio_pcie_cfg_lim]; MMIO must cover at least one bus
|
||||
ja .no_pcie_cfg
|
||||
|
||||
; -- it looks like a true PCIe config space;
|
||||
mov eax, [mmio_pcie_cfg_addr] ; physical address
|
||||
or eax, (PG_SHARED + PG_LARGE + PG_USER)
|
||||
mov ebx, PCIe_CONFIG_SPACE ; linear address
|
||||
mov ecx, ebx
|
||||
shr ebx, 20
|
||||
add ebx, sys_pgdir ; PgDir entry @
|
||||
@@:
|
||||
mov dword[ebx], eax ; map 4 buses
|
||||
invlpg [ecx]
|
||||
cmp bl, 4
|
||||
jz .pcie_cfg_mapped ; fix it later
|
||||
add bl, 4 ; next PgDir entry
|
||||
add eax, 0x400000 ; eax += 4M
|
||||
add ecx, 0x400000
|
||||
jmp @b
|
||||
|
||||
.pcie_cfg_mapped:
|
||||
|
||||
; -- glad to have the extended PCIe config field found
|
||||
; mov esi, boot_pcie_ok
|
||||
; call boot_log
|
||||
ret ; <<<<<<<<<<< OK >>>>>>>>>>>
|
||||
|
||||
.no_pcie_cfg:
|
||||
|
||||
xor eax, eax
|
||||
mov [mmio_pcie_cfg_addr], eax
|
||||
mov [mmio_pcie_cfg_lim], eax
|
||||
add bl, 12
|
||||
cmp bl, 0xC0 ; MMIO regs lay below this offset
|
||||
jb .check_HT_mmio
|
||||
.pcie_failed:
|
||||
; mov esi, boot_pcie_fail
|
||||
; call boot_log
|
||||
ret ; <<<<<<<<< FAILURE >>>>>>>>>
|
||||
|
||||
51
kernel/branches/kolibri-process/bus/pci/pci16.inc
Normal file
51
kernel/branches/kolibri-process/bus/pci/pci16.inc
Normal file
@@ -0,0 +1,51 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;; PCI16.INC ;;
|
||||
;; ;;
|
||||
;; 16 bit PCI driver code ;;
|
||||
;; ;;
|
||||
;; Version 0.2 December 21st, 2002 ;;
|
||||
;; ;;
|
||||
;; Author: Victor Prodan, victorprodan@yahoo.com ;;
|
||||
;; ;;
|
||||
;; See file COPYING for details ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
init_pci_16:
|
||||
|
||||
pushad
|
||||
|
||||
xor ax, ax
|
||||
mov es, ax
|
||||
mov byte [es:0x9020], 1;default mechanism:1
|
||||
mov ax, 0xb101
|
||||
int 0x1a
|
||||
or ah, ah
|
||||
jnz pci16skip
|
||||
|
||||
mov [es:0x9021], cl;last PCI bus in system
|
||||
mov [es:0x9022], bx
|
||||
mov [es:0x9024], edi
|
||||
|
||||
; we have a PCI BIOS, so check which configuration mechanism(s)
|
||||
; it supports
|
||||
; AL = PCI hardware characteristics (bit0 => mechanism1, bit1 => mechanism2)
|
||||
test al, 1
|
||||
jnz pci16skip
|
||||
test al, 2
|
||||
jz pci16skip
|
||||
mov byte [es:0x9020], 2; if (al&3)==2 => mechanism 2
|
||||
|
||||
pci16skip:
|
||||
|
||||
mov ax, 0x1000
|
||||
mov es, ax
|
||||
|
||||
popad
|
||||
724
kernel/branches/kolibri-process/bus/pci/pci32.inc
Normal file
724
kernel/branches/kolibri-process/bus/pci/pci32.inc
Normal file
@@ -0,0 +1,724 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;; ;;
|
||||
;; PCI32.INC ;;
|
||||
;; ;;
|
||||
;; 32 bit PCI driver code ;;
|
||||
;; ;;
|
||||
;; Version 0.3 April 9, 2007 ;;
|
||||
;; Version 0.2 December 21st, 2002 ;;
|
||||
;; ;;
|
||||
;; Author: Victor Prodan, victorprodan@yahoo.com ;;
|
||||
;; Mihailov Ilia, ghost.nsk@gmail.com ;;
|
||||
;; Credits: ;;
|
||||
;; Ralf Brown ;;
|
||||
;; Mike Hibbett, mikeh@oceanfree.net ;;
|
||||
;; ;;
|
||||
;; See file COPYING for details ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4418 $
|
||||
|
||||
;***************************************************************************
|
||||
; Function
|
||||
; pci_api:
|
||||
;
|
||||
; Description
|
||||
; entry point for system PCI calls
|
||||
;***************************************************************************
|
||||
;mmio_pci_addr equ 0x400 ; set actual PCI address here to activate user-MMIO
|
||||
|
||||
iglobal
|
||||
align 4
|
||||
f62call:
|
||||
dd pci_fn_0
|
||||
dd pci_fn_1
|
||||
dd pci_fn_2
|
||||
dd pci_service_not_supported ;3
|
||||
dd pci_read_reg ;4 byte
|
||||
dd pci_read_reg ;5 word
|
||||
dd pci_read_reg ;6 dword
|
||||
dd pci_service_not_supported ;7
|
||||
dd pci_write_reg ;8 byte
|
||||
dd pci_write_reg ;9 word
|
||||
dd pci_write_reg ;10 dword
|
||||
if defined mmio_pci_addr
|
||||
dd pci_mmio_init ;11
|
||||
dd pci_mmio_map ;12
|
||||
dd pci_mmio_unmap ;13
|
||||
end if
|
||||
|
||||
endg
|
||||
|
||||
align 4
|
||||
|
||||
pci_api:
|
||||
|
||||
;cross
|
||||
mov eax, ebx
|
||||
mov ebx, ecx
|
||||
mov ecx, edx
|
||||
|
||||
cmp [pci_access_enabled], 1
|
||||
jne pci_service_not_supported
|
||||
|
||||
movzx edx, al
|
||||
|
||||
if defined mmio_pci_addr
|
||||
cmp al, 13
|
||||
ja pci_service_not_supported
|
||||
else
|
||||
cmp al, 10
|
||||
ja pci_service_not_supported
|
||||
end if
|
||||
|
||||
call dword [f62call+edx*4]
|
||||
mov dword [esp+32], eax
|
||||
ret
|
||||
|
||||
|
||||
align 4
|
||||
pci_api_drv:
|
||||
|
||||
cmp [pci_access_enabled], 1
|
||||
jne .fail
|
||||
|
||||
cmp eax, 2
|
||||
ja .fail
|
||||
|
||||
jmp dword [f62call+eax*4]
|
||||
|
||||
.fail:
|
||||
or eax, -1
|
||||
ret
|
||||
|
||||
|
||||
;; ============================================
|
||||
|
||||
pci_fn_0:
|
||||
; PCI function 0: get pci version (AH.AL)
|
||||
movzx eax, word [BOOT_VARS+0x9022]
|
||||
ret
|
||||
|
||||
pci_fn_1:
|
||||
; PCI function 1: get last bus in AL
|
||||
mov al, [BOOT_VARS+0x9021]
|
||||
ret
|
||||
|
||||
pci_fn_2:
|
||||
; PCI function 2: get pci access mechanism
|
||||
mov al, [BOOT_VARS+0x9020]
|
||||
ret
|
||||
|
||||
pci_service_not_supported:
|
||||
or eax, -1
|
||||
mov dword [esp+32], eax
|
||||
ret
|
||||
|
||||
;***************************************************************************
|
||||
; Function
|
||||
; pci_make_config_cmd
|
||||
;
|
||||
; Description
|
||||
; creates a command dword for use with the PCI bus
|
||||
; bus # in ah
|
||||
; device+func in bh (dddddfff)
|
||||
; register in bl
|
||||
;
|
||||
; command dword returned in eax ( 10000000 bbbbbbbb dddddfff rrrrrr00 )
|
||||
;***************************************************************************
|
||||
|
||||
align 4
|
||||
|
||||
pci_make_config_cmd:
|
||||
shl eax, 8 ; move bus to bits 16-23
|
||||
mov ax, bx ; combine all
|
||||
and eax, 0xffffff
|
||||
or eax, 0x80000000
|
||||
ret
|
||||
|
||||
;***************************************************************************
|
||||
; Function
|
||||
; pci_read_reg:
|
||||
;
|
||||
; Description
|
||||
; read a register from the PCI config space into EAX/AX/AL
|
||||
; IN: ah=bus,device+func=bh,register address=bl
|
||||
; number of bytes to read (1,2,4) coded into AL, bits 0-1
|
||||
; (0 - byte, 1 - word, 2 - dword)
|
||||
;***************************************************************************
|
||||
|
||||
align 4
|
||||
|
||||
pci_read_reg:
|
||||
push ebx esi
|
||||
cmp byte [BOOT_VARS+0x9020], 2;what mechanism will we use?
|
||||
je pci_read_reg_2
|
||||
|
||||
; mechanism 1
|
||||
mov esi, eax ; save register size into ESI
|
||||
and esi, 3
|
||||
|
||||
call pci_make_config_cmd
|
||||
mov ebx, eax
|
||||
; get current state
|
||||
mov dx, 0xcf8
|
||||
in eax, dx
|
||||
push eax
|
||||
; set up addressing to config data
|
||||
mov eax, ebx
|
||||
and al, 0xfc; make address dword-aligned
|
||||
out dx, eax
|
||||
; get requested DWORD of config data
|
||||
mov dl, 0xfc
|
||||
and bl, 3
|
||||
or dl, bl ; add to port address first 2 bits of register address
|
||||
|
||||
or esi, esi
|
||||
jz pci_read_byte1
|
||||
cmp esi, 1
|
||||
jz pci_read_word1
|
||||
cmp esi, 2
|
||||
jz pci_read_dword1
|
||||
jmp pci_fin_read1
|
||||
|
||||
pci_read_byte1:
|
||||
in al, dx
|
||||
jmp pci_fin_read1
|
||||
pci_read_word1:
|
||||
in ax, dx
|
||||
jmp pci_fin_read1
|
||||
pci_read_dword1:
|
||||
in eax, dx
|
||||
jmp pci_fin_read1
|
||||
pci_fin_read1:
|
||||
; restore configuration control
|
||||
xchg eax, [esp]
|
||||
mov dx, 0xcf8
|
||||
out dx, eax
|
||||
|
||||
pop eax
|
||||
pop esi ebx
|
||||
ret
|
||||
pci_read_reg_2:
|
||||
|
||||
test bh, 128 ;mech#2 only supports 16 devices per bus
|
||||
jnz pci_read_reg_err
|
||||
|
||||
mov esi, eax ; save register size into ESI
|
||||
and esi, 3
|
||||
|
||||
push eax
|
||||
;store current state of config space
|
||||
mov dx, 0xcf8
|
||||
in al, dx
|
||||
mov ah, al
|
||||
mov dl, 0xfa
|
||||
in al, dx
|
||||
|
||||
xchg eax, [esp]
|
||||
; out 0xcfa,bus
|
||||
mov al, ah
|
||||
out dx, al
|
||||
; out 0xcf8,0x80
|
||||
mov dl, 0xf8
|
||||
mov al, 0x80
|
||||
out dx, al
|
||||
; compute addr
|
||||
shr bh, 3; func is ignored in mechanism 2
|
||||
or bh, 0xc0
|
||||
mov dx, bx
|
||||
|
||||
or esi, esi
|
||||
jz pci_read_byte2
|
||||
cmp esi, 1
|
||||
jz pci_read_word2
|
||||
cmp esi, 2
|
||||
jz pci_read_dword2
|
||||
jmp pci_fin_read2
|
||||
|
||||
pci_read_byte2:
|
||||
in al, dx
|
||||
jmp pci_fin_read2
|
||||
pci_read_word2:
|
||||
in ax, dx
|
||||
jmp pci_fin_read2
|
||||
pci_read_dword2:
|
||||
in eax, dx
|
||||
; jmp pci_fin_read2
|
||||
pci_fin_read2:
|
||||
|
||||
; restore configuration space
|
||||
xchg eax, [esp]
|
||||
mov dx, 0xcfa
|
||||
out dx, al
|
||||
mov dl, 0xf8
|
||||
mov al, ah
|
||||
out dx, al
|
||||
|
||||
pop eax
|
||||
pop esi ebx
|
||||
ret
|
||||
|
||||
pci_read_reg_err:
|
||||
xor eax, eax
|
||||
dec eax
|
||||
pop esi ebx
|
||||
ret
|
||||
|
||||
|
||||
;***************************************************************************
|
||||
; Function
|
||||
; pci_write_reg:
|
||||
;
|
||||
; Description
|
||||
; write a register from ECX/CX/CL into the PCI config space
|
||||
; IN: ah=bus,device+func=bh,register address (dword aligned)=bl,
|
||||
; value to write in ecx
|
||||
; number of bytes to write (1,2,4) coded into AL, bits 0-1
|
||||
; (0 - byte, 1 - word, 2 - dword)
|
||||
;***************************************************************************
|
||||
|
||||
align 4
|
||||
|
||||
pci_write_reg:
|
||||
push esi ebx
|
||||
cmp byte [BOOT_VARS+0x9020], 2;what mechanism will we use?
|
||||
je pci_write_reg_2
|
||||
|
||||
; mechanism 1
|
||||
mov esi, eax ; save register size into ESI
|
||||
and esi, 3
|
||||
|
||||
call pci_make_config_cmd
|
||||
mov ebx, eax
|
||||
; get current state into ecx
|
||||
mov dx, 0xcf8
|
||||
in eax, dx
|
||||
push eax
|
||||
; set up addressing to config data
|
||||
mov eax, ebx
|
||||
and al, 0xfc; make address dword-aligned
|
||||
out dx, eax
|
||||
; write DWORD of config data
|
||||
mov dl, 0xfc
|
||||
and bl, 3
|
||||
or dl, bl
|
||||
mov eax, ecx
|
||||
|
||||
or esi, esi
|
||||
jz pci_write_byte1
|
||||
cmp esi, 1
|
||||
jz pci_write_word1
|
||||
cmp esi, 2
|
||||
jz pci_write_dword1
|
||||
jmp pci_fin_write1
|
||||
|
||||
pci_write_byte1:
|
||||
out dx, al
|
||||
jmp pci_fin_write1
|
||||
pci_write_word1:
|
||||
out dx, ax
|
||||
jmp pci_fin_write1
|
||||
pci_write_dword1:
|
||||
out dx, eax
|
||||
jmp pci_fin_write1
|
||||
pci_fin_write1:
|
||||
|
||||
; restore configuration control
|
||||
pop eax
|
||||
mov dl, 0xf8
|
||||
out dx, eax
|
||||
|
||||
xor eax, eax
|
||||
pop ebx esi
|
||||
|
||||
ret
|
||||
pci_write_reg_2:
|
||||
|
||||
test bh, 128 ;mech#2 only supports 16 devices per bus
|
||||
jnz pci_write_reg_err
|
||||
|
||||
|
||||
mov esi, eax ; save register size into ESI
|
||||
and esi, 3
|
||||
|
||||
push eax
|
||||
;store current state of config space
|
||||
mov dx, 0xcf8
|
||||
in al, dx
|
||||
mov ah, al
|
||||
mov dl, 0xfa
|
||||
in al, dx
|
||||
xchg eax, [esp]
|
||||
; out 0xcfa,bus
|
||||
mov al, ah
|
||||
out dx, al
|
||||
; out 0xcf8,0x80
|
||||
mov dl, 0xf8
|
||||
mov al, 0x80
|
||||
out dx, al
|
||||
; compute addr
|
||||
shr bh, 3; func is ignored in mechanism 2
|
||||
or bh, 0xc0
|
||||
mov dx, bx
|
||||
; write register
|
||||
mov eax, ecx
|
||||
|
||||
or esi, esi
|
||||
jz pci_write_byte2
|
||||
cmp esi, 1
|
||||
jz pci_write_word2
|
||||
cmp esi, 2
|
||||
jz pci_write_dword2
|
||||
jmp pci_fin_write2
|
||||
|
||||
pci_write_byte2:
|
||||
out dx, al
|
||||
jmp pci_fin_write2
|
||||
pci_write_word2:
|
||||
out dx, ax
|
||||
jmp pci_fin_write2
|
||||
pci_write_dword2:
|
||||
out dx, eax
|
||||
jmp pci_fin_write2
|
||||
pci_fin_write2:
|
||||
; restore configuration space
|
||||
pop eax
|
||||
mov dx, 0xcfa
|
||||
out dx, al
|
||||
mov dl, 0xf8
|
||||
mov al, ah
|
||||
out dx, al
|
||||
|
||||
xor eax, eax
|
||||
pop ebx esi
|
||||
ret
|
||||
|
||||
pci_write_reg_err:
|
||||
xor eax, eax
|
||||
dec eax
|
||||
pop ebx esi
|
||||
ret
|
||||
|
||||
if defined mmio_pci_addr ; must be set above
|
||||
;***************************************************************************
|
||||
; Function
|
||||
; pci_mmio_init
|
||||
;
|
||||
; Description
|
||||
; IN: bx = device's PCI bus address (bbbbbbbbdddddfff)
|
||||
; Returns eax = user heap space available (bytes)
|
||||
; Error codes
|
||||
; eax = -1 : PCI user access blocked,
|
||||
; eax = -2 : device not registered for uMMIO service
|
||||
; eax = -3 : user heap initialization failure
|
||||
;***************************************************************************
|
||||
pci_mmio_init:
|
||||
cmp bx, mmio_pci_addr
|
||||
jz @f
|
||||
mov eax, -2
|
||||
ret
|
||||
@@:
|
||||
call init_heap ; (if not initialized yet)
|
||||
or eax, eax
|
||||
jz @f
|
||||
ret
|
||||
@@:
|
||||
mov eax, -3
|
||||
ret
|
||||
|
||||
|
||||
;***************************************************************************
|
||||
; Function
|
||||
; pci_mmio_map
|
||||
;
|
||||
; Description
|
||||
; maps a block of PCI memory to user-accessible linear address
|
||||
;
|
||||
; WARNING! This VERY EXPERIMENTAL service is for one chosen PCI device only!
|
||||
; The target device address should be set in kernel var mmio_pci_addr
|
||||
;
|
||||
; IN: ah = BAR#;
|
||||
; IN: ebx = block size (bytes);
|
||||
; IN: ecx = offset in MMIO block (in 4K-pages, to avoid misaligned pages);
|
||||
;
|
||||
; Returns eax = MMIO block's linear address in the userspace (if no error)
|
||||
;
|
||||
;
|
||||
; Error codes
|
||||
; eax = -1 : user access to PCI blocked,
|
||||
; eax = -2 : an invalid BAR register referred
|
||||
; eax = -3 : no i/o space on that BAR
|
||||
; eax = -4 : a port i/o BAR register referred
|
||||
; eax = -5 : dynamic userspace allocation problem
|
||||
;***************************************************************************
|
||||
|
||||
pci_mmio_map:
|
||||
and edx, 0x0ffff
|
||||
cmp ah, 6
|
||||
jc .bar_0_5
|
||||
jz .bar_rom
|
||||
mov eax, -2
|
||||
ret
|
||||
.bar_rom:
|
||||
mov ah, 8 ; bar6 = Expansion ROM base address
|
||||
.bar_0_5:
|
||||
push ecx
|
||||
add ebx, 4095
|
||||
and ebx, -4096
|
||||
push ebx
|
||||
mov bl, ah ; bl = BAR# (0..5), however bl=8 for BAR6
|
||||
shl bl, 1
|
||||
shl bl, 1
|
||||
add bl, 0x10; now bl = BAR offset in PCI config. space
|
||||
mov ax, mmio_pci_addr
|
||||
mov bh, al ; bh = dddddfff
|
||||
mov al, 2 ; al : DW to read
|
||||
call pci_read_reg
|
||||
or eax, eax
|
||||
jnz @f
|
||||
mov eax, -3 ; empty I/O space
|
||||
jmp mmio_ret_fail
|
||||
@@:
|
||||
test eax, 1
|
||||
jz @f
|
||||
mov eax, -4 ; damned ports (not MMIO space)
|
||||
jmp mmio_ret_fail
|
||||
@@:
|
||||
pop ecx ; ecx = block size, bytes (expanded to whole page)
|
||||
mov ebx, ecx; user_alloc destroys eax, ecx, edx, but saves ebx
|
||||
and eax, 0xFFFFFFF0
|
||||
push eax ; store MMIO physical address + keep 2DWords in the stack
|
||||
stdcall user_alloc, ecx
|
||||
or eax, eax
|
||||
jnz mmio_map_over
|
||||
mov eax, -5 ; problem with page allocation
|
||||
|
||||
mmio_ret_fail:
|
||||
pop ecx
|
||||
pop edx
|
||||
ret
|
||||
|
||||
mmio_map_over:
|
||||
mov ecx, ebx; ecx = size (bytes, expanded to whole page)
|
||||
shr ecx, 12 ; ecx = number of pages
|
||||
mov ebx, eax; ebx = linear address
|
||||
pop eax ; eax = MMIO start
|
||||
pop edx ; edx = MMIO shift (pages)
|
||||
shl edx, 12 ; edx = MMIO shift (bytes)
|
||||
add eax, edx; eax = uMMIO physical address
|
||||
or eax, PG_SHARED
|
||||
or eax, PG_UW
|
||||
or eax, PG_NOCACHE
|
||||
mov edi, ebx
|
||||
call commit_pages
|
||||
mov eax, edi
|
||||
ret
|
||||
|
||||
;***************************************************************************
|
||||
; Function
|
||||
; pci_mmio_unmap_page
|
||||
;
|
||||
; Description
|
||||
; unmaps the linear space previously tied to a PCI memory block
|
||||
;
|
||||
; IN: ebx = linear address of space previously allocated by pci_mmio_map
|
||||
; returns eax = 1 if successfully unmapped
|
||||
;
|
||||
; Error codes
|
||||
; eax = -1 if no user PCI access allowed,
|
||||
; eax = 0 if unmapping failed
|
||||
;***************************************************************************
|
||||
|
||||
pci_mmio_unmap:
|
||||
stdcall user_free, ebx
|
||||
ret
|
||||
|
||||
end if
|
||||
|
||||
;-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
|
||||
uglobal
|
||||
align 4
|
||||
; VendID (2), DevID (2), Revision = 0 (1), Class Code (3), FNum (1), Bus (1)
|
||||
pci_emu_dat:
|
||||
times 30*10 db 0
|
||||
endg
|
||||
;-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
|
||||
align 4
|
||||
sys_pcibios:
|
||||
cmp [pci_access_enabled], 1
|
||||
jne .unsupported_func
|
||||
cmp [pci_bios_entry], 0
|
||||
jz .emulate_bios
|
||||
|
||||
push ds
|
||||
mov ax, pci_data_sel
|
||||
mov ds, ax
|
||||
mov eax, ebp
|
||||
mov ah, 0B1h
|
||||
call pword [cs:pci_bios_entry]
|
||||
pop ds
|
||||
|
||||
jmp .return
|
||||
;-=-=-=-=-=-=-=-=
|
||||
.emulate_bios:
|
||||
cmp ebp, 1 ; PCI_FUNCTION_ID
|
||||
jnz .not_PCI_BIOS_PRESENT
|
||||
mov edx, 'PCI '
|
||||
mov al, [BOOT_VARS + 0x9020]
|
||||
mov bx, [BOOT_VARS + 0x9022]
|
||||
mov cl, [BOOT_VARS + 0x9021]
|
||||
xor ah, ah
|
||||
jmp .return_abcd
|
||||
|
||||
.not_PCI_BIOS_PRESENT:
|
||||
cmp ebp, 2 ; FIND_PCI_DEVICE
|
||||
jne .not_FIND_PCI_DEVICE
|
||||
mov ebx, pci_emu_dat
|
||||
..nxt:
|
||||
cmp [ebx], dx
|
||||
jne ..no
|
||||
cmp [ebx + 2], cx
|
||||
jne ..no
|
||||
dec si
|
||||
jns ..no
|
||||
mov bx, [ebx + 4]
|
||||
xor ah, ah
|
||||
jmp .return_ab
|
||||
..no:
|
||||
cmp word[ebx], 0
|
||||
je ..dev_not_found
|
||||
add ebx, 10
|
||||
jmp ..nxt
|
||||
..dev_not_found:
|
||||
mov ah, 0x86 ; DEVICE_NOT_FOUND
|
||||
jmp .return_a
|
||||
|
||||
.not_FIND_PCI_DEVICE:
|
||||
cmp ebp, 3 ; FIND_PCI_CLASS_CODE
|
||||
jne .not_FIND_PCI_CLASS_CODE
|
||||
mov esi, pci_emu_dat
|
||||
shl ecx, 8
|
||||
..nxt2:
|
||||
cmp [esi], ecx
|
||||
jne ..no2
|
||||
mov bx, [esi]
|
||||
xor ah, ah
|
||||
jmp .return_ab
|
||||
..no2:
|
||||
cmp dword[esi], 0
|
||||
je ..dev_not_found
|
||||
add esi, 10
|
||||
jmp ..nxt2
|
||||
|
||||
.not_FIND_PCI_CLASS_CODE:
|
||||
cmp ebp, 8 ; READ_CONFIG_*
|
||||
jb .not_READ_CONFIG
|
||||
cmp ebp, 0x0A
|
||||
ja .not_READ_CONFIG
|
||||
mov eax, ebp
|
||||
mov ah, bh
|
||||
mov edx, edi
|
||||
mov bh, bl
|
||||
mov bl, dl
|
||||
call pci_read_reg
|
||||
mov ecx, eax
|
||||
xor ah, ah ; SUCCESSFUL
|
||||
jmp .return_abc
|
||||
.not_READ_CONFIG:
|
||||
cmp ebp, 0x0B ; WRITE_CONFIG_*
|
||||
jb .not_WRITE_CONFIG
|
||||
cmp ebp, 0x0D
|
||||
ja .not_WRITE_CONFIG
|
||||
lea eax, [ebp+1]
|
||||
mov ah, bh
|
||||
mov edx, edi
|
||||
mov bh, bl
|
||||
mov bl, dl
|
||||
call pci_write_reg
|
||||
xor ah, ah ; SUCCESSFUL
|
||||
jmp .return_abc
|
||||
.not_WRITE_CONFIG:
|
||||
.unsupported_func:
|
||||
mov ah, 0x81 ; FUNC_NOT_SUPPORTED
|
||||
.return:
|
||||
mov dword[esp + 4 ], edi
|
||||
mov dword[esp + 8], esi
|
||||
.return_abcd:
|
||||
mov dword[esp + 24], edx
|
||||
.return_abc:
|
||||
mov dword[esp + 28], ecx
|
||||
.return_ab:
|
||||
mov dword[esp + 20], ebx
|
||||
.return_a:
|
||||
mov dword[esp + 32], eax
|
||||
ret
|
||||
|
||||
proc pci_enum
|
||||
push ebp
|
||||
mov ebp, esp
|
||||
push 0
|
||||
virtual at ebp-4
|
||||
.devfn db ?
|
||||
.bus db ?
|
||||
end virtual
|
||||
.loop:
|
||||
mov ah, [.bus]
|
||||
mov al, 2
|
||||
mov bh, [.devfn]
|
||||
mov bl, 0
|
||||
call pci_read_reg
|
||||
cmp eax, 0xFFFFFFFF
|
||||
jnz .has_device
|
||||
test byte [.devfn], 7
|
||||
jnz .next_func
|
||||
jmp .no_device
|
||||
.has_device:
|
||||
push eax
|
||||
movi eax, sizeof.PCIDEV
|
||||
call malloc
|
||||
pop ecx
|
||||
test eax, eax
|
||||
jz .nomemory
|
||||
mov edi, eax
|
||||
mov [edi+PCIDEV.vendor_device_id], ecx
|
||||
mov eax, pcidev_list
|
||||
mov ecx, [eax+PCIDEV.bk]
|
||||
mov [edi+PCIDEV.bk], ecx
|
||||
mov [edi+PCIDEV.fd], eax
|
||||
mov [ecx+PCIDEV.fd], edi
|
||||
mov [eax+PCIDEV.bk], edi
|
||||
mov eax, dword [.devfn]
|
||||
mov dword [edi+PCIDEV.devfn], eax
|
||||
mov dword [edi+PCIDEV.owner], 0
|
||||
mov bh, al
|
||||
mov al, 2
|
||||
mov bl, 8
|
||||
call pci_read_reg
|
||||
shr eax, 8
|
||||
mov [edi+PCIDEV.class], eax
|
||||
test byte [.devfn], 7
|
||||
jnz .next_func
|
||||
mov ah, [.bus]
|
||||
mov al, 0
|
||||
mov bh, [.devfn]
|
||||
mov bl, 0Eh
|
||||
call pci_read_reg
|
||||
test al, al
|
||||
js .next_func
|
||||
.no_device:
|
||||
or byte [.devfn], 7
|
||||
.next_func:
|
||||
inc dword [.devfn]
|
||||
mov ah, [.bus]
|
||||
cmp ah, [BOOT_VARS+0x9021]
|
||||
jbe .loop
|
||||
.nomemory:
|
||||
leave
|
||||
ret
|
||||
endp
|
||||
446
kernel/branches/kolibri-process/bus/usb/common.inc
Normal file
446
kernel/branches/kolibri-process/bus/usb/common.inc
Normal file
@@ -0,0 +1,446 @@
|
||||
; Constants and structures that are shared between different parts of
|
||||
; USB subsystem and *HCI drivers.
|
||||
|
||||
; =============================================================================
|
||||
; ================================= Constants =================================
|
||||
; =============================================================================
|
||||
; Version of all structures related to host controllers.
|
||||
; Must be the same in kernel and *hci-drivers.
|
||||
USBHC_VERSION = 1
|
||||
|
||||
; USB device must have at least 100ms of stable power before initializing can
|
||||
; proceed; one timer tick is 10ms, so enforce delay in 10 ticks
|
||||
USB_CONNECT_DELAY = 10
|
||||
; USB requires at least 10 ms for reset signalling. Normally, this is one timer
|
||||
; tick. However, it is possible that we start reset signalling in the end of
|
||||
; interval between timer ticks and then we test time in the start of the next
|
||||
; interval; in this case, the delta between [timer_ticks] is 1, but the real
|
||||
; time passed is significantly less than 10 ms. To avoid this, we add an extra
|
||||
; tick; this guarantees that at least 10 ms have passed.
|
||||
USB_RESET_TIME = 2
|
||||
; USB requires at least 10 ms of reset recovery, a delay between reset
|
||||
; signalling and any commands to device. Add an extra tick for the same reasons
|
||||
; as with the previous constant.
|
||||
USB_RESET_RECOVERY_TIME = 2
|
||||
|
||||
; USB pipe types
|
||||
CONTROL_PIPE = 0
|
||||
ISOCHRONOUS_PIPE = 1
|
||||
BULK_PIPE = 2
|
||||
INTERRUPT_PIPE = 3
|
||||
|
||||
; Status codes for transfer callbacks.
|
||||
; Taken from OHCI as most verbose controller in this sense.
|
||||
USB_STATUS_OK = 0 ; no error
|
||||
USB_STATUS_CRC = 1 ; CRC error
|
||||
USB_STATUS_BITSTUFF = 2 ; bit stuffing violation
|
||||
USB_STATUS_TOGGLE = 3 ; data toggle mismatch
|
||||
USB_STATUS_STALL = 4 ; device returned STALL
|
||||
USB_STATUS_NORESPONSE = 5 ; device not responding
|
||||
USB_STATUS_PIDCHECK = 6 ; invalid PID check bits
|
||||
USB_STATUS_WRONGPID = 7 ; unexpected PID value
|
||||
USB_STATUS_OVERRUN = 8 ; too many data from endpoint
|
||||
USB_STATUS_UNDERRUN = 9 ; too few data from endpoint
|
||||
USB_STATUS_BUFOVERRUN = 12 ; overflow of internal controller buffer
|
||||
USB_STATUS_BUFUNDERRUN = 13 ; underflow of internal controller buffer
|
||||
USB_STATUS_CLOSED = 16 ; pipe closed
|
||||
; either explicitly with USBClosePipe
|
||||
; or implicitly due to device disconnect
|
||||
|
||||
; Possible speeds of USB devices
|
||||
USB_SPEED_FS = 0 ; full-speed
|
||||
USB_SPEED_LS = 1 ; low-speed
|
||||
USB_SPEED_HS = 2 ; high-speed
|
||||
|
||||
; flags for usb_pipe.Flags
|
||||
USB_FLAG_CLOSED = 1 ; pipe is closed, no new transfers
|
||||
; pipe is closed, return error instead of submitting any new transfer
|
||||
USB_FLAG_CAN_FREE = 2
|
||||
; pipe is closed via explicit call to USBClosePipe, so it can be freed without
|
||||
; any driver notification; if this flag is not set, then the pipe is closed due
|
||||
; to device disconnect, so it must remain valid until return from disconnect
|
||||
; callback provided by the driver
|
||||
USB_FLAG_EXTRA_WAIT = 4
|
||||
; The pipe was in wait list, while another event occured;
|
||||
; when the first wait will be done, reinsert the pipe to wait list
|
||||
USB_FLAG_CLOSED_BIT = 0 ; USB_FLAG_CLOSED = 1 shl USB_FLAG_CLOSED_BIT
|
||||
|
||||
; =============================================================================
|
||||
; ================================ Structures =================================
|
||||
; =============================================================================
|
||||
|
||||
; Description of controller-specific data and functions.
|
||||
struct usb_hardware_func
|
||||
Version dd ? ; must be USBHC_VERSION
|
||||
ID dd ? ; '*HCI'
|
||||
DataSize dd ? ; sizeof(*hci_controller)
|
||||
BeforeInit dd ?
|
||||
; Early initialization: take ownership from BIOS.
|
||||
; in: [ebp-4] = (bus shl 8) + devfn
|
||||
Init dd ?
|
||||
; Initialize controller-specific part of controller data.
|
||||
; in: eax -> *hci_controller to initialize, [ebp-4] = (bus shl 8) + devfn
|
||||
; out: eax = 0 <=> failed, otherwise eax -> usb_controller
|
||||
ProcessDeferred dd ?
|
||||
; Called regularly from the main loop of USB thread
|
||||
; (either due to timeout from a previous call, or due to explicit wakeup).
|
||||
; in: esi -> usb_controller
|
||||
; out: eax = maximum timeout for next call (-1 = infinity)
|
||||
SetDeviceAddress dd ?
|
||||
; in: esi -> usb_controller, ebx -> usb_pipe, cl = address
|
||||
GetDeviceAddress dd ?
|
||||
; in: esi -> usb_controller, ebx -> usb_pipe
|
||||
; out: eax = address
|
||||
PortDisable dd ?
|
||||
; Disable the given port in the root hub.
|
||||
; in: esi -> usb_controller, ecx = port (zero-based)
|
||||
InitiateReset dd ?
|
||||
; Start reset signalling on the given port.
|
||||
; in: esi -> usb_controller, ecx = port (zero-based)
|
||||
SetEndpointPacketSize dd ?
|
||||
; in: esi -> usb_controller, ebx -> usb_pipe, ecx = packet size
|
||||
AllocPipe dd ?
|
||||
; out: eax = pointer to allocated usb_pipe
|
||||
FreePipe dd ?
|
||||
; void stdcall with one argument = pointer to previously allocated usb_pipe
|
||||
InitPipe dd ?
|
||||
; in: edi -> usb_pipe for target, ecx -> usb_pipe for config pipe,
|
||||
; esi -> usb_controller, eax -> usb_gtd for the first TD,
|
||||
; [ebp+12] = endpoint, [ebp+16] = maxpacket, [ebp+20] = type
|
||||
UnlinkPipe dd ?
|
||||
; esi -> usb_controller, ebx -> usb_pipe
|
||||
AllocTD dd ?
|
||||
; out: eax = pointer to allocated usb_gtd
|
||||
FreeTD dd ?
|
||||
; void stdcall with one argument = pointer to previously allocated usb_gtd
|
||||
AllocTransfer dd ?
|
||||
; Allocate and initialize one stage of a transfer.
|
||||
; ebx -> usb_pipe, other parameters are passed through the stack:
|
||||
; buffer,size = data to transfer
|
||||
; flags = same as in usb_open_pipe:
|
||||
; bit 0 = allow short transfer, other bits reserved
|
||||
; td = pointer to the current end-of-queue descriptor
|
||||
; direction =
|
||||
; 0000b for normal transfers,
|
||||
; 1000b for control SETUP transfer,
|
||||
; 1101b for control OUT transfer,
|
||||
; 1110b for control IN transfer
|
||||
; returns eax = pointer to the new end-of-queue descriptor
|
||||
; (not included in the queue itself) or 0 on error
|
||||
InsertTransfer dd ?
|
||||
; Activate previously initialized transfer (maybe with multiple stages).
|
||||
; esi -> usb_controller, ebx -> usb_pipe,
|
||||
; [esp+4] -> first usb_gtd for the transfer,
|
||||
; ecx -> last descriptor for the transfer
|
||||
NewDevice dd ?
|
||||
; Initiate configuration of a new device (create pseudo-pipe describing that
|
||||
; device and call usb_new_device).
|
||||
; esi -> usb_controller, eax = speed (one of USB_SPEED_* constants).
|
||||
ends
|
||||
|
||||
; pointers to kernel API functions that are called from *HCI-drivers
|
||||
struct usbhc_func
|
||||
usb_process_gtd dd ?
|
||||
usb_init_static_endpoint dd ?
|
||||
usb_wakeup_if_needed dd ?
|
||||
usb_subscribe_control dd ?
|
||||
usb_subscription_done dd ?
|
||||
usb_allocate_common dd ?
|
||||
usb_free_common dd ?
|
||||
usb_td_to_virt dd ?
|
||||
usb_init_transfer dd ?
|
||||
usb_undo_tds dd ?
|
||||
usb_test_pending_port dd ?
|
||||
usb_get_tt dd ?
|
||||
usb_get_tt_think_time dd ?
|
||||
usb_new_device dd ?
|
||||
usb_disconnect_stage2 dd ?
|
||||
usb_process_wait_lists dd ?
|
||||
usb_unlink_td dd ?
|
||||
usb_is_final_packet dd ?
|
||||
usb_find_ehci_companion dd ?
|
||||
ends
|
||||
|
||||
; Controller descriptor.
|
||||
; This structure represents the common (controller-independent) part
|
||||
; of a controller for the USB code. The corresponding controller-dependent
|
||||
; part *hci_controller is located immediately before usb_controller.
|
||||
struct usb_controller
|
||||
; Two following fields organize all controllers in the global linked list.
|
||||
Next dd ?
|
||||
Prev dd ?
|
||||
HardwareFunc dd ?
|
||||
; Pointer to usb_hardware_func structure with controller-specific functions.
|
||||
NumPorts dd ?
|
||||
; Number of ports in the root hub.
|
||||
PCICoordinates dd ?
|
||||
; Device:function and bus number from PCI.
|
||||
;
|
||||
; The hardware is allowed to cache some data from hardware structures.
|
||||
; Regular operations are designed considering this,
|
||||
; but sometimes it is required to wait for synchronization of hardware cache
|
||||
; with modified structures in memory.
|
||||
; The code keeps two queues of pipes waiting for synchronization,
|
||||
; one for asynchronous (bulk/control) pipes, one for periodic pipes, hardware
|
||||
; cache is invalidated under different conditions for those types.
|
||||
; Both queues are organized in the same way, as single-linked lists.
|
||||
; There are three special positions: the head of list (new pipes are added
|
||||
; here), the first pipe to be synchronized at the current iteration,
|
||||
; the tail of list (all pipes starting from here are synchronized).
|
||||
WaitPipeListAsync dd ?
|
||||
WaitPipeListPeriodic dd ?
|
||||
; List heads.
|
||||
WaitPipeRequestAsync dd ?
|
||||
WaitPipeRequestPeriodic dd ?
|
||||
; Pending request to hardware to refresh cache for items from WaitPipeList*.
|
||||
; (Pointers to some items in WaitPipeList* or NULLs).
|
||||
ReadyPipeHeadAsync dd ?
|
||||
ReadyPipeHeadPeriodic dd ?
|
||||
; Items of RemovingList* which were released by hardware and are ready
|
||||
; for further processing.
|
||||
; (Pointers to some items in WaitPipeList* or NULLs).
|
||||
NewConnected dd ?
|
||||
; bit mask of recently connected ports of the root hub,
|
||||
; bit set = a device was recently connected to the corresponding port;
|
||||
; after USB_CONNECT_DELAY ticks of stable status these ports are moved to
|
||||
; PendingPorts
|
||||
NewDisconnected dd ?
|
||||
; bit mask of disconnected ports of the root hub,
|
||||
; bit set = a device in the corresponding port was disconnected,
|
||||
; disconnect processing is required.
|
||||
PendingPorts dd ?
|
||||
; bit mask of ports which are ready to be initialized
|
||||
ControlLock MUTEX ?
|
||||
; mutex which guards all operations with control queue
|
||||
BulkLock MUTEX ?
|
||||
; mutex which guards all operations with bulk queue
|
||||
PeriodicLock MUTEX ?
|
||||
; mutex which guards all operations with periodic queues
|
||||
WaitSpinlock:
|
||||
; spinlock guarding WaitPipeRequest/ReadyPipeHead (but not WaitPipeList)
|
||||
StartWaitFrame dd ?
|
||||
; USB frame number when WaitPipeRequest* was registered.
|
||||
ResettingHub dd ?
|
||||
; Pointer to usb_hub responsible for the currently resetting port, if any.
|
||||
; NULL for the root hub.
|
||||
ResettingPort db ?
|
||||
; Port that is currently resetting, 0-based.
|
||||
ResettingSpeed db ?
|
||||
; Speed of currently resetting device.
|
||||
ResettingStatus db ?
|
||||
; Status of port reset. 0 = no port is resetting, -1 = reset failed,
|
||||
; 1 = reset in progress, 2 = reset recovery in progress.
|
||||
rb 1 ; alignment
|
||||
ResetTime dd ?
|
||||
; Time when reset signalling or reset recovery has been started.
|
||||
SetAddressBuffer rb 8
|
||||
; Buffer for USB control command SET_ADDRESS.
|
||||
ExistingAddresses rd 128/32
|
||||
; Bitmask for 128 bits; bit i is cleared <=> address i is free for allocating
|
||||
; for new devices. Bit 0 is always set.
|
||||
ConnectedTime rd 16
|
||||
; Time, in timer ticks, when the port i has signalled the connect event.
|
||||
; Valid only if bit i in NewConnected is set.
|
||||
DevicesByPort rd 16
|
||||
; Pointer to usb_pipe for zero endpoint (which serves as device handle)
|
||||
; for each port.
|
||||
ends
|
||||
|
||||
; Pipe descriptor.
|
||||
; * An USB pipe is described by two structures, for hardware and for software.
|
||||
; * This is the software part. The hardware part is defined in a driver
|
||||
; of the corresponding controller.
|
||||
; * The hardware part is located immediately before usb_pipe,
|
||||
; both are allocated at once by controller-specific code
|
||||
; (it knows the total length, which depends on the hardware part).
|
||||
struct usb_pipe
|
||||
Controller dd ?
|
||||
; Pointer to usb_controller structure corresponding to this pipe.
|
||||
; Must be the first dword after hardware part, see *hci_new_device.
|
||||
;
|
||||
; Every endpoint is included into one of processing lists:
|
||||
; * Bulk list contains all Bulk endpoints.
|
||||
; * Control list contains all Control endpoints.
|
||||
; * Several Periodic lists serve Interrupt endpoints with different interval.
|
||||
; - There are N=2^n "leaf" periodic lists for N ms interval, one is processed
|
||||
; in the frames 0,N,2N,..., another is processed in the frames
|
||||
; 1,1+N,1+2N,... and so on. The hardware starts processing of periodic
|
||||
; endpoints in every frame from the list identified by lower n bits of the
|
||||
; frame number; the addresses of these N lists are written to the
|
||||
; controller data area during the initialization.
|
||||
; - We assume that n=5, N=32 to simplify the code and compact the data.
|
||||
; OHCI works in this way. UHCI and EHCI actually have n=10, N=1024,
|
||||
; but this is an overkill for interrupt endpoints; the large value of N is
|
||||
; useful only for isochronous transfers in UHCI and EHCI. UHCI/EHCI code
|
||||
; initializes "leaf" lists k,k+32,k+64,...,k+(1024-32) to the same value,
|
||||
; giving essentially N=32.
|
||||
; This restriction means that the actual maximum interval of polling any
|
||||
; interrupt endpoint is 32ms, which seems to be a reasonable value.
|
||||
; - Similarly, there are 16 lists for 16-ms interval, 8 lists for 8-ms
|
||||
; interval and so on. Finally, there is one list for 1ms interval. Their
|
||||
; addresses are not directly known to the controller.
|
||||
; - The hardware serves endpoints following a physical link from the hardware
|
||||
; part.
|
||||
; - The hardware links are organized as follows. If the list item is not the
|
||||
; last, it's hardware link points to the next item. The hardware link of
|
||||
; the last item points to the first item of the "next" list.
|
||||
; - The "next" list for k-th and (k+M)-th periodic lists for interval 2M ms
|
||||
; is the k-th periodic list for interval M ms, M >= 1. In this scheme,
|
||||
; if two "previous" lists are served in the frames k,k+2M,k+4M,...
|
||||
; and k+M,k+3M,k+5M,... correspondingly, the "next" list is served in
|
||||
; the frames k,k+M,k+2M,k+3M,k+4M,k+5M,..., which is exactly what we want.
|
||||
; - The links between Periodic, Control, Bulk lists and the processing of
|
||||
; Isochronous endpoints are controller-specific.
|
||||
; * The head of every processing list is a static entry which does not
|
||||
; correspond to any real pipe. It is described by usb_static_ep
|
||||
; structure, not usb_pipe. For OHCI and UHCI, sizeof.usb_static_ep plus
|
||||
; sizeof hardware part is 20h, the total number of lists is
|
||||
; 32+16+8+4+2+1+1+1 = 65, so all these structures fit in one page,
|
||||
; leaving space for other data. This is another reason for 32ms limit.
|
||||
; * Static endpoint descriptors are kept in *hci_controller structure.
|
||||
; * All items in every processing list, including the static head, are
|
||||
; organized in a double-linked list using .NextVirt and .PrevVirt fields.
|
||||
; * [[item.NextVirt].PrevVirt] = [[item.PrevVirt].NextVirt] for all items.
|
||||
NextVirt dd ?
|
||||
; Next endpoint in the processing list.
|
||||
; See also PrevVirt field and the description before NextVirt field.
|
||||
PrevVirt dd ?
|
||||
; Previous endpoint in the processing list.
|
||||
; See also NextVirt field and the description before NextVirt field.
|
||||
;
|
||||
; Every pipe has the associated transfer queue, that is, the double-linked
|
||||
; list of Transfer Descriptors aka TD. For Control, Bulk and Interrupt
|
||||
; endpoints this list consists of usb_gtd structures
|
||||
; (GTD = General Transfer Descriptors), for Isochronous endpoints
|
||||
; this list consists of usb_itd structures, which are not developed yet.
|
||||
; The pipe needs to know only the last TD; the first TD can be
|
||||
; obtained as [[pipe.LastTD].NextVirt].
|
||||
LastTD dd ?
|
||||
; Last TD in the transfer queue.
|
||||
;
|
||||
; All opened pipes corresponding to the same physical device are organized in
|
||||
; the double-linked list using .NextSibling and .PrevSibling fields.
|
||||
; The head of this list is kept in usb_device_data structure (OpenedPipeList).
|
||||
; This list is used when the device is disconnected and all pipes for the
|
||||
; device should be closed.
|
||||
; Also, all pipes closed due to disconnect must remain valid at least until
|
||||
; driver-provided disconnect function returns; all should-be-freed-but-not-now
|
||||
; pipes for one device are organized in another double-linked list with
|
||||
; the head in usb_device_data.ClosedPipeList; this list uses the same link
|
||||
; fields, one pipe can never be in both lists.
|
||||
NextSibling dd ?
|
||||
; Next pipe for the physical device.
|
||||
PrevSibling dd ?
|
||||
; Previous pipe for the physical device.
|
||||
;
|
||||
; When hardware part of pipe is changed, some time is needed before further
|
||||
; actions so that hardware reacts on this change. During that time,
|
||||
; all changed pipes are organized in single-linked list with the head
|
||||
; usb_controller.WaitPipeList* and link field NextWait.
|
||||
; Currently there are two possible reasons to change:
|
||||
; change of address/packet size in initial configuration,
|
||||
; close of the pipe. They are distinguished by USB_FLAG_CLOSED.
|
||||
NextWait dd ?
|
||||
Lock MUTEX
|
||||
; Mutex that guards operations with transfer queue for this pipe.
|
||||
Type db ?
|
||||
; Type of pipe, one of {CONTROL,ISOCHRONOUS,BULK,INTERRUPT}_PIPE.
|
||||
Flags db ?
|
||||
; Combination of flags, USB_FLAG_*.
|
||||
rb 2 ; dword alignment
|
||||
DeviceData dd ?
|
||||
; Pointer to usb_device_data, common for all pipes for one device.
|
||||
ends
|
||||
|
||||
; This structure describes the static head of every list of pipes.
|
||||
struct usb_static_ep
|
||||
; software fields
|
||||
Bandwidth dd ?
|
||||
; valid only for interrupt/isochronous USB1 lists
|
||||
; The offsets of the following two fields must be the same in this structure
|
||||
; and in usb_pipe.
|
||||
NextVirt dd ?
|
||||
PrevVirt dd ?
|
||||
ends
|
||||
|
||||
; This structure represents one transfer descriptor
|
||||
; ('g' stands for "general" as opposed to isochronous usb_itd).
|
||||
; Note that one transfer can have several descriptors:
|
||||
; a control transfer has three stages.
|
||||
; Additionally, every controller has a limit on transfer length with
|
||||
; one descriptor (packet size for UHCI, 1K for OHCI, 4K for EHCI),
|
||||
; large transfers must be split into individual packets according to that limit.
|
||||
struct usb_gtd
|
||||
Callback dd ?
|
||||
; Zero for intermediate descriptors, pointer to callback function
|
||||
; for final descriptor. See the docs for description of the callback.
|
||||
UserData dd ?
|
||||
; Dword which is passed to Callback as is, not used by USB code itself.
|
||||
; Two following fields organize all descriptors for one pipe in
|
||||
; the linked list.
|
||||
NextVirt dd ?
|
||||
PrevVirt dd ?
|
||||
Pipe dd ?
|
||||
; Pointer to the parent usb_pipe.
|
||||
Buffer dd ?
|
||||
; Pointer to data for this descriptor.
|
||||
Length dd ?
|
||||
; Length of data for this descriptor.
|
||||
ends
|
||||
|
||||
; Interface-specific data. Several interfaces of one device can operate
|
||||
; independently, each is controlled by some driver and is identified by
|
||||
; some driver-specific data passed as is to the driver.
|
||||
struct usb_interface_data
|
||||
DriverData dd ?
|
||||
; Passed as is to the driver.
|
||||
DriverFunc dd ?
|
||||
; Pointer to USBSRV structure for the driver.
|
||||
ends
|
||||
|
||||
; Device-specific data.
|
||||
struct usb_device_data
|
||||
PipeListLock MUTEX
|
||||
; Lock guarding OpenedPipeList. Must be the first item of the structure,
|
||||
; the code passes pointer to usb_device_data as is to mutex_lock/unlock.
|
||||
OpenedPipeList rd 2
|
||||
; List of all opened pipes for the device.
|
||||
; Used when the device is disconnected, so all pipes should be closed.
|
||||
ClosedPipeList rd 2
|
||||
; List of all closed, but still valid pipes for the device.
|
||||
; A pipe closed with USBClosePipe is just deallocated,
|
||||
; but a pipe closed due to disconnect must remain valid until driver-provided
|
||||
; disconnect handler returns; this list links all such pipes to deallocate them
|
||||
; after disconnect processing.
|
||||
NumPipes dd ?
|
||||
; Number of not-yet-closed pipes.
|
||||
Hub dd ?
|
||||
; NULL if connected to the root hub, pointer to usb_hub otherwise.
|
||||
TTHub dd ?
|
||||
; Pointer to usb_hub for (the) hub with Transaction Translator for the device,
|
||||
; NULL if the device operates in the same speed as the controller.
|
||||
Port db ?
|
||||
; Port on the hub, zero-based.
|
||||
TTPort db ?
|
||||
; Port on the TTHub, zero-based.
|
||||
DeviceDescrSize db ?
|
||||
; Size of device descriptor.
|
||||
Speed db ?
|
||||
; Device speed, one of USB_SPEED_*.
|
||||
NumInterfaces dd ?
|
||||
; Number of interfaces.
|
||||
ConfigDataSize dd ?
|
||||
; Total size of data associated with the configuration descriptor
|
||||
; (including the configuration descriptor itself).
|
||||
Interfaces dd ?
|
||||
; Offset from the beginning of this structure to Interfaces field.
|
||||
; Variable-length fields:
|
||||
; DeviceDescriptor:
|
||||
; device descriptor starts here
|
||||
; ConfigDescriptor = DeviceDescriptor + DeviceDescrSize
|
||||
; configuration descriptor with all associated data
|
||||
; Interfaces = ALIGN_UP(ConfigDescriptor + ConfigDataSize, 4)
|
||||
; array of NumInterfaces elements of type usb_interface_data
|
||||
ends
|
||||
|
||||
usb_device_data.DeviceDescriptor = sizeof.usb_device_data
|
||||
322
kernel/branches/kolibri-process/bus/usb/hccommon.inc
Normal file
322
kernel/branches/kolibri-process/bus/usb/hccommon.inc
Normal file
@@ -0,0 +1,322 @@
|
||||
; USB Host Controller support code: hardware-independent part,
|
||||
; common for all controller types.
|
||||
|
||||
iglobal
|
||||
; USB HC support: some functions interesting only for *HCI-drivers.
|
||||
align 4
|
||||
usb_hc_func:
|
||||
dd usb_process_gtd
|
||||
dd usb_init_static_endpoint
|
||||
dd usb_wakeup_if_needed
|
||||
dd usb_subscribe_control
|
||||
dd usb_subscription_done
|
||||
dd usb_allocate_common
|
||||
dd usb_free_common
|
||||
dd usb_td_to_virt
|
||||
dd usb_init_transfer
|
||||
dd usb_undo_tds
|
||||
dd usb_test_pending_port
|
||||
dd usb_get_tt
|
||||
dd usb_get_tt_think_time
|
||||
dd usb_new_device
|
||||
dd usb_disconnect_stage2
|
||||
dd usb_process_wait_lists
|
||||
dd usb_unlink_td
|
||||
dd usb_is_final_packet
|
||||
dd usb_find_ehci_companion
|
||||
endg
|
||||
|
||||
; Initializes one controller, called by usb_init for every controller.
|
||||
; eax -> PCIDEV structure for the device.
|
||||
proc usb_init_controller
|
||||
push ebp
|
||||
mov ebp, esp
|
||||
; 1. Store in the stack PCI coordinates and save pointer to PCIDEV:
|
||||
; make [ebp-4] = (bus shl 8) + devfn, used by controller-specific Init funcs.
|
||||
push dword [eax+PCIDEV.devfn]
|
||||
push eax
|
||||
mov edi, [eax+PCIDEV.owner]
|
||||
test edi, edi
|
||||
jz .nothing
|
||||
mov edi, [edi+USBSRV.usb_func]
|
||||
; 2. Allocate *hci_controller + usb_controller.
|
||||
mov ebx, [edi+usb_hardware_func.DataSize]
|
||||
add ebx, sizeof.usb_controller
|
||||
stdcall kernel_alloc, ebx
|
||||
test eax, eax
|
||||
jz .nothing
|
||||
; 3. Zero-initialize both structures.
|
||||
push edi eax
|
||||
mov ecx, ebx
|
||||
shr ecx, 2
|
||||
xchg edi, eax
|
||||
xor eax, eax
|
||||
rep stosd
|
||||
; 4. Initialize usb_controller structure,
|
||||
; except data known only to controller-specific code (like NumPorts)
|
||||
; and link fields
|
||||
; (this structure will be inserted to the overall list at step 6).
|
||||
dec eax
|
||||
mov [edi+usb_controller.ExistingAddresses+4-sizeof.usb_controller], eax
|
||||
mov [edi+usb_controller.ExistingAddresses+8-sizeof.usb_controller], eax
|
||||
mov [edi+usb_controller.ExistingAddresses+12-sizeof.usb_controller], eax
|
||||
mov [edi+usb_controller.ResettingPort-sizeof.usb_controller], al ; no resetting port
|
||||
dec eax ; don't allocate zero address
|
||||
mov [edi+usb_controller.ExistingAddresses-sizeof.usb_controller], eax
|
||||
mov eax, [ebp-4]
|
||||
mov [edi+usb_controller.PCICoordinates-sizeof.usb_controller], eax
|
||||
lea ecx, [edi+usb_controller.PeriodicLock-sizeof.usb_controller]
|
||||
call mutex_init
|
||||
add ecx, usb_controller.ControlLock - usb_controller.PeriodicLock
|
||||
call mutex_init
|
||||
add ecx, usb_controller.BulkLock - usb_controller.ControlLock
|
||||
call mutex_init
|
||||
pop eax edi
|
||||
mov [eax+ebx-sizeof.usb_controller+usb_controller.HardwareFunc], edi
|
||||
push eax
|
||||
; 5. Call controller-specific initialization.
|
||||
; If failed, free memory allocated in step 2 and return.
|
||||
call [edi+usb_hardware_func.Init]
|
||||
test eax, eax
|
||||
jz .fail
|
||||
pop ecx
|
||||
; 6. Insert the controller to the global list.
|
||||
xchg eax, ebx
|
||||
mov ecx, usb_controllers_list_mutex
|
||||
call mutex_lock
|
||||
mov edx, usb_controllers_list
|
||||
mov eax, [edx+usb_controller.Prev]
|
||||
mov [ebx+usb_controller.Next], edx
|
||||
mov [ebx+usb_controller.Prev], eax
|
||||
mov [edx+usb_controller.Prev], ebx
|
||||
mov [eax+usb_controller.Next], ebx
|
||||
call mutex_unlock
|
||||
; 7. Wakeup USB thread to call ProcessDeferred.
|
||||
call usb_wakeup
|
||||
.nothing:
|
||||
; 8. Restore pointer to PCIDEV saved in step 1 and return.
|
||||
pop eax
|
||||
leave
|
||||
ret
|
||||
.fail:
|
||||
call kernel_free
|
||||
jmp .nothing
|
||||
endp
|
||||
|
||||
; Helper function, calculates physical address including offset in page.
|
||||
proc get_phys_addr
|
||||
push ecx
|
||||
mov ecx, eax
|
||||
and ecx, 0xFFF
|
||||
call get_pg_addr
|
||||
add eax, ecx
|
||||
pop ecx
|
||||
ret
|
||||
endp
|
||||
|
||||
; Put the given control pipe in the wait list;
|
||||
; called when the pipe structure is changed and a possible hardware cache
|
||||
; needs to be synchronized. When it will be known that the cache is updated,
|
||||
; usb_subscription_done procedure will be called.
|
||||
proc usb_subscribe_control
|
||||
cmp [ebx+usb_pipe.NextWait], -1
|
||||
jnz @f
|
||||
mov eax, [esi+usb_controller.WaitPipeListAsync]
|
||||
mov [ebx+usb_pipe.NextWait], eax
|
||||
mov [esi+usb_controller.WaitPipeListAsync], ebx
|
||||
@@:
|
||||
ret
|
||||
endp
|
||||
|
||||
; Called after synchronization of hardware cache with software changes.
|
||||
; Continues process of device enumeration based on when it was delayed
|
||||
; due to call to usb_subscribe_control.
|
||||
proc usb_subscription_done
|
||||
mov eax, [ebx+usb_pipe.DeviceData]
|
||||
cmp [eax+usb_device_data.DeviceDescrSize], 0
|
||||
jz usb_after_set_address
|
||||
jmp usb_after_set_endpoint_size
|
||||
endp
|
||||
|
||||
; This function is called when a new device has either passed
|
||||
; or failed first stages of configuration, so the next device
|
||||
; can enter configuration process.
|
||||
proc usb_test_pending_port
|
||||
mov [esi+usb_controller.ResettingPort], -1
|
||||
cmp [esi+usb_controller.PendingPorts], 0
|
||||
jz .nothing
|
||||
bsf ecx, [esi+usb_controller.PendingPorts]
|
||||
btr [esi+usb_controller.PendingPorts], ecx
|
||||
mov eax, [esi+usb_controller.HardwareFunc]
|
||||
jmp [eax+usb_hardware_func.InitiateReset]
|
||||
.nothing:
|
||||
ret
|
||||
endp
|
||||
|
||||
; This procedure is regularly called from controller-specific ProcessDeferred,
|
||||
; it checks whether there are disconnected events and if so, process them.
|
||||
proc usb_disconnect_stage2
|
||||
bsf ecx, [esi+usb_controller.NewDisconnected]
|
||||
jz .nothing
|
||||
lock btr [esi+usb_controller.NewDisconnected], ecx
|
||||
btr [esi+usb_controller.PendingPorts], ecx
|
||||
xor ebx, ebx
|
||||
xchg ebx, [esi+usb_controller.DevicesByPort+ecx*4]
|
||||
test ebx, ebx
|
||||
jz usb_disconnect_stage2
|
||||
call usb_device_disconnected
|
||||
jmp usb_disconnect_stage2
|
||||
.nothing:
|
||||
ret
|
||||
endp
|
||||
|
||||
; Initial stage of disconnect processing: called when device is disconnected.
|
||||
proc usb_device_disconnected
|
||||
; Loop over all pipes, close everything, wait until hardware reacts.
|
||||
; The final handling is done in usb_pipe_closed.
|
||||
push ebx
|
||||
mov ecx, [ebx+usb_pipe.DeviceData]
|
||||
call mutex_lock
|
||||
lea eax, [ecx+usb_device_data.OpenedPipeList-usb_pipe.NextSibling]
|
||||
push eax
|
||||
mov ebx, [eax+usb_pipe.NextSibling]
|
||||
.pipe_loop:
|
||||
call usb_close_pipe_nolock
|
||||
mov ebx, [ebx+usb_pipe.NextSibling]
|
||||
cmp ebx, [esp]
|
||||
jnz .pipe_loop
|
||||
pop eax
|
||||
pop ebx
|
||||
mov ecx, [ebx+usb_pipe.DeviceData]
|
||||
call mutex_unlock
|
||||
ret
|
||||
endp
|
||||
|
||||
; Called from controller-specific ProcessDeferred,
|
||||
; processes wait-pipe-done notifications,
|
||||
; returns whether there are more items in wait queues.
|
||||
; in: esi -> usb_controller
|
||||
; out: eax = bitmask of pipe types with non-empty wait queue
|
||||
proc usb_process_wait_lists
|
||||
xor edx, edx
|
||||
push edx
|
||||
call usb_process_one_wait_list
|
||||
jnc @f
|
||||
or byte [esp], 1 shl CONTROL_PIPE
|
||||
@@:
|
||||
movi edx, 4
|
||||
call usb_process_one_wait_list
|
||||
jnc @f
|
||||
or byte [esp], 1 shl INTERRUPT_PIPE
|
||||
@@:
|
||||
xor edx, edx
|
||||
call usb_process_one_wait_list
|
||||
jnc @f
|
||||
or byte [esp], 1 shl CONTROL_PIPE
|
||||
@@:
|
||||
pop eax
|
||||
ret
|
||||
endp
|
||||
|
||||
; Helper procedure for usb_process_wait_lists;
|
||||
; does the same for one wait queue.
|
||||
; in: esi -> usb_controller,
|
||||
; edx=0 for *Async, edx=4 for *Periodic list
|
||||
; out: CF = issue new request
|
||||
proc usb_process_one_wait_list
|
||||
; 1. Check whether there is a pending request. If so, do nothing.
|
||||
mov ebx, [esi+usb_controller.WaitPipeRequestAsync+edx]
|
||||
cmp ebx, [esi+usb_controller.ReadyPipeHeadAsync+edx]
|
||||
clc
|
||||
jnz .nothing
|
||||
; 2. Check whether there are new data. If so, issue a new request.
|
||||
cmp ebx, [esi+usb_controller.WaitPipeListAsync+edx]
|
||||
stc
|
||||
jnz .nothing
|
||||
test ebx, ebx
|
||||
jz .nothing
|
||||
; 3. Clear all lists.
|
||||
xor ecx, ecx
|
||||
mov [esi+usb_controller.WaitPipeListAsync+edx], ecx
|
||||
mov [esi+usb_controller.WaitPipeRequestAsync+edx], ecx
|
||||
mov [esi+usb_controller.ReadyPipeHeadAsync+edx], ecx
|
||||
; 4. Loop over all pipes from the wait list.
|
||||
.pipe_loop:
|
||||
; For every pipe:
|
||||
; 5. Save edx and next pipe in the list.
|
||||
push edx
|
||||
push [ebx+usb_pipe.NextWait]
|
||||
; 6. If USB_FLAG_EXTRA_WAIT is set, reinsert the pipe to the list and continue.
|
||||
test [ebx+usb_pipe.Flags], USB_FLAG_EXTRA_WAIT
|
||||
jz .process
|
||||
mov eax, [esi+usb_controller.WaitPipeListAsync+edx]
|
||||
mov [ebx+usb_pipe.NextWait], eax
|
||||
mov [esi+usb_controller.WaitPipeListAsync+edx], ebx
|
||||
jmp .continue
|
||||
.process:
|
||||
; 7. Call the handler depending on USB_FLAG_CLOSED.
|
||||
or [ebx+usb_pipe.NextWait], -1
|
||||
test [ebx+usb_pipe.Flags], USB_FLAG_CLOSED
|
||||
jz .nodisconnect
|
||||
call usb_pipe_closed
|
||||
jmp .continue
|
||||
.nodisconnect:
|
||||
call usb_subscription_done
|
||||
.continue:
|
||||
; 8. Restore edx and next pipe saved in step 5 and continue the loop.
|
||||
pop ebx
|
||||
pop edx
|
||||
test ebx, ebx
|
||||
jnz .pipe_loop
|
||||
.check_new_work:
|
||||
; 9. Set CF depending on whether WaitPipeList* is nonzero.
|
||||
cmp [esi+usb_controller.WaitPipeListAsync+edx], 1
|
||||
cmc
|
||||
.nothing:
|
||||
ret
|
||||
endp
|
||||
|
||||
; Called from USB1 controller-specific initialization.
|
||||
; Finds EHCI companion controller for given USB1 controller.
|
||||
; in: bl = PCI device:function for USB1 controller, bh = PCI bus
|
||||
; out: eax -> usb_controller for EHCI companion
|
||||
proc usb_find_ehci_companion
|
||||
; 1. Loop over all registered controllers.
|
||||
mov eax, usb_controllers_list
|
||||
.next:
|
||||
mov eax, [eax+usb_controller.Next]
|
||||
cmp eax, usb_controllers_list
|
||||
jz .notfound
|
||||
; 2. For every controller, check the type, ignore everything that is not EHCI.
|
||||
mov edx, [eax+usb_controller.HardwareFunc]
|
||||
cmp [edx+usb_hardware_func.ID], 'EHCI'
|
||||
jnz .next
|
||||
; 3. For EHCI controller, compare PCI coordinates with input data:
|
||||
; bus and device must be the same, function can be different.
|
||||
mov edx, [eax+usb_controller.PCICoordinates]
|
||||
xor edx, ebx
|
||||
cmp dx, 8
|
||||
jae .next
|
||||
ret
|
||||
.notfound:
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
; Find Transaction Translator hub and port for the given device.
|
||||
; in: edx = parent hub for the device, ecx = port for the device
|
||||
; out: edx = TT hub for the device, ecx = TT port for the device.
|
||||
proc usb_get_tt
|
||||
; If the parent hub is high-speed, it is TT for the device.
|
||||
; Otherwise, the parent hub itself is behind TT, and the device
|
||||
; has the same TT hub+port as the parent hub.
|
||||
mov eax, [edx+usb_hub.ConfigPipe]
|
||||
mov eax, [eax+usb_pipe.DeviceData]
|
||||
cmp [eax+usb_device_data.Speed], USB_SPEED_HS
|
||||
jz @f
|
||||
movzx ecx, [eax+usb_device_data.TTPort]
|
||||
mov edx, [eax+usb_device_data.TTHub]
|
||||
@@:
|
||||
mov edx, [edx+usb_hub.ConfigPipe]
|
||||
ret
|
||||
endp
|
||||
1275
kernel/branches/kolibri-process/bus/usb/hub.inc
Normal file
1275
kernel/branches/kolibri-process/bus/usb/hub.inc
Normal file
File diff suppressed because it is too large
Load Diff
258
kernel/branches/kolibri-process/bus/usb/init.inc
Normal file
258
kernel/branches/kolibri-process/bus/usb/init.inc
Normal file
@@ -0,0 +1,258 @@
|
||||
; Initialization of the USB subsystem.
|
||||
; Provides usb_init procedure, includes all needed files.
|
||||
|
||||
; General notes:
|
||||
; * There is one entry point for external kernel code: usb_init is called
|
||||
; from initialization code and initializes USB subsystem.
|
||||
; * There are several entry points for API; see the docs for description.
|
||||
; * There are several functions which are called from controller-specific
|
||||
; parts of USB subsystem. The most important is usb_new_device,
|
||||
; which is called when a new device has been connected (over some time),
|
||||
; has been reset and is ready to start configuring.
|
||||
; * IRQ handlers are very restricted. They can not take any locks,
|
||||
; since otherwise a deadlock is possible: imagine that a code has taken the
|
||||
; lock and was interrupted by IRQ handler. Now IRQ handler would wait for
|
||||
; releasing the lock, and a lock owner would wait for exiting IRQ handler
|
||||
; to get the control.
|
||||
; * Thus, there is the special USB thread which processes almost all activity.
|
||||
; IRQ handlers do the minimal processing and wake this thread.
|
||||
; * Also the USB thread wakes occasionally to process tasks which can be
|
||||
; predicted without interrupts. These include e.g. a periodic roothub
|
||||
; scanning in UHCI and initializing in USB_CONNECT_DELAY ticks
|
||||
; after connecting a new device.
|
||||
; * The main procedure of USB thread, usb_thread_proc, does all its work
|
||||
; by querying usb_hardware_func.ProcessDeferred for every controller
|
||||
; and usb_hub_process_deferred for every hub.
|
||||
; ProcessDeferred does controller-specific actions and calculates the time
|
||||
; when it should be invoked again, possibly infinite.
|
||||
; usb_thread_proc selects the minimum from all times returned by
|
||||
; ProcessDeferred and sleeps until this moment is reached or the thread
|
||||
; is awakened by IRQ handler.
|
||||
|
||||
iglobal
|
||||
uhci_service_name:
|
||||
db 'UHCI',0
|
||||
ohci_service_name:
|
||||
db 'OHCI',0
|
||||
ehci_service_name:
|
||||
db 'EHCI',0
|
||||
endg
|
||||
|
||||
; Initializes the USB subsystem.
|
||||
proc usb_init
|
||||
; 1. Initialize all locks.
|
||||
mov ecx, usb_controllers_list_mutex
|
||||
call mutex_init
|
||||
; 2. Kick off BIOS from all USB controllers, calling the corresponding function
|
||||
; *hci_kickoff_bios. Also count USB controllers for the next step.
|
||||
; Note: USB1 companion(s) must go before the corresponding EHCI controller,
|
||||
; otherwise BIOS could see a device moving from EHCI to a companion;
|
||||
; first, this always wastes time;
|
||||
; second, some BIOSes are buggy, do not expect that move and try to refer to
|
||||
; previously-assigned controller instead of actual; sometimes that leads to
|
||||
; hangoff.
|
||||
; Thus, process controllers in PCI order.
|
||||
mov esi, pcidev_list
|
||||
push 0
|
||||
.kickoff:
|
||||
mov esi, [esi+PCIDEV.fd]
|
||||
cmp esi, pcidev_list
|
||||
jz .done_kickoff
|
||||
cmp word [esi+PCIDEV.class+1], 0x0C03
|
||||
jnz .kickoff
|
||||
mov ebx, uhci_service_name
|
||||
cmp byte [esi+PCIDEV.class], 0x00
|
||||
jz .do_kickoff
|
||||
mov ebx, ohci_service_name
|
||||
cmp byte [esi+PCIDEV.class], 0x10
|
||||
jz .do_kickoff
|
||||
mov ebx, ehci_service_name
|
||||
cmp byte [esi+PCIDEV.class], 0x20
|
||||
jnz .kickoff
|
||||
.do_kickoff:
|
||||
inc dword [esp]
|
||||
push ebx esi
|
||||
stdcall get_service, ebx
|
||||
pop esi ebx
|
||||
test eax, eax
|
||||
jz .driver_fail
|
||||
mov edx, [eax+USBSRV.usb_func]
|
||||
cmp [edx+usb_hardware_func.Version], USBHC_VERSION
|
||||
jnz .driver_invalid
|
||||
mov [esi+PCIDEV.owner], eax
|
||||
call [edx+usb_hardware_func.BeforeInit]
|
||||
jmp .kickoff
|
||||
.driver_fail:
|
||||
DEBUGF 1,'K : failed to load driver %s\n',ebx
|
||||
jmp .kickoff
|
||||
.driver_invalid:
|
||||
DEBUGF 1,'K : driver %s has wrong version\n',ebx
|
||||
jmp .kickoff
|
||||
.done_kickoff:
|
||||
pop eax
|
||||
; 3. If no controllers were found, exit.
|
||||
; Otherwise, run the USB thread.
|
||||
test eax, eax
|
||||
jz .nothing
|
||||
call create_usb_thread
|
||||
jz .nothing
|
||||
; 4. Initialize all USB controllers, calling usb_init_controller for each.
|
||||
; Note: USB1 companion(s) should go before the corresponding EHCI controller,
|
||||
; although this is not strictly necessary (this way, a companion would not try
|
||||
; to initialize high-speed device only to see a disconnect when EHCI takes
|
||||
; control).
|
||||
; Thus, process all EHCI controllers in the first loop, all USB1 controllers
|
||||
; in the second loop. (One loop in reversed PCI order could also be used,
|
||||
; but seems less natural.)
|
||||
; 4a. Loop over all PCI devices, call usb_init_controller
|
||||
; for all EHCI controllers.
|
||||
mov eax, pcidev_list
|
||||
.scan_ehci:
|
||||
mov eax, [eax+PCIDEV.fd]
|
||||
cmp eax, pcidev_list
|
||||
jz .done_ehci
|
||||
cmp [eax+PCIDEV.class], 0x0C0320
|
||||
jnz .scan_ehci
|
||||
call usb_init_controller
|
||||
jmp .scan_ehci
|
||||
.done_ehci:
|
||||
; 4b. Loop over all PCI devices, call usb_init_controller
|
||||
; for all UHCI and OHCI controllers.
|
||||
mov eax, pcidev_list
|
||||
.scan_usb1:
|
||||
mov eax, [eax+PCIDEV.fd]
|
||||
cmp eax, pcidev_list
|
||||
jz .done_usb1
|
||||
cmp [eax+PCIDEV.class], 0x0C0300
|
||||
jz @f
|
||||
cmp [eax+PCIDEV.class], 0x0C0310
|
||||
jnz .scan_usb1
|
||||
@@:
|
||||
call usb_init_controller
|
||||
jmp .scan_usb1
|
||||
.done_usb1:
|
||||
.nothing:
|
||||
ret
|
||||
endp
|
||||
|
||||
uglobal
|
||||
align 4
|
||||
usb_event dd ?
|
||||
endg
|
||||
|
||||
; Helper function for usb_init. Creates and initializes the USB thread.
|
||||
proc create_usb_thread
|
||||
; 1. Create the thread.
|
||||
push edi
|
||||
movi ebx, 1
|
||||
mov ecx, usb_thread_proc
|
||||
xor edx, edx
|
||||
call new_sys_threads
|
||||
pop edi
|
||||
; If failed, say something to the debug board and return with ZF set.
|
||||
test eax, eax
|
||||
jns @f
|
||||
DEBUGF 1,'K : cannot create kernel thread for USB, error %d\n',eax
|
||||
.clear:
|
||||
xor eax, eax
|
||||
jmp .nothing
|
||||
@@:
|
||||
; 2. Wait while the USB thread initializes itself.
|
||||
@@:
|
||||
call change_task
|
||||
cmp [usb_event], 0
|
||||
jz @b
|
||||
; 3. If initialization failed, the USB thread sets [usb_event] to -1.
|
||||
; Return with ZF set or cleared corresponding to the result.
|
||||
cmp [usb_event], -1
|
||||
jz .clear
|
||||
.nothing:
|
||||
ret
|
||||
endp
|
||||
|
||||
; Helper function for IRQ handlers. Wakes the USB thread if ebx is nonzero.
|
||||
proc usb_wakeup_if_needed
|
||||
test ebx, ebx
|
||||
jz usb_wakeup.nothing
|
||||
usb_wakeup:
|
||||
xor edx, edx
|
||||
mov eax, [usb_event]
|
||||
mov ebx, [eax+EVENT.id]
|
||||
xor esi, esi
|
||||
call raise_event
|
||||
.nothing:
|
||||
ret
|
||||
endp
|
||||
|
||||
; Main loop of the USB thread.
|
||||
proc usb_thread_proc
|
||||
; 1. Initialize: create event to allow wakeup by interrupt handlers.
|
||||
xor esi, esi
|
||||
mov ecx, MANUAL_DESTROY
|
||||
call create_event
|
||||
test eax, eax
|
||||
jnz @f
|
||||
; If failed, set [usb_event] to -1 and terminate myself.
|
||||
dbgstr 'cannot create event for USB thread'
|
||||
or [usb_event], -1
|
||||
jmp sys_end
|
||||
@@:
|
||||
mov [usb_event], eax
|
||||
push -1 ; initial timeout: infinite
|
||||
usb_thread_wait:
|
||||
; 2. Main loop: wait for either wakeup event or timeout.
|
||||
pop ecx ; get timeout
|
||||
mov eax, [usb_event]
|
||||
mov ebx, [eax+EVENT.id]
|
||||
call wait_event_timeout
|
||||
push -1 ; default timeout: infinite
|
||||
; 3. Main loop: call worker functions of all controllers;
|
||||
; if some function schedules wakeup in timeout less than the current value,
|
||||
; replace that value with the returned timeout.
|
||||
mov esi, usb_controllers_list
|
||||
@@:
|
||||
mov esi, [esi+usb_controller.Next]
|
||||
cmp esi, usb_controllers_list
|
||||
jz .controllers_done
|
||||
mov eax, [esi+usb_controller.HardwareFunc]
|
||||
call [eax+usb_hardware_func.ProcessDeferred]
|
||||
cmp [esp], eax
|
||||
jb @b
|
||||
mov [esp], eax
|
||||
jmp @b
|
||||
.controllers_done:
|
||||
; 4. Main loop: call hub worker function for all hubs,
|
||||
; similarly calculating minimum of all returned timeouts.
|
||||
; When done, continue to 2.
|
||||
mov esi, usb_hubs_list
|
||||
@@:
|
||||
mov esi, [esi+usb_hub.Next]
|
||||
cmp esi, usb_hubs_list
|
||||
jz usb_thread_wait
|
||||
call usb_hub_process_deferred
|
||||
cmp [esp], eax
|
||||
jb @b
|
||||
mov [esp], eax
|
||||
jmp @b
|
||||
endp
|
||||
|
||||
iglobal
|
||||
align 4
|
||||
usb_controllers_list:
|
||||
dd usb_controllers_list
|
||||
dd usb_controllers_list
|
||||
usb_hubs_list:
|
||||
dd usb_hubs_list
|
||||
dd usb_hubs_list
|
||||
endg
|
||||
uglobal
|
||||
align 4
|
||||
usb_controllers_list_mutex MUTEX
|
||||
endg
|
||||
|
||||
include "memory.inc"
|
||||
include "common.inc"
|
||||
include "hccommon.inc"
|
||||
include "pipe.inc"
|
||||
include "protocol.inc"
|
||||
include "hub.inc"
|
||||
144
kernel/branches/kolibri-process/bus/usb/memory.inc
Normal file
144
kernel/branches/kolibri-process/bus/usb/memory.inc
Normal file
@@ -0,0 +1,144 @@
|
||||
; Memory management for USB structures.
|
||||
; Protocol layer uses the common kernel heap malloc/free.
|
||||
; Hardware layer has special requirements:
|
||||
; * memory blocks should be properly aligned
|
||||
; * memory blocks should not cross page boundary
|
||||
; Hardware layer allocates fixed-size blocks.
|
||||
; Thus, the specific allocator is quite easy to write:
|
||||
; allocate one page, split into blocks, maintain the single-linked
|
||||
; list of all free blocks in each page.
|
||||
|
||||
; Note: size must be a multiple of required alignment.
|
||||
|
||||
; Data for one pool: dd pointer to the first page, MUTEX lock.
|
||||
|
||||
; Allocator for fixed-size blocks: allocate a block.
|
||||
; [ebx-4] = pointer to the first page, ebx = pointer to MUTEX structure.
|
||||
proc usb_allocate_common
|
||||
push edi ; save used register to be stdcall
|
||||
virtual at esp
|
||||
dd ? ; saved edi
|
||||
dd ? ; return address
|
||||
.size dd ?
|
||||
end virtual
|
||||
; 1. Take the lock.
|
||||
mov ecx, ebx
|
||||
call mutex_lock
|
||||
; 2. Find the first allocated page with a free block, if any.
|
||||
; 2a. Initialize for the loop.
|
||||
mov edx, ebx
|
||||
.pageloop:
|
||||
; 2b. Get the next page, keeping the current in eax.
|
||||
mov eax, edx
|
||||
mov edx, [edx-4]
|
||||
; 2c. If there is no next page, we're out of luck; go to 4.
|
||||
test edx, edx
|
||||
jz .newpage
|
||||
add edx, 0x1000
|
||||
@@:
|
||||
; 2d. Get the pointer to the first free block on this page.
|
||||
; If there is no free block, continue to 2b.
|
||||
mov eax, [edx-8]
|
||||
test eax, eax
|
||||
jz .pageloop
|
||||
; 2e. Get the pointer to the next free block.
|
||||
mov ecx, [eax]
|
||||
; 2f. Update the pointer to the first free block from eax to ecx.
|
||||
; Normally [edx-8] still contains eax, if so, atomically set it to ecx
|
||||
; and proceed to 3.
|
||||
; However, the price of simplicity of usb_free_common (in particular, it
|
||||
; doesn't take the lock) is that [edx-8] could (rarely) be changed while
|
||||
; we processed steps 2d+2e. If so, return to 2d and retry.
|
||||
lock cmpxchg [edx-8], ecx
|
||||
jnz @b
|
||||
.return:
|
||||
; 3. Release the lock taken in step 1 and return.
|
||||
push eax
|
||||
mov ecx, ebx
|
||||
call mutex_unlock
|
||||
pop eax
|
||||
pop edi ; restore used register to be stdcall
|
||||
ret 4
|
||||
.newpage:
|
||||
; 4. Allocate a new page.
|
||||
push eax
|
||||
stdcall kernel_alloc, 0x1000
|
||||
pop edx
|
||||
; If failed, say something to the debug board and return zero.
|
||||
test eax, eax
|
||||
jz .nomemory
|
||||
; 5. Add the new page to the tail of list of allocated pages.
|
||||
mov [edx-4], eax
|
||||
; 6. Initialize two service dwords in the end of page:
|
||||
; first free block is (start of page) + (block size)
|
||||
; (we will return first block at (start of page), so consider it allocated),
|
||||
; no next page.
|
||||
mov edx, eax
|
||||
lea edi, [eax+0x1000-8]
|
||||
add edx, [.size]
|
||||
mov [edi], edx
|
||||
and dword [edi+4], 0
|
||||
; 7. All blocks starting from edx are free; join them in a single-linked list.
|
||||
@@:
|
||||
mov ecx, edx
|
||||
add edx, [.size]
|
||||
mov [ecx], edx
|
||||
cmp edx, edi
|
||||
jbe @b
|
||||
sub ecx, [.size]
|
||||
and dword [ecx], 0
|
||||
; 8. Return (start of page).
|
||||
jmp .return
|
||||
.nomemory:
|
||||
dbgstr 'no memory for USB descriptor'
|
||||
xor eax, eax
|
||||
jmp .return
|
||||
endp
|
||||
|
||||
; Allocator for fixed-size blocks: free a block.
|
||||
proc usb_free_common
|
||||
push ecx edx
|
||||
virtual at esp
|
||||
rd 2 ; saved registers
|
||||
dd ? ; return address
|
||||
.block dd ?
|
||||
end virtual
|
||||
; Insert the given block to the head of free blocks in this page.
|
||||
mov ecx, [.block]
|
||||
mov edx, ecx
|
||||
or edx, 0xFFF
|
||||
@@:
|
||||
mov eax, [edx+1-8]
|
||||
mov [ecx], eax
|
||||
lock cmpxchg [edx+1-8], ecx
|
||||
jnz @b
|
||||
pop edx ecx
|
||||
ret 4
|
||||
endp
|
||||
|
||||
; Helper procedure: translate physical address in ecx
|
||||
; of some transfer descriptor to linear address.
|
||||
; in: eax = address of first page
|
||||
proc usb_td_to_virt
|
||||
; Traverse all pages used for transfer descriptors, looking for the one
|
||||
; with physical address as in ecx.
|
||||
@@:
|
||||
test eax, eax
|
||||
jz .zero
|
||||
push eax
|
||||
call get_pg_addr
|
||||
sub eax, ecx
|
||||
jz .found
|
||||
cmp eax, -0x1000
|
||||
ja .found
|
||||
pop eax
|
||||
mov eax, [eax+0x1000-4]
|
||||
jmp @b
|
||||
.found:
|
||||
; When found, combine page address from eax with page offset from ecx.
|
||||
pop eax
|
||||
and ecx, 0xFFF
|
||||
add eax, ecx
|
||||
.zero:
|
||||
ret
|
||||
endp
|
||||
675
kernel/branches/kolibri-process/bus/usb/pipe.inc
Normal file
675
kernel/branches/kolibri-process/bus/usb/pipe.inc
Normal file
@@ -0,0 +1,675 @@
|
||||
; Functions for USB pipe manipulation: opening/closing, sending data etc.
|
||||
;
|
||||
USB_STDCALL_VERIFY = 1
|
||||
macro stdcall_verify [arg]
|
||||
{
|
||||
common
|
||||
if USB_STDCALL_VERIFY
|
||||
pushad
|
||||
stdcall arg
|
||||
call verify_regs
|
||||
popad
|
||||
else
|
||||
stdcall arg
|
||||
end if
|
||||
}
|
||||
|
||||
; Initialization of usb_static_ep structure,
|
||||
; called from controller-specific initialization; edi -> usb_static_ep
|
||||
proc usb_init_static_endpoint
|
||||
mov [edi+usb_static_ep.NextVirt], edi
|
||||
mov [edi+usb_static_ep.PrevVirt], edi
|
||||
ret
|
||||
endp
|
||||
|
||||
; Part of API for drivers, see documentation for USBOpenPipe.
|
||||
proc usb_open_pipe stdcall uses ebx esi edi,\
|
||||
config_pipe:dword, endpoint:dword, maxpacket:dword, type:dword, interval:dword
|
||||
locals
|
||||
tt_vars rd 24 ; should be enough for ehci_select_tt_interrupt_list
|
||||
targetsmask dd ? ; S-Mask for USB2
|
||||
bandwidth dd ?
|
||||
target dd ?
|
||||
endl
|
||||
; 1. Verify type of pipe: it must be one of *_PIPE constants.
|
||||
; Isochronous pipes are not supported yet.
|
||||
mov eax, [type]
|
||||
cmp eax, INTERRUPT_PIPE
|
||||
ja .badtype
|
||||
cmp al, ISOCHRONOUS_PIPE
|
||||
jnz .goodtype
|
||||
.badtype:
|
||||
dbgstr 'unsupported type of USB pipe'
|
||||
jmp .return0
|
||||
.goodtype:
|
||||
; 2. Allocate memory for pipe and transfer queue.
|
||||
; Empty transfer queue consists of one inactive TD.
|
||||
mov ebx, [config_pipe]
|
||||
mov esi, [ebx+usb_pipe.Controller]
|
||||
mov edx, [esi+usb_controller.HardwareFunc]
|
||||
call [edx+usb_hardware_func.AllocPipe]
|
||||
test eax, eax
|
||||
jz .nothing
|
||||
mov edi, eax
|
||||
mov edx, [esi+usb_controller.HardwareFunc]
|
||||
call [edx+usb_hardware_func.AllocTD]
|
||||
test eax, eax
|
||||
jz .free_and_return0
|
||||
; 3. Initialize transfer queue: pointer to transfer descriptor,
|
||||
; pointers in transfer descriptor, queue lock.
|
||||
mov [edi+usb_pipe.LastTD], eax
|
||||
mov [eax+usb_gtd.NextVirt], eax
|
||||
mov [eax+usb_gtd.PrevVirt], eax
|
||||
mov [eax+usb_gtd.Pipe], edi
|
||||
lea ecx, [edi+usb_pipe.Lock]
|
||||
call mutex_init
|
||||
; 4. Initialize software part of pipe structure, except device-related fields.
|
||||
mov al, byte [type]
|
||||
mov [edi+usb_pipe.Type], al
|
||||
xor eax, eax
|
||||
mov [edi+usb_pipe.Flags], al
|
||||
mov [edi+usb_pipe.DeviceData], eax
|
||||
mov [edi+usb_pipe.Controller], esi
|
||||
or [edi+usb_pipe.NextWait], -1
|
||||
; 5. Initialize device-related fields:
|
||||
; for zero endpoint, set .NextSibling = .PrevSibling = this;
|
||||
; for other endpoins, copy device data, take the lock guarding pipe list
|
||||
; for the device and verify that disconnect processing has not yet started
|
||||
; for the device. (Since disconnect processing also takes that lock,
|
||||
; either it has completed or it will not start until we release the lock.)
|
||||
; Note: usb_device_disconnected should not see the new pipe until
|
||||
; initialization is complete, so that lock will be held during next steps
|
||||
; (disconnect processing should either not see it at all, or see fully
|
||||
; initialized pipe).
|
||||
cmp [endpoint], eax
|
||||
jz .zero_endpoint
|
||||
mov ecx, [ebx+usb_pipe.DeviceData]
|
||||
mov [edi+usb_pipe.DeviceData], ecx
|
||||
call mutex_lock
|
||||
test [ebx+usb_pipe.Flags], USB_FLAG_CLOSED
|
||||
jz .common
|
||||
.fail:
|
||||
; If disconnect processing has completed, unlock the mutex, free memory
|
||||
; allocated in step 2 and return zero.
|
||||
call mutex_unlock
|
||||
mov edx, [esi+usb_controller.HardwareFunc]
|
||||
stdcall [edx+usb_hardware_func.FreeTD], [edi+usb_pipe.LastTD]
|
||||
.free_and_return0:
|
||||
mov edx, [esi+usb_controller.HardwareFunc]
|
||||
stdcall [edx+usb_hardware_func.FreePipe], edi
|
||||
.return0:
|
||||
xor eax, eax
|
||||
jmp .nothing
|
||||
.zero_endpoint:
|
||||
mov [edi+usb_pipe.NextSibling], edi
|
||||
mov [edi+usb_pipe.PrevSibling], edi
|
||||
.common:
|
||||
; 6. Initialize hardware part of pipe structure.
|
||||
; 6a. Acquire the corresponding mutex.
|
||||
lea ecx, [esi+usb_controller.ControlLock]
|
||||
cmp [type], BULK_PIPE
|
||||
jb @f ; control pipe
|
||||
lea ecx, [esi+usb_controller.BulkLock]
|
||||
jz @f ; bulk pipe
|
||||
lea ecx, [esi+usb_controller.PeriodicLock]
|
||||
@@:
|
||||
call mutex_lock
|
||||
; 6b. Let the controller-specific code do its job.
|
||||
push ecx
|
||||
mov edx, [esi+usb_controller.HardwareFunc]
|
||||
mov eax, [edi+usb_pipe.LastTD]
|
||||
mov ecx, [config_pipe]
|
||||
call [edx+usb_hardware_func.InitPipe]
|
||||
pop ecx
|
||||
; 6c. Release the mutex.
|
||||
push eax
|
||||
call mutex_unlock
|
||||
pop eax
|
||||
; 6d. If controller-specific code indicates failure,
|
||||
; release the lock taken in step 5, free memory allocated in step 2
|
||||
; and return zero.
|
||||
test eax, eax
|
||||
jz .fail
|
||||
; 7. The pipe is initialized. If this is not the first pipe for the device,
|
||||
; insert it to the tail of pipe list for the device,
|
||||
; increment number of pipes,
|
||||
; release the lock taken at step 5.
|
||||
mov ecx, [edi+usb_pipe.DeviceData]
|
||||
test ecx, ecx
|
||||
jz @f
|
||||
mov eax, [ebx+usb_pipe.PrevSibling]
|
||||
mov [edi+usb_pipe.NextSibling], ebx
|
||||
mov [edi+usb_pipe.PrevSibling], eax
|
||||
mov [ebx+usb_pipe.PrevSibling], edi
|
||||
mov [eax+usb_pipe.NextSibling], edi
|
||||
inc [ecx+usb_device_data.NumPipes]
|
||||
call mutex_unlock
|
||||
@@:
|
||||
; 8. Return pointer to usb_pipe.
|
||||
mov eax, edi
|
||||
.nothing:
|
||||
ret
|
||||
endp
|
||||
|
||||
; This procedure is called several times during initial device configuration,
|
||||
; when usb_device_data structure is reallocated.
|
||||
; It (re)initializes all pointers in usb_device_data.
|
||||
; ebx -> usb_pipe
|
||||
proc usb_reinit_pipe_list
|
||||
push eax
|
||||
; 1. (Re)initialize the lock guarding pipe list.
|
||||
mov ecx, [ebx+usb_pipe.DeviceData]
|
||||
call mutex_init
|
||||
; 2. Initialize list of opened pipes: two entries, the head and ebx.
|
||||
add ecx, usb_device_data.OpenedPipeList - usb_pipe.NextSibling
|
||||
mov [ecx+usb_pipe.NextSibling], ebx
|
||||
mov [ecx+usb_pipe.PrevSibling], ebx
|
||||
mov [ebx+usb_pipe.NextSibling], ecx
|
||||
mov [ebx+usb_pipe.PrevSibling], ecx
|
||||
; 3. Initialize list of closed pipes: empty list, only the head is present.
|
||||
add ecx, usb_device_data.ClosedPipeList - usb_device_data.OpenedPipeList
|
||||
mov [ecx+usb_pipe.NextSibling], ecx
|
||||
mov [ecx+usb_pipe.PrevSibling], ecx
|
||||
pop eax
|
||||
ret
|
||||
endp
|
||||
|
||||
; Part of API for drivers, see documentation for USBClosePipe.
|
||||
proc usb_close_pipe
|
||||
push ebx esi ; save used registers to be stdcall
|
||||
virtual at esp
|
||||
rd 2 ; saved registers
|
||||
dd ? ; return address
|
||||
.pipe dd ?
|
||||
end virtual
|
||||
; 1. Lock the pipe list for the device.
|
||||
mov ebx, [.pipe]
|
||||
mov esi, [ebx+usb_pipe.Controller]
|
||||
mov ecx, [ebx+usb_pipe.DeviceData]
|
||||
call mutex_lock
|
||||
; 2. Set the flag "the driver has abandoned this pipe, free it at any time".
|
||||
lea ecx, [ebx+usb_pipe.Lock]
|
||||
call mutex_lock
|
||||
or [ebx+usb_pipe.Flags], USB_FLAG_CAN_FREE
|
||||
call mutex_unlock
|
||||
; 3. Call the worker function.
|
||||
call usb_close_pipe_nolock
|
||||
; 4. Unlock the pipe list for the device.
|
||||
mov ecx, [ebx+usb_pipe.DeviceData]
|
||||
call mutex_unlock
|
||||
; 5. Wakeup the USB thread so that it can proceed with releasing that pipe.
|
||||
push edi
|
||||
call usb_wakeup
|
||||
pop edi
|
||||
; 6. Return.
|
||||
pop esi ebx ; restore used registers to be stdcall
|
||||
retn 4
|
||||
endp
|
||||
|
||||
; Worker function for pipe closing. Called by usb_close_pipe API and
|
||||
; from disconnect processing.
|
||||
; The lock guarding pipe list for the device should be held by the caller.
|
||||
; ebx -> usb_pipe, esi -> usb_controller
|
||||
proc usb_close_pipe_nolock
|
||||
; 1. Set the flag "pipe is closed, ignore new transfers".
|
||||
; If it was already set, do nothing.
|
||||
lea ecx, [ebx+usb_pipe.Lock]
|
||||
call mutex_lock
|
||||
bts dword [ebx+usb_pipe.Flags], USB_FLAG_CLOSED_BIT
|
||||
jc .closed
|
||||
call mutex_unlock
|
||||
; 2. Remove the pipe from the list of opened pipes.
|
||||
mov eax, [ebx+usb_pipe.NextSibling]
|
||||
mov edx, [ebx+usb_pipe.PrevSibling]
|
||||
mov [eax+usb_pipe.PrevSibling], edx
|
||||
mov [edx+usb_pipe.NextSibling], eax
|
||||
; 3. Unlink the pipe from hardware structures.
|
||||
; 3a. Acquire the corresponding lock.
|
||||
lea edx, [esi+usb_controller.WaitPipeListAsync]
|
||||
lea ecx, [esi+usb_controller.ControlLock]
|
||||
cmp [ebx+usb_pipe.Type], BULK_PIPE
|
||||
jb @f ; control pipe
|
||||
lea ecx, [esi+usb_controller.BulkLock]
|
||||
jz @f ; bulk pipe
|
||||
add edx, usb_controller.WaitPipeListPeriodic - usb_controller.WaitPipeListAsync
|
||||
lea ecx, [esi+usb_controller.PeriodicLock]
|
||||
@@:
|
||||
push edx
|
||||
call mutex_lock
|
||||
push ecx
|
||||
; 3b. Let the controller-specific code do its job.
|
||||
mov eax, [esi+usb_controller.HardwareFunc]
|
||||
call [eax+usb_hardware_func.UnlinkPipe]
|
||||
; 3c. Release the corresponding lock.
|
||||
pop ecx
|
||||
call mutex_unlock
|
||||
; 4. Put the pipe into wait queue.
|
||||
pop edx
|
||||
cmp [ebx+usb_pipe.NextWait], -1
|
||||
jz .insert_new
|
||||
or [ebx+usb_pipe.Flags], USB_FLAG_EXTRA_WAIT
|
||||
jmp .inserted
|
||||
.insert_new:
|
||||
mov eax, [edx]
|
||||
mov [ebx+usb_pipe.NextWait], eax
|
||||
mov [edx], ebx
|
||||
.inserted:
|
||||
; 5. Return.
|
||||
ret
|
||||
.closed:
|
||||
call mutex_unlock
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
; This procedure is called when a pipe with USB_FLAG_CLOSED is removed from the
|
||||
; corresponding wait list. It means that the hardware has fully forgot about it.
|
||||
; ebx -> usb_pipe, esi -> usb_controller
|
||||
proc usb_pipe_closed
|
||||
push edi
|
||||
mov edi, [esi+usb_controller.HardwareFunc]
|
||||
; 1. Loop over all transfers, calling the driver with USB_STATUS_CLOSED
|
||||
; and freeing all descriptors.
|
||||
mov edx, [ebx+usb_pipe.LastTD]
|
||||
test edx, edx
|
||||
jz .no_transfer
|
||||
mov edx, [edx+usb_gtd.NextVirt]
|
||||
.transfer_loop:
|
||||
cmp edx, [ebx+usb_pipe.LastTD]
|
||||
jz .transfer_done
|
||||
mov ecx, [edx+usb_gtd.Callback]
|
||||
test ecx, ecx
|
||||
jz .no_callback
|
||||
push edx
|
||||
stdcall_verify ecx, ebx, USB_STATUS_CLOSED, \
|
||||
[edx+usb_gtd.Buffer], 0, [edx+usb_gtd.UserData]
|
||||
pop edx
|
||||
.no_callback:
|
||||
push [edx+usb_gtd.NextVirt]
|
||||
stdcall [edi+usb_hardware_func.FreeTD], edx
|
||||
pop edx
|
||||
jmp .transfer_loop
|
||||
.transfer_done:
|
||||
stdcall [edi+usb_hardware_func.FreeTD], edx
|
||||
.no_transfer:
|
||||
; 2. Decrement number of pipes for the device.
|
||||
; If this pipe is the last pipe, go to 5.
|
||||
mov ecx, [ebx+usb_pipe.DeviceData]
|
||||
call mutex_lock
|
||||
dec [ecx+usb_device_data.NumPipes]
|
||||
jz .last_pipe
|
||||
call mutex_unlock
|
||||
; 3. If the flag "the driver has abandoned this pipe" is set,
|
||||
; free memory and return.
|
||||
test [ebx+usb_pipe.Flags], USB_FLAG_CAN_FREE
|
||||
jz .nofree
|
||||
stdcall [edi+usb_hardware_func.FreePipe], ebx
|
||||
pop edi
|
||||
ret
|
||||
; 4. Otherwise, add it to the list of closed pipes and return.
|
||||
.nofree:
|
||||
add ecx, usb_device_data.ClosedPipeList - usb_pipe.NextSibling
|
||||
mov edx, [ecx+usb_pipe.PrevSibling]
|
||||
mov [ebx+usb_pipe.NextSibling], ecx
|
||||
mov [ebx+usb_pipe.PrevSibling], edx
|
||||
mov [ecx+usb_pipe.PrevSibling], ebx
|
||||
mov [edx+usb_pipe.NextSibling], ebx
|
||||
pop edi
|
||||
ret
|
||||
.last_pipe:
|
||||
; That was the last pipe for the device.
|
||||
; 5. Notify device driver(s) about disconnect.
|
||||
call mutex_unlock
|
||||
mov eax, [ecx+usb_device_data.NumInterfaces]
|
||||
test eax, eax
|
||||
jz .notify_done
|
||||
add ecx, [ecx+usb_device_data.Interfaces]
|
||||
.notify_loop:
|
||||
mov edx, [ecx+usb_interface_data.DriverFunc]
|
||||
test edx, edx
|
||||
jz @f
|
||||
mov edx, [edx+USBSRV.usb_func]
|
||||
cmp [edx+USBFUNC.strucsize], USBFUNC.device_disconnect + 4
|
||||
jb @f
|
||||
mov edx, [edx+USBFUNC.device_disconnect]
|
||||
test edx, edx
|
||||
jz @f
|
||||
push eax ecx
|
||||
stdcall_verify edx, [ecx+usb_interface_data.DriverData]
|
||||
pop ecx eax
|
||||
@@:
|
||||
add ecx, sizeof.usb_interface_data
|
||||
dec eax
|
||||
jnz .notify_loop
|
||||
.notify_done:
|
||||
; 6. Bus address, if assigned, can now be reused.
|
||||
call [edi+usb_hardware_func.GetDeviceAddress]
|
||||
test eax, eax
|
||||
jz @f
|
||||
bts [esi+usb_controller.ExistingAddresses], eax
|
||||
@@:
|
||||
dbgstr 'USB device disconnected'
|
||||
; 7. All drivers have returned from disconnect callback,
|
||||
; so all drivers should not use any device-related pipes.
|
||||
; Free the remaining pipes.
|
||||
mov eax, [ebx+usb_pipe.DeviceData]
|
||||
add eax, usb_device_data.ClosedPipeList - usb_pipe.NextSibling
|
||||
push eax
|
||||
mov eax, [eax+usb_pipe.NextSibling]
|
||||
.free_loop:
|
||||
cmp eax, [esp]
|
||||
jz .free_done
|
||||
push [eax+usb_pipe.NextSibling]
|
||||
stdcall [edi+usb_hardware_func.FreePipe], eax
|
||||
pop eax
|
||||
jmp .free_loop
|
||||
.free_done:
|
||||
stdcall [edi+usb_hardware_func.FreePipe], ebx
|
||||
pop eax
|
||||
; 8. Free the usb_device_data structure.
|
||||
sub eax, usb_device_data.ClosedPipeList - usb_pipe.NextSibling
|
||||
call free
|
||||
; 9. Return.
|
||||
.nothing:
|
||||
pop edi
|
||||
ret
|
||||
endp
|
||||
|
||||
; Part of API for drivers, see documentation for USBNormalTransferAsync.
|
||||
proc usb_normal_transfer_async stdcall uses ebx edi,\
|
||||
pipe:dword, buffer:dword, size:dword, callback:dword, calldata:dword, flags:dword
|
||||
; 1. Sanity check: callback must be nonzero.
|
||||
; (It is important for other parts of code.)
|
||||
xor eax, eax
|
||||
cmp [callback], eax
|
||||
jz .nothing
|
||||
; 2. Lock the transfer queue.
|
||||
mov ebx, [pipe]
|
||||
lea ecx, [ebx+usb_pipe.Lock]
|
||||
call mutex_lock
|
||||
; 3. If the pipe has already been closed (presumably due to device disconnect),
|
||||
; release the lock taken in step 2 and return zero.
|
||||
xor eax, eax
|
||||
test [ebx+usb_pipe.Flags], USB_FLAG_CLOSED
|
||||
jnz .unlock
|
||||
; 4. Allocate and initialize TDs for the transfer.
|
||||
mov edx, [ebx+usb_pipe.Controller]
|
||||
mov edi, [edx+usb_controller.HardwareFunc]
|
||||
stdcall [edi+usb_hardware_func.AllocTransfer], [buffer], [size], [flags], [ebx+usb_pipe.LastTD], 0
|
||||
; If failed, release the lock taken in step 2 and return zero.
|
||||
test eax, eax
|
||||
jz .unlock
|
||||
; 5. Store callback and its parameters in the last descriptor for this transfer.
|
||||
mov ecx, [eax+usb_gtd.PrevVirt]
|
||||
mov edx, [callback]
|
||||
mov [ecx+usb_gtd.Callback], edx
|
||||
mov edx, [calldata]
|
||||
mov [ecx+usb_gtd.UserData], edx
|
||||
mov edx, [buffer]
|
||||
mov [ecx+usb_gtd.Buffer], edx
|
||||
; 6. Advance LastTD pointer and activate transfer.
|
||||
push [ebx+usb_pipe.LastTD]
|
||||
mov [ebx+usb_pipe.LastTD], eax
|
||||
call [edi+usb_hardware_func.InsertTransfer]
|
||||
pop eax
|
||||
; 7. Release the lock taken in step 2 and
|
||||
; return pointer to the first descriptor for the new transfer.
|
||||
.unlock:
|
||||
push eax
|
||||
lea ecx, [ebx+usb_pipe.Lock]
|
||||
call mutex_unlock
|
||||
pop eax
|
||||
.nothing:
|
||||
ret
|
||||
endp
|
||||
|
||||
; Part of API for drivers, see documentation for USBControlTransferAsync.
|
||||
proc usb_control_async stdcall uses ebx edi,\
|
||||
pipe:dword, config:dword, buffer:dword, size:dword, callback:dword, calldata:dword, flags:dword
|
||||
locals
|
||||
last_td dd ?
|
||||
endl
|
||||
; 1. Sanity check: callback must be nonzero.
|
||||
; (It is important for other parts of code.)
|
||||
cmp [callback], 0
|
||||
jz .return0
|
||||
; 2. Lock the transfer queue.
|
||||
mov ebx, [pipe]
|
||||
lea ecx, [ebx+usb_pipe.Lock]
|
||||
call mutex_lock
|
||||
; 3. If the pipe has already been closed (presumably due to device disconnect),
|
||||
; release the lock taken in step 2 and return zero.
|
||||
test [ebx+usb_pipe.Flags], USB_FLAG_CLOSED
|
||||
jnz .unlock_return0
|
||||
; A control transfer contains two or three stages:
|
||||
; Setup stage, optional Data stage, Status stage.
|
||||
; 4. Allocate and initialize TDs for the Setup stage.
|
||||
; Payload is 8 bytes from [config].
|
||||
mov edx, [ebx+usb_pipe.Controller]
|
||||
mov edi, [edx+usb_controller.HardwareFunc]
|
||||
stdcall [edi+usb_hardware_func.AllocTransfer], [config], 8, 0, [ebx+usb_pipe.LastTD], (2 shl 2) + 0
|
||||
; short transfer is an error, direction is DATA0, token is SETUP
|
||||
mov [last_td], eax
|
||||
test eax, eax
|
||||
jz .fail
|
||||
; 5. Allocate and initialize TDs for the Data stage, if [size] is nonzero.
|
||||
; Payload is [size] bytes from [buffer].
|
||||
mov edx, [config]
|
||||
mov ecx, (3 shl 2) + 1 ; DATA1, token is OUT
|
||||
cmp byte [edx], 0
|
||||
jns @f
|
||||
cmp [size], 0
|
||||
jz @f
|
||||
inc ecx ; token is IN
|
||||
@@:
|
||||
cmp [size], 0
|
||||
jz .nodata
|
||||
push ecx
|
||||
stdcall [edi+usb_hardware_func.AllocTransfer], [buffer], [size], [flags], eax, ecx
|
||||
pop ecx
|
||||
test eax, eax
|
||||
jz .fail
|
||||
mov [last_td], eax
|
||||
.nodata:
|
||||
; 6. Allocate and initialize TDs for the Status stage.
|
||||
; No payload.
|
||||
xor ecx, 3 ; IN becomes OUT, OUT becomes IN
|
||||
stdcall [edi+usb_hardware_func.AllocTransfer], 0, 0, 0, eax, ecx
|
||||
test eax, eax
|
||||
jz .fail
|
||||
; 7. Store callback and its parameters in the last descriptor for this transfer.
|
||||
mov ecx, [eax+usb_gtd.PrevVirt]
|
||||
mov edx, [callback]
|
||||
mov [ecx+usb_gtd.Callback], edx
|
||||
mov edx, [calldata]
|
||||
mov [ecx+usb_gtd.UserData], edx
|
||||
mov edx, [buffer]
|
||||
mov [ecx+usb_gtd.Buffer], edx
|
||||
; 8. Advance LastTD pointer and activate transfer.
|
||||
push [ebx+usb_pipe.LastTD]
|
||||
mov [ebx+usb_pipe.LastTD], eax
|
||||
call [edi+usb_hardware_func.InsertTransfer]
|
||||
; 9. Release the lock taken in step 2 and
|
||||
; return pointer to the first descriptor for the new transfer.
|
||||
lea ecx, [ebx+usb_pipe.Lock]
|
||||
call mutex_unlock
|
||||
pop eax
|
||||
ret
|
||||
.fail:
|
||||
mov eax, [last_td]
|
||||
test eax, eax
|
||||
jz .unlock_return0
|
||||
stdcall usb_undo_tds, [ebx+usb_pipe.LastTD]
|
||||
.unlock_return0:
|
||||
lea ecx, [ebx+usb_pipe.Lock]
|
||||
call mutex_unlock
|
||||
.return0:
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
; Part of API for drivers, see documentation for USBGetParam.
|
||||
proc usb_get_param
|
||||
virtual at esp
|
||||
dd ? ; return address
|
||||
.pipe dd ?
|
||||
.param dd ?
|
||||
end virtual
|
||||
mov edx, [.param]
|
||||
mov ecx, [.pipe]
|
||||
mov eax, [ecx+usb_pipe.DeviceData]
|
||||
test edx, edx
|
||||
jz .get_device_descriptor
|
||||
dec edx
|
||||
jz .get_config_descriptor
|
||||
dec edx
|
||||
jz .get_speed
|
||||
or eax, -1
|
||||
ret 8
|
||||
.get_device_descriptor:
|
||||
add eax, usb_device_data.DeviceDescriptor
|
||||
ret 8
|
||||
.get_config_descriptor:
|
||||
movzx ecx, [eax+usb_device_data.DeviceDescrSize]
|
||||
lea eax, [eax+ecx+usb_device_data.DeviceDescriptor]
|
||||
ret 8
|
||||
.get_speed:
|
||||
movzx eax, [eax+usb_device_data.Speed]
|
||||
ret 8
|
||||
endp
|
||||
|
||||
; Initialize software part of usb_gtd. Called from controller-specific code
|
||||
; somewhere in AllocTransfer with eax -> next (inactive) usb_gtd,
|
||||
; ebx -> usb_pipe, ebp frame from call to AllocTransfer with [.td] ->
|
||||
; current (initializing) usb_gtd.
|
||||
; Returns ecx = [.td].
|
||||
proc usb_init_transfer
|
||||
virtual at ebp-4
|
||||
.Size dd ?
|
||||
rd 2
|
||||
.Buffer dd ?
|
||||
dd ?
|
||||
.Flags dd ?
|
||||
.td dd ?
|
||||
end virtual
|
||||
mov [eax+usb_gtd.Pipe], ebx
|
||||
mov ecx, [.td]
|
||||
mov [eax+usb_gtd.PrevVirt], ecx
|
||||
mov edx, [ecx+usb_gtd.NextVirt]
|
||||
mov [ecx+usb_gtd.NextVirt], eax
|
||||
mov [eax+usb_gtd.NextVirt], edx
|
||||
mov [edx+usb_gtd.PrevVirt], eax
|
||||
mov edx, [.Size]
|
||||
mov [ecx+usb_gtd.Length], edx
|
||||
xor edx, edx
|
||||
mov [ecx+usb_gtd.Callback], edx
|
||||
mov [ecx+usb_gtd.UserData], edx
|
||||
ret
|
||||
endp
|
||||
|
||||
; Free all TDs for the current transfer if something has failed
|
||||
; during initialization (e.g. no memory for the next TD).
|
||||
; Stdcall with one stack argument = first TD for the transfer
|
||||
; and eax = last initialized TD for the transfer.
|
||||
proc usb_undo_tds
|
||||
push [eax+usb_gtd.NextVirt]
|
||||
@@:
|
||||
cmp eax, [esp+8]
|
||||
jz @f
|
||||
push [eax+usb_gtd.PrevVirt]
|
||||
stdcall [edi+usb_hardware_func.FreeTD], eax
|
||||
pop eax
|
||||
jmp @b
|
||||
@@:
|
||||
pop ecx
|
||||
mov [eax+usb_gtd.NextVirt], ecx
|
||||
mov [ecx+usb_gtd.PrevVirt], eax
|
||||
ret 4
|
||||
endp
|
||||
|
||||
; Helper procedure for handling short packets in controller-specific code.
|
||||
; Returns with CF cleared if this is the final packet in some stage:
|
||||
; for control transfers that means one of Data and Status stages,
|
||||
; for other transfers - the final packet in the only stage.
|
||||
proc usb_is_final_packet
|
||||
cmp [ebx+usb_gtd.Callback], 0
|
||||
jnz .nothing
|
||||
mov eax, [ebx+usb_gtd.NextVirt]
|
||||
cmp [eax+usb_gtd.Callback], 0
|
||||
jz .stc
|
||||
mov eax, [ebx+usb_gtd.Pipe]
|
||||
cmp [eax+usb_pipe.Type], CONTROL_PIPE
|
||||
jz .nothing
|
||||
.stc:
|
||||
stc
|
||||
.nothing:
|
||||
ret
|
||||
endp
|
||||
|
||||
; Helper procedure for controller-specific code:
|
||||
; removes one TD from the transfer queue, ebx -> usb_gtd to remove.
|
||||
proc usb_unlink_td
|
||||
mov ecx, [ebx+usb_gtd.Pipe]
|
||||
add ecx, usb_pipe.Lock
|
||||
call mutex_lock
|
||||
mov eax, [ebx+usb_gtd.PrevVirt]
|
||||
mov edx, [ebx+usb_gtd.NextVirt]
|
||||
mov [edx+usb_gtd.PrevVirt], eax
|
||||
mov [eax+usb_gtd.NextVirt], edx
|
||||
call mutex_unlock
|
||||
ret
|
||||
endp
|
||||
|
||||
; One part of transfer is completed, run the associated callback
|
||||
; or update total length in the next part of transfer.
|
||||
; in: ebx -> usb_gtd, ecx = status, edx = length
|
||||
proc usb_process_gtd
|
||||
; 1. Test whether it is the last descriptor in the transfer
|
||||
; <=> it has an associated callback.
|
||||
mov eax, [ebx+usb_gtd.Callback]
|
||||
test eax, eax
|
||||
jz .nocallback
|
||||
; 2. It has an associated callback; call it with corresponding parameters.
|
||||
stdcall_verify eax, [ebx+usb_gtd.Pipe], ecx, \
|
||||
[ebx+usb_gtd.Buffer], edx, [ebx+usb_gtd.UserData]
|
||||
ret
|
||||
.nocallback:
|
||||
; 3. It is an intermediate descriptor. Add its length to the length
|
||||
; in the following descriptor.
|
||||
mov eax, [ebx+usb_gtd.NextVirt]
|
||||
add [eax+usb_gtd.Length], edx
|
||||
ret
|
||||
endp
|
||||
|
||||
if USB_STDCALL_VERIFY
|
||||
proc verify_regs
|
||||
virtual at esp
|
||||
dd ? ; return address
|
||||
.edi dd ?
|
||||
.esi dd ?
|
||||
.ebp dd ?
|
||||
.esp dd ?
|
||||
.ebx dd ?
|
||||
.edx dd ?
|
||||
.ecx dd ?
|
||||
.eax dd ?
|
||||
end virtual
|
||||
cmp ebx, [.ebx]
|
||||
jz @f
|
||||
dbgstr 'ERROR!!! ebx changed'
|
||||
@@:
|
||||
cmp esi, [.esi]
|
||||
jz @f
|
||||
dbgstr 'ERROR!!! esi changed'
|
||||
@@:
|
||||
cmp edi, [.edi]
|
||||
jz @f
|
||||
dbgstr 'ERROR!!! edi changed'
|
||||
@@:
|
||||
cmp ebp, [.ebp]
|
||||
jz @f
|
||||
dbgstr 'ERROR!!! ebp changed'
|
||||
@@:
|
||||
ret
|
||||
endp
|
||||
end if
|
||||
935
kernel/branches/kolibri-process/bus/usb/protocol.inc
Normal file
935
kernel/branches/kolibri-process/bus/usb/protocol.inc
Normal file
@@ -0,0 +1,935 @@
|
||||
; Implementation of the USB protocol for device enumeration.
|
||||
; Manage a USB device when it becomes ready for USB commands:
|
||||
; configure, enumerate, load the corresponding driver(s),
|
||||
; pass device information to the driver.
|
||||
|
||||
; =============================================================================
|
||||
; ================================= Constants =================================
|
||||
; =============================================================================
|
||||
; USB standard request codes
|
||||
USB_GET_STATUS = 0
|
||||
USB_CLEAR_FEATURE = 1
|
||||
USB_SET_FEATURE = 3
|
||||
USB_SET_ADDRESS = 5
|
||||
USB_GET_DESCRIPTOR = 6
|
||||
USB_SET_DESCRIPTOR = 7
|
||||
USB_GET_CONFIGURATION = 8
|
||||
USB_SET_CONFIGURATION = 9
|
||||
USB_GET_INTERFACE = 10
|
||||
USB_SET_INTERFACE = 11
|
||||
USB_SYNCH_FRAME = 12
|
||||
|
||||
; USB standard descriptor types
|
||||
USB_DEVICE_DESCR = 1
|
||||
USB_CONFIG_DESCR = 2
|
||||
USB_STRING_DESCR = 3
|
||||
USB_INTERFACE_DESCR = 4
|
||||
USB_ENDPOINT_DESCR = 5
|
||||
USB_DEVICE_QUALIFIER_DESCR = 6
|
||||
USB_OTHER_SPEED_CONFIG_DESCR = 7
|
||||
USB_INTERFACE_POWER_DESCR = 8
|
||||
|
||||
; Compile-time setting. If set, the code will dump all descriptors as they are
|
||||
; read to the debug board.
|
||||
USB_DUMP_DESCRIPTORS = 1
|
||||
|
||||
; =============================================================================
|
||||
; ================================ Structures =================================
|
||||
; =============================================================================
|
||||
; USB descriptors. See USB specification for detailed explanations.
|
||||
; First two bytes of every descriptor have the same meaning.
|
||||
struct usb_descr
|
||||
bLength db ?
|
||||
; Size of this descriptor in bytes
|
||||
bDescriptorType db ?
|
||||
; One of USB_*_DESCR constants.
|
||||
ends
|
||||
|
||||
; USB device descriptor
|
||||
struct usb_device_descr usb_descr
|
||||
bcdUSB dw ?
|
||||
; USB Specification Release number in BCD, e.g. 110h = USB 1.1
|
||||
bDeviceClass db ?
|
||||
; USB Device Class Code
|
||||
bDeviceSubClass db ?
|
||||
; USB Device Subclass Code
|
||||
bDeviceProtocol db ?
|
||||
; USB Device Protocol Code
|
||||
bMaxPacketSize0 db ?
|
||||
; Maximum packet size for zero endpoint
|
||||
idVendor dw ?
|
||||
; Vendor ID
|
||||
idProduct dw ?
|
||||
; Product ID
|
||||
bcdDevice dw ?
|
||||
; Device release number in BCD
|
||||
iManufacturer db ?
|
||||
; Index of string descriptor describing manufacturer
|
||||
iProduct db ?
|
||||
; Index of string descriptor describing product
|
||||
iSerialNumber db ?
|
||||
; Index of string descriptor describing serial number
|
||||
bNumConfigurations db ?
|
||||
; Number of possible configurations
|
||||
ends
|
||||
|
||||
; USB configuration descriptor
|
||||
struct usb_config_descr usb_descr
|
||||
wTotalLength dw ?
|
||||
; Total length of data returned for this configuration
|
||||
bNumInterfaces db ?
|
||||
; Number of interfaces in this configuration
|
||||
bConfigurationValue db ?
|
||||
; Value for SET_CONFIGURATION control request
|
||||
iConfiguration db ?
|
||||
; Index of string descriptor describing this configuration
|
||||
bmAttributes db ?
|
||||
; Bit 6 is SelfPowered, bit 5 is RemoteWakeupSupported,
|
||||
; bit 7 must be 1, other bits must be 0
|
||||
bMaxPower db ?
|
||||
; Maximum power consumption from the bus in 2mA units
|
||||
ends
|
||||
|
||||
; USB interface descriptor
|
||||
struct usb_interface_descr usb_descr
|
||||
; The following two fields work in pair. Sometimes one interface can work
|
||||
; in different modes; e.g. videostream from web-cameras requires different
|
||||
; bandwidth depending on resolution/quality/compression settings.
|
||||
; Each mode of each interface has its own descriptor with its own endpoints
|
||||
; following; all descriptors for one interface have the same bInterfaceNumber,
|
||||
; and different bAlternateSetting.
|
||||
; By default, any interface operates in mode with bAlternateSetting = 0.
|
||||
; Often this is the only mode. If there are another modes, the active mode
|
||||
; is selected by SET_INTERFACE(bAlternateSetting) control request.
|
||||
bInterfaceNumber db ?
|
||||
bAlternateSetting db ?
|
||||
bNumEndpoints db ?
|
||||
; Number of endpoints used by this interface, excluding zero endpoint
|
||||
bInterfaceClass db ?
|
||||
; USB Interface Class Code
|
||||
bInterfaceSubClass db ?
|
||||
; USB Interface Subclass Code
|
||||
bInterfaceProtocol db ?
|
||||
; USB Interface Protocol Code
|
||||
iInterface db ?
|
||||
; Index of string descriptor describing this interface
|
||||
ends
|
||||
|
||||
; USB endpoint descriptor
|
||||
struct usb_endpoint_descr usb_descr
|
||||
bEndpointAddress db ?
|
||||
; Lower 4 bits form endpoint number,
|
||||
; upper bit is 0 for OUT endpoints and 1 for IN endpoints,
|
||||
; other bits must be zero
|
||||
bmAttributes db ?
|
||||
; Lower 2 bits form transfer type, one of *_PIPE,
|
||||
; other bits must be zero for non-isochronous endpoints;
|
||||
; refer to the USB specification for meaning in isochronous case
|
||||
wMaxPacketSize dw ?
|
||||
; Lower 11 bits form maximum packet size,
|
||||
; next two bits specify the number of additional transactions per microframe
|
||||
; for high-speed periodic endpoints, other bits must be zero.
|
||||
bInterval db ?
|
||||
; Interval for polling endpoint for data transfers.
|
||||
; Isochronous and high-speed interrupt endpoints: poll every 2^(bInterval-1)
|
||||
; (micro)frames
|
||||
; Full/low-speed interrupt endpoints: poll every bInterval frames
|
||||
; High-speed bulk/control OUT endpoints: maximum NAK rate
|
||||
ends
|
||||
|
||||
; =============================================================================
|
||||
; =================================== Code ====================================
|
||||
; =============================================================================
|
||||
|
||||
; When a new device is ready to be configured, a controller-specific code
|
||||
; calls usb_new_device.
|
||||
; The sequence of further actions:
|
||||
; * open pipe for the zero endpoint (usb_new_device);
|
||||
; maximum packet size is not known yet, but it must be at least 8 bytes,
|
||||
; so it is safe to send packets with <= 8 bytes
|
||||
; * issue SET_ADDRESS control request (usb_new_device)
|
||||
; * set the new device address in the pipe (usb_set_address_callback)
|
||||
; * notify a controller-specific code that initialization of other ports
|
||||
; can be started (usb_set_address_callback)
|
||||
; * issue GET_DESCRIPTOR control request for first 8 bytes of device descriptor
|
||||
; (usb_after_set_address)
|
||||
; * first 8 bytes of device descriptor contain the true packet size for zero
|
||||
; endpoint, so set the true packet size (usb_get_descr8_callback)
|
||||
; * first 8 bytes of a descriptor contain the full size of this descriptor,
|
||||
; issue GET_DESCRIPTOR control request for the full device descriptor
|
||||
; (usb_after_set_endpoint_size)
|
||||
; * issue GET_DESCRIPTOR control request for first 8 bytes of configuration
|
||||
; descriptor (usb_get_descr_callback)
|
||||
; * issue GET_DESCRIPTOR control request for full configuration descriptor
|
||||
; (usb_know_length_callback)
|
||||
; * issue SET_CONFIGURATION control request (usb_set_config_callback)
|
||||
; * parse configuration descriptor, load the corresponding driver(s),
|
||||
; pass the configuration descriptor to the driver and let the driver do
|
||||
; the further work (usb_got_config_callback)
|
||||
|
||||
; This function is called from controller-specific part
|
||||
; when a new device is ready to be configured.
|
||||
; in: ecx -> pseudo-pipe, part of usb_pipe
|
||||
; in: esi -> usb_controller
|
||||
; in: [esi+usb_controller.ResettingHub] is the pointer to usb_hub for device,
|
||||
; NULL if the device is connected to the root hub
|
||||
; in: [esi+usb_controller.ResettingPort] is the port for the device, zero-based
|
||||
; in: [esi+usb_controller.ResettingSpeed] is the speed of the device, one of
|
||||
; USB_SPEED_xx.
|
||||
; out: eax = 0 <=> failed, the caller should disable the port.
|
||||
proc usb_new_device
|
||||
push ebx edi ; save used registers to be stdcall
|
||||
; 1. Allocate resources. Any device uses the following resources:
|
||||
; - device address in the bus
|
||||
; - memory for device data
|
||||
; - pipe for zero endpoint
|
||||
; If some allocation fails, we must undo our actions. Closing the pipe
|
||||
; is a hard task, so we avoid it and open the pipe as the last resource.
|
||||
; The order for other two allocations is quite arbitrary.
|
||||
; 1a. Allocate a bus address.
|
||||
push ecx
|
||||
call usb_set_address_request
|
||||
pop ecx
|
||||
; 1b. If failed, just return zero.
|
||||
test eax, eax
|
||||
jz .nothing
|
||||
; 1c. Allocate memory for device data.
|
||||
; For now, we need sizeof.usb_device_data and extra 8 bytes for GET_DESCRIPTOR
|
||||
; input and output, see usb_after_set_address. Later we will reallocate it
|
||||
; to actual size needed for descriptors.
|
||||
movi eax, sizeof.usb_device_data + 8
|
||||
push ecx
|
||||
call malloc
|
||||
pop ecx
|
||||
; 1d. If failed, free the bus address and return zero.
|
||||
test eax, eax
|
||||
jz .nomemory
|
||||
; 1e. Open pipe for endpoint zero.
|
||||
; For now, we do not know the actual maximum packet size;
|
||||
; for full-speed devices it can be any of 8, 16, 32, 64 bytes,
|
||||
; low-speed devices must have 8 bytes, high-speed devices must have 64 bytes.
|
||||
; Thus, we must use some fake "maximum packet size" until the actual size
|
||||
; will be known. However, the maximum packet size must be at least 8, and
|
||||
; initial stages of the configuration process involves only packets of <= 8
|
||||
; bytes, they will be transferred correctly as long as
|
||||
; the fake "maximum packet size" is also at least 8.
|
||||
; Thus, any number >= 8 is suitable for actual hardware.
|
||||
; However, software emulation of EHCI in VirtualBox assumes that high-speed
|
||||
; control transfers are those originating from pipes with max packet size = 64,
|
||||
; even on early stages of the configuration process. This is incorrect,
|
||||
; but we have no specific preferences, so let VirtualBox be happy and use 64
|
||||
; as the fake "maximum packet size".
|
||||
push eax
|
||||
; We will need many zeroes.
|
||||
; "push edi" is one byte, "push 0" is two bytes; save space, use edi.
|
||||
xor edi, edi
|
||||
stdcall usb_open_pipe, ecx, edi, 64, edi, edi
|
||||
; Put pointer to pipe into ebx. "xchg eax,reg" is one byte, mov is two bytes.
|
||||
xchg eax, ebx
|
||||
pop eax
|
||||
; 1f. If failed, free the memory, the bus address and return zero.
|
||||
test ebx, ebx
|
||||
jz .freememory
|
||||
; 2. Store pointer to device data in the pipe structure.
|
||||
mov [ebx+usb_pipe.DeviceData], eax
|
||||
; 3. Init device data, using usb_controller.Resetting* variables.
|
||||
mov [eax+usb_device_data.TTHub], edi
|
||||
mov [eax+usb_device_data.TTPort], 0
|
||||
mov [eax+usb_device_data.NumInterfaces], edi
|
||||
mov [eax+usb_device_data.DeviceDescrSize], 0
|
||||
mov dl, [esi+usb_controller.ResettingSpeed]
|
||||
mov [eax+usb_device_data.Speed], dl
|
||||
mov [eax+usb_device_data.NumPipes], 1
|
||||
push ebx
|
||||
cmp dl, USB_SPEED_HS
|
||||
jz .nott
|
||||
mov ebx, [esi+usb_controller.ResettingHub]
|
||||
test ebx, ebx
|
||||
jz .nott
|
||||
mov cl, [esi+usb_controller.ResettingPort]
|
||||
mov edx, [ebx+usb_hub.ConfigPipe]
|
||||
mov edx, [edx+usb_pipe.DeviceData]
|
||||
cmp [edx+usb_device_data.TTHub], 0
|
||||
jz @f
|
||||
mov cl, [edx+usb_device_data.TTPort]
|
||||
mov ebx, [edx+usb_device_data.TTHub]
|
||||
jmp .has_tt
|
||||
@@:
|
||||
cmp [edx+usb_device_data.Speed], USB_SPEED_HS
|
||||
jnz .nott
|
||||
.has_tt:
|
||||
mov [eax+usb_device_data.TTHub], ebx
|
||||
mov [eax+usb_device_data.TTPort], cl
|
||||
.nott:
|
||||
pop ebx
|
||||
mov [eax+usb_device_data.ConfigDataSize], edi
|
||||
mov [eax+usb_device_data.Interfaces], edi
|
||||
movzx ecx, [esi+usb_controller.ResettingPort]
|
||||
mov [eax+usb_device_data.Port], cl
|
||||
mov edx, [esi+usb_controller.ResettingHub]
|
||||
mov [eax+usb_device_data.Hub], edx
|
||||
; 4. Store pointer to the config pipe in the hub data.
|
||||
; Config pipe serves as device identifier.
|
||||
; Root hubs use the array inside usb_controller structure,
|
||||
; non-root hubs use the array immediately after usb_hub structure.
|
||||
test edx, edx
|
||||
jz .roothub
|
||||
mov edx, [edx+usb_hub.ConnectedDevicesPtr]
|
||||
mov [edx+ecx*4], ebx
|
||||
jmp @f
|
||||
.roothub:
|
||||
mov [esi+usb_controller.DevicesByPort+ecx*4], ebx
|
||||
@@:
|
||||
call usb_reinit_pipe_list
|
||||
; 5. Issue SET_ADDRESS control request, using buffer filled in step 1a.
|
||||
; Use the return value from usb_control_async as our return value;
|
||||
; if it is zero, then something has failed.
|
||||
lea eax, [esi+usb_controller.SetAddressBuffer]
|
||||
stdcall usb_control_async, ebx, eax, edi, edi, usb_set_address_callback, edi, edi
|
||||
.nothing:
|
||||
; 6. Return.
|
||||
pop edi ebx ; restore used registers to be stdcall
|
||||
ret
|
||||
; Handlers of failures in steps 1b, 1d, 1f.
|
||||
.freememory:
|
||||
call free
|
||||
jmp .freeaddr
|
||||
.nomemory:
|
||||
dbgstr 'No memory for device data'
|
||||
.freeaddr:
|
||||
mov ecx, dword [esi+usb_controller.SetAddressBuffer+2]
|
||||
bts [esi+usb_controller.ExistingAddresses], ecx
|
||||
xor eax, eax
|
||||
jmp .nothing
|
||||
endp
|
||||
|
||||
; Helper procedure for usb_new_device.
|
||||
; Allocates a new USB address and fills usb_controller.SetAddressBuffer
|
||||
; with data for SET_ADDRESS(allocated_address) request.
|
||||
; out: eax = 0 <=> failed
|
||||
; Destroys edi.
|
||||
proc usb_set_address_request
|
||||
; There are 128 bits, one for each possible address.
|
||||
; Note: only the USB thread works with usb_controller.ExistingAddresses,
|
||||
; so there is no need for synchronization.
|
||||
; We must find a bit set to 1 and clear it.
|
||||
; 1. Find the first dword which has a nonzero bit = which is nonzero.
|
||||
mov ecx, 128/32
|
||||
lea edi, [esi+usb_controller.ExistingAddresses]
|
||||
xor eax, eax
|
||||
repz scasd
|
||||
; 2. If all dwords are zero, return an error.
|
||||
jz .error
|
||||
; 3. The dword at [edi-4] is nonzero. Find the lowest nonzero bit.
|
||||
bsf eax, [edi-4]
|
||||
; Now eax = bit number inside the dword at [edi-4].
|
||||
; 4. Clear the bit.
|
||||
btr [edi-4], eax
|
||||
; 5. Generate the address by edi = memory address and eax = bit inside dword.
|
||||
; Address = eax + 8 * (edi-4 - (esi+usb_controller.ExistingAddress)).
|
||||
sub edi, esi
|
||||
lea edi, [eax+(edi-4-usb_controller.ExistingAddresses)*8]
|
||||
; 6. Store the allocated address in SetAddressBuffer and fill remaining fields.
|
||||
; Note that usb_controller is zeroed at allocation, so only command byte needs
|
||||
; to be filled.
|
||||
mov byte [esi+usb_controller.SetAddressBuffer+1], USB_SET_ADDRESS
|
||||
mov dword [esi+usb_controller.SetAddressBuffer+2], edi
|
||||
; 7. Return non-zero value in eax.
|
||||
inc eax
|
||||
.nothing:
|
||||
ret
|
||||
.error:
|
||||
dbgstr 'cannot allocate USB address'
|
||||
xor eax, eax
|
||||
jmp .nothing
|
||||
endp
|
||||
|
||||
; This procedure is called by USB stack when SET_ADDRESS request initiated by
|
||||
; usb_new_device is completed, either successfully or unsuccessfully.
|
||||
; Note that USB stack uses esi = pointer to usb_controller.
|
||||
proc usb_set_address_callback stdcall, pipe:dword, status:dword, buffer:dword, length:dword, calldata:dword
|
||||
push ebx ; save ebx to be stdcall
|
||||
; Load data to registers for further references.
|
||||
mov ebx, [pipe]
|
||||
mov ecx, dword [esi+usb_controller.SetAddressBuffer+2]
|
||||
mov eax, [esi+usb_controller.HardwareFunc]
|
||||
; 1. Check whether the device has accepted new address. If so, proceed to 2.
|
||||
; Otherwise, go to 3.
|
||||
cmp [status], 0
|
||||
jnz .error
|
||||
; 2. Address accepted.
|
||||
; 2a. The controller-specific structure for the control pipe still uses
|
||||
; zero address. Call the controller-specific function to change it to
|
||||
; the actual address.
|
||||
; Note that the hardware could cache the controller-specific structure,
|
||||
; so setting the address could take some time until the cache is evicted.
|
||||
; Thus, the call is asynchronous; meet us in usb_after_set_address when it will
|
||||
; be safe to continue.
|
||||
; dbgstr 'address set in device'
|
||||
call [eax+usb_hardware_func.SetDeviceAddress]
|
||||
; 2b. If the port is in non-root hub, clear 'reset in progress' flag.
|
||||
; In any case, proceed to 4.
|
||||
mov eax, [esi+usb_controller.ResettingHub]
|
||||
test eax, eax
|
||||
jz .return
|
||||
and [eax+usb_hub.Actions], not HUB_RESET_IN_PROGRESS
|
||||
.return:
|
||||
; 4. Address configuration done, we can proceed with other ports.
|
||||
; Call the worker function for that.
|
||||
call usb_test_pending_port
|
||||
.nothing:
|
||||
pop ebx ; restore ebx to be stdcall
|
||||
ret
|
||||
.error:
|
||||
; 3. Device error: device not responding, disconnect etc.
|
||||
DEBUGF 1,'K : error %d in SET_ADDRESS, USB device disabled\n',[status]
|
||||
; 3a. The address has not been accepted. Mark it as free.
|
||||
bts dword [esi+usb_controller.ExistingAddresses], ecx
|
||||
; 3b. Disable the port with bad device.
|
||||
; For the root hub, call the controller-specific function and go to 6.
|
||||
; For non-root hubs, let the hub code do its work and return (the request
|
||||
; could take some time, the hub code is responsible for proceeding).
|
||||
cmp [esi+usb_controller.ResettingHub], 0
|
||||
jz .roothub
|
||||
mov eax, [esi+usb_controller.ResettingHub]
|
||||
call usb_hub_disable_resetting_port
|
||||
jmp .nothing
|
||||
.roothub:
|
||||
movzx ecx, [esi+usb_controller.ResettingPort]
|
||||
call [eax+usb_hardware_func.PortDisable]
|
||||
jmp .return
|
||||
endp
|
||||
|
||||
; This procedure is called from usb_subscription_done when the hardware cache
|
||||
; is cleared after request from usb_set_address_callback.
|
||||
; in: ebx -> usb_pipe
|
||||
proc usb_after_set_address
|
||||
; dbgstr 'address set for controller'
|
||||
; Issue control transfer GET_DESCRIPTOR(DEVICE_DESCR) for first 8 bytes.
|
||||
; Remember, we still do not know the actual packet size;
|
||||
; 8-bytes-request is safe.
|
||||
; usb_new_device has allocated 8 extra bytes besides sizeof.usb_device_data;
|
||||
; use them for both input and output.
|
||||
mov eax, [ebx+usb_pipe.DeviceData]
|
||||
add eax, usb_device_data.DeviceDescriptor
|
||||
mov dword [eax], \
|
||||
80h + \ ; device-to-host, standard, device-wide
|
||||
(USB_GET_DESCRIPTOR shl 8) + \ ; request
|
||||
(0 shl 16) + \ ; descriptor index: there is only one
|
||||
(USB_DEVICE_DESCR shl 24) ; descriptor type
|
||||
mov dword [eax+4], 8 shl 16 ; data length
|
||||
stdcall usb_control_async, ebx, eax, eax, 8, usb_get_descr8_callback, eax, 0
|
||||
ret
|
||||
endp
|
||||
|
||||
; This procedure is called by USB stack when GET_DESCRIPTOR(DEVICE_DESCR)
|
||||
; request initiated by usb_after_set_address is completed, either successfully
|
||||
; or unsuccessfully.
|
||||
; Note that USB stack uses esi = pointer to usb_controller.
|
||||
proc usb_get_descr8_callback stdcall, pipe:dword, status:dword, buffer:dword, length:dword, calldata:dword
|
||||
; mov eax, [buffer]
|
||||
; DEBUGF 1,'K : descr8: l=%x; %x %x %x %x %x %x %x %x\n',[length],\
|
||||
; [eax]:2,[eax+1]:2,[eax+2]:2,[eax+3]:2,[eax+4]:2,[eax+5]:2,[eax+6]:2,[eax+7]:2
|
||||
push edi ebx ; save used registers to be stdcall
|
||||
mov ebx, [pipe]
|
||||
; 1. Check whether the operation was successful.
|
||||
; If not, say something to the debug board and stop the initialization.
|
||||
cmp [status], 0
|
||||
jnz .error
|
||||
; 2. Length of descriptor must be at least sizeof.usb_device_descr bytes.
|
||||
; If not, say something to the debug board and stop the initialization.
|
||||
mov eax, [ebx+usb_pipe.DeviceData]
|
||||
cmp [eax+usb_device_data.DeviceDescriptor+usb_device_descr.bLength], sizeof.usb_device_descr
|
||||
jb .error
|
||||
; 3. Now first 8 bytes of device descriptor are known;
|
||||
; set DeviceDescrSize accordingly.
|
||||
mov [eax+usb_device_data.DeviceDescrSize], 8
|
||||
; 4. The controller-specific structure for the control pipe still uses
|
||||
; the fake "maximum packet size". Call the controller-specific function to
|
||||
; change it to the actual packet size from the device.
|
||||
; Note that the hardware could cache the controller-specific structure,
|
||||
; so changing it could take some time until the cache is evicted.
|
||||
; Thus, the call is asynchronous; meet us in usb_after_set_endpoint_size
|
||||
; when it will be safe to continue.
|
||||
movzx ecx, [eax+usb_device_data.DeviceDescriptor+usb_device_descr.bMaxPacketSize0]
|
||||
mov eax, [esi+usb_controller.HardwareFunc]
|
||||
call [eax+usb_hardware_func.SetEndpointPacketSize]
|
||||
.nothing:
|
||||
; 5. Return.
|
||||
pop ebx edi ; restore used registers to be stdcall
|
||||
ret
|
||||
.error:
|
||||
dbgstr 'error with USB device descriptor'
|
||||
jmp .nothing
|
||||
endp
|
||||
|
||||
; This procedure is called from usb_subscription_done when the hardware cache
|
||||
; is cleared after request from usb_get_descr8_callback.
|
||||
; in: ebx -> usb_pipe
|
||||
proc usb_after_set_endpoint_size
|
||||
; 1. Reallocate memory for device data:
|
||||
; add memory for now-known size of device descriptor and extra 8 bytes
|
||||
; for further actions.
|
||||
; 1a. Allocate new memory.
|
||||
mov eax, [ebx+usb_pipe.DeviceData]
|
||||
movzx eax, [eax+usb_device_data.DeviceDescriptor+usb_device_descr.bLength]
|
||||
; save length for step 2
|
||||
push eax
|
||||
add eax, sizeof.usb_device_data + 8
|
||||
call malloc
|
||||
; 1b. If failed, say something to the debug board and stop the initialization.
|
||||
test eax, eax
|
||||
jz .nomemory
|
||||
; 1c. Copy data from old memory to new memory and switch the pointer in usb_pipe.
|
||||
push eax
|
||||
push esi edi
|
||||
mov esi, [ebx+usb_pipe.DeviceData]
|
||||
mov [ebx+usb_pipe.DeviceData], eax
|
||||
mov edi, eax
|
||||
mov eax, esi
|
||||
mov ecx, sizeof.usb_device_data / 4
|
||||
rep movsd
|
||||
pop edi esi
|
||||
call usb_reinit_pipe_list
|
||||
; 1d. Free the old memory.
|
||||
call free
|
||||
pop eax
|
||||
; 2. Issue control transfer GET_DESCRIPTOR(DEVICE) for full descriptor.
|
||||
; restore length saved in step 1a
|
||||
pop edx
|
||||
add eax, sizeof.usb_device_data
|
||||
mov dword [eax], \
|
||||
80h + \ ; device-to-host, standard, device-wide
|
||||
(USB_GET_DESCRIPTOR shl 8) + \ ; request
|
||||
(0 shl 16) + \ ; descriptor index: there is only one
|
||||
(USB_DEVICE_DESCR shl 24) ; descriptor type
|
||||
and dword [eax+4], 0
|
||||
mov [eax+6], dl ; data length
|
||||
stdcall usb_control_async, ebx, eax, eax, edx, usb_get_descr_callback, eax, 0
|
||||
; 3. Return.
|
||||
ret
|
||||
.nomemory:
|
||||
dbgstr 'No memory for device data'
|
||||
ret
|
||||
endp
|
||||
|
||||
; This procedure is called by USB stack when GET_DESCRIPTOR(DEVICE)
|
||||
; request initiated by usb_after_set_endpoint_size is completed,
|
||||
; either successfully or unsuccessfully.
|
||||
proc usb_get_descr_callback stdcall, pipe:dword, status:dword, buffer:dword, length:dword, calldata:dword
|
||||
; Note: the prolog is the same as in usb_get_descr8_callback.
|
||||
push edi ebx ; save used registers to be stdcall
|
||||
; 1. Check whether the operation was successful.
|
||||
; If not, say something to the debug board and stop the initialization.
|
||||
cmp [status], 0
|
||||
jnz usb_get_descr8_callback.error
|
||||
; The full descriptor is known, dump it if specified by compile-time option.
|
||||
if USB_DUMP_DESCRIPTORS
|
||||
mov eax, [buffer]
|
||||
mov ecx, [length]
|
||||
sub ecx, 8
|
||||
jbe .skipdebug
|
||||
DEBUGF 1,'K : device descriptor:'
|
||||
@@:
|
||||
DEBUGF 1,' %x',[eax]:2
|
||||
inc eax
|
||||
dec ecx
|
||||
jnz @b
|
||||
DEBUGF 1,'\n'
|
||||
.skipdebug:
|
||||
end if
|
||||
; 2. Check that bLength is the same as was in the previous request.
|
||||
; If not, say something to the debug board and stop the initialization.
|
||||
; It is important, because usb_after_set_endpoint_size has allocated memory
|
||||
; according to the old bLength. Note that [length] for control transfers
|
||||
; includes 8 bytes of setup packet, so data length = [length] - 8.
|
||||
mov eax, [buffer]
|
||||
movzx ecx, [eax+usb_device_descr.bLength]
|
||||
add ecx, 8
|
||||
cmp [length], ecx
|
||||
jnz usb_get_descr8_callback.error
|
||||
; Amuse the user if she is watching the debug board.
|
||||
mov cl, [eax+usb_device_descr.bNumConfigurations]
|
||||
DEBUGF 1,'K : found USB device with ID %x:%x, %d configuration(s)\n',\
|
||||
[eax+usb_device_descr.idVendor]:4,\
|
||||
[eax+usb_device_descr.idProduct]:4,\
|
||||
cl
|
||||
; 3. If there are no configurations, stop the initialization.
|
||||
cmp [eax+usb_device_descr.bNumConfigurations], 0
|
||||
jz .nothing
|
||||
; 4. Copy length of device descriptor to device data structure.
|
||||
movzx edx, [eax+usb_device_descr.bLength]
|
||||
mov [eax+usb_device_data.DeviceDescrSize-usb_device_data.DeviceDescriptor], dl
|
||||
; 5. Issue control transfer GET_DESCRIPTOR(CONFIGURATION). We do not know
|
||||
; the full length of that descriptor, so start with first 8 bytes, they contain
|
||||
; the full length.
|
||||
; usb_after_set_endpoint_size has allocated 8 extra bytes after the
|
||||
; device descriptor, use them for both input and output.
|
||||
add eax, edx
|
||||
mov dword [eax], \
|
||||
80h + \ ; device-to-host, standard, device-wide
|
||||
(USB_GET_DESCRIPTOR shl 8) + \ ; request
|
||||
(0 shl 16) + \ ; descriptor index: there is only one
|
||||
(USB_CONFIG_DESCR shl 24) ; descriptor type
|
||||
mov dword [eax+4], 8 shl 16 ; data length
|
||||
stdcall usb_control_async, [pipe], eax, eax, 8, usb_know_length_callback, eax, 0
|
||||
.nothing:
|
||||
; 6. Return.
|
||||
pop ebx edi ; restore used registers to be stdcall
|
||||
ret
|
||||
endp
|
||||
|
||||
; This procedure is called by USB stack when GET_DESCRIPTOR(CONFIGURATION)
|
||||
; request initiated by usb_get_descr_callback is completed,
|
||||
; either successfully or unsuccessfully.
|
||||
proc usb_know_length_callback stdcall, pipe:dword, status:dword, buffer:dword, length:dword, calldata:dword
|
||||
push ebx ; save used registers to be stdcall
|
||||
; 1. Check whether the operation was successful.
|
||||
; If not, say something to the debug board and stop the initialization.
|
||||
cmp [status], 0
|
||||
jnz .error
|
||||
; 2. Get the total length of data associated with config descriptor and store
|
||||
; it in device data structure. The total length must be at least
|
||||
; sizeof.usb_config_descr bytes; if not, say something to the debug board and
|
||||
; stop the initialization.
|
||||
mov eax, [buffer]
|
||||
mov edx, [pipe]
|
||||
movzx ecx, [eax+usb_config_descr.wTotalLength]
|
||||
mov eax, [edx+usb_pipe.DeviceData]
|
||||
cmp ecx, sizeof.usb_config_descr
|
||||
jb .error
|
||||
mov [eax+usb_device_data.ConfigDataSize], ecx
|
||||
; 3. Reallocate memory for device data:
|
||||
; include usb_device_data structure, device descriptor,
|
||||
; config descriptor with all associated data, and extra bytes
|
||||
; sufficient for 8 bytes control packet and for one usb_interface_data struc.
|
||||
; Align extra bytes to dword boundary.
|
||||
if sizeof.usb_interface_data > 8
|
||||
.extra_size = sizeof.usb_interface_data
|
||||
else
|
||||
.extra_size = 8
|
||||
end if
|
||||
; 3a. Allocate new memory.
|
||||
movzx edx, [eax+usb_device_data.DeviceDescrSize]
|
||||
lea eax, [ecx+edx+sizeof.usb_device_data+.extra_size+3]
|
||||
and eax, not 3
|
||||
push eax
|
||||
call malloc
|
||||
pop edx
|
||||
; 3b. If failed, say something to the debug board and stop the initialization.
|
||||
test eax, eax
|
||||
jz .nomemory
|
||||
; 3c. Copy data from old memory to new memory and switch the pointer in usb_pipe.
|
||||
push eax
|
||||
mov ebx, [pipe]
|
||||
push esi edi
|
||||
mov esi, [ebx+usb_pipe.DeviceData]
|
||||
mov edi, eax
|
||||
mov [ebx+usb_pipe.DeviceData], eax
|
||||
mov eax, esi
|
||||
movzx ecx, [esi+usb_device_data.DeviceDescrSize]
|
||||
sub edx, .extra_size
|
||||
mov [esi+usb_device_data.Interfaces], edx
|
||||
add ecx, sizeof.usb_device_data + 8
|
||||
mov edx, ecx
|
||||
shr ecx, 2
|
||||
and edx, 3
|
||||
rep movsd
|
||||
mov ecx, edx
|
||||
rep movsb
|
||||
pop edi esi
|
||||
call usb_reinit_pipe_list
|
||||
; 3d. Free old memory.
|
||||
call free
|
||||
pop eax
|
||||
; 4. Issue control transfer GET_DESCRIPTOR(DEVICE) for full descriptor.
|
||||
movzx ecx, [eax+usb_device_data.DeviceDescrSize]
|
||||
mov edx, [eax+usb_device_data.ConfigDataSize]
|
||||
lea eax, [eax+ecx+sizeof.usb_device_data]
|
||||
mov dword [eax], \
|
||||
80h + \ ; device-to-host, standard, device-wide
|
||||
(USB_GET_DESCRIPTOR shl 8) + \ ; request
|
||||
(0 shl 16) + \ ; descriptor index: there is only one
|
||||
(USB_CONFIG_DESCR shl 24) ; descriptor type
|
||||
and dword [eax+4], 0
|
||||
mov word [eax+6], dx ; data length
|
||||
stdcall usb_control_async, [pipe], eax, eax, edx, usb_set_config_callback, eax, 0
|
||||
.nothing:
|
||||
; 5. Return.
|
||||
pop ebx ; restore used registers to be stdcall
|
||||
ret
|
||||
.error:
|
||||
dbgstr 'error with USB configuration descriptor'
|
||||
jmp .nothing
|
||||
.nomemory:
|
||||
dbgstr 'No memory for device data'
|
||||
jmp .nothing
|
||||
endp
|
||||
|
||||
; This procedure is called by USB stack when GET_DESCRIPTOR(CONFIGURATION)
|
||||
; request initiated by usb_know_length_callback is completed,
|
||||
; either successfully or unsuccessfully.
|
||||
proc usb_set_config_callback stdcall, pipe:dword, status:dword, buffer:dword, length:dword, calldata:dword
|
||||
; Note that the prolog is the same as in usb_know_length_callback.
|
||||
push ebx ; save used registers to be stdcall
|
||||
; 1. Check whether the operation was successful.
|
||||
; If not, say something to the debug board and stop the initialization.
|
||||
xor ecx, ecx
|
||||
mov ebx, [pipe]
|
||||
cmp [status], ecx
|
||||
jnz usb_know_length_callback.error
|
||||
; The full descriptor is known, dump it if specified by compile-time option.
|
||||
if USB_DUMP_DESCRIPTORS
|
||||
mov eax, [buffer]
|
||||
mov ecx, [length]
|
||||
sub ecx, 8
|
||||
jbe .skip_debug
|
||||
DEBUGF 1,'K : config descriptor:'
|
||||
@@:
|
||||
DEBUGF 1,' %x',[eax]:2
|
||||
inc eax
|
||||
dec ecx
|
||||
jnz @b
|
||||
DEBUGF 1,'\n'
|
||||
.skip_debug:
|
||||
xor ecx, ecx
|
||||
end if
|
||||
; 2. Issue control transfer SET_CONFIGURATION to activate this configuration.
|
||||
; Usually this is the only configuration.
|
||||
; Use extra bytes allocated by usb_know_length_callback;
|
||||
; offset from device data start is stored in Interfaces.
|
||||
mov eax, [ebx+usb_pipe.DeviceData]
|
||||
mov edx, [buffer]
|
||||
add eax, [eax+usb_device_data.Interfaces]
|
||||
mov dl, [edx+usb_config_descr.bConfigurationValue]
|
||||
mov dword [eax], USB_SET_CONFIGURATION shl 8
|
||||
mov dword [eax+4], ecx
|
||||
mov byte [eax+2], dl
|
||||
stdcall usb_control_async, [pipe], eax, ecx, ecx, usb_got_config_callback, [buffer], ecx
|
||||
pop ebx ; restore used registers to be stdcall
|
||||
ret
|
||||
endp
|
||||
|
||||
; This procedure is called by USB stack when SET_CONFIGURATION
|
||||
; request initiated by usb_set_config_callback is completed,
|
||||
; either successfully or unsuccessfully.
|
||||
; If successfully, the device is configured and ready to work,
|
||||
; pass the device to the corresponding driver(s).
|
||||
proc usb_got_config_callback stdcall, pipe:dword, status:dword, buffer:dword, length:dword, calldata:dword
|
||||
locals
|
||||
InterfacesData dd ?
|
||||
NumInterfaces dd ?
|
||||
driver dd ?
|
||||
endl
|
||||
; 1. If there was an error, say something to the debug board and stop the
|
||||
; initialization.
|
||||
cmp [status], 0
|
||||
jz @f
|
||||
dbgstr 'USB error in SET_CONFIGURATION'
|
||||
ret
|
||||
@@:
|
||||
push ebx edi ; save used registers to be stdcall
|
||||
; 2. Sanity checks: the total length must be the same as before (because we
|
||||
; have allocated memory assuming the old value), length of config descriptor
|
||||
; must be at least sizeof.usb_config_descr (we use fields from it),
|
||||
; there must be at least one interface.
|
||||
mov ebx, [pipe]
|
||||
mov ebx, [ebx+usb_pipe.DeviceData]
|
||||
mov eax, [calldata]
|
||||
mov edx, [ebx+usb_device_data.ConfigDataSize]
|
||||
cmp [eax+usb_config_descr.wTotalLength], dx
|
||||
jnz .invalid
|
||||
cmp [eax+usb_config_descr.bLength], 9
|
||||
jb .invalid
|
||||
movzx edx, [eax+usb_config_descr.bNumInterfaces]
|
||||
test edx, edx
|
||||
jnz @f
|
||||
.invalid:
|
||||
dbgstr 'error: invalid configuration descriptor'
|
||||
jmp .nothing
|
||||
@@:
|
||||
; 3. Store the number of interfaces in device data structure.
|
||||
mov [ebx+usb_device_data.NumInterfaces], edx
|
||||
; 4. If there is only one interface (which happens quite often),
|
||||
; the memory allocated in usb_know_length_callback is sufficient.
|
||||
; Otherwise (which also happens quite often), reallocate device data.
|
||||
; 4a. Check whether there is only one interface. If so, skip this step.
|
||||
cmp edx, 1
|
||||
jz .has_memory
|
||||
; 4b. Allocate new memory.
|
||||
mov eax, [ebx+usb_device_data.Interfaces]
|
||||
lea eax, [eax+edx*sizeof.usb_interface_data]
|
||||
call malloc
|
||||
; 4c. If failed, say something to the debug board and
|
||||
; stop the initialization.
|
||||
test eax, eax
|
||||
jnz @f
|
||||
dbgstr 'No memory for device data'
|
||||
jmp .nothing
|
||||
@@:
|
||||
; 4d. Copy data from old memory to new memory and switch the pointer in usb_pipe.
|
||||
push eax
|
||||
push esi
|
||||
mov ebx, [pipe]
|
||||
mov edi, eax
|
||||
mov esi, [ebx+usb_pipe.DeviceData]
|
||||
mov [ebx+usb_pipe.DeviceData], eax
|
||||
mov eax, esi
|
||||
mov ecx, [esi+usb_device_data.Interfaces]
|
||||
shr ecx, 2
|
||||
rep movsd
|
||||
pop esi
|
||||
call usb_reinit_pipe_list
|
||||
; 4e. Free old memory.
|
||||
call free
|
||||
pop ebx
|
||||
.has_memory:
|
||||
; 5. Initialize interfaces table: zero all contents.
|
||||
mov edi, [ebx+usb_device_data.Interfaces]
|
||||
add edi, ebx
|
||||
mov [InterfacesData], edi
|
||||
mov ecx, [ebx+usb_device_data.NumInterfaces]
|
||||
if sizeof.usb_interface_data <> 8
|
||||
You have changed sizeof.usb_interface_data? Modify this place too.
|
||||
end if
|
||||
add ecx, ecx
|
||||
xor eax, eax
|
||||
rep stosd
|
||||
; No interfaces are found yet.
|
||||
mov [NumInterfaces], eax
|
||||
; 6. Get the pointer to config descriptor data.
|
||||
; Note: if there was reallocation, [buffer] is not valid anymore,
|
||||
; so calculate value based on usb_device_data.
|
||||
movzx eax, [ebx+usb_device_data.DeviceDescrSize]
|
||||
lea eax, [eax+ebx+sizeof.usb_device_data]
|
||||
mov [calldata], eax
|
||||
mov ecx, [ebx+usb_device_data.ConfigDataSize]
|
||||
; 7. Loop over all descriptors,
|
||||
; scan for interface descriptors with bAlternateSetting = 0,
|
||||
; load the corresponding driver, call its AddDevice function.
|
||||
.descriptor_loop:
|
||||
; While in loop: eax points to the current descriptor,
|
||||
; ecx = number of bytes left, the iteration starts only if ecx is nonzero,
|
||||
; edx = size of the current descriptor.
|
||||
; 7a. The first byte is always accessible; it contains the length of
|
||||
; the current descriptor. Validate that the length is at least 2 bytes,
|
||||
; and the entire descriptor is readable (the length is at most number of
|
||||
; bytes left).
|
||||
movzx edx, [eax+usb_descr.bLength]
|
||||
cmp edx, sizeof.usb_descr
|
||||
jb .invalid
|
||||
cmp ecx, edx
|
||||
jb .invalid
|
||||
; 7b. Check descriptor type. Ignore all non-INTERFACE descriptor.
|
||||
cmp byte [eax+usb_descr.bDescriptorType], USB_INTERFACE_DESCR
|
||||
jz .interface
|
||||
.next_descriptor:
|
||||
; 7c. Advance pointer, decrease length left, if there is still something left,
|
||||
; continue the loop.
|
||||
add eax, edx
|
||||
sub ecx, edx
|
||||
jnz .descriptor_loop
|
||||
.done:
|
||||
.nothing:
|
||||
pop edi ebx ; restore used registers to be stdcall
|
||||
ret
|
||||
.interface:
|
||||
; 7d. Validate the descriptor length.
|
||||
cmp edx, sizeof.usb_interface_descr
|
||||
jb .next_descriptor
|
||||
; 7e. If bAlternateSetting is nonzero, this descriptor actually describes
|
||||
; another mode of already known interface and belongs to the already loaded
|
||||
; driver; amuse the user and continue to 7c.
|
||||
cmp byte [eax+usb_interface_descr.bAlternateSetting], 0
|
||||
jz @f
|
||||
DEBUGF 1,'K : note: alternate setting with %x/%x/%x\n',\
|
||||
[eax+usb_interface_descr.bInterfaceClass]:2,\
|
||||
[eax+usb_interface_descr.bInterfaceSubClass]:2,\
|
||||
[eax+usb_interface_descr.bInterfaceProtocol]:2
|
||||
jmp .next_descriptor
|
||||
@@:
|
||||
; 7f. Check that the new interface does not overflow allocated table.
|
||||
mov edx, [NumInterfaces]
|
||||
inc edx
|
||||
cmp edx, [ebx+usb_device_data.NumInterfaces]
|
||||
ja .invalid
|
||||
; 7g. We have found a new interface. Advance bookkeeping vars.
|
||||
mov [NumInterfaces], edx
|
||||
add [InterfacesData], sizeof.usb_interface_data
|
||||
; 7h. Save length left and pointer to the current interface descriptor.
|
||||
push ecx eax
|
||||
; Amuse the user if she is watching the debug board.
|
||||
DEBUGF 1,'K : USB interface class/subclass/protocol = %x/%x/%x\n',\
|
||||
[eax+usb_interface_descr.bInterfaceClass]:2,\
|
||||
[eax+usb_interface_descr.bInterfaceSubClass]:2,\
|
||||
[eax+usb_interface_descr.bInterfaceProtocol]:2
|
||||
; 7i. Select the correct driver based on interface class.
|
||||
; For hubs, go to 7j. Otherwise, go to 7k.
|
||||
; Note: this should be rewritten as table-based lookup when more drivers will
|
||||
; be available.
|
||||
cmp byte [eax+usb_interface_descr.bInterfaceClass], 9
|
||||
jz .found_hub
|
||||
mov edx, usb_hid_name
|
||||
cmp byte [eax+usb_interface_descr.bInterfaceClass], 3
|
||||
jz .load_driver
|
||||
mov edx, usb_print_name
|
||||
cmp byte [eax+usb_interface_descr.bInterfaceClass], 7
|
||||
jz .load_driver
|
||||
mov edx, usb_stor_name
|
||||
cmp byte [eax+usb_interface_descr.bInterfaceClass], 8
|
||||
jz .load_driver
|
||||
mov edx, usb_other_name
|
||||
jmp .load_driver
|
||||
.found_hub:
|
||||
; 7j. Hubs are a part of USB stack, thus, integrated into the kernel.
|
||||
; Use the pointer to hub callbacks and go to 7m.
|
||||
mov eax, usb_hub_pseudosrv - USBSRV.usb_func
|
||||
jmp .driver_loaded
|
||||
.load_driver:
|
||||
; 7k. Load the corresponding driver.
|
||||
push ebx esi edi
|
||||
stdcall get_service, edx
|
||||
pop edi esi ebx
|
||||
; 7l. If failed, say something to the debug board and go to 7p.
|
||||
test eax, eax
|
||||
jnz .driver_loaded
|
||||
dbgstr 'failed to load class driver'
|
||||
jmp .next_descriptor2
|
||||
.driver_loaded:
|
||||
; 7m. Call AddDevice function of the driver.
|
||||
; Note that top of stack contains a pointer to the current interface,
|
||||
; saved by step 7h.
|
||||
mov [driver], eax
|
||||
mov eax, [eax+USBSRV.usb_func]
|
||||
pop edx
|
||||
push edx
|
||||
; Note: usb_hub_init assumes that edx points to usb_interface_descr,
|
||||
; ecx = length rest; if you change the code, modify usb_hub_init also.
|
||||
stdcall [eax+USBFUNC.add_device], [pipe], [calldata], edx
|
||||
; 7n. If failed, say something to the debug board and go to 7p.
|
||||
test eax, eax
|
||||
jnz .store_data
|
||||
dbgstr 'USB device initialization failed'
|
||||
jmp .next_descriptor2
|
||||
.store_data:
|
||||
; 7o. Store the returned value and the driver handle to InterfacesData.
|
||||
; Note that step 7g has already advanced InterfacesData.
|
||||
mov edx, [InterfacesData]
|
||||
mov [edx+usb_interface_data.DriverData-sizeof.usb_interface_data], eax
|
||||
mov eax, [driver]
|
||||
mov [edx+usb_interface_data.DriverFunc-sizeof.usb_interface_data], eax
|
||||
.next_descriptor2:
|
||||
; 7p. Restore registers saved in step 7h, get the descriptor length and
|
||||
; continue to 7c.
|
||||
pop eax ecx
|
||||
movzx edx, byte [eax+usb_descr.bLength]
|
||||
jmp .next_descriptor
|
||||
endp
|
||||
|
||||
; Driver names, see step 7i of usb_got_config_callback.
|
||||
iglobal
|
||||
usb_hid_name db 'usbhid',0
|
||||
usb_stor_name db 'usbstor',0
|
||||
usb_print_name db 'usbprint',0
|
||||
usb_other_name db 'usbother',0
|
||||
endg
|
||||
637
kernel/branches/kolibri-process/const.inc
Normal file
637
kernel/branches/kolibri-process/const.inc
Normal file
@@ -0,0 +1,637 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4418 $
|
||||
|
||||
|
||||
dpl0 equ 10010000b ; data read dpl0
|
||||
drw0 equ 10010010b ; data read/write dpl0
|
||||
drw3 equ 11110010b ; data read/write dpl3
|
||||
cpl0 equ 10011010b ; code read dpl0
|
||||
cpl3 equ 11111010b ; code read dpl3
|
||||
|
||||
D32 equ 01000000b ; 32bit segment
|
||||
G32 equ 10000000b ; page gran
|
||||
|
||||
|
||||
;;;;;;;;;;;;cpu_caps flags;;;;;;;;;;;;;;;;
|
||||
|
||||
CPU_386 equ 3
|
||||
CPU_486 equ 4
|
||||
CPU_PENTIUM equ 5
|
||||
CPU_P6 equ 6
|
||||
CPU_PENTIUM4 equ 0x0F
|
||||
|
||||
CAPS_FPU equ 00 ;on-chip x87 floating point unit
|
||||
CAPS_VME equ 01 ;virtual-mode enhancements
|
||||
CAPS_DE equ 02 ;debugging extensions
|
||||
CAPS_PSE equ 03 ;page-size extensions
|
||||
CAPS_TSC equ 04 ;time stamp counter
|
||||
CAPS_MSR equ 05 ;model-specific registers
|
||||
CAPS_PAE equ 06 ;physical-address extensions
|
||||
CAPS_MCE equ 07 ;machine check exception
|
||||
CAPS_CX8 equ 08 ;CMPXCHG8B instruction
|
||||
CAPS_APIC equ 09 ;on-chip advanced programmable
|
||||
; interrupt controller
|
||||
; 10 ;unused
|
||||
CAPS_SEP equ 11 ;SYSENTER and SYSEXIT instructions
|
||||
CAPS_MTRR equ 12 ;memory-type range registers
|
||||
CAPS_PGE equ 13 ;page global extension
|
||||
CAPS_MCA equ 14 ;machine check architecture
|
||||
CAPS_CMOV equ 15 ;conditional move instructions
|
||||
CAPS_PAT equ 16 ;page attribute table
|
||||
|
||||
CAPS_PSE36 equ 17 ;page-size extensions
|
||||
CAPS_PSN equ 18 ;processor serial number
|
||||
CAPS_CLFLUSH equ 19 ;CLFUSH instruction
|
||||
|
||||
CAPS_DS equ 21 ;debug store
|
||||
CAPS_ACPI equ 22 ;thermal monitor and software
|
||||
;controlled clock supported
|
||||
CAPS_MMX equ 23 ;MMX instructions
|
||||
CAPS_FXSR equ 24 ;FXSAVE and FXRSTOR instructions
|
||||
CAPS_SSE equ 25 ;SSE instructions
|
||||
CAPS_SSE2 equ 26 ;SSE2 instructions
|
||||
CAPS_SS equ 27 ;self-snoop
|
||||
CAPS_HTT equ 28 ;hyper-threading technology
|
||||
CAPS_TM equ 29 ;thermal monitor supported
|
||||
CAPS_IA64 equ 30 ;IA64 capabilities
|
||||
CAPS_PBE equ 31 ;pending break enable
|
||||
|
||||
;ecx
|
||||
CAPS_SSE3 equ 32 ;SSE3 instructions
|
||||
; 33
|
||||
; 34
|
||||
CAPS_MONITOR equ 35 ;MONITOR/MWAIT instructions
|
||||
CAPS_DS_CPL equ 36 ;
|
||||
CAPS_VMX equ 37 ;virtual mode extensions
|
||||
; 38 ;
|
||||
CAPS_EST equ 39 ;enhansed speed step
|
||||
CAPS_TM2 equ 40 ;thermal monitor2 supported
|
||||
; 41
|
||||
CAPS_CID equ 42 ;
|
||||
; 43
|
||||
; 44
|
||||
CAPS_CX16 equ 45 ;CMPXCHG16B instruction
|
||||
CAPS_xTPR equ 46 ;
|
||||
;
|
||||
;reserved
|
||||
;
|
||||
;ext edx /ecx
|
||||
CAPS_SYSCAL equ 64 ;
|
||||
CAPS_XD equ 65 ;execution disable
|
||||
CAPS_FFXSR equ 66 ;
|
||||
CAPS_RDTSCP equ 67 ;
|
||||
CAPS_X64 equ 68 ;
|
||||
CAPS_3DNOW equ 69 ;
|
||||
CAPS_3DNOWEXT equ 70 ;
|
||||
CAPS_LAHF equ 71 ;
|
||||
CAPS_CMP_LEG equ 72 ;
|
||||
CAPS_SVM equ 73 ;secure virual machine
|
||||
CAPS_ALTMOVCR8 equ 74 ;
|
||||
|
||||
; CPU MSR names
|
||||
MSR_SYSENTER_CS equ 0x174
|
||||
MSR_SYSENTER_ESP equ 0x175
|
||||
MSR_SYSENTER_EIP equ 0x176
|
||||
MSR_AMD_EFER equ 0xC0000080 ; Extended Feature Enable Register
|
||||
MSR_AMD_STAR equ 0xC0000081 ; SYSCALL/SYSRET Target Address Register
|
||||
|
||||
CR0_PE equ 0x00000001 ;protected mode
|
||||
CR0_MP equ 0x00000002 ;monitor fpu
|
||||
CR0_EM equ 0x00000004 ;fpu emulation
|
||||
CR0_TS equ 0x00000008 ;task switch
|
||||
CR0_ET equ 0x00000010 ;extension type hardcoded to 1
|
||||
CR0_NE equ 0x00000020 ;numeric error
|
||||
CR0_WP equ 0x00010000 ;write protect
|
||||
CR0_AM equ 0x00040000 ;alignment check
|
||||
CR0_NW equ 0x20000000 ;not write-through
|
||||
CR0_CD equ 0x40000000 ;cache disable
|
||||
CR0_PG equ 0x80000000 ;paging
|
||||
|
||||
|
||||
CR4_VME equ 0x0001
|
||||
CR4_PVI equ 0x0002
|
||||
CR4_TSD equ 0x0004
|
||||
CR4_DE equ 0x0008
|
||||
CR4_PSE equ 0x0010
|
||||
CR4_PAE equ 0x0020
|
||||
CR4_MCE equ 0x0040
|
||||
CR4_PGE equ 0x0080
|
||||
CR4_PCE equ 0x0100
|
||||
CR4_OSFXSR equ 0x0200
|
||||
CR4_OSXMMEXPT equ 0x0400
|
||||
|
||||
SSE_IE equ 0x0001
|
||||
SSE_DE equ 0x0002
|
||||
SSE_ZE equ 0x0004
|
||||
SSE_OE equ 0x0008
|
||||
SSE_UE equ 0x0010
|
||||
SSE_PE equ 0x0020
|
||||
SSE_DAZ equ 0x0040
|
||||
SSE_IM equ 0x0080
|
||||
SSE_DM equ 0x0100
|
||||
SSE_ZM equ 0x0200
|
||||
SSE_OM equ 0x0400
|
||||
SSE_UM equ 0x0800
|
||||
SSE_PM equ 0x1000
|
||||
SSE_FZ equ 0x8000
|
||||
|
||||
SSE_INIT equ (SSE_IM+SSE_DM+SSE_ZM+SSE_OM+SSE_UM+SSE_PM)
|
||||
|
||||
IRQ_PIC equ 0
|
||||
IRQ_APIC equ 1
|
||||
|
||||
struct TSS
|
||||
_back rw 2
|
||||
_esp0 rd 1
|
||||
_ss0 rw 2
|
||||
_esp1 rd 1
|
||||
_ss1 rw 2
|
||||
_esp2 rd 1
|
||||
_ss2 rw 2
|
||||
_cr3 rd 1
|
||||
_eip rd 1
|
||||
_eflags rd 1
|
||||
_eax rd 1
|
||||
_ecx rd 1
|
||||
_edx rd 1
|
||||
_ebx rd 1
|
||||
_esp rd 1
|
||||
_ebp rd 1
|
||||
_esi rd 1
|
||||
_edi rd 1
|
||||
_es rw 2
|
||||
_cs rw 2
|
||||
_ss rw 2
|
||||
_ds rw 2
|
||||
_fs rw 2
|
||||
_gs rw 2
|
||||
_ldt rw 2
|
||||
_trap rw 1
|
||||
_io rw 1
|
||||
rb 24
|
||||
_io_map_0 rb 4096
|
||||
_io_map_1 rb 4096
|
||||
ends
|
||||
|
||||
PARTITION_COUNT equ 64
|
||||
DRIVE_DATA_SIZE equ (16+PARTITION_COUNT*100)
|
||||
|
||||
OS_BASE equ 0x80000000
|
||||
|
||||
window_data equ (OS_BASE+0x0001000)
|
||||
|
||||
CURRENT_TASK equ (OS_BASE+0x0003000)
|
||||
TASK_COUNT equ (OS_BASE+0x0003004)
|
||||
TASK_BASE equ (OS_BASE+0x0003010)
|
||||
TASK_DATA equ (OS_BASE+0x0003020)
|
||||
TASK_EVENT equ (OS_BASE+0x0003020)
|
||||
|
||||
CDDataBuf equ (OS_BASE+0x0005000)
|
||||
|
||||
;unused 0x6000 - 0x8fff
|
||||
|
||||
BOOT_VARS equ (OS_BASE) ;0x9000
|
||||
|
||||
idts equ (OS_BASE+0x000B100)
|
||||
WIN_STACK equ (OS_BASE+0x000C000)
|
||||
WIN_POS equ (OS_BASE+0x000C400)
|
||||
FDD_BUFF equ (OS_BASE+0x000D000) ;512
|
||||
|
||||
WIN_TEMP_XY equ (OS_BASE+0x000F300)
|
||||
KEY_COUNT equ (OS_BASE+0x000F400)
|
||||
KEY_BUFF equ (OS_BASE+0x000F401)
|
||||
|
||||
BTN_COUNT equ (OS_BASE+0x000F500)
|
||||
BTN_BUFF equ (OS_BASE+0x000F501)
|
||||
|
||||
|
||||
BTN_ADDR equ (OS_BASE+0x000FE88)
|
||||
MEM_AMOUNT equ (OS_BASE+0x000FE8C)
|
||||
|
||||
SYS_SHUTDOWN equ (OS_BASE+0x000FF00)
|
||||
TASK_ACTIVATE equ (OS_BASE+0x000FF01)
|
||||
|
||||
|
||||
TMP_STACK_TOP equ 0x006CC00
|
||||
|
||||
sys_proc equ (OS_BASE+0x006F000)
|
||||
|
||||
SLOT_BASE equ (OS_BASE+0x0080000)
|
||||
|
||||
VGABasePtr equ (OS_BASE+0x00A0000)
|
||||
|
||||
CLEAN_ZONE equ (_CLEAN_ZONE-OS_BASE)
|
||||
IDE_DMA equ (_IDE_DMA-OS_BASE)
|
||||
|
||||
; unused?
|
||||
SB16Buffer equ (OS_BASE+0x02A0000)
|
||||
SB16_Status equ (OS_BASE+0x02B0000)
|
||||
|
||||
UPPER_KERNEL_PAGES equ (OS_BASE+0x0400000)
|
||||
|
||||
virtual at (OS_BASE+0x05FFF80)
|
||||
tss TSS
|
||||
end virtual
|
||||
|
||||
HEAP_BASE equ (OS_BASE+0x0800000)
|
||||
HEAP_MIN_SIZE equ 0x01000000
|
||||
|
||||
page_tabs equ 0xFDC00000
|
||||
app_page_tabs equ 0xFDC00000
|
||||
kernel_tabs equ (page_tabs+ (OS_BASE shr 10)) ;0xFDE00000
|
||||
master_tab equ (page_tabs+ (page_tabs shr 10)) ;0xFDFF70000
|
||||
|
||||
LFB_BASE equ 0xFE000000
|
||||
|
||||
|
||||
new_app_base equ 0;
|
||||
|
||||
twdw equ 0x2000 ;(CURRENT_TASK-window_data)
|
||||
|
||||
std_application_base_address equ new_app_base
|
||||
RING0_STACK_SIZE equ (0x2000 - 512) ;512 байт для контекста FPU
|
||||
|
||||
REG_SS equ (RING0_STACK_SIZE-4)
|
||||
REG_APP_ESP equ (RING0_STACK_SIZE-8)
|
||||
REG_EFLAGS equ (RING0_STACK_SIZE-12)
|
||||
REG_CS equ (RING0_STACK_SIZE-16)
|
||||
REG_EIP equ (RING0_STACK_SIZE-20)
|
||||
REG_EAX equ (RING0_STACK_SIZE-24)
|
||||
REG_ECX equ (RING0_STACK_SIZE-28)
|
||||
REG_EDX equ (RING0_STACK_SIZE-32)
|
||||
REG_EBX equ (RING0_STACK_SIZE-36)
|
||||
REG_ESP equ (RING0_STACK_SIZE-40) ;RING0_STACK_SIZE-20
|
||||
REG_EBP equ (RING0_STACK_SIZE-44)
|
||||
REG_ESI equ (RING0_STACK_SIZE-48)
|
||||
REG_EDI equ (RING0_STACK_SIZE-52)
|
||||
REG_RET equ (RING0_STACK_SIZE-56) ;irq0.return
|
||||
|
||||
|
||||
PG_UNMAP equ 0x000
|
||||
PG_MAP equ 0x001
|
||||
PG_WRITE equ 0x002
|
||||
PG_SW equ 0x003
|
||||
PG_USER equ 0x005
|
||||
PG_UW equ 0x007
|
||||
PG_NOCACHE equ 0x018
|
||||
PG_LARGE equ 0x080
|
||||
PG_GLOBAL equ 0x100
|
||||
|
||||
PG_SHARED equ 0x200
|
||||
|
||||
;;;;;;;;;;;boot time variables
|
||||
|
||||
BOOT_BPP equ 0x9000 ;byte bits per pixel
|
||||
BOOT_PITCH equ 0x9001 ;word scanline length
|
||||
BOOT_VESA_MODE equ 0x9008 ;word vesa video mode
|
||||
BOOT_X_RES equ 0x900A ;word X res
|
||||
BOOT_Y_RES equ 0x900C ;word Y res
|
||||
BOOT_BANK_SW equ 0x9014 ;dword Vesa 1.2 pm bank switch
|
||||
BOOT_LFB equ 0x9018 ;dword Vesa 2.0 LFB address
|
||||
BOOT_MTRR equ 0x901C ;byte 0 or 1 : enable MTRR graphics acceleration
|
||||
;BOOT_LOG equ 0x901D ;byte not used anymore (0 or 1 : enable system log display)
|
||||
BOOT_LAUNCHER_START equ 0x901D ;byte (0 or 1) start the first app (right now it's LAUNCHER) after kernel is loaded?
|
||||
;BOOT_DIRECT_LFB equ 0x901E ;byte 0 or 1 : enable direct lfb write, paging disabled
|
||||
BOOT_DEBUG_PRINT equ 0x901E ;byte If nonzero, duplicates debug output to the screen.
|
||||
BOOT_DMA equ 0x901F ;
|
||||
BOOT_PCI_DATA equ 0x9020 ;8bytes pci data
|
||||
BOOT_VRR equ 0x9030 ;byte VRR start enabled 1, 2-no
|
||||
BOOT_IDE_BASE_ADDR equ 0x9031 ;word IDEContrRegsBaseAddr
|
||||
BOOT_MEM_AMOUNT equ 0x9034 ;dword memory amount
|
||||
|
||||
BOOT_APM_ENTRY equ 0x9040
|
||||
BOOT_APM_VERSION equ 0x9044
|
||||
BOOT_APM_FLAGS equ 0x9046 ;unused
|
||||
BOOT_APM_CODE_32 equ 0x9050
|
||||
BOOT_APM_CODE_16 equ 0x9052
|
||||
BOOT_APM_DATA_16 equ 0x9054
|
||||
BOOT_IDE_BAR0_16 equ 0x9056
|
||||
BOOT_IDE_BAR1_16 equ 0x9058
|
||||
BOOT_IDE_BAR2_16 equ 0x905A
|
||||
BOOT_IDE_BAR3_16 equ 0x905C
|
||||
BOOT_IDE_PI_16 equ 0x905E
|
||||
BOOT_IDE_INTERR_16 equ 0x9060
|
||||
|
||||
TMP_FILE_NAME equ 0
|
||||
TMP_CMD_LINE equ 1024
|
||||
TMP_ICON_OFFS equ 1280
|
||||
|
||||
|
||||
EVENT_REDRAW equ 0x00000001
|
||||
EVENT_KEY equ 0x00000002
|
||||
EVENT_BUTTON equ 0x00000004
|
||||
EVENT_BACKGROUND equ 0x00000010
|
||||
EVENT_MOUSE equ 0x00000020
|
||||
EVENT_IPC equ 0x00000040
|
||||
EVENT_NETWORK equ 0x00000080
|
||||
EVENT_DEBUG equ 0x00000100
|
||||
EVENT_NETWORK2 equ 0x00000200
|
||||
EVENT_EXTENDED equ 0x00000400
|
||||
|
||||
EV_INTR equ 1
|
||||
|
||||
struct THR_DATA
|
||||
rb (8192-512)
|
||||
; pl0_stack
|
||||
fpu_state rb 512
|
||||
tls_page rb 4096
|
||||
pdbr rb 4096
|
||||
ends
|
||||
|
||||
virtual at (OS_BASE-sizeof.THR_DATA)
|
||||
thr_data THR_DATA
|
||||
end virtual
|
||||
|
||||
struct SYS_VARS
|
||||
bpp dd ?
|
||||
scanline dd ?
|
||||
vesa_mode dd ?
|
||||
x_res dd ?
|
||||
y_res dd ?
|
||||
ends
|
||||
|
||||
struct APPOBJ ; common object header
|
||||
magic dd ? ;
|
||||
destroy dd ? ; internal destructor
|
||||
fd dd ? ; next object in list
|
||||
bk dd ? ; prev object in list
|
||||
pid dd ? ; owner id
|
||||
ends
|
||||
|
||||
APP_OBJ_OFFSET equ 48
|
||||
APP_EV_OFFSET equ 40
|
||||
|
||||
struct CURSOR APPOBJ
|
||||
base dd ? ;allocated memory
|
||||
hot_x dd ? ;hotspot coords
|
||||
hot_y dd ?
|
||||
|
||||
list_next dd ? ;next cursor in cursor list
|
||||
list_prev dd ? ;prev cursor in cursor list
|
||||
dev_obj dd ? ;device depended data
|
||||
ends
|
||||
|
||||
|
||||
struct EVENT APPOBJ
|
||||
id dd ? ;event uid
|
||||
state dd ? ;internal flags
|
||||
code dd ?
|
||||
rd 5
|
||||
ends
|
||||
|
||||
|
||||
struct SMEM
|
||||
bk dd ?
|
||||
fd dd ? ;+4
|
||||
base dd ? ;+8
|
||||
size dd ? ;+12
|
||||
access dd ? ;+16
|
||||
refcount dd ? ;+20
|
||||
name rb 32 ;+24
|
||||
ends
|
||||
|
||||
struct SMAP APPOBJ
|
||||
base dd ? ;mapped base
|
||||
parent dd ? ;SMEM
|
||||
ends
|
||||
|
||||
struct DLLDESCR
|
||||
bk dd ?
|
||||
fd dd ? ;+4
|
||||
data dd ? ;+8
|
||||
size dd ? ;+12
|
||||
timestamp dq ?
|
||||
refcount dd ?
|
||||
defaultbase dd ?
|
||||
coff_hdr dd ?
|
||||
symbols_ptr dd ?
|
||||
symbols_num dd ?
|
||||
symbols_lim dd ?
|
||||
exports dd ? ;export table
|
||||
name rb 260
|
||||
ends
|
||||
|
||||
struct HDLL
|
||||
fd dd ? ;next object in list
|
||||
bk dd ? ;prev object in list
|
||||
pid dd ? ;owner id
|
||||
|
||||
base dd ? ;mapped base
|
||||
size dd ? ;mapped size
|
||||
refcount dd ? ;reference counter for this process and this lib
|
||||
parent dd ? ;DLLDESCR
|
||||
ends
|
||||
|
||||
struct display_t
|
||||
x dd ?
|
||||
y dd ?
|
||||
width dd ?
|
||||
height dd ?
|
||||
bpp dd ?
|
||||
vrefresh dd ?
|
||||
pitch dd ?
|
||||
lfb dd ?
|
||||
|
||||
modes dd ?
|
||||
ddev dd ?
|
||||
connector dd ?
|
||||
crtc dd ?
|
||||
|
||||
cr_list.next dd ?
|
||||
cr_list.prev dd ?
|
||||
|
||||
cursor dd ?
|
||||
|
||||
init_cursor dd ?
|
||||
select_cursor dd ?
|
||||
show_cursor dd ?
|
||||
move_cursor dd ?
|
||||
restore_cursor dd ?
|
||||
disable_mouse dd ?
|
||||
mask_seqno dd ?
|
||||
check_mouse dd ?
|
||||
check_m_pixel dd ?
|
||||
ends
|
||||
|
||||
struct BOOT_DATA
|
||||
bpp dd ?
|
||||
scanline dd ?
|
||||
vesa_mode dd ?
|
||||
x_res dd ?
|
||||
y_res dd ?
|
||||
mouse_port dd ?
|
||||
bank_switch dd ?
|
||||
lfb dd ?
|
||||
vesa_mem dd ?
|
||||
log dd ?
|
||||
direct_lfb dd ?
|
||||
pci_data dd ?
|
||||
dd ?
|
||||
vrr dd ?
|
||||
ide_base dd ?
|
||||
mem_amount dd ?
|
||||
pages_count dd ?
|
||||
pagemap_size dd ?
|
||||
kernel_max dd ?
|
||||
kernel_pages dd ?
|
||||
kernel_tables dd ?
|
||||
|
||||
cpu_vendor dd ?
|
||||
dd ?
|
||||
dd ?
|
||||
cpu_sign dd ?
|
||||
cpu_info dd ?
|
||||
cpu_caps dd ?
|
||||
dd ?
|
||||
dd ?
|
||||
ends
|
||||
|
||||
struct LHEAD
|
||||
next dd ? ;next object in list
|
||||
prev dd ? ;prev object in list
|
||||
ends
|
||||
|
||||
struct MUTEX
|
||||
lhead LHEAD
|
||||
count dd ?
|
||||
ends
|
||||
|
||||
struct PCIDEV
|
||||
bk dd ?
|
||||
fd dd ?
|
||||
vendor_device_id dd ?
|
||||
class dd ?
|
||||
devfn db ?
|
||||
bus db ?
|
||||
rb 2
|
||||
owner dd ? ; pointer to SRV or 0
|
||||
ends
|
||||
|
||||
; The following macro assume that we are on uniprocessor machine.
|
||||
; Serious work is needed for multiprocessor machines.
|
||||
macro spin_lock_irqsave spinlock
|
||||
{
|
||||
pushf
|
||||
cli
|
||||
}
|
||||
macro spin_unlock_irqrestore spinlock
|
||||
{
|
||||
popf
|
||||
}
|
||||
macro spin_lock_irq spinlock
|
||||
{
|
||||
cli
|
||||
}
|
||||
macro spin_unlock_irq spinlock
|
||||
{
|
||||
sti
|
||||
}
|
||||
|
||||
struct MEM_STATE
|
||||
mutex MUTEX
|
||||
smallmap dd ?
|
||||
treemap dd ?
|
||||
topsize dd ?
|
||||
top dd ?
|
||||
smallbins rd 4*32
|
||||
treebins rd 32
|
||||
ends
|
||||
|
||||
struct PG_DATA
|
||||
mem_amount dd ?
|
||||
vesa_mem dd ?
|
||||
pages_count dd ?
|
||||
pages_free dd ?
|
||||
pages_faults dd ?
|
||||
pagemap_size dd ?
|
||||
kernel_pages dd ?
|
||||
kernel_tables dd ?
|
||||
sys_page_dir dd ?
|
||||
mutex MUTEX
|
||||
ends
|
||||
|
||||
struct SRV
|
||||
srv_name rb 16 ;ASCIIZ string
|
||||
magic dd ? ;+0x10 ;'SRV '
|
||||
size dd ? ;+0x14 ;size of structure SRV
|
||||
fd dd ? ;+0x18 ;next SRV descriptor
|
||||
bk dd ? ;+0x1C ;prev SRV descriptor
|
||||
base dd ? ;+0x20 ;service base address
|
||||
entry dd ? ;+0x24 ;service START function
|
||||
srv_proc dd ? ;+0x28 ;user mode service handler
|
||||
srv_proc_ex dd ? ;+0x2C ;kernel mode service handler
|
||||
ends
|
||||
|
||||
struct USBSRV
|
||||
srv SRV
|
||||
usb_func dd ?
|
||||
ends
|
||||
|
||||
struct USBFUNC
|
||||
strucsize dd ?
|
||||
add_device dd ?
|
||||
device_disconnect dd ?
|
||||
ends
|
||||
|
||||
DRV_ENTRY equ 1
|
||||
DRV_EXIT equ -1
|
||||
|
||||
struct COFF_HEADER
|
||||
machine dw ?
|
||||
nSections dw ?
|
||||
DataTime dd ?
|
||||
pSymTable dd ?
|
||||
nSymbols dd ?
|
||||
optHeader dw ?
|
||||
flags dw ?
|
||||
ends
|
||||
|
||||
struct COFF_SECTION
|
||||
Name rb 8
|
||||
VirtualSize dd ?
|
||||
VirtualAddress dd ?
|
||||
SizeOfRawData dd ?
|
||||
PtrRawData dd ?
|
||||
PtrReloc dd ?
|
||||
PtrLinenumbers dd ?
|
||||
NumReloc dw ?
|
||||
NumLinenum dw ?
|
||||
Characteristics dd ?
|
||||
ends
|
||||
|
||||
struct COFF_RELOC
|
||||
VirtualAddress dd ?
|
||||
SymIndex dd ?
|
||||
Type dw ?
|
||||
ends
|
||||
|
||||
struct COFF_SYM
|
||||
Name rb 8
|
||||
Value dd ?
|
||||
SectionNumber dw ?
|
||||
Type dw ?
|
||||
StorageClass db ?
|
||||
NumAuxSymbols db ?
|
||||
ends
|
||||
|
||||
struct IOCTL
|
||||
handle dd ?
|
||||
io_code dd ?
|
||||
input dd ?
|
||||
inp_size dd ?
|
||||
output dd ?
|
||||
out_size dd ?
|
||||
ends
|
||||
|
||||
struct IRQH
|
||||
list LHEAD
|
||||
handler dd ? ;handler roututine
|
||||
data dd ? ;user-specific data
|
||||
num_ints dd ? ;how many times handled
|
||||
ends
|
||||
443
kernel/branches/kolibri-process/core/apic.inc
Normal file
443
kernel/branches/kolibri-process/core/apic.inc
Normal file
@@ -0,0 +1,443 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
|
||||
iglobal
|
||||
IRQ_COUNT dd 24
|
||||
endg
|
||||
|
||||
uglobal
|
||||
irq_mode rd 1
|
||||
IOAPIC_base rd 1
|
||||
LAPIC_BASE rd 1
|
||||
endg
|
||||
|
||||
APIC_ID equ 0x20
|
||||
APIC_TPR equ 0x80
|
||||
APIC_EOI equ 0xb0
|
||||
APIC_LDR equ 0xd0
|
||||
APIC_DFR equ 0xe0
|
||||
APIC_SVR equ 0xf0
|
||||
APIC_ISR equ 0x100
|
||||
APIC_ESR equ 0x280
|
||||
APIC_ICRL equ 0x300
|
||||
APIC_ICRH equ 0x310
|
||||
APIC_LVT_LINT0 equ 0x350
|
||||
APIC_LVT_LINT1 equ 0x360
|
||||
APIC_LVT_err equ 0x370
|
||||
|
||||
; APIC timer
|
||||
APIC_LVT_timer equ 0x320
|
||||
APIC_timer_div equ 0x3e0
|
||||
APIC_timer_init equ 0x380
|
||||
APIC_timer_cur equ 0x390
|
||||
; IOAPIC
|
||||
IOAPIC_ID equ 0x0
|
||||
IOAPIC_VER equ 0x1
|
||||
IOAPIC_ARB equ 0x2
|
||||
IOAPIC_REDTBL equ 0x10
|
||||
|
||||
align 4
|
||||
APIC_init:
|
||||
mov [irq_mode], IRQ_PIC
|
||||
|
||||
cmp [acpi_ioapic_base], 0
|
||||
jz .no_apic
|
||||
|
||||
cmp [acpi_lapic_base], 0
|
||||
jz .no_apic
|
||||
|
||||
stdcall load_file, dev_data_path
|
||||
test eax, eax
|
||||
jz .no_apic
|
||||
|
||||
mov [acpi_dev_data], eax
|
||||
mov [acpi_dev_size], ebx
|
||||
|
||||
call IRQ_mask_all
|
||||
|
||||
; IOAPIC init
|
||||
stdcall map_io_mem, [acpi_ioapic_base], 0x20, PG_SW+PG_NOCACHE
|
||||
mov [IOAPIC_base], eax
|
||||
|
||||
mov eax, IOAPIC_VER
|
||||
call IOAPIC_read
|
||||
shr eax, 16
|
||||
inc al
|
||||
movzx eax, al
|
||||
cmp al, IRQ_RESERVED
|
||||
jbe @f
|
||||
|
||||
mov al, IRQ_RESERVED
|
||||
@@:
|
||||
mov [IRQ_COUNT], eax
|
||||
|
||||
; Reroute IOAPIC & mask all interrupts
|
||||
xor ecx, ecx
|
||||
mov eax, IOAPIC_REDTBL
|
||||
@@:
|
||||
mov ebx, eax
|
||||
call IOAPIC_read
|
||||
mov ah, 0x08; Delivery Mode: Fixed, Destination Mode: Logical
|
||||
mov al, cl
|
||||
add al, 0x20; vector
|
||||
or eax, 0x10000; Mask Interrupt
|
||||
cmp ecx, 16
|
||||
jb .set
|
||||
|
||||
or eax, 0xa000;<<< level-triggered active-low for IRQ16+
|
||||
.set:
|
||||
xchg eax, ebx
|
||||
call IOAPIC_write
|
||||
inc eax
|
||||
mov ebx, eax
|
||||
call IOAPIC_read
|
||||
or eax, 0xff000000; Destination Field
|
||||
xchg eax, ebx
|
||||
call IOAPIC_write
|
||||
inc eax
|
||||
inc ecx
|
||||
cmp ecx, [IRQ_COUNT]
|
||||
jb @b
|
||||
|
||||
call LAPIC_init
|
||||
|
||||
mov [irq_mode], IRQ_APIC
|
||||
|
||||
mov al, 0x70
|
||||
out 0x22, al
|
||||
mov al, 1
|
||||
out 0x23, al
|
||||
|
||||
call pci_irq_fixup
|
||||
.no_apic:
|
||||
|
||||
ret
|
||||
|
||||
;===========================================================
|
||||
align 4
|
||||
LAPIC_init:
|
||||
|
||||
cmp [LAPIC_BASE], 0
|
||||
jne .done
|
||||
|
||||
stdcall map_io_mem, [acpi_lapic_base], 0x1000, PG_SW+PG_NOCACHE
|
||||
mov [LAPIC_BASE], eax
|
||||
mov esi, eax
|
||||
|
||||
; Program Destination Format Register for Flat mode.
|
||||
mov eax, [esi + APIC_DFR]
|
||||
or eax, 0xf0000000
|
||||
mov [esi + APIC_DFR], eax
|
||||
|
||||
; Program Logical Destination Register.
|
||||
mov eax, [esi + APIC_LDR]
|
||||
;and eax, 0xff000000
|
||||
and eax, 0x00ffffff
|
||||
or eax, 0x01000000;!!!!!!!!!!!!
|
||||
mov [esi + APIC_LDR], eax
|
||||
|
||||
; Task Priority Register initialization.
|
||||
mov eax, [esi + APIC_TPR]
|
||||
and eax, 0xffffff00
|
||||
mov [esi + APIC_TPR], eax
|
||||
|
||||
; Flush the queue
|
||||
mov edx, 0
|
||||
.nxt2:
|
||||
mov ecx, 32
|
||||
mov eax, [esi + APIC_ISR + edx]
|
||||
.nxt:
|
||||
shr eax, 1
|
||||
jnc @f
|
||||
mov dword [esi + APIC_EOI], 0; EOI
|
||||
@@:
|
||||
loop .nxt
|
||||
|
||||
add edx, 0x10
|
||||
cmp edx, 0x170
|
||||
jbe .nxt2
|
||||
|
||||
; Spurious-Interrupt Vector Register initialization.
|
||||
mov eax, [esi + APIC_SVR]
|
||||
or eax, 0x1ff
|
||||
and eax, 0xfffffdff
|
||||
mov [esi + APIC_SVR], eax
|
||||
|
||||
; Initialize LVT LINT0 register. (INTR)
|
||||
mov eax, 0x00700
|
||||
; mov eax, 0x10700
|
||||
mov [esi + APIC_LVT_LINT0], eax
|
||||
|
||||
; Initialize LVT LINT1 register. (NMI)
|
||||
mov eax, 0x00400
|
||||
mov [esi + APIC_LVT_LINT1], eax
|
||||
|
||||
; Initialize LVT Error register.
|
||||
mov eax, [esi + APIC_LVT_err]
|
||||
or eax, 0x10000; bit 16
|
||||
mov [esi + APIC_LVT_err], eax
|
||||
|
||||
; LAPIC timer
|
||||
; pre init
|
||||
mov dword[esi + APIC_timer_div], 1011b; 1
|
||||
mov dword[esi + APIC_timer_init], 0xffffffff; max val
|
||||
push esi
|
||||
mov esi, 640 ; wait 0.64 sec
|
||||
call delay_ms
|
||||
pop esi
|
||||
mov eax, [esi + APIC_timer_cur]; read current tick couner
|
||||
xor eax, 0xffffffff ; eax = 0xffffffff - eax
|
||||
shr eax, 6 ; eax /= 64; APIC ticks per 0.01 sec
|
||||
|
||||
; Start (every 0.01 sec)
|
||||
mov dword[esi + APIC_LVT_timer], 0x30020; periodic int 0x20
|
||||
mov dword[esi + APIC_timer_init], eax
|
||||
|
||||
.done:
|
||||
ret
|
||||
|
||||
;===========================================================
|
||||
; IOAPIC implementation
|
||||
align 4
|
||||
IOAPIC_read:
|
||||
; in : EAX - IOAPIC register
|
||||
; out: EAX - readed value
|
||||
push esi
|
||||
mov esi, [IOAPIC_base]
|
||||
mov [esi], eax
|
||||
mov eax, [esi + 0x10]
|
||||
pop esi
|
||||
ret
|
||||
|
||||
align 4
|
||||
IOAPIC_write:
|
||||
; in : EAX - IOAPIC register
|
||||
; EBX - value
|
||||
; out: none
|
||||
push esi
|
||||
mov esi, [IOAPIC_base]
|
||||
mov [esi], eax
|
||||
mov [esi + 0x10], ebx
|
||||
pop esi
|
||||
ret
|
||||
;===========================================================
|
||||
; Remap all IRQ to 0x20+ Vectors
|
||||
; IRQ0 to vector 0x20, IRQ1 to vector 0x21....
|
||||
align 4
|
||||
PIC_init:
|
||||
cli
|
||||
mov al, 0x11 ; icw4, edge triggered
|
||||
out 0x20, al
|
||||
out 0xA0, al
|
||||
|
||||
mov al, 0x20 ; generate 0x20 +
|
||||
out 0x21, al
|
||||
mov al, 0x28 ; generate 0x28 +
|
||||
out 0xA1, al
|
||||
|
||||
mov al, 0x04 ; slave at irq2
|
||||
out 0x21, al
|
||||
mov al, 0x02 ; at irq9
|
||||
out 0xA1, al
|
||||
|
||||
mov al, 0x01 ; 8086 mode
|
||||
out 0x21, al
|
||||
out 0xA1, al
|
||||
|
||||
call IRQ_mask_all
|
||||
; mov dword[irq_type_to_set], IRQ_TYPE_PIC
|
||||
ret
|
||||
|
||||
; -----------------------------------------
|
||||
; TIMER SET TO 1/100 S
|
||||
align 4
|
||||
PIT_init:
|
||||
mov al, 0x34 ; set to 100Hz
|
||||
out 0x43, al
|
||||
mov al, 0x9b ; lsb 1193180 / 1193
|
||||
out 0x40, al
|
||||
mov al, 0x2e ; msb
|
||||
out 0x40, al
|
||||
ret
|
||||
|
||||
; -----------------------------------------
|
||||
align 4
|
||||
unmask_timer:
|
||||
cmp [irq_mode], IRQ_APIC
|
||||
je @f
|
||||
|
||||
stdcall enable_irq, 0
|
||||
ret
|
||||
@@:
|
||||
; use PIT
|
||||
; in some systems PIT no connected to IOAPIC
|
||||
; mov eax, 0x14
|
||||
; call IOAPIC_read
|
||||
; mov ah, 0x09 ; Delivery Mode: Lowest Priority, Destination Mode: Logical
|
||||
; mov al, 0x20
|
||||
; or eax, 0x10000 ; Mask Interrupt
|
||||
; mov ebx, eax
|
||||
; mov eax, 0x14
|
||||
; call IOAPIC_write
|
||||
; stdcall enable_irq, 2
|
||||
; ret
|
||||
|
||||
; use LAPIC timer
|
||||
mov esi, [LAPIC_BASE]
|
||||
mov eax, [esi + APIC_LVT_timer]
|
||||
and eax, 0xfffeffff
|
||||
mov [esi + APIC_LVT_timer], eax
|
||||
ret
|
||||
|
||||
; -----------------------------------------
|
||||
; Disable all IRQ
|
||||
align 4
|
||||
IRQ_mask_all:
|
||||
cmp [irq_mode], IRQ_APIC
|
||||
je .APIC
|
||||
|
||||
mov al, 0xFF
|
||||
out 0x21, al
|
||||
out 0xA1, al
|
||||
mov ecx, 0x1000
|
||||
ret
|
||||
.APIC:
|
||||
mov ecx, [IRQ_COUNT]
|
||||
mov eax, 0x10
|
||||
@@:
|
||||
mov ebx, eax
|
||||
call IOAPIC_read
|
||||
or eax, 0x10000; bit 16
|
||||
xchg eax, ebx
|
||||
call IOAPIC_write
|
||||
inc eax
|
||||
inc eax
|
||||
loop @b
|
||||
ret
|
||||
|
||||
; -----------------------------------------
|
||||
; End Of Interrupt
|
||||
; cl - IRQ number
|
||||
align 4
|
||||
irq_eoi: ; __fastcall
|
||||
cmp [irq_mode], IRQ_APIC
|
||||
je .APIC
|
||||
|
||||
cmp cl, 8
|
||||
mov al, 0x20
|
||||
jb @f
|
||||
out 0xa0, al
|
||||
@@:
|
||||
out 0x20, al
|
||||
ret
|
||||
|
||||
.APIC:
|
||||
mov eax, [LAPIC_BASE]
|
||||
mov dword [eax + APIC_EOI], 0; EOI
|
||||
ret
|
||||
|
||||
; -----------------------------------------
|
||||
; from dll.inc
|
||||
align 4
|
||||
proc enable_irq stdcall, irq_line:dword
|
||||
mov ebx, [irq_line]
|
||||
cmp [irq_mode], IRQ_APIC
|
||||
je .APIC
|
||||
|
||||
mov edx, 0x21
|
||||
cmp ebx, 8
|
||||
jb @F
|
||||
|
||||
mov edx, 0xA1
|
||||
sub ebx, 8
|
||||
@@:
|
||||
in al, dx
|
||||
btr eax, ebx
|
||||
out dx, al
|
||||
ret
|
||||
.APIC:
|
||||
shl ebx, 1
|
||||
add ebx, 0x10
|
||||
mov eax, ebx
|
||||
call IOAPIC_read
|
||||
and eax, 0xfffeffff; bit 16
|
||||
xchg eax, ebx
|
||||
call IOAPIC_write
|
||||
ret
|
||||
endp
|
||||
|
||||
proc disable_irq stdcall, irq_line:dword
|
||||
mov ebx, [irq_line]
|
||||
cmp [irq_mode], IRQ_APIC
|
||||
je .APIC
|
||||
|
||||
mov edx, 0x21
|
||||
cmp ebx, 8
|
||||
jb @F
|
||||
|
||||
mov edx, 0xA1
|
||||
sub ebx, 8
|
||||
@@:
|
||||
in al, dx
|
||||
bts eax, ebx
|
||||
out dx, al
|
||||
ret
|
||||
.APIC:
|
||||
shl ebx, 1
|
||||
add ebx, 0x10
|
||||
mov eax, ebx
|
||||
call IOAPIC_read
|
||||
or eax, 0x10000; bit 16
|
||||
xchg eax, ebx
|
||||
call IOAPIC_write
|
||||
ret
|
||||
endp
|
||||
|
||||
align 4
|
||||
pci_irq_fixup:
|
||||
|
||||
push ebp
|
||||
|
||||
mov esi, [acpi_dev_data]
|
||||
mov ebx, [acpi_dev_size]
|
||||
|
||||
lea edi, [esi+ebx]
|
||||
|
||||
.iterate:
|
||||
|
||||
cmp esi, edi
|
||||
jae .done
|
||||
|
||||
mov eax, [esi]
|
||||
|
||||
cmp eax, -1
|
||||
je .done
|
||||
|
||||
movzx ebx, al
|
||||
movzx ebp, ah
|
||||
|
||||
stdcall pci_read32, ebp, ebx, 0
|
||||
|
||||
cmp eax, [esi+4]
|
||||
jne .skip
|
||||
|
||||
mov eax, [esi+8]
|
||||
stdcall pci_write8, ebp, ebx, 0x3C, eax
|
||||
.skip:
|
||||
add esi, 16
|
||||
jmp .iterate
|
||||
|
||||
.done:
|
||||
.fail:
|
||||
pop ebp
|
||||
ret
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
148
kernel/branches/kolibri-process/core/clipboard.inc
Normal file
148
kernel/branches/kolibri-process/core/clipboard.inc
Normal file
@@ -0,0 +1,148 @@
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
sys_clipboard:
|
||||
xor eax, eax
|
||||
dec eax
|
||||
; check availability of main list
|
||||
cmp [clipboard_main_list], eax
|
||||
je .exit_1 ; main list area not found
|
||||
|
||||
test ebx, ebx ; 0 - Get the number of slots in the clipboard
|
||||
jnz .1
|
||||
; get the number of slots
|
||||
mov eax, [clipboard_slots]
|
||||
jmp .exit_1
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
.1:
|
||||
dec ebx ; 1 - Read the data from the clipboard
|
||||
jnz .2
|
||||
; verify the existence of slot
|
||||
cmp ecx, [clipboard_slots]
|
||||
jae .exit_2
|
||||
; get a pointer to the data of slot
|
||||
shl ecx, 2
|
||||
add ecx, [clipboard_main_list]
|
||||
mov esi, [ecx]
|
||||
mov ecx, [esi]
|
||||
; allocate memory for application for copy the data of slots
|
||||
push ecx
|
||||
stdcall user_alloc, ecx
|
||||
pop ecx
|
||||
; copying data of slots
|
||||
mov edi, eax
|
||||
cld
|
||||
rep movsb
|
||||
jmp .exit_1
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
.2:
|
||||
dec ebx ; 2 - Write the data to the clipboard
|
||||
jnz .3
|
||||
; check the lock
|
||||
mov ebx, clipboard_write_lock
|
||||
xor eax, eax
|
||||
cmp [ebx], eax
|
||||
jne .exit_2
|
||||
; lock last slot
|
||||
inc eax
|
||||
mov [ebx], eax
|
||||
; check the overflow pointer of slots
|
||||
cmp [clipboard_slots], 1024
|
||||
jae .exit_3
|
||||
; get memory for new slot
|
||||
push ebx ecx edx
|
||||
stdcall kernel_alloc, ecx
|
||||
pop edx ecx ebx
|
||||
test eax, eax
|
||||
jz .exit_3
|
||||
; create a new slot
|
||||
mov edi, eax
|
||||
mov eax, [clipboard_slots]
|
||||
shl eax, 2
|
||||
add eax, [clipboard_main_list]
|
||||
mov [eax], edi
|
||||
; copy the data into the slot
|
||||
mov esi, edx
|
||||
mov eax, ecx
|
||||
cld
|
||||
stosd ; store size of slot
|
||||
sub ecx, 4
|
||||
add esi, 4
|
||||
rep movsb ; store slot data
|
||||
; increase the counter of slots
|
||||
inc [clipboard_slots]
|
||||
; unlock last slot
|
||||
xor eax, eax
|
||||
mov [ebx], eax
|
||||
jmp .exit_1
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
.3:
|
||||
dec ebx ; 3 - Delete the last slot in the clipboard
|
||||
jnz .4
|
||||
; check the availability of slots
|
||||
mov eax, [clipboard_slots]
|
||||
test eax, eax
|
||||
jz .exit_2
|
||||
; check the lock
|
||||
mov ebx, clipboard_write_lock
|
||||
xor eax, eax
|
||||
cmp [ebx], eax
|
||||
jne .exit_2
|
||||
; lock last slot
|
||||
inc eax
|
||||
mov [ebx], eax
|
||||
; decrease the counter of slots
|
||||
mov eax, clipboard_slots
|
||||
dec dword [eax]
|
||||
; free of kernel memory allocated for the slot
|
||||
mov eax, [eax]
|
||||
shl eax, 2
|
||||
add eax, [clipboard_main_list]
|
||||
mov eax, [eax]
|
||||
push ebx
|
||||
stdcall kernel_free, eax
|
||||
pop ebx
|
||||
; unlock last slot
|
||||
xor eax, eax
|
||||
mov [ebx], eax
|
||||
jmp .exit_1
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
.4:
|
||||
dec ebx ; 4 - Emergency discharge of clipboard
|
||||
jnz .exit
|
||||
; check the lock
|
||||
mov ebx, clipboard_write_lock
|
||||
xor eax, eax
|
||||
cmp [ebx], eax
|
||||
je .exit_2
|
||||
|
||||
; there should be a procedure for checking the integrity of the slots
|
||||
; and I will do so in the future
|
||||
|
||||
; unlock last slot
|
||||
mov [ebx], eax
|
||||
jmp .exit
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
.exit_3:
|
||||
; unlock last slot
|
||||
xor eax, eax
|
||||
mov [ebx], eax
|
||||
.exit_2:
|
||||
xor eax, eax
|
||||
inc eax ; error
|
||||
.exit_1:
|
||||
mov [esp + 32], eax
|
||||
.exit:
|
||||
ret
|
||||
;------------------------------------------------------------------------------
|
||||
uglobal
|
||||
align 4
|
||||
clipboard_slots dd ?
|
||||
clipboard_main_list dd ?
|
||||
clipboard_write_lock dd ?
|
||||
endg
|
||||
;------------------------------------------------------------------------------
|
||||
11
kernel/branches/kolibri-process/core/conf_lib-sp.inc
Normal file
11
kernel/branches/kolibri-process/core/conf_lib-sp.inc
Normal file
@@ -0,0 +1,11 @@
|
||||
; Éste archivo debe ser editado con codificación CP866
|
||||
|
||||
ugui_mouse_speed cp850 'velocidad del ratón',0
|
||||
ugui_mouse_delay cp850 'demora del ratón',0
|
||||
|
||||
udev cp850 'disp',0
|
||||
unet cp850 'red',0
|
||||
unet_active cp850 'activa',0
|
||||
unet_addr cp850 'direc',0
|
||||
unet_mask cp850 'másc',0
|
||||
unet_gate cp850 'puer',0
|
||||
254
kernel/branches/kolibri-process/core/conf_lib.inc
Normal file
254
kernel/branches/kolibri-process/core/conf_lib.inc
Normal file
@@ -0,0 +1,254 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;-------------------------------------------------------------------------
|
||||
;Loading configuration from ini file
|
||||
; {SPraid.simba}
|
||||
;-------------------------------------------------------------------------
|
||||
|
||||
$Revision: 3545 $
|
||||
|
||||
iglobal
|
||||
conf_path_sect:
|
||||
db 'path',0
|
||||
|
||||
conf_fname db '/sys/sys.conf',0
|
||||
endg
|
||||
; set soke kernel configuration
|
||||
proc set_kernel_conf
|
||||
locals
|
||||
par db 30 dup(?)
|
||||
endl
|
||||
|
||||
pushad
|
||||
;[gui]
|
||||
;mouse_speed
|
||||
|
||||
lea eax, [par]
|
||||
push eax
|
||||
invoke ini.get_str, conf_fname, ugui, ugui_mouse_speed, \
|
||||
eax,30, ugui_mouse_speed_def
|
||||
pop eax
|
||||
stdcall strtoint, eax
|
||||
mov [mouse_speed_factor], ax
|
||||
|
||||
;mouse_delay
|
||||
lea eax, [par]
|
||||
push eax
|
||||
invoke ini.get_str, conf_fname, ugui, ugui_mouse_delay, \
|
||||
eax,30, ugui_mouse_delay_def
|
||||
pop eax
|
||||
stdcall strtoint, eax
|
||||
mov [mouse_delay], eax
|
||||
|
||||
|
||||
;midibase
|
||||
lea eax, [par]
|
||||
push eax
|
||||
invoke ini.get_str, conf_fname, udev, udev_midibase, eax, 30, udev_midibase_def
|
||||
pop eax
|
||||
stdcall strtoint, eax
|
||||
|
||||
cmp eax, 0x100
|
||||
jb @f
|
||||
cmp eax, 0x10000
|
||||
jae @f
|
||||
mov [midi_base], ax
|
||||
mov [mididp], eax
|
||||
inc eax
|
||||
mov [midisp], eax
|
||||
@@:
|
||||
popad
|
||||
ret
|
||||
endp
|
||||
iglobal
|
||||
ugui db 'gui',0
|
||||
ugui_mouse_speed_def db '2',0
|
||||
ugui_mouse_delay_def db '0x00A',0
|
||||
udev_midibase db 'midibase',0
|
||||
udev_midibase_def db '0x320',0
|
||||
endg
|
||||
|
||||
iglobal
|
||||
if lang eq sp
|
||||
include 'core/conf_lib-sp.inc'
|
||||
else
|
||||
ugui_mouse_speed db 'mouse_speed',0
|
||||
ugui_mouse_delay db 'mouse_delay',0
|
||||
udev db 'dev',0
|
||||
unet db 'net',0
|
||||
unet_active db 'active',0
|
||||
unet_addr db 'addr',0
|
||||
unet_mask db 'mask',0
|
||||
unet_gate db 'gate',0
|
||||
end if
|
||||
unet_def db 0
|
||||
endg
|
||||
; convert string to DWord
|
||||
proc strtoint stdcall,strs
|
||||
pushad
|
||||
|
||||
mov eax, [strs]
|
||||
inc eax
|
||||
mov bl, [eax]
|
||||
cmp bl, 'x'
|
||||
je .hex
|
||||
cmp bl, 'X'
|
||||
je .hex
|
||||
jmp .dec
|
||||
.hex:
|
||||
inc eax
|
||||
stdcall strtoint_hex, eax
|
||||
jmp .exit
|
||||
.dec:
|
||||
dec eax
|
||||
stdcall strtoint_dec, eax
|
||||
.exit:
|
||||
mov [esp+28], eax
|
||||
popad
|
||||
ret
|
||||
endp
|
||||
|
||||
; convert string to DWord for decimal value
|
||||
proc strtoint_dec stdcall,strs
|
||||
pushad
|
||||
xor edx, edx
|
||||
; поиск конца
|
||||
mov esi, [strs]
|
||||
@@:
|
||||
lodsb
|
||||
or al, al
|
||||
jnz @b
|
||||
mov ebx, esi
|
||||
mov esi, [strs]
|
||||
dec ebx
|
||||
sub ebx, esi
|
||||
mov ecx, 1
|
||||
|
||||
@@:
|
||||
dec ebx
|
||||
or ebx, ebx
|
||||
jz @f
|
||||
imul ecx, ecx, 10; порядок
|
||||
jmp @b
|
||||
@@:
|
||||
|
||||
xchg ebx, ecx
|
||||
|
||||
|
||||
xor ecx, ecx
|
||||
|
||||
|
||||
@@:
|
||||
xor eax, eax
|
||||
lodsb
|
||||
cmp al, 0
|
||||
je .eend
|
||||
|
||||
sub al, 30h
|
||||
imul ebx
|
||||
add ecx, eax
|
||||
push ecx
|
||||
xchg eax, ebx
|
||||
mov ecx, 10
|
||||
div ecx
|
||||
xchg eax, ebx
|
||||
pop ecx
|
||||
jmp @b
|
||||
|
||||
.eend:
|
||||
mov [esp+28], ecx
|
||||
popad
|
||||
ret
|
||||
endp
|
||||
|
||||
;convert string to DWord for hex value
|
||||
proc strtoint_hex stdcall,strs
|
||||
pushad
|
||||
xor edx, edx
|
||||
|
||||
mov esi, [strs]
|
||||
mov ebx, 1
|
||||
add esi, 1
|
||||
|
||||
@@:
|
||||
lodsb
|
||||
or al, al
|
||||
jz @f
|
||||
shl ebx, 4
|
||||
jmp @b
|
||||
@@:
|
||||
xor ecx, ecx
|
||||
mov esi, [strs]
|
||||
|
||||
@@:
|
||||
xor eax, eax
|
||||
lodsb
|
||||
cmp al, 0
|
||||
je .eend
|
||||
|
||||
cmp al, 'a'
|
||||
jae .bm
|
||||
cmp al, 'A'
|
||||
jae .bb
|
||||
jmp .cc
|
||||
.bm: ; 57h
|
||||
sub al, 57h
|
||||
jmp .do
|
||||
|
||||
.bb: ; 37h
|
||||
sub al, 37h
|
||||
jmp .do
|
||||
|
||||
.cc: ; 30h
|
||||
sub al, 30h
|
||||
|
||||
.do:
|
||||
imul ebx
|
||||
add ecx, eax
|
||||
shr ebx, 4
|
||||
|
||||
jmp @b
|
||||
|
||||
.eend:
|
||||
mov [esp+28], ecx
|
||||
popad
|
||||
ret
|
||||
endp
|
||||
|
||||
|
||||
; convert string to DWord for IP addres
|
||||
proc do_inet_adr stdcall,strs
|
||||
pushad
|
||||
|
||||
mov esi, [strs]
|
||||
mov ebx, 0
|
||||
.next:
|
||||
push esi
|
||||
@@:
|
||||
lodsb
|
||||
or al, al
|
||||
jz @f
|
||||
cmp al, '.'
|
||||
jz @f
|
||||
jmp @b
|
||||
@@:
|
||||
mov cl, al
|
||||
mov [esi-1], byte 0
|
||||
;pop eax
|
||||
call strtoint_dec
|
||||
rol eax, 24
|
||||
ror ebx, 8
|
||||
add ebx, eax
|
||||
or cl, cl
|
||||
jz @f
|
||||
jmp .next
|
||||
@@:
|
||||
mov [esp+28], ebx
|
||||
popad
|
||||
ret
|
||||
endp
|
||||
435
kernel/branches/kolibri-process/core/debug.inc
Normal file
435
kernel/branches/kolibri-process/core/debug.inc
Normal file
@@ -0,0 +1,435 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
; diamond, 2006
|
||||
sys_debug_services:
|
||||
cmp ebx, 9
|
||||
ja @f
|
||||
jmp dword [sys_debug_services_table+ebx*4]
|
||||
@@:
|
||||
ret
|
||||
iglobal
|
||||
align 4
|
||||
sys_debug_services_table:
|
||||
dd debug_set_event_data
|
||||
dd debug_getcontext
|
||||
dd debug_setcontext
|
||||
dd debug_detach
|
||||
dd debug_suspend
|
||||
dd debug_resume
|
||||
dd debug_read_process_memory
|
||||
dd debug_write_process_memory
|
||||
dd debug_terminate
|
||||
dd debug_set_drx
|
||||
endg
|
||||
debug_set_event_data:
|
||||
; in: ecx = pointer
|
||||
; destroys eax
|
||||
mov eax, [current_slot]
|
||||
mov [eax+APPDATA.dbg_event_mem], ecx
|
||||
ret
|
||||
|
||||
get_debuggee_slot:
|
||||
; in: ecx=PID
|
||||
; out: CF=1 if error
|
||||
; CF=0 and eax=slot*0x20 if ok
|
||||
; out: interrupts disabled
|
||||
cli
|
||||
mov eax, ecx
|
||||
call pid_to_slot
|
||||
test eax, eax
|
||||
jz .ret_bad
|
||||
shl eax, 5
|
||||
push ebx
|
||||
mov ebx, [CURRENT_TASK]
|
||||
cmp [SLOT_BASE+eax*8+APPDATA.debugger_slot], ebx
|
||||
pop ebx
|
||||
jnz .ret_bad
|
||||
; clc ; automatically
|
||||
ret
|
||||
.ret_bad:
|
||||
stc
|
||||
ret
|
||||
|
||||
debug_detach:
|
||||
; in: ecx=pid
|
||||
; destroys eax,ebx
|
||||
call get_debuggee_slot
|
||||
jc .ret
|
||||
and dword [eax*8+SLOT_BASE+APPDATA.debugger_slot], 0
|
||||
call do_resume
|
||||
.ret:
|
||||
sti
|
||||
ret
|
||||
|
||||
debug_terminate:
|
||||
; in: ecx=pid
|
||||
call get_debuggee_slot
|
||||
jc debug_detach.ret
|
||||
mov ecx, eax
|
||||
shr ecx, 5
|
||||
; push 2
|
||||
; pop ebx
|
||||
mov edx, esi
|
||||
jmp sysfn_terminate
|
||||
|
||||
debug_suspend:
|
||||
; in: ecx=pid
|
||||
; destroys eax,ecx
|
||||
cli
|
||||
mov eax, ecx
|
||||
call pid_to_slot
|
||||
shl eax, 5
|
||||
jz .ret
|
||||
mov cl, [CURRENT_TASK+eax+TASKDATA.state] ; process state
|
||||
test cl, cl
|
||||
jz .1
|
||||
cmp cl, 5
|
||||
jnz .ret
|
||||
mov cl, 2
|
||||
.2:
|
||||
mov [CURRENT_TASK+eax+TASKDATA.state], cl
|
||||
.ret:
|
||||
sti
|
||||
ret
|
||||
.1:
|
||||
inc ecx
|
||||
jmp .2
|
||||
|
||||
do_resume:
|
||||
mov cl, [CURRENT_TASK+eax+TASKDATA.state]
|
||||
cmp cl, 1
|
||||
jz .1
|
||||
cmp cl, 2
|
||||
jnz .ret
|
||||
mov cl, 5
|
||||
.2:
|
||||
mov [CURRENT_TASK+eax+TASKDATA.state], cl
|
||||
.ret:
|
||||
ret
|
||||
.1:
|
||||
dec ecx
|
||||
jmp .2
|
||||
|
||||
debug_resume:
|
||||
; in: ecx=pid
|
||||
; destroys eax,ebx
|
||||
cli
|
||||
mov eax, ecx
|
||||
call pid_to_slot
|
||||
shl eax, 5
|
||||
jz .ret
|
||||
call do_resume
|
||||
.ret:
|
||||
sti
|
||||
ret
|
||||
|
||||
debug_getcontext:
|
||||
; in:
|
||||
; ecx=pid
|
||||
; edx=sizeof(CONTEXT)
|
||||
; esi->CONTEXT
|
||||
; destroys eax,ecx,edx,esi,edi
|
||||
cmp edx, 28h
|
||||
jnz .ret
|
||||
; push ecx
|
||||
; mov ecx, esi
|
||||
call check_region
|
||||
; pop ecx
|
||||
dec eax
|
||||
jnz .ret
|
||||
call get_debuggee_slot
|
||||
jc .ret
|
||||
mov edi, esi
|
||||
mov eax, [eax*8+SLOT_BASE+APPDATA.pl0_stack]
|
||||
lea esi, [eax+RING0_STACK_SIZE]
|
||||
|
||||
.ring0:
|
||||
; note that following code assumes that all interrupt/exception handlers
|
||||
; saves ring-3 context by pushad in this order
|
||||
; top of ring0 stack: ring3 stack ptr (ss+esp), iret data (cs+eip+eflags), pushad
|
||||
sub esi, 8+12+20h
|
||||
lodsd ;edi
|
||||
mov [edi+24h], eax
|
||||
lodsd ;esi
|
||||
mov [edi+20h], eax
|
||||
lodsd ; ebp
|
||||
mov [edi+1Ch], eax
|
||||
lodsd ;esp
|
||||
lodsd ;ebx
|
||||
mov [edi+14h], eax
|
||||
lodsd ;edx
|
||||
mov [edi+10h], eax
|
||||
lodsd ;ecx
|
||||
mov [edi+0Ch], eax
|
||||
lodsd ;eax
|
||||
mov [edi+8], eax
|
||||
lodsd ;eip
|
||||
mov [edi], eax
|
||||
lodsd ;cs
|
||||
lodsd ;eflags
|
||||
mov [edi+4], eax
|
||||
lodsd ;esp
|
||||
mov [edi+18h], eax
|
||||
.ret:
|
||||
sti
|
||||
ret
|
||||
|
||||
debug_setcontext:
|
||||
; in:
|
||||
; ecx=pid
|
||||
; edx=sizeof(CONTEXT)
|
||||
; esi->CONTEXT
|
||||
; destroys eax,ecx,edx,esi,edi
|
||||
cmp edx, 28h
|
||||
jnz .ret
|
||||
; push ebx
|
||||
; mov ebx, edx
|
||||
call check_region
|
||||
; pop ebx
|
||||
dec eax
|
||||
jnz .ret
|
||||
call get_debuggee_slot
|
||||
jc .stiret
|
||||
; mov esi, edx
|
||||
mov eax, [eax*8+SLOT_BASE+APPDATA.pl0_stack]
|
||||
lea edi, [eax+RING0_STACK_SIZE]
|
||||
|
||||
.ring0:
|
||||
sub edi, 8+12+20h
|
||||
mov eax, [esi+24h] ;edi
|
||||
stosd
|
||||
mov eax, [esi+20h] ;esi
|
||||
stosd
|
||||
mov eax, [esi+1Ch] ;ebp
|
||||
stosd
|
||||
scasd
|
||||
mov eax, [esi+14h] ;ebx
|
||||
stosd
|
||||
mov eax, [esi+10h] ;edx
|
||||
stosd
|
||||
mov eax, [esi+0Ch] ;ecx
|
||||
stosd
|
||||
mov eax, [esi+8] ;eax
|
||||
stosd
|
||||
mov eax, [esi] ;eip
|
||||
stosd
|
||||
scasd
|
||||
mov eax, [esi+4] ;eflags
|
||||
stosd
|
||||
mov eax, [esi+18h] ;esp
|
||||
stosd
|
||||
.stiret:
|
||||
sti
|
||||
.ret:
|
||||
ret
|
||||
|
||||
debug_set_drx:
|
||||
call get_debuggee_slot
|
||||
jc .errret
|
||||
mov ebp, eax
|
||||
lea eax, [eax*8+SLOT_BASE+APPDATA.dbg_regs]
|
||||
; [eax]=dr0, [eax+4]=dr1, [eax+8]=dr2, [eax+C]=dr3
|
||||
; [eax+10]=dr7
|
||||
cmp esi, OS_BASE
|
||||
jae .errret
|
||||
cmp dl, 3
|
||||
ja .errret
|
||||
mov ecx, dr7
|
||||
;fix me
|
||||
xchg ecx, edx
|
||||
shr edx, cl
|
||||
shr edx, cl
|
||||
xchg ecx, edx
|
||||
|
||||
test ecx, 2 ; bit 1+2*index = G0..G3, global break enable
|
||||
jnz .errret2
|
||||
test dh, dh
|
||||
jns .new
|
||||
; clear breakpoint
|
||||
movzx edx, dl
|
||||
add edx, edx
|
||||
and dword [eax+edx*2], 0 ; clear DR<i>
|
||||
btr dword [eax+10h], edx ; clear L<i> bit
|
||||
test byte [eax+10h], 55h
|
||||
jnz .okret
|
||||
; imul eax, ebp, tss_step/32
|
||||
; and byte [eax + tss_data + TSS._trap], not 1
|
||||
and [ebp*8 + SLOT_BASE+APPDATA.dbg_state], not 1
|
||||
.okret:
|
||||
and dword [esp+32], 0
|
||||
sti
|
||||
ret
|
||||
.errret:
|
||||
sti
|
||||
mov dword [esp+32], 1
|
||||
ret
|
||||
.errret2:
|
||||
sti
|
||||
mov dword [esp+32], 2
|
||||
ret
|
||||
.new:
|
||||
; add new breakpoint
|
||||
; dl=index; dh=flags; esi=address
|
||||
test dh, 0xF0
|
||||
jnz .errret
|
||||
mov cl, dh
|
||||
and cl, 3
|
||||
cmp cl, 2
|
||||
jz .errret
|
||||
mov cl, dh
|
||||
shr cl, 2
|
||||
cmp cl, 2
|
||||
jz .errret
|
||||
|
||||
mov ebx, esi
|
||||
test bl, dl
|
||||
|
||||
jnz .errret
|
||||
or byte [eax+10h+1], 3 ; set GE and LE flags
|
||||
|
||||
movzx edx, dh
|
||||
movzx ecx, dl
|
||||
add ecx, ecx
|
||||
bts dword [eax+10h], ecx ; set L<i> flag
|
||||
add ecx, ecx
|
||||
mov [eax+ecx], ebx;esi ; set DR<i>
|
||||
shl edx, cl
|
||||
mov ebx, 0xF
|
||||
shl ebx, cl
|
||||
not ebx
|
||||
and [eax+10h+2], bx
|
||||
or [eax+10h+2], dx ; set R/W and LEN fields
|
||||
; imul eax, ebp, tss_step/32
|
||||
; or byte [eax + tss_data + TSS._trap], 1
|
||||
or [ebp*8 + SLOT_BASE+APPDATA.dbg_state], 1
|
||||
jmp .okret
|
||||
|
||||
debug_read_process_memory:
|
||||
; in:
|
||||
; ecx=pid
|
||||
; edx=length
|
||||
; edi->buffer in debugger
|
||||
; esi=address in debuggee
|
||||
; out: [esp+36]=sizeof(read)
|
||||
; destroys all
|
||||
; push ebx
|
||||
; mov ebx, esi
|
||||
call check_region
|
||||
; pop ebx
|
||||
dec eax
|
||||
jnz .err
|
||||
call get_debuggee_slot
|
||||
jc .err
|
||||
shr eax, 5
|
||||
mov ecx, edi
|
||||
call read_process_memory
|
||||
sti
|
||||
mov dword [esp+32], eax
|
||||
ret
|
||||
.err:
|
||||
or dword [esp+32], -1
|
||||
ret
|
||||
|
||||
debug_write_process_memory:
|
||||
; in:
|
||||
; ecx=pid
|
||||
; edx=length
|
||||
; edi->buffer in debugger
|
||||
; esi=address in debuggee
|
||||
; out: [esp+36]=sizeof(write)
|
||||
; destroys all
|
||||
; push ebx
|
||||
; mov ebx, esi
|
||||
call check_region
|
||||
; pop ebx
|
||||
dec eax
|
||||
jnz debug_read_process_memory.err
|
||||
call get_debuggee_slot
|
||||
jc debug_read_process_memory.err
|
||||
shr eax, 5
|
||||
mov ecx, edi
|
||||
call write_process_memory
|
||||
sti
|
||||
mov [esp+32], eax
|
||||
ret
|
||||
|
||||
debugger_notify:
|
||||
; in: eax=debugger slot
|
||||
; ecx=size of debug message
|
||||
; [esp+4]..[esp+4+ecx]=message
|
||||
; interrupts must be disabled!
|
||||
; destroys all general registers
|
||||
; interrupts remain disabled
|
||||
xchg ebp, eax
|
||||
mov edi, [timer_ticks]
|
||||
add edi, 500 ; 5 sec timeout
|
||||
.1:
|
||||
mov eax, ebp
|
||||
shl eax, 8
|
||||
mov esi, [SLOT_BASE+eax+APPDATA.dbg_event_mem]
|
||||
test esi, esi
|
||||
jz .ret
|
||||
; read buffer header
|
||||
push ecx
|
||||
push eax
|
||||
push eax
|
||||
mov eax, ebp
|
||||
mov ecx, esp
|
||||
mov edx, 8
|
||||
call read_process_memory
|
||||
cmp eax, edx
|
||||
jz @f
|
||||
add esp, 12
|
||||
jmp .ret
|
||||
@@:
|
||||
cmp dword [ecx], 0
|
||||
jg @f
|
||||
.2:
|
||||
pop ecx
|
||||
pop ecx
|
||||
pop ecx
|
||||
cmp dword [CURRENT_TASK], 1
|
||||
jnz .notos
|
||||
cmp [timer_ticks], edi
|
||||
jae .ret
|
||||
.notos:
|
||||
sti
|
||||
call change_task
|
||||
cli
|
||||
jmp .1
|
||||
@@:
|
||||
mov edx, [ecx+8]
|
||||
add edx, [ecx+4]
|
||||
cmp edx, [ecx]
|
||||
ja .2
|
||||
; advance buffer position
|
||||
push edx
|
||||
mov edx, 4
|
||||
sub ecx, edx
|
||||
mov eax, ebp
|
||||
add esi, edx
|
||||
call write_process_memory
|
||||
pop eax
|
||||
; write message
|
||||
mov eax, ebp
|
||||
add esi, edx
|
||||
add esi, [ecx+8]
|
||||
add ecx, 20
|
||||
pop edx
|
||||
pop edx
|
||||
pop edx
|
||||
call write_process_memory
|
||||
; new debug event
|
||||
mov eax, ebp
|
||||
shl eax, 8
|
||||
or byte [SLOT_BASE+eax+APPDATA.event_mask+1], 1 ; set flag 100h
|
||||
.ret:
|
||||
ret
|
||||
1662
kernel/branches/kolibri-process/core/dll.inc
Normal file
1662
kernel/branches/kolibri-process/core/dll.inc
Normal file
File diff suppressed because it is too large
Load Diff
40
kernel/branches/kolibri-process/core/export.inc
Normal file
40
kernel/branches/kolibri-process/core/export.inc
Normal file
@@ -0,0 +1,40 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
; Macroinstruction for making export section
|
||||
|
||||
|
||||
macro export dllname,[label,string]
|
||||
{ common
|
||||
local module,addresses,names,ordinal,count
|
||||
count = 0
|
||||
forward
|
||||
count = count+1
|
||||
common
|
||||
dd 0,0,0, (module-OS_BASE) , 1
|
||||
dd count,count,(addresses-OS_BASE),(names-OS_BASE),(ordinal-OS_BASE)
|
||||
addresses:
|
||||
forward
|
||||
dd (label-OS_BASE)
|
||||
common
|
||||
names:
|
||||
forward
|
||||
local name
|
||||
dd (name-OS_BASE)
|
||||
common
|
||||
ordinal:
|
||||
count = 0
|
||||
forward
|
||||
dw count
|
||||
count = count+1
|
||||
common
|
||||
module db dllname,0
|
||||
forward
|
||||
name db string,0
|
||||
}
|
||||
128
kernel/branches/kolibri-process/core/exports.inc
Normal file
128
kernel/branches/kolibri-process/core/exports.inc
Normal file
@@ -0,0 +1,128 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4418 $
|
||||
|
||||
iglobal
|
||||
szKernel db 'KERNEL', 0
|
||||
szVersion db 'version',0
|
||||
endg
|
||||
|
||||
align 4
|
||||
__exports:
|
||||
export 'KERNEL', \
|
||||
alloc_kernel_space, 'AllocKernelSpace', \ ; stdcall
|
||||
alloc_page, 'AllocPage', \ ; gcc ABI
|
||||
alloc_pages, 'AllocPages', \ ; stdcall
|
||||
commit_pages, 'CommitPages', \ ; eax, ebx, ecx
|
||||
\
|
||||
disk_add, 'DiskAdd', \ ;stdcall
|
||||
disk_del, 'DiskDel', \
|
||||
disk_media_changed, 'DiskMediaChanged', \ ;stdcall
|
||||
\
|
||||
create_event, 'CreateEvent', \ ; ecx, esi
|
||||
destroy_event, 'DestroyEvent', \ ;
|
||||
raise_event, 'RaiseEvent', \ ; eax, ebx, edx, esi
|
||||
wait_event, 'WaitEvent', \ ; eax, ebx
|
||||
wait_event_timeout, 'WaitEventTimeout', \ ; eax, ebx, ecx
|
||||
get_event_ex, 'GetEvent', \ ; edi
|
||||
clear_event, 'ClearEvent', \ ;see EVENT.inc for specification
|
||||
send_event, 'SendEvent', \ ;see EVENT.inc for specification
|
||||
\
|
||||
create_kernel_object, 'CreateObject', \
|
||||
create_ring_buffer, 'CreateRingBuffer', \ ; stdcall
|
||||
destroy_kernel_object, 'DestroyObject', \
|
||||
free_kernel_space, 'FreeKernelSpace', \ ; stdcall
|
||||
free_page, 'FreePage', \ ; eax
|
||||
kernel_alloc, 'KernelAlloc', \ ; stdcall
|
||||
kernel_free, 'KernelFree', \ ; stdcall
|
||||
malloc, 'Kmalloc', \
|
||||
free, 'Kfree', \
|
||||
map_io_mem, 'MapIoMem', \ ; stdcall
|
||||
map_page, 'MapPage', \ ; stdcall
|
||||
get_pg_addr, 'GetPgAddr', \ ; eax
|
||||
get_phys_addr, 'GetPhysAddr', \ ; eax
|
||||
map_space, 'MapSpace', \
|
||||
release_pages, 'ReleasePages', \
|
||||
\
|
||||
mutex_init, 'MutexInit', \ ; gcc fastcall
|
||||
mutex_lock, 'MutexLock', \ ; gcc fastcall
|
||||
mutex_unlock, 'MutexUnlock', \ ; gcc fastcall
|
||||
\
|
||||
get_display, 'GetDisplay', \
|
||||
set_screen, 'SetScreen', \
|
||||
window._.get_rect, 'GetWindowRect', \ ; gcc fastcall
|
||||
pci_api_drv, 'PciApi', \
|
||||
pci_read8, 'PciRead8', \ ; stdcall
|
||||
pci_read16, 'PciRead16', \ ; stdcall
|
||||
pci_read32, 'PciRead32', \ ; stdcall
|
||||
pci_write8, 'PciWrite8', \ ; stdcall
|
||||
pci_write16, 'PciWrite16', \ ; stdcall
|
||||
pci_write32, 'PciWrite32', \ ; stdcall
|
||||
\
|
||||
get_pid, 'GetPid', \
|
||||
get_service, 'GetService', \ ;
|
||||
reg_service, 'RegService', \ ; stdcall
|
||||
attach_int_handler, 'AttachIntHandler', \ ; stdcall
|
||||
user_alloc, 'UserAlloc', \ ; stdcall
|
||||
user_alloc_at, 'UserAllocAt', \ ; stdcall
|
||||
user_free, 'UserFree', \ ; stdcall
|
||||
unmap_pages, 'UnmapPages', \ ; eax, ecx
|
||||
sys_msg_board_str, 'SysMsgBoardStr', \
|
||||
sys_msg_board, 'SysMsgBoard', \
|
||||
get_timer_ticks, 'GetTimerTicks', \
|
||||
get_stack_base, 'GetStackBase', \
|
||||
delay_hs, 'Delay', \ ; ebx
|
||||
set_mouse_data, 'SetMouseData', \ ;
|
||||
set_keyboard_data, 'SetKeyboardData', \ ; gcc fastcall
|
||||
register_keyboard, 'RegKeyboard', \
|
||||
delete_keyboard, 'DelKeyboard', \
|
||||
get_cpu_freq, 'GetCpuFreq', \
|
||||
\
|
||||
new_sys_threads, 'CreateThread', \ ; ebx, ecx, edx
|
||||
\
|
||||
srv_handler, 'ServiceHandler', \
|
||||
fpu_save, 'FpuSave', \
|
||||
fpu_restore, 'FpuRestore', \
|
||||
r_f_port_area, 'ReservePortArea', \
|
||||
boot_log, 'Boot_Log', \
|
||||
\
|
||||
load_cursor, 'LoadCursor', \ ;stdcall
|
||||
\
|
||||
get_curr_task, 'GetCurrentTask', \
|
||||
load_file, 'LoadFile', \ ;retval eax, ebx
|
||||
delay_ms, 'Sleep', \
|
||||
\
|
||||
strncat, 'strncat', \
|
||||
strncpy, 'strncpy', \
|
||||
strncmp, 'strncmp', \
|
||||
strnlen, 'strnlen', \
|
||||
strchr, 'strchr', \
|
||||
strrchr, 'strrchr', \
|
||||
\
|
||||
timer_hs, 'TimerHS', \
|
||||
timer_hs, 'TimerHs', \ ; shit happens
|
||||
cancel_timer_hs, 'CancelTimerHS', \
|
||||
\
|
||||
reg_usb_driver, 'RegUSBDriver', \
|
||||
usb_open_pipe, 'USBOpenPipe', \
|
||||
usb_close_pipe, 'USBClosePipe', \
|
||||
usb_normal_transfer_async, 'USBNormalTransferAsync', \
|
||||
usb_control_async, 'USBControlTransferAsync', \
|
||||
usb_get_param, 'USBGetParam', \
|
||||
usb_hc_func, 'USBHCFunc', \
|
||||
\
|
||||
NET_add_device, 'NetRegDev', \
|
||||
NET_remove_device, 'NetUnRegDev', \
|
||||
NET_ptr_to_num, 'NetPtrToNum', \
|
||||
NET_link_changed, 'NetLinkChanged', \
|
||||
ETH_input, 'Eth_input', \
|
||||
\
|
||||
0, 'LFBAddress' ; must be the last one
|
||||
load kernel_exports_count dword from __exports + 24
|
||||
load kernel_exports_addresses dword from __exports + 28
|
||||
exp_lfb = OS_BASE + kernel_exports_addresses + (kernel_exports_count - 1) * 4 - 4
|
||||
333
kernel/branches/kolibri-process/core/ext_lib.inc
Normal file
333
kernel/branches/kolibri-process/core/ext_lib.inc
Normal file
@@ -0,0 +1,333 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;============================================================================
|
||||
;
|
||||
; External kernel dependencies (libraries) loading
|
||||
;
|
||||
;============================================================================
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
if 0
|
||||
; The code currently does not work. Kill "if 0/end if" only after correcting
|
||||
; to current kernel (dll.inc).
|
||||
macro library [name,fname]
|
||||
{
|
||||
forward
|
||||
dd __#name#_library_table__,__#name#_library_name__
|
||||
common
|
||||
dd 0
|
||||
forward
|
||||
__#name#_library_name__ db fname,0
|
||||
}
|
||||
|
||||
macro import lname,[name,sname]
|
||||
{
|
||||
common
|
||||
align 4
|
||||
__#lname#_library_table__:
|
||||
forward
|
||||
name dd __#name#_import_name__
|
||||
common
|
||||
dd 0
|
||||
forward
|
||||
__#name#_import_name__ db sname,0
|
||||
}
|
||||
|
||||
macro export [name,sname]
|
||||
{
|
||||
align 4
|
||||
forward
|
||||
dd __#name#_export_name__,name
|
||||
common
|
||||
dd 0
|
||||
forward
|
||||
__#name#_export_name__ db sname,0
|
||||
}
|
||||
|
||||
|
||||
|
||||
align 4 ; loading library (use kernel functions)
|
||||
proc load_k_library stdcall, file_name:dword
|
||||
locals
|
||||
coff dd ?
|
||||
sym dd ?
|
||||
strings dd ?
|
||||
img_size dd ?
|
||||
img_base dd ?
|
||||
exports dd ?
|
||||
endl
|
||||
|
||||
cli
|
||||
|
||||
stdcall load_file, [file_name]
|
||||
test eax, eax
|
||||
jz .fail
|
||||
|
||||
mov [coff], eax
|
||||
movzx ecx, [eax+CFH.nSections]
|
||||
xor ebx, ebx
|
||||
|
||||
lea edx, [eax+20]
|
||||
@@:
|
||||
add ebx, [edx+CFS.SizeOfRawData]
|
||||
add ebx, 15
|
||||
and ebx, not 15
|
||||
add edx, COFF_SECTION_SIZE
|
||||
dec ecx
|
||||
jnz @B
|
||||
mov [img_size], ebx
|
||||
|
||||
stdcall kernel_alloc, [img_size]
|
||||
|
||||
test eax, eax
|
||||
jz .fail
|
||||
mov [img_base], eax
|
||||
|
||||
mov edx, [coff]
|
||||
movzx ebx, [edx+CFH.nSections]
|
||||
mov edi, [img_base]
|
||||
lea eax, [edx+20]
|
||||
@@:
|
||||
mov [eax+CFS.VirtualAddress], edi
|
||||
mov esi, [eax+CFS.PtrRawData]
|
||||
test esi, esi
|
||||
jnz .copy
|
||||
add edi, [eax+CFS.SizeOfRawData]
|
||||
jmp .next
|
||||
.copy:
|
||||
add esi, edx
|
||||
mov ecx, [eax+CFS.SizeOfRawData]
|
||||
cld
|
||||
rep movsb
|
||||
.next:
|
||||
add edi, 15
|
||||
and edi, not 15
|
||||
add eax, COFF_SECTION_SIZE
|
||||
dec ebx
|
||||
jnz @B
|
||||
|
||||
mov ebx, [edx+CFH.pSymTable]
|
||||
add ebx, edx
|
||||
mov [sym], ebx
|
||||
mov ecx, [edx+CFH.nSymbols]
|
||||
add ecx, ecx
|
||||
lea ecx, [ecx+ecx*8];ecx*=18 = nSymbols*CSYM_SIZE
|
||||
add ecx, [sym]
|
||||
mov [strings], ecx
|
||||
|
||||
lea eax, [edx+20]
|
||||
|
||||
stdcall fix_coff_symbols, eax, [sym], [edx+CFH.nSymbols], \
|
||||
[strings], dword 0
|
||||
test eax, eax
|
||||
jnz @F
|
||||
|
||||
@@:
|
||||
mov edx, [coff]
|
||||
movzx ebx, [edx+CFH.nSections]
|
||||
mov edi, 0
|
||||
lea eax, [edx+20]
|
||||
@@:
|
||||
add [eax+CFS.VirtualAddress], edi ;patch user space offset
|
||||
add eax, COFF_SECTION_SIZE
|
||||
dec ebx
|
||||
jnz @B
|
||||
|
||||
add edx, 20
|
||||
stdcall fix_coff_relocs, [coff], edx, [sym]
|
||||
|
||||
mov ebx, [coff]
|
||||
stdcall get_coff_sym, [sym], [ebx+CFH.nSymbols], szEXPORTS
|
||||
mov [exports], eax
|
||||
|
||||
stdcall kernel_free, [coff]
|
||||
|
||||
mov eax, [exports]
|
||||
ret
|
||||
.fail:
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
|
||||
proc dll.Load, import_table:dword
|
||||
mov esi, [import_table]
|
||||
.next_lib:
|
||||
mov edx, [esi]
|
||||
or edx, edx
|
||||
jz .exit
|
||||
push esi
|
||||
|
||||
mov edi, s_libname
|
||||
|
||||
mov al, '/'
|
||||
stosb
|
||||
mov esi, sysdir_path
|
||||
@@:
|
||||
lodsb
|
||||
stosb
|
||||
or al, al
|
||||
jnz @b
|
||||
dec edi
|
||||
mov [edi], dword '/lib'
|
||||
mov [edi+4], byte '/'
|
||||
add edi, 5
|
||||
pop esi
|
||||
push esi
|
||||
mov esi, [esi+4]
|
||||
@@:
|
||||
lodsb
|
||||
stosb
|
||||
or al, al
|
||||
jnz @b
|
||||
|
||||
pushad
|
||||
stdcall load_k_library, s_libname
|
||||
mov [esp+28], eax
|
||||
popad
|
||||
or eax, eax
|
||||
jz .fail
|
||||
stdcall dll.Link, eax, edx
|
||||
stdcall dll.Init, [eax+4]
|
||||
pop esi
|
||||
add esi, 8
|
||||
jmp .next_lib
|
||||
.exit:
|
||||
xor eax, eax
|
||||
ret
|
||||
.fail:
|
||||
add esp, 4
|
||||
xor eax, eax
|
||||
inc eax
|
||||
ret
|
||||
endp
|
||||
|
||||
proc dll.Link, exp:dword,imp:dword
|
||||
push eax
|
||||
mov esi, [imp]
|
||||
test esi, esi
|
||||
jz .done
|
||||
.next:
|
||||
lodsd
|
||||
test eax, eax
|
||||
jz .done
|
||||
stdcall dll.GetProcAddress, [exp], eax
|
||||
or eax, eax
|
||||
jz @f
|
||||
mov [esi-4], eax
|
||||
jmp .next
|
||||
@@:
|
||||
mov dword[esp], 0
|
||||
.done:
|
||||
pop eax
|
||||
ret
|
||||
endp
|
||||
|
||||
proc dll.Init, dllentry:dword
|
||||
pushad
|
||||
mov eax, mem.Alloc
|
||||
mov ebx, mem.Free
|
||||
mov ecx, mem.ReAlloc
|
||||
mov edx, dll.Load
|
||||
stdcall [dllentry]
|
||||
popad
|
||||
ret
|
||||
endp
|
||||
|
||||
proc dll.GetProcAddress, exp:dword,sz_name:dword
|
||||
mov edx, [exp]
|
||||
.next:
|
||||
test edx, edx
|
||||
jz .end
|
||||
stdcall strncmp, [edx], [sz_name], dword -1
|
||||
test eax, eax
|
||||
jz .ok
|
||||
add edx, 8
|
||||
jmp .next
|
||||
.ok:
|
||||
mov eax, [edx+4]
|
||||
.end:
|
||||
ret
|
||||
endp
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
proc mem.Alloc size ;/////////////////////////////////////////////////////////
|
||||
;-----------------------------------------------------------------------------
|
||||
push ebx ecx
|
||||
; mov eax,[size]
|
||||
; lea ecx,[eax+4+4095]
|
||||
; and ecx,not 4095
|
||||
; stdcall kernel_alloc, ecx
|
||||
; add ecx,-4
|
||||
; mov [eax],ecx
|
||||
; add eax,4
|
||||
|
||||
stdcall kernel_alloc, [size]
|
||||
|
||||
pop ecx ebx
|
||||
ret
|
||||
endp
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
proc mem.ReAlloc mptr,size;///////////////////////////////////////////////////
|
||||
;-----------------------------------------------------------------------------
|
||||
push ebx ecx esi edi eax
|
||||
mov eax, [mptr]
|
||||
mov ebx, [size]
|
||||
or eax, eax
|
||||
jz @f
|
||||
lea ecx, [ebx+4+4095]
|
||||
and ecx, not 4095
|
||||
add ecx, -4
|
||||
cmp ecx, [eax-4]
|
||||
je .exit
|
||||
@@:
|
||||
mov eax, ebx
|
||||
call mem.Alloc
|
||||
xchg eax, [esp]
|
||||
or eax, eax
|
||||
jz .exit
|
||||
mov esi, eax
|
||||
xchg eax, [esp]
|
||||
mov edi, eax
|
||||
mov ecx, [esi-4]
|
||||
cmp ecx, [edi-4]
|
||||
jbe @f
|
||||
mov ecx, [edi-4]
|
||||
@@:
|
||||
add ecx, 3
|
||||
shr ecx, 2
|
||||
cld
|
||||
rep movsd
|
||||
xchg eax, [esp]
|
||||
call mem.Free
|
||||
.exit:
|
||||
pop eax edi esi ecx ebx
|
||||
ret
|
||||
endp
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
proc mem.Free mptr ;//////////////////////////////////////////////////////////
|
||||
;-----------------------------------------------------------------------------
|
||||
; mov eax,[mptr]
|
||||
; or eax,eax
|
||||
; jz @f
|
||||
; push ebx ecx
|
||||
; lea ecx,[eax-4]
|
||||
; stdcall kernel_free, ecx
|
||||
; pop ecx ebx
|
||||
; @@: ret
|
||||
stdcall kernel_free, [mptr]
|
||||
ret
|
||||
endp
|
||||
|
||||
uglobal
|
||||
s_libname db 64 dup (0)
|
||||
endg
|
||||
end if
|
||||
183
kernel/branches/kolibri-process/core/fpu.inc
Normal file
183
kernel/branches/kolibri-process/core/fpu.inc
Normal file
@@ -0,0 +1,183 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3534 $
|
||||
|
||||
|
||||
init_fpu:
|
||||
clts
|
||||
fninit
|
||||
|
||||
bt [cpu_caps], CAPS_SSE
|
||||
jnc .no_SSE
|
||||
|
||||
mov ebx, cr4
|
||||
mov ecx, cr0
|
||||
or ebx, CR4_OSFXSR+CR4_OSXMMEXPT
|
||||
mov cr4, ebx
|
||||
|
||||
and ecx, not (CR0_MP+CR0_EM)
|
||||
or ecx, CR0_NE
|
||||
mov cr0, ecx
|
||||
|
||||
mov dword [esp-4], SSE_INIT
|
||||
ldmxcsr [esp-4]
|
||||
|
||||
xorps xmm0, xmm0
|
||||
xorps xmm1, xmm1
|
||||
xorps xmm2, xmm2
|
||||
xorps xmm3, xmm3
|
||||
xorps xmm4, xmm4
|
||||
xorps xmm5, xmm5
|
||||
xorps xmm6, xmm6
|
||||
xorps xmm7, xmm7
|
||||
fxsave [fpu_data] ;[eax]
|
||||
ret
|
||||
.no_SSE:
|
||||
mov ecx, cr0
|
||||
and ecx, not CR0_EM
|
||||
or ecx, CR0_MP+CR0_NE
|
||||
mov cr0, ecx
|
||||
fnsave [fpu_data]
|
||||
ret
|
||||
|
||||
; param
|
||||
; eax= 512 bytes memory area
|
||||
|
||||
align 4
|
||||
fpu_save:
|
||||
push ecx
|
||||
push esi
|
||||
push edi
|
||||
|
||||
pushfd
|
||||
cli
|
||||
|
||||
clts
|
||||
mov edi, eax
|
||||
|
||||
mov ecx, [fpu_owner]
|
||||
mov esi, [CURRENT_TASK]
|
||||
cmp ecx, esi
|
||||
jne .save
|
||||
|
||||
call save_context
|
||||
jmp .exit
|
||||
.save:
|
||||
mov [fpu_owner], esi
|
||||
|
||||
shl ecx, 8
|
||||
mov eax, [ecx+SLOT_BASE+APPDATA.fpu_state]
|
||||
|
||||
call save_context
|
||||
|
||||
shl esi, 8
|
||||
mov esi, [esi+SLOT_BASE+APPDATA.fpu_state]
|
||||
mov ecx, 512/4
|
||||
cld
|
||||
rep movsd
|
||||
fninit
|
||||
.exit:
|
||||
popfd
|
||||
pop edi
|
||||
pop esi
|
||||
pop ecx
|
||||
ret
|
||||
|
||||
align 4
|
||||
save_context:
|
||||
bt [cpu_caps], CAPS_SSE
|
||||
jnc .no_SSE
|
||||
|
||||
fxsave [eax]
|
||||
ret
|
||||
.no_SSE:
|
||||
fnsave [eax]
|
||||
ret
|
||||
|
||||
align 4
|
||||
fpu_restore:
|
||||
push ecx
|
||||
push esi
|
||||
|
||||
mov esi, eax
|
||||
|
||||
pushfd
|
||||
cli
|
||||
|
||||
mov ecx, [fpu_owner]
|
||||
mov eax, [CURRENT_TASK]
|
||||
cmp ecx, eax
|
||||
jne .copy
|
||||
|
||||
clts
|
||||
bt [cpu_caps], CAPS_SSE
|
||||
jnc .no_SSE
|
||||
|
||||
fxrstor [esi]
|
||||
popfd
|
||||
pop esi
|
||||
pop ecx
|
||||
ret
|
||||
.no_SSE:
|
||||
fnclex ;fix possible problems
|
||||
frstor [esi]
|
||||
popfd
|
||||
pop esi
|
||||
pop ecx
|
||||
ret
|
||||
.copy:
|
||||
shl eax, 8
|
||||
mov edi, [eax+SLOT_BASE+APPDATA.fpu_state]
|
||||
mov ecx, 512/4
|
||||
cld
|
||||
rep movsd
|
||||
popfd
|
||||
pop esi
|
||||
pop ecx
|
||||
ret
|
||||
|
||||
align 4
|
||||
except_7: ;#NM exception handler
|
||||
save_ring3_context
|
||||
clts
|
||||
mov ax, app_data;
|
||||
mov ds, ax
|
||||
mov es, ax
|
||||
|
||||
mov ebx, [fpu_owner]
|
||||
cmp ebx, [CURRENT_TASK]
|
||||
je .exit
|
||||
|
||||
shl ebx, 8
|
||||
mov eax, [ebx+SLOT_BASE+APPDATA.fpu_state]
|
||||
bt [cpu_caps], CAPS_SSE
|
||||
jnc .no_SSE
|
||||
|
||||
fxsave [eax]
|
||||
mov ebx, [CURRENT_TASK]
|
||||
mov [fpu_owner], ebx
|
||||
shl ebx, 8
|
||||
mov eax, [ebx+SLOT_BASE+APPDATA.fpu_state]
|
||||
fxrstor [eax]
|
||||
.exit:
|
||||
restore_ring3_context
|
||||
iret
|
||||
|
||||
.no_SSE:
|
||||
fnsave [eax]
|
||||
mov ebx, [CURRENT_TASK]
|
||||
mov [fpu_owner], ebx
|
||||
shl ebx, 8
|
||||
mov eax, [ebx+SLOT_BASE+APPDATA.fpu_state]
|
||||
frstor [eax]
|
||||
restore_ring3_context
|
||||
iret
|
||||
|
||||
iglobal
|
||||
fpu_owner dd 2
|
||||
endg
|
||||
1519
kernel/branches/kolibri-process/core/heap.inc
Normal file
1519
kernel/branches/kolibri-process/core/heap.inc
Normal file
File diff suppressed because it is too large
Load Diff
278
kernel/branches/kolibri-process/core/irq.inc
Normal file
278
kernel/branches/kolibri-process/core/irq.inc
Normal file
@@ -0,0 +1,278 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
IRQ_RESERVED equ 24
|
||||
|
||||
IRQ_POOL_SIZE equ 48
|
||||
|
||||
uglobal
|
||||
|
||||
align 16
|
||||
irqh_tab rd sizeof.LHEAD * IRQ_RESERVED / 4
|
||||
|
||||
irqh_pool rd sizeof.IRQH * IRQ_POOL_SIZE /4
|
||||
next_irqh rd 1
|
||||
|
||||
irq_active_set rd 1
|
||||
irq_failed rd IRQ_RESERVED
|
||||
|
||||
endg
|
||||
|
||||
align 4
|
||||
init_irqs:
|
||||
|
||||
mov ecx, IRQ_RESERVED
|
||||
mov edi, irqh_tab
|
||||
@@:
|
||||
mov eax, edi
|
||||
stosd
|
||||
stosd
|
||||
loop @B
|
||||
|
||||
mov ecx, IRQ_POOL_SIZE-1
|
||||
mov eax, irqh_pool+sizeof.IRQH
|
||||
mov [next_irqh], irqh_pool
|
||||
@@:
|
||||
mov [eax-sizeof.IRQH], eax
|
||||
add eax, sizeof.IRQH
|
||||
loop @B
|
||||
|
||||
mov [eax-sizeof.IRQH], dword 0
|
||||
ret
|
||||
|
||||
|
||||
align 4
|
||||
proc attach_int_handler stdcall, irq:dword, handler:dword, user_data:dword
|
||||
locals
|
||||
.irqh dd ?
|
||||
endl
|
||||
|
||||
DEBUGF 1, "K : Attach Interrupt %d Handler %x\n", [irq], [handler]
|
||||
|
||||
and [.irqh], 0
|
||||
|
||||
push ebx
|
||||
|
||||
mov ebx, [irq] ;irq num
|
||||
test ebx, ebx
|
||||
jz .err
|
||||
|
||||
cmp ebx, IRQ_RESERVED
|
||||
jae .err
|
||||
|
||||
mov edx, [handler]
|
||||
test edx, edx
|
||||
jz .err
|
||||
|
||||
spin_lock_irqsave IrqsList
|
||||
|
||||
;allocate handler
|
||||
|
||||
mov ecx, [next_irqh]
|
||||
test ecx, ecx
|
||||
jz .fail
|
||||
|
||||
mov eax, [ecx]
|
||||
mov [next_irqh], eax
|
||||
mov [.irqh], ecx
|
||||
|
||||
mov [irq_failed+ebx*4], 0;clear counter
|
||||
|
||||
mov eax, [user_data]
|
||||
mov [ecx+IRQH.handler], edx
|
||||
mov [ecx+IRQH.data], eax
|
||||
and [ecx+IRQH.num_ints], 0
|
||||
|
||||
lea edx, [irqh_tab+ebx*8]
|
||||
list_add_tail ecx, edx ;clobber eax
|
||||
stdcall enable_irq, ebx
|
||||
|
||||
.fail:
|
||||
spin_unlock_irqrestore IrqsList
|
||||
.err:
|
||||
pop ebx
|
||||
mov eax, [.irqh]
|
||||
ret
|
||||
|
||||
endp
|
||||
|
||||
if 0
|
||||
align 4
|
||||
proc get_int_handler stdcall, irq:dword
|
||||
|
||||
mov eax, [irq]
|
||||
cmp eax, 15
|
||||
ja .fail
|
||||
mov eax, [irq_tab + 4 * eax]
|
||||
ret
|
||||
.fail:
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
end if
|
||||
|
||||
|
||||
align 4
|
||||
proc detach_int_handler
|
||||
|
||||
ret
|
||||
endp
|
||||
|
||||
|
||||
macro irq_serv_h [num] {
|
||||
forward
|
||||
align 4
|
||||
.irq_#num :
|
||||
push num
|
||||
jmp .main
|
||||
}
|
||||
|
||||
align 16
|
||||
irq_serv:
|
||||
|
||||
; .irq_1:
|
||||
; push 1
|
||||
; jmp .main
|
||||
; etc...
|
||||
|
||||
irq_serv_h 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 14, 15
|
||||
irq_serv_h 16, 17, 18, 19, 20, 21, 22, 23
|
||||
|
||||
purge irq_serv_h
|
||||
|
||||
align 16
|
||||
.main:
|
||||
save_ring3_context
|
||||
|
||||
mov ebp, [esp + 32]
|
||||
mov bx, app_data;os_data
|
||||
mov ds, bx
|
||||
mov es, bx
|
||||
|
||||
cmp [v86_irqhooks+ebp*8], 0
|
||||
jnz v86_irq
|
||||
|
||||
bts [irq_active_set], ebp
|
||||
|
||||
lea esi, [irqh_tab+ebp*8] ; esi= list head
|
||||
mov ebx, esi
|
||||
.next:
|
||||
mov ebx, [ebx+IRQH.list.next]; ebx= irqh pointer
|
||||
cmp ebx, esi
|
||||
je .done
|
||||
|
||||
push ebx ; FIX THIS
|
||||
push edi
|
||||
push esi
|
||||
|
||||
push [ebx+IRQH.data]
|
||||
call [ebx+IRQH.handler]
|
||||
pop ecx
|
||||
|
||||
pop esi
|
||||
pop edi
|
||||
pop ebx
|
||||
|
||||
test eax, eax
|
||||
jz .next
|
||||
|
||||
inc [ebx+IRQH.num_ints]
|
||||
btr [irq_active_set], ebp
|
||||
jmp .next
|
||||
|
||||
.done:
|
||||
btr [irq_active_set], ebp
|
||||
jnc .exit
|
||||
|
||||
; There is at least one configuration with one device which generates IRQ
|
||||
; that is not the same as it should be according to PCI config space.
|
||||
; For that device, the handler is registered at wrong IRQ.
|
||||
; As a workaround, when nobody acknowledges the generated IRQ,
|
||||
; try to ask all other registered handlers; if some handler acknowledges
|
||||
; the IRQ this time, relink it to the current IRQ list.
|
||||
; To make this more reliable, for every handler keep number of times
|
||||
; that it has acknowledged an IRQ, and assume that handlers with at least one
|
||||
; acknowledged IRQ are registered properly.
|
||||
; Note: this still isn't 100% correct, because two IRQs can fire simultaneously,
|
||||
; the better way would be to find the correct IRQ, but I don't know how to do
|
||||
; this in that case.
|
||||
push ebp
|
||||
xor ebp, ebp
|
||||
.try_other_irqs:
|
||||
cmp ebp, [esp]
|
||||
jz .try_next_irq
|
||||
cmp ebp, 1
|
||||
jz .try_next_irq
|
||||
cmp ebp, 6
|
||||
jz .try_next_irq
|
||||
cmp ebp, 12
|
||||
jz .try_next_irq
|
||||
cmp ebp, 14
|
||||
jz .try_next_irq
|
||||
cmp ebp, 15
|
||||
jz .try_next_irq
|
||||
lea esi, [irqh_tab+ebp*8]
|
||||
mov ebx, esi
|
||||
.try_next_handler:
|
||||
mov ebx, [ebx+IRQH.list.next]
|
||||
cmp ebx, esi
|
||||
je .try_next_irq
|
||||
cmp [ebx+IRQH.num_ints], 0
|
||||
jne .try_next_handler
|
||||
; keyboard handler acknowledges everything
|
||||
push [ebx+IRQH.data]
|
||||
call [ebx+IRQH.handler]
|
||||
pop ecx
|
||||
test eax, eax
|
||||
jz .try_next_handler
|
||||
|
||||
.found_in_wrong_list:
|
||||
DEBUGF 1,'K : warning: relinking handler from IRQ%d to IRQ%d\n',\
|
||||
ebp, [esp]
|
||||
pop ebp
|
||||
spin_lock_irqsave IrqsList
|
||||
list_del ebx
|
||||
lea edx, [irqh_tab+ebp*8]
|
||||
list_add_tail ebx, edx
|
||||
spin_unlock_irqrestore IrqsList
|
||||
jmp .exit
|
||||
|
||||
.try_next_irq:
|
||||
inc ebp
|
||||
cmp ebp, 16
|
||||
jb .try_other_irqs
|
||||
pop ebp
|
||||
|
||||
.fail:
|
||||
inc [irq_failed+ebp*4]
|
||||
.exit:
|
||||
|
||||
mov ecx, ebp
|
||||
call irq_eoi
|
||||
|
||||
; IRQ handler could make some kernel thread ready; reschedule
|
||||
mov bl, SCHEDULE_HIGHER_PRIORITY
|
||||
call find_next_task
|
||||
jz .return ; if there is only one running process
|
||||
call do_change_task
|
||||
.return:
|
||||
restore_ring3_context
|
||||
add esp, 4
|
||||
iret
|
||||
|
||||
align 4
|
||||
irqD:
|
||||
push eax
|
||||
push ecx
|
||||
xor eax, eax
|
||||
out 0xf0, al
|
||||
mov cl, 13
|
||||
call irq_eoi
|
||||
pop ecx
|
||||
pop eax
|
||||
iret
|
||||
|
||||
1035
kernel/branches/kolibri-process/core/malloc.inc
Normal file
1035
kernel/branches/kolibri-process/core/malloc.inc
Normal file
File diff suppressed because it is too large
Load Diff
1546
kernel/branches/kolibri-process/core/memory.inc
Normal file
1546
kernel/branches/kolibri-process/core/memory.inc
Normal file
File diff suppressed because it is too large
Load Diff
282
kernel/branches/kolibri-process/core/peload.inc
Normal file
282
kernel/branches/kolibri-process/core/peload.inc
Normal file
@@ -0,0 +1,282 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4421 $
|
||||
|
||||
include 'export.inc'
|
||||
|
||||
align 4
|
||||
|
||||
proc load_PE stdcall, file_name:dword
|
||||
locals
|
||||
image dd ?
|
||||
entry dd ?
|
||||
base dd ?
|
||||
endl
|
||||
|
||||
stdcall load_file, [file_name]
|
||||
test eax, eax
|
||||
jz .fail
|
||||
|
||||
mov [image], eax
|
||||
|
||||
mov edx, [eax+60]
|
||||
|
||||
stdcall kernel_alloc, [eax+80+edx]
|
||||
test eax, eax
|
||||
jz .cleanup
|
||||
|
||||
mov [base], eax
|
||||
|
||||
stdcall map_PE, eax, [image]
|
||||
|
||||
mov [entry], eax
|
||||
test eax, eax
|
||||
jnz .cleanup
|
||||
|
||||
stdcall kernel_free, [base]
|
||||
.cleanup:
|
||||
stdcall kernel_free, [image]
|
||||
mov eax, [entry]
|
||||
ret
|
||||
.fail:
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
DWORD equ dword
|
||||
PTR equ
|
||||
|
||||
align 4
|
||||
map_PE: ;stdcall base:dword, image:dword
|
||||
cld
|
||||
push ebp
|
||||
push edi
|
||||
push esi
|
||||
push ebx
|
||||
sub esp, 60
|
||||
mov ebx, DWORD PTR [esp+84]
|
||||
mov ebp, DWORD PTR [esp+80]
|
||||
mov edx, ebx
|
||||
mov esi, ebx
|
||||
add edx, DWORD PTR [ebx+60]
|
||||
mov edi, ebp
|
||||
mov DWORD PTR [esp+32], edx
|
||||
mov ecx, DWORD PTR [edx+84]
|
||||
|
||||
shr ecx, 2
|
||||
rep movsd
|
||||
|
||||
movzx eax, WORD PTR [edx+6]
|
||||
mov DWORD PTR [esp+36], 0
|
||||
mov DWORD PTR [esp+16], eax
|
||||
jmp L2
|
||||
L3:
|
||||
mov eax, DWORD PTR [edx+264]
|
||||
test eax, eax
|
||||
je L4
|
||||
mov esi, ebx
|
||||
mov edi, ebp
|
||||
add esi, DWORD PTR [edx+268]
|
||||
mov ecx, eax
|
||||
add edi, DWORD PTR [edx+260]
|
||||
|
||||
add ecx, 3
|
||||
shr ecx, 2
|
||||
rep movsd
|
||||
|
||||
L4:
|
||||
mov ecx, DWORD PTR [edx+256]
|
||||
cmp ecx, eax
|
||||
jbe L6
|
||||
sub ecx, eax
|
||||
add eax, DWORD PTR [edx+260]
|
||||
lea edi, [eax+ebp]
|
||||
|
||||
xor eax, eax
|
||||
rep stosb
|
||||
|
||||
L6:
|
||||
inc DWORD PTR [esp+36]
|
||||
add edx, 40
|
||||
L2:
|
||||
mov esi, DWORD PTR [esp+16]
|
||||
cmp DWORD PTR [esp+36], esi
|
||||
jne L3
|
||||
mov edi, DWORD PTR [esp+32]
|
||||
cmp DWORD PTR [edi+164], 0
|
||||
je L9
|
||||
pushd [edi+164]
|
||||
mov esi, ebp
|
||||
mov ecx, ebp
|
||||
sub esi, DWORD PTR [edi+52]
|
||||
add ecx, DWORD PTR [edi+160]
|
||||
mov eax, esi
|
||||
shr eax, 16
|
||||
mov DWORD PTR [esp+16], eax
|
||||
L12:
|
||||
mov eax, [ecx+4]
|
||||
sub [esp], eax
|
||||
lea ebx, [eax-8]
|
||||
xor edi, edi
|
||||
shr ebx, 1
|
||||
jmp L13
|
||||
L14:
|
||||
movzx eax, WORD PTR [ecx+8+edi*2]
|
||||
mov edx, eax
|
||||
shr eax, 12
|
||||
and edx, 4095
|
||||
add edx, DWORD PTR [ecx]
|
||||
cmp ax, 2
|
||||
je L17
|
||||
cmp ax, 3
|
||||
je L18
|
||||
dec ax
|
||||
jne L15
|
||||
mov eax, DWORD PTR [esp+16]
|
||||
add WORD PTR [edx+ebp], ax
|
||||
L17:
|
||||
add WORD PTR [edx+ebp], si
|
||||
L18:
|
||||
add DWORD PTR [edx+ebp], esi
|
||||
L15:
|
||||
inc edi
|
||||
L13:
|
||||
cmp edi, ebx
|
||||
jne L14
|
||||
add ecx, DWORD PTR [ecx+4]
|
||||
L11:
|
||||
cmp dword [esp], 0
|
||||
jg L12
|
||||
pop eax
|
||||
L9:
|
||||
mov edx, DWORD PTR [esp+32]
|
||||
cmp DWORD PTR [edx+132], 0
|
||||
je L20
|
||||
mov eax, ebp
|
||||
add eax, DWORD PTR [edx+128]
|
||||
mov DWORD PTR [esp+40], 0
|
||||
add eax, 20
|
||||
mov DWORD PTR [esp+56], eax
|
||||
L22:
|
||||
mov ecx, DWORD PTR [esp+56]
|
||||
cmp DWORD PTR [ecx-16], 0
|
||||
jne L23
|
||||
cmp DWORD PTR [ecx-8], 0
|
||||
je L25
|
||||
L23:
|
||||
mov edi, DWORD PTR [__exports+32]
|
||||
mov esi, DWORD PTR [__exports+28]
|
||||
mov eax, DWORD PTR [esp+56]
|
||||
mov DWORD PTR [esp+20], edi
|
||||
add edi, OS_BASE
|
||||
add esi, OS_BASE
|
||||
mov DWORD PTR [esp+44], esi
|
||||
mov ecx, DWORD PTR [eax-4]
|
||||
mov DWORD PTR [esp+48], edi
|
||||
mov edx, DWORD PTR [eax-20]
|
||||
test edx, edx
|
||||
jnz @f
|
||||
mov edx, ecx
|
||||
@@:
|
||||
mov DWORD PTR [esp+52], 0
|
||||
add ecx, ebp
|
||||
add edx, ebp
|
||||
mov DWORD PTR [esp+24], edx
|
||||
mov DWORD PTR [esp+28], ecx
|
||||
L26:
|
||||
mov esi, DWORD PTR [esp+52]
|
||||
mov edi, DWORD PTR [esp+24]
|
||||
mov eax, DWORD PTR [edi+esi*4]
|
||||
test eax, eax
|
||||
je L27
|
||||
test eax, eax
|
||||
js L27
|
||||
lea edi, [ebp+eax]
|
||||
mov eax, DWORD PTR [esp+28]
|
||||
mov DWORD PTR [eax+esi*4], 0
|
||||
lea esi, [edi+2]
|
||||
push eax
|
||||
push 32
|
||||
movzx eax, WORD PTR [edi]
|
||||
mov edx, DWORD PTR [esp+56]
|
||||
mov eax, DWORD PTR [edx+eax*4]
|
||||
add eax, OS_BASE
|
||||
push eax
|
||||
push esi
|
||||
call strncmp
|
||||
pop ebx
|
||||
xor ebx, ebx
|
||||
test eax, eax
|
||||
jne L32
|
||||
jmp L30
|
||||
L33:
|
||||
push ecx
|
||||
push 32
|
||||
mov ecx, DWORD PTR [esp+28]
|
||||
mov eax, DWORD PTR [ecx+OS_BASE+ebx*4]
|
||||
add eax, OS_BASE
|
||||
push eax
|
||||
push esi
|
||||
call strncmp
|
||||
pop edx
|
||||
test eax, eax
|
||||
jne L34
|
||||
mov esi, DWORD PTR [esp+44]
|
||||
mov edx, DWORD PTR [esp+52]
|
||||
mov ecx, DWORD PTR [esp+28]
|
||||
mov eax, DWORD PTR [esi+ebx*4]
|
||||
add eax, OS_BASE
|
||||
mov DWORD PTR [ecx+edx*4], eax
|
||||
jmp L36
|
||||
L34:
|
||||
inc ebx
|
||||
L32:
|
||||
cmp ebx, DWORD PTR [__exports+24]
|
||||
jb L33
|
||||
L36:
|
||||
cmp ebx, DWORD PTR [__exports+24]
|
||||
jne L37
|
||||
|
||||
mov esi, msg_unresolved
|
||||
call sys_msg_board_str
|
||||
lea esi, [edi+2]
|
||||
call sys_msg_board_str
|
||||
mov esi, msg_CR
|
||||
call sys_msg_board_str
|
||||
|
||||
mov DWORD PTR [esp+40], 1
|
||||
jmp L37
|
||||
L30:
|
||||
movzx eax, WORD PTR [edi]
|
||||
mov esi, DWORD PTR [esp+44]
|
||||
mov edi, DWORD PTR [esp+52]
|
||||
mov edx, DWORD PTR [esp+28]
|
||||
mov eax, DWORD PTR [esi+eax*4]
|
||||
add eax, OS_BASE
|
||||
mov DWORD PTR [edx+edi*4], eax
|
||||
L37:
|
||||
inc DWORD PTR [esp+52]
|
||||
jmp L26
|
||||
L27:
|
||||
add DWORD PTR [esp+56], 20
|
||||
jmp L22
|
||||
L25:
|
||||
xor eax, eax
|
||||
cmp DWORD PTR [esp+40], 0
|
||||
jne L40
|
||||
L20:
|
||||
mov ecx, DWORD PTR [esp+32]
|
||||
mov eax, ebp
|
||||
add eax, DWORD PTR [ecx+40]
|
||||
L40:
|
||||
add esp, 60
|
||||
pop ebx
|
||||
pop esi
|
||||
pop edi
|
||||
pop ebp
|
||||
ret 8
|
||||
513
kernel/branches/kolibri-process/core/sched.inc
Normal file
513
kernel/branches/kolibri-process/core/sched.inc
Normal file
@@ -0,0 +1,513 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Copyright (C) MenuetOS 2000-2004 Ville Mikael Turjanmaa ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3617 $
|
||||
|
||||
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; IRQ0 HANDLER (TIMER INTERRUPT) ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
|
||||
align 32
|
||||
irq0:
|
||||
pushad
|
||||
Mov ds, ax, app_data
|
||||
mov es, ax
|
||||
inc [timer_ticks]
|
||||
mov eax, [timer_ticks]
|
||||
call playNote ; <<<--- Speaker driver
|
||||
sub eax, [next_usage_update]
|
||||
cmp eax, 100
|
||||
jb .nocounter
|
||||
add [next_usage_update], 100
|
||||
call updatecputimes
|
||||
.nocounter:
|
||||
xor ecx, ecx ; send End Of Interrupt signal
|
||||
call irq_eoi
|
||||
; btr dword[DONT_SWITCH], 0
|
||||
; jc .return
|
||||
mov bl, SCHEDULE_ANY_PRIORITY
|
||||
call find_next_task
|
||||
jz .return ; if there is only one running process
|
||||
call do_change_task
|
||||
.return:
|
||||
popad
|
||||
iretd
|
||||
|
||||
align 4
|
||||
change_task:
|
||||
pushfd
|
||||
cli
|
||||
pushad
|
||||
if 0
|
||||
; \begin{Mario79} ; <- must be refractoried, if used...
|
||||
cmp [dma_task_switched], 1
|
||||
jne .find_next_task
|
||||
mov [dma_task_switched], 0
|
||||
mov ebx, [dma_process]
|
||||
cmp [CURRENT_TASK], ebx
|
||||
je .return
|
||||
mov edi, [dma_slot_ptr]
|
||||
mov [CURRENT_TASK], ebx
|
||||
mov [TASK_BASE], edi
|
||||
jmp @f
|
||||
.find_next_task:
|
||||
; \end{Mario79}
|
||||
end if
|
||||
mov bl, SCHEDULE_ANY_PRIORITY
|
||||
call find_next_task
|
||||
jz .return ; the same task -> skip switch
|
||||
@@:
|
||||
; mov byte[DONT_SWITCH], 1
|
||||
call do_change_task
|
||||
.return:
|
||||
popad
|
||||
popfd
|
||||
ret
|
||||
|
||||
uglobal
|
||||
align 4
|
||||
; far_jump:
|
||||
; .offs dd ?
|
||||
; .sel dw ?
|
||||
context_counter dd 0 ;noname & halyavin
|
||||
next_usage_update dd 0
|
||||
timer_ticks dd 0
|
||||
; prev_slot dd ?
|
||||
; event_sched dd ?
|
||||
endg
|
||||
|
||||
align 4
|
||||
update_counters:
|
||||
mov edi, [TASK_BASE]
|
||||
rdtsc
|
||||
sub eax, [edi+TASKDATA.counter_add] ; time stamp counter add
|
||||
add [edi+TASKDATA.counter_sum], eax ; counter sum
|
||||
ret
|
||||
align 4
|
||||
updatecputimes:
|
||||
mov ecx, [TASK_COUNT]
|
||||
mov edi, TASK_DATA
|
||||
.newupdate:
|
||||
xor eax, eax
|
||||
xchg eax, [edi+TASKDATA.counter_sum]
|
||||
mov [edi+TASKDATA.cpu_usage], eax
|
||||
add edi, 0x20
|
||||
loop .newupdate
|
||||
ret
|
||||
|
||||
;TODO: Надо бы убрать использование do_change_task из V86...
|
||||
; и после этого перенести обработку TASKDATA.counter_add/sum в do_change_task
|
||||
|
||||
align 4
|
||||
do_change_task:
|
||||
;param:
|
||||
; ebx = address of the APPDATA for incoming task (new)
|
||||
;warning:
|
||||
; [CURRENT_TASK] and [TASK_BASE] must be changed before (e.g. in find_next_task)
|
||||
; [current_slot] is the outcoming (old), and set here to a new value (ebx)
|
||||
;scratched: eax,ecx,esi
|
||||
mov esi, ebx
|
||||
xchg esi, [current_slot]
|
||||
; set new stack after saving old
|
||||
mov [esi+APPDATA.saved_esp], esp
|
||||
mov esp, [ebx+APPDATA.saved_esp]
|
||||
; set new thread io-map
|
||||
Mov dword [page_tabs+((tss._io_map_0 and -4096) shr 10)],eax,[ebx+APPDATA.io_map]
|
||||
Mov dword [page_tabs+((tss._io_map_1 and -4096) shr 10)],eax,[ebx+APPDATA.io_map+4]
|
||||
; set new thread memory-map
|
||||
mov ecx, APPDATA.process
|
||||
mov eax, [ebx+ecx] ;offset>0x7F
|
||||
cmp eax, [esi+ecx] ;offset>0x7F
|
||||
je @f
|
||||
mov eax, [eax+PROC.pdt_0_phys]
|
||||
mov cr3, eax
|
||||
@@:
|
||||
; set tss.esp0
|
||||
|
||||
Mov [tss._esp0],eax,[ebx+APPDATA.saved_esp0]
|
||||
|
||||
mov edx, [ebx+APPDATA.tls_base]
|
||||
cmp edx, [esi+APPDATA.tls_base]
|
||||
je @f
|
||||
|
||||
mov [tls_data_l+2], dx
|
||||
shr edx, 16
|
||||
mov [tls_data_l+4], dl
|
||||
mov [tls_data_l+7], dh
|
||||
|
||||
mov dx, app_tls
|
||||
mov fs, dx
|
||||
@@:
|
||||
; set gs selector unconditionally
|
||||
Mov gs,ax,graph_data
|
||||
; set CR0.TS
|
||||
cmp bh, byte[fpu_owner] ;bh == incoming task (new)
|
||||
clts ;clear a task switch flag
|
||||
je @f
|
||||
mov eax, cr0 ;and set it again if the owner
|
||||
or eax, CR0_TS ;of a fpu has changed
|
||||
mov cr0, eax
|
||||
@@: ; set context_counter (only for user pleasure ???)
|
||||
inc [context_counter] ;noname & halyavin
|
||||
; set debug-registers, if it's necessary
|
||||
test byte[ebx+APPDATA.dbg_state], 1
|
||||
jz @f
|
||||
xor eax, eax
|
||||
mov dr6, eax
|
||||
lea esi, [ebx+APPDATA.dbg_regs]
|
||||
cld
|
||||
macro lodsReg [reg] {
|
||||
lodsd
|
||||
mov reg, eax
|
||||
} lodsReg dr0, dr1, dr2, dr3, dr7
|
||||
purge lodsReg
|
||||
@@:
|
||||
ret
|
||||
;end.
|
||||
|
||||
|
||||
|
||||
struct MUTEX_WAITER
|
||||
list LHEAD
|
||||
task dd ?
|
||||
ends
|
||||
|
||||
;void __fastcall mutex_init(struct mutex *lock)
|
||||
|
||||
align 4
|
||||
mutex_init:
|
||||
mov [ecx+MUTEX.lhead.next], ecx
|
||||
mov [ecx+MUTEX.lhead.prev], ecx
|
||||
mov [ecx+MUTEX.count], 1
|
||||
ret
|
||||
|
||||
|
||||
;void __fastcall mutex_lock(struct mutex *lock)
|
||||
|
||||
align 4
|
||||
mutex_lock:
|
||||
|
||||
dec [ecx+MUTEX.count]
|
||||
jns .done
|
||||
|
||||
pushfd
|
||||
cli
|
||||
|
||||
sub esp, sizeof.MUTEX_WAITER
|
||||
|
||||
list_add_tail esp, ecx ;esp= new waiter, ecx= list head
|
||||
|
||||
mov edx, [TASK_BASE]
|
||||
mov [esp+MUTEX_WAITER.task], edx
|
||||
|
||||
.forever:
|
||||
|
||||
mov eax, -1
|
||||
xchg eax, [ecx+MUTEX.count]
|
||||
dec eax
|
||||
jz @F
|
||||
|
||||
mov [edx+TASKDATA.state], 1
|
||||
call change_task
|
||||
jmp .forever
|
||||
@@:
|
||||
mov edx, [esp+MUTEX_WAITER.list.next]
|
||||
mov eax, [esp+MUTEX_WAITER.list.prev]
|
||||
|
||||
mov [eax+MUTEX_WAITER.list.next], edx
|
||||
mov [edx+MUTEX_WAITER.list.prev], eax
|
||||
cmp [ecx+MUTEX.lhead.next], ecx
|
||||
jne @F
|
||||
|
||||
mov [ecx+MUTEX.count], 0
|
||||
@@:
|
||||
add esp, sizeof.MUTEX_WAITER
|
||||
|
||||
popfd
|
||||
.done:
|
||||
ret
|
||||
|
||||
;void __fastcall mutex_unlock(struct mutex *lock)
|
||||
|
||||
align 4
|
||||
mutex_unlock:
|
||||
|
||||
pushfd
|
||||
cli
|
||||
|
||||
mov eax, [ecx+MUTEX.lhead.next]
|
||||
cmp eax, ecx
|
||||
mov [ecx+MUTEX.count], 1
|
||||
je @F
|
||||
|
||||
mov eax, [eax+MUTEX_WAITER.task]
|
||||
mov [eax+TASKDATA.state], 0
|
||||
@@:
|
||||
popfd
|
||||
ret
|
||||
|
||||
|
||||
purge MUTEX_WAITER
|
||||
|
||||
MAX_PRIORITY = 0 ; highest, used for kernel tasks
|
||||
USER_PRIORITY = 1 ; default
|
||||
IDLE_PRIORITY = 2 ; lowest, only IDLE thread goes here
|
||||
NR_SCHED_QUEUES = 3 ; MUST equal IDLE_PRIORYTY + 1
|
||||
|
||||
uglobal
|
||||
; [scheduler_current + i*4] = zero if there are no threads with priority i,
|
||||
; pointer to APPDATA of the current thread with priority i otherwise.
|
||||
align 4
|
||||
scheduler_current rd NR_SCHED_QUEUES
|
||||
endg
|
||||
|
||||
; Add the given thread to the given priority list for the scheduler.
|
||||
; in: edx -> APPDATA, ecx = priority
|
||||
proc scheduler_add_thread
|
||||
; 1. Acquire the lock.
|
||||
spin_lock_irqsave SchedulerLock
|
||||
; 2. Store the priority in APPDATA structure.
|
||||
mov [edx+APPDATA.priority], ecx
|
||||
; 3. There are two different cases: the given list is empty or not empty.
|
||||
; In first case, go to 6. Otherwise, advance to 4.
|
||||
mov eax, [scheduler_current+ecx*4]
|
||||
test eax, eax
|
||||
jz .new_list
|
||||
; 4. Insert the new item immediately before the current item.
|
||||
mov ecx, [eax+APPDATA.in_schedule.prev]
|
||||
mov [edx+APPDATA.in_schedule.next], eax
|
||||
mov [edx+APPDATA.in_schedule.prev], ecx
|
||||
mov [eax+APPDATA.in_schedule.prev], edx
|
||||
mov [ecx+APPDATA.in_schedule.next], edx
|
||||
; 5. Release the lock and return.
|
||||
spin_unlock_irqrestore SchedulerLock
|
||||
ret
|
||||
.new_list:
|
||||
; 6. Initialize the list with one item and make it the current item.
|
||||
mov [edx+APPDATA.in_schedule.next], edx
|
||||
mov [edx+APPDATA.in_schedule.prev], edx
|
||||
mov [scheduler_current+ecx*4], edx
|
||||
; 7. Release the lock and return.
|
||||
spin_unlock_irqrestore SchedulerLock
|
||||
ret
|
||||
endp
|
||||
|
||||
; Remove the given thread from the corresponding priority list for the scheduler.
|
||||
; in: edx -> APPDATA
|
||||
proc scheduler_remove_thread
|
||||
; 1. Acquire the lock.
|
||||
spin_lock_irqsave SchedulerLock
|
||||
; 2. Remove the item from the corresponding list.
|
||||
mov eax, [edx+APPDATA.in_schedule.next]
|
||||
mov ecx, [edx+APPDATA.in_schedule.prev]
|
||||
mov [eax+APPDATA.in_schedule.prev], ecx
|
||||
mov [ecx+APPDATA.in_schedule.next], eax
|
||||
; 3. If the given thread is the current item in the list,
|
||||
; advance the current item.
|
||||
; 3a. Check whether the given thread is the current item;
|
||||
; if no, skip the rest of this step.
|
||||
mov ecx, [edx+APPDATA.priority]
|
||||
cmp [scheduler_current+ecx*4], edx
|
||||
jnz .return
|
||||
; 3b. Set the current item to eax; step 2 has set eax = next item.
|
||||
mov [scheduler_current+ecx*4], eax
|
||||
; 3c. If there were only one item in the list, zero the current item.
|
||||
cmp eax, edx
|
||||
jnz .return
|
||||
mov [scheduler_current+ecx*4], 0
|
||||
.return:
|
||||
; 4. Release the lock and return.
|
||||
spin_unlock_irqrestore SchedulerLock
|
||||
ret
|
||||
endp
|
||||
|
||||
SCHEDULE_ANY_PRIORITY = 0
|
||||
SCHEDULE_HIGHER_PRIORITY = 1
|
||||
;info:
|
||||
; Find next task to execute
|
||||
;in:
|
||||
; bl = SCHEDULE_ANY_PRIORITY:
|
||||
; consider threads with any priority
|
||||
; bl = SCHEDULE_HIGHER_PRIORITY:
|
||||
; consider only threads with strictly higher priority than the current one,
|
||||
; keep running the current thread if other ready threads have the same or lower priority
|
||||
;retval:
|
||||
; ebx = address of the APPDATA for the selected task (slot-base)
|
||||
; edi = address of the TASKDATA for the selected task
|
||||
; ZF = 1 if the task is the same
|
||||
;warning:
|
||||
; [CURRENT_TASK] = bh , [TASK_BASE] = edi -- as result
|
||||
; [current_slot] is not set to new value (ebx)!!!
|
||||
;scratched: eax,ecx
|
||||
proc find_next_task
|
||||
call update_counters
|
||||
spin_lock_irqsave SchedulerLock
|
||||
push NR_SCHED_QUEUES
|
||||
; If bl == SCHEDULE_ANY_PRIORITY = 0, loop over all NR_SCHED lists.
|
||||
; Otherwise, loop over first [APPDATA.priority] lists.
|
||||
test bl, bl
|
||||
jz .start
|
||||
mov ebx, [current_slot]
|
||||
mov edi, [TASK_BASE]
|
||||
mov eax, [ebx+APPDATA.priority]
|
||||
test eax, eax
|
||||
jz .unlock_found
|
||||
mov [esp], eax
|
||||
.start:
|
||||
xor ecx, ecx
|
||||
.priority_loop:
|
||||
mov ebx, [scheduler_current+ecx*4]
|
||||
test ebx, ebx
|
||||
jz .priority_next
|
||||
.task_loop:
|
||||
mov ebx, [ebx+APPDATA.in_schedule.next]
|
||||
mov edi, ebx
|
||||
shr edi, 3
|
||||
add edi, CURRENT_TASK - (SLOT_BASE shr 3)
|
||||
mov al, [edi+TASKDATA.state]
|
||||
test al, al
|
||||
jz .task_found ; state == 0
|
||||
cmp al, 5
|
||||
jne .task_next ; state == 1,2,3,4,9
|
||||
; state == 5
|
||||
pushad ; more freedom for [APPDATA.wait_test]
|
||||
call [ebx+APPDATA.wait_test]
|
||||
mov [esp+28], eax
|
||||
popad
|
||||
or eax, eax
|
||||
jnz @f
|
||||
; testing for timeout
|
||||
mov eax, [timer_ticks]
|
||||
sub eax, [ebx+APPDATA.wait_begin]
|
||||
cmp eax, [ebx+APPDATA.wait_timeout]
|
||||
jb .task_next
|
||||
xor eax, eax
|
||||
@@:
|
||||
mov [ebx+APPDATA.wait_param], eax ; retval for wait
|
||||
mov [edi+TASKDATA.state], 0
|
||||
.task_found:
|
||||
mov [scheduler_current+ecx*4], ebx
|
||||
; If we have selected a thread with higher priority
|
||||
; AND rescheduling is due to IRQ,
|
||||
; turn the current scheduler list one entry back,
|
||||
; so the current thread will be next after high-priority thread is done.
|
||||
mov ecx, [esp]
|
||||
cmp ecx, NR_SCHED_QUEUES
|
||||
jz .unlock_found
|
||||
mov eax, [current_slot]
|
||||
mov eax, [eax+APPDATA.in_schedule.prev]
|
||||
mov [scheduler_current+ecx*4], eax
|
||||
.unlock_found:
|
||||
pop ecx
|
||||
spin_unlock_irqrestore SchedulerLock
|
||||
.found:
|
||||
mov [CURRENT_TASK], bh
|
||||
mov [TASK_BASE], edi
|
||||
rdtsc ;call _rdtsc
|
||||
mov [edi+TASKDATA.counter_add], eax; for next using update_counters
|
||||
cmp ebx, [current_slot]
|
||||
ret
|
||||
.task_next:
|
||||
cmp ebx, [scheduler_current+ecx*4]
|
||||
jnz .task_loop
|
||||
.priority_next:
|
||||
inc ecx
|
||||
cmp ecx, [esp]
|
||||
jb .priority_loop
|
||||
mov ebx, [current_slot]
|
||||
mov edi, [TASK_BASE]
|
||||
jmp .unlock_found
|
||||
endp
|
||||
|
||||
if 0
|
||||
|
||||
struc TIMER
|
||||
{
|
||||
.next dd ?
|
||||
.exp_time dd ?
|
||||
.func dd ?
|
||||
.arg dd ?
|
||||
}
|
||||
|
||||
|
||||
uglobal
|
||||
rdy_head rd 16
|
||||
endg
|
||||
|
||||
align 4
|
||||
pick_task:
|
||||
|
||||
xor eax, eax
|
||||
.pick:
|
||||
mov ebx, [rdy_head+eax*4]
|
||||
test ebx, ebx
|
||||
jz .next
|
||||
|
||||
mov [next_task], ebx
|
||||
test [ebx+flags.billable]
|
||||
jz @F
|
||||
mov [bill_task], ebx
|
||||
@@:
|
||||
ret
|
||||
.next:
|
||||
inc eax
|
||||
jmp .pick
|
||||
|
||||
; param
|
||||
; eax= task
|
||||
;
|
||||
; retval
|
||||
; eax= task
|
||||
; ebx= queue
|
||||
; ecx= front if 1 or back if 0
|
||||
align 4
|
||||
shed:
|
||||
cmp [eax+.tics_left], 0;signed compare
|
||||
mov ebx, [eax+.priority]
|
||||
setg ecx
|
||||
jg @F
|
||||
|
||||
mov edx, [eax+.tics_quantum]
|
||||
mov [eax+.ticks_left], edx
|
||||
cmp ebx, (IDLE_PRIORITY-1)
|
||||
je @F
|
||||
inc ebx
|
||||
@@:
|
||||
ret
|
||||
|
||||
; param
|
||||
; eax= task
|
||||
align 4
|
||||
enqueue:
|
||||
call shed;eax
|
||||
cmp [rdy_head+ebx*4], 0
|
||||
jnz @F
|
||||
|
||||
mov [rdy_head+ebx*4], eax
|
||||
mov [rdy_tail+ebx*4], eax
|
||||
mov [eax+.next_ready], 0
|
||||
jmp .pick
|
||||
@@:
|
||||
test ecx, ecx
|
||||
jz .back
|
||||
|
||||
mov ecx, [rdy_head+ebx*4]
|
||||
mov [eax+.next_ready], ecx
|
||||
mov [rdy_head+ebx*4], eax
|
||||
jmp .pick
|
||||
.back:
|
||||
mov ecx, [rdy_tail+ebx*4]
|
||||
mov [ecx+.next_ready], eax
|
||||
mov [rdy_tail+ebx*4], eax
|
||||
mov [eax+.next_ready], 0
|
||||
.pick:
|
||||
call pick_proc;select next task
|
||||
ret
|
||||
|
||||
end if
|
||||
188
kernel/branches/kolibri-process/core/string.inc
Normal file
188
kernel/branches/kolibri-process/core/string.inc
Normal file
@@ -0,0 +1,188 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; Author: Kees J. Bot 1 Jan 1994 ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
; size_t strncat(char *s1, const char *s2, size_t n)
|
||||
; Append string s2 to s1.
|
||||
|
||||
; char *strchr(const char *s, int c)
|
||||
|
||||
|
||||
; int strncmp(const char *s1, const char *s2, size_t n)
|
||||
; Compare two strings.
|
||||
|
||||
; char *strncpy(char *s1, const char *s2, size_t n)
|
||||
; Copy string s2 to s1.
|
||||
|
||||
; size_t strnlen(const char *s, size_t n)
|
||||
; Return the length of a string.
|
||||
|
||||
; proc strrchr stdcall, s:dword, c:dword
|
||||
; Look for the last occurrence a character in a string.
|
||||
|
||||
proc strncat stdcall, s1:dword, s2:dword, n:dword
|
||||
push esi
|
||||
push edi
|
||||
mov edi, [s1] ; String s1
|
||||
mov edx, [n] ; Maximum length
|
||||
|
||||
mov ecx, -1
|
||||
xor al, al ; Null byte
|
||||
cld
|
||||
repne scasb ; Look for the zero byte in s1
|
||||
dec edi ; Back one up (and clear 'Z' flag)
|
||||
push edi ; Save end of s1
|
||||
mov edi, [s2] ; edi = string s2
|
||||
mov ecx, edx ; Maximum count
|
||||
repne scasb ; Look for the end of s2
|
||||
jne @F
|
||||
inc ecx ; Exclude null byte
|
||||
@@:
|
||||
sub edx, ecx ; Number of bytes in s2
|
||||
mov ecx, edx
|
||||
mov esi, [s2] ; esi = string s2
|
||||
pop edi ; edi = end of string s1
|
||||
rep movsb ; Copy bytes
|
||||
stosb ; Add a terminating null
|
||||
mov eax, [s1] ; Return s1
|
||||
pop edi
|
||||
pop esi
|
||||
ret
|
||||
endp
|
||||
|
||||
align 4
|
||||
proc strncmp stdcall, s1:dword, s2:dword, n:dword
|
||||
|
||||
push esi
|
||||
push edi
|
||||
mov ecx, [n]
|
||||
test ecx, ecx ; Max length is zero?
|
||||
je .done
|
||||
|
||||
mov esi, [s1] ; esi = string s1
|
||||
mov edi, [s2] ; edi = string s2
|
||||
cld
|
||||
.compare:
|
||||
cmpsb ; Compare two bytes
|
||||
jne .done
|
||||
cmp byte [esi-1], 0 ; End of string?
|
||||
je .done
|
||||
dec ecx ; Length limit reached?
|
||||
jne .compare
|
||||
.done:
|
||||
seta al ; al = (s1 > s2)
|
||||
setb ah ; ah = (s1 < s2)
|
||||
sub al, ah
|
||||
movsx eax, al ; eax = (s1 > s2) - (s1 < s2), i.e. -1, 0, 1
|
||||
pop edi
|
||||
pop esi
|
||||
ret
|
||||
endp
|
||||
|
||||
align 4
|
||||
proc strncpy stdcall, s1:dword, s2:dword, n:dword
|
||||
|
||||
push esi
|
||||
push edi
|
||||
|
||||
mov ecx, [n] ; Maximum length
|
||||
mov edi, [s2] ; edi = string s2
|
||||
xor al, al ; Look for a zero byte
|
||||
mov edx, ecx ; Save maximum count
|
||||
cld
|
||||
repne scasb ; Look for end of s2
|
||||
sub edx, ecx ; Number of bytes in s2 including null
|
||||
xchg ecx, edx
|
||||
mov esi, [s2] ; esi = string s2
|
||||
mov edi, [s1] ; edi = string s1
|
||||
rep movsb ; Copy bytes
|
||||
|
||||
mov ecx, edx ; Number of bytes not copied
|
||||
rep stosb ; strncpy always copies n bytes by null padding
|
||||
mov eax, [s1] ; Return s1
|
||||
pop edi
|
||||
pop esi
|
||||
ret
|
||||
endp
|
||||
|
||||
align 4
|
||||
proc strnlen stdcall, s:dword, n:dword
|
||||
|
||||
push edi
|
||||
mov edi, [s] ; edi = string
|
||||
xor al, al ; Look for a zero byte
|
||||
mov edx, ecx ; Save maximum count
|
||||
cmp cl, 1 ; 'Z' bit must be clear if ecx = 0
|
||||
cld
|
||||
repne scasb ; Look for zero
|
||||
jne @F
|
||||
inc ecx ; Don't count zero byte
|
||||
@@:
|
||||
mov eax, edx
|
||||
sub eax, ecx ; Compute bytes scanned
|
||||
pop edi
|
||||
ret
|
||||
endp
|
||||
|
||||
align 4
|
||||
proc strchr stdcall, s:dword, c:dword
|
||||
push edi
|
||||
cld
|
||||
mov edi, [s] ; edi = string
|
||||
mov edx, 16 ; Look at small chunks of the string
|
||||
.next:
|
||||
shl edx, 1 ; Chunks become bigger each time
|
||||
mov ecx, edx
|
||||
xor al, al ; Look for the zero at the end
|
||||
repne scasb
|
||||
pushf ; Remember the flags
|
||||
sub ecx, edx
|
||||
neg ecx ; Some or all of the chunk
|
||||
sub edi, ecx ; Step back
|
||||
mov eax, [c] ; The character to look for
|
||||
repne scasb
|
||||
je .found
|
||||
popf ; Did we find the end of string earlier?
|
||||
jne .next ; No, try again
|
||||
xor eax, eax ; Return NULL
|
||||
pop edi
|
||||
ret
|
||||
.found:
|
||||
pop eax ; Get rid of those flags
|
||||
lea eax, [edi-1] ; Address of byte found
|
||||
pop edi
|
||||
ret
|
||||
|
||||
endp
|
||||
|
||||
|
||||
proc strrchr stdcall, s:dword, c:dword
|
||||
push edi
|
||||
mov edi, [s] ; edi = string
|
||||
mov ecx, -1
|
||||
xor al, al
|
||||
cld
|
||||
repne scasb ; Look for the end of the string
|
||||
not ecx ; -1 - ecx = Length of the string + null
|
||||
dec edi ; Put edi back on the zero byte
|
||||
mov eax, [c] ; The character to look for
|
||||
std ; Downwards search
|
||||
repne scasb
|
||||
cld ; Direction bit back to default
|
||||
jne .fail
|
||||
lea eax, [edi+1] ; Found it
|
||||
pop edi
|
||||
ret
|
||||
.fail:
|
||||
xor eax, eax ; Not there
|
||||
pop edi
|
||||
ret
|
||||
endp
|
||||
|
||||
|
||||
119
kernel/branches/kolibri-process/core/sync.inc
Normal file
119
kernel/branches/kolibri-process/core/sync.inc
Normal file
@@ -0,0 +1,119 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;; Synhronization for MenuetOS. ;;
|
||||
;; Author: Halyavin Andrey, halyavin@land.ru ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
if ~defined sync_inc
|
||||
sync_inc_fix:
|
||||
sync_inc fix sync_inc_fix
|
||||
|
||||
;simplest mutex.
|
||||
macro SimpleMutex name
|
||||
{
|
||||
; iglobal
|
||||
name dd 0
|
||||
name#.type = 1
|
||||
; endg
|
||||
}
|
||||
macro WaitSimpleMutex name
|
||||
{
|
||||
local start_wait,ok
|
||||
start_wait=$
|
||||
cli
|
||||
cmp [name], dword 0
|
||||
jz ok
|
||||
sti
|
||||
call change_task
|
||||
jmp start_wait
|
||||
ok=$
|
||||
push eax
|
||||
mov eax, dword [TASK_BASE+second_base_address]
|
||||
mov eax, [eax+TASKDATA.pid]
|
||||
mov [name], eax
|
||||
pop eax
|
||||
sti
|
||||
}
|
||||
macro ReleaseSimpleMutex name
|
||||
{
|
||||
mov [name], dword 0
|
||||
}
|
||||
macro TryWaitSimpleMutex name ;result in eax and in flags
|
||||
{
|
||||
local ok,try_end
|
||||
cmp [name], dword 0
|
||||
jz ok
|
||||
xor eax, eax
|
||||
jmp try_end
|
||||
ok=$
|
||||
xor eax, eax
|
||||
inc eax
|
||||
try_end=$
|
||||
}
|
||||
macro SimpleCriticalSection name
|
||||
{
|
||||
; iglobal
|
||||
name dd 0
|
||||
dd 0
|
||||
name#.type=2
|
||||
; endg
|
||||
}
|
||||
macro WaitSimpleCriticalSection name
|
||||
{
|
||||
local start_wait,first_wait,inc_counter,end_wait
|
||||
push eax
|
||||
mov eax, [TASK_BASE+second_base_address]
|
||||
mov eax, [eax+TASKDATA.pid]
|
||||
start_wait=$
|
||||
cli
|
||||
cmp [name], dword 0
|
||||
jz first_wait
|
||||
cmp [name], eax
|
||||
jz inc_counter
|
||||
sti
|
||||
call change_task
|
||||
jmp start_wait
|
||||
first_wait=$
|
||||
mov [name], eax
|
||||
mov [name+4], dword 1
|
||||
jmp end_wait
|
||||
inc_counter=$
|
||||
inc dword [name+4]
|
||||
end_wait=$
|
||||
sti
|
||||
pop eax
|
||||
}
|
||||
macro ReleaseSimpleCriticalSection name
|
||||
{
|
||||
local release_end
|
||||
dec dword [name+4]
|
||||
jnz release_end
|
||||
mov [name], dword 0
|
||||
release_end=$
|
||||
}
|
||||
macro TryWaitSimpleCriticalSection name ;result in eax and in flags
|
||||
{
|
||||
local ok,try_end
|
||||
mov eax, [CURRENT_TASK+second_base_address]
|
||||
mov eax, [eax+TASKDATA.pid]
|
||||
cmp [name], eax
|
||||
jz ok
|
||||
cmp [name], 0
|
||||
jz ok
|
||||
xor eax, eax
|
||||
jmp try_end
|
||||
ok=$
|
||||
xor eax, eax
|
||||
inc eax
|
||||
try_end=$
|
||||
}
|
||||
_cli equ call MEM_HeapLock
|
||||
_sti equ call MEM_HeapUnLock
|
||||
end if
|
||||
|
||||
4
kernel/branches/kolibri-process/core/sys32-sp.inc
Normal file
4
kernel/branches/kolibri-process/core/sys32-sp.inc
Normal file
@@ -0,0 +1,4 @@
|
||||
; Éste archivo debe ser editado con codificación CP866
|
||||
|
||||
msg_sel_ker cp850 "núcleo", 0
|
||||
msg_sel_app cp850 "aplicación", 0
|
||||
849
kernel/branches/kolibri-process/core/sys32.inc
Normal file
849
kernel/branches/kolibri-process/core/sys32.inc
Normal file
@@ -0,0 +1,849 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;; ;;
|
||||
;; MenuetOS process management, protected ring3 ;;
|
||||
;; ;;
|
||||
;; Distributed under GPL. See file COPYING for details. ;;
|
||||
;; Copyright 2003 Ville Turjanmaa ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4313 $
|
||||
|
||||
align 4 ;3A08
|
||||
build_interrupt_table:
|
||||
mov edi, idts
|
||||
mov esi, sys_int
|
||||
mov ecx, 0x40
|
||||
mov eax, (10001110b shl 24) + os_code
|
||||
@@:
|
||||
movsw ;low word of code-entry
|
||||
stosd ;interrupt gate type : os_code selector
|
||||
movsw ;high word of code-entry
|
||||
loop @b
|
||||
movsd ;copy low dword of trap gate for int 0x40
|
||||
movsd ;copy high dword of trap gate for int 0x40
|
||||
lidt [esi]
|
||||
ret
|
||||
|
||||
iglobal
|
||||
align 4
|
||||
sys_int:
|
||||
;exception handlers addresses (for interrupt gate construction)
|
||||
dd e0,e1,e2,e3,e4,e5,e6,except_7 ; SEE: core/fpu.inc
|
||||
dd e8,e9,e10,e11,e12,e13,page_fault_exc,e15
|
||||
dd e16, e17,e18, e19
|
||||
times 12 dd unknown_interrupt ;int_20..int_31
|
||||
|
||||
;interrupt handlers addresses (for interrupt gate construction)
|
||||
; 0x20 .. 0x2F - IRQ handlers
|
||||
dd irq0, irq_serv.irq_1, irq_serv.irq_2
|
||||
dd irq_serv.irq_3, irq_serv.irq_4
|
||||
dd irq_serv.irq_5, irq_serv.irq_6, irq_serv.irq_7
|
||||
dd irq_serv.irq_8, irq_serv.irq_9, irq_serv.irq_10
|
||||
dd irq_serv.irq_11, irq_serv.irq_12, irqD, irq_serv.irq_14, irq_serv.irq_15
|
||||
dd irq_serv.irq_16
|
||||
dd irq_serv.irq_17
|
||||
dd irq_serv.irq_18
|
||||
dd irq_serv.irq_19
|
||||
dd irq_serv.irq_20
|
||||
dd irq_serv.irq_21
|
||||
dd irq_serv.irq_22
|
||||
dd irq_serv.irq_23
|
||||
|
||||
times 32 - IRQ_RESERVED dd unknown_interrupt
|
||||
;int_0x40 gate trap (for directly copied)
|
||||
dw i40 and 0xFFFF, os_code, 11101111b shl 8, i40 shr 16
|
||||
|
||||
idtreg: ; data for LIDT instruction (!!! must be immediately below sys_int data)
|
||||
dw 2*($-sys_int-4)-1
|
||||
dd idts ;0x8000B100
|
||||
dw 0 ;просто выравнивание
|
||||
|
||||
msg_fault_sel dd msg_exc_8,msg_exc_u,msg_exc_a,msg_exc_b
|
||||
dd msg_exc_c,msg_exc_d,msg_exc_e
|
||||
|
||||
msg_exc_8 db "Double fault", 0
|
||||
msg_exc_u db "Undefined Exception", 0
|
||||
msg_exc_a db "Invalid TSS", 0
|
||||
msg_exc_b db "Segment not present", 0
|
||||
msg_exc_c db "Stack fault", 0
|
||||
msg_exc_d db "General protection fault", 0
|
||||
msg_exc_e db "Page fault", 0
|
||||
|
||||
if lang eq sp
|
||||
include 'core/sys32-sp.inc'
|
||||
else
|
||||
msg_sel_ker db "kernel", 0
|
||||
msg_sel_app db "application", 0
|
||||
end if
|
||||
|
||||
endg
|
||||
|
||||
macro save_ring3_context {
|
||||
pushad
|
||||
}
|
||||
macro restore_ring3_context {
|
||||
popad
|
||||
}
|
||||
macro exc_wo_code [num] {
|
||||
e#num :
|
||||
save_ring3_context
|
||||
mov bl, num
|
||||
jmp exc_c
|
||||
} exc_wo_code 0,1,2,3,4,5,6,15,16,19
|
||||
|
||||
macro exc_w_code [num] {
|
||||
e#num :
|
||||
add esp, 4
|
||||
save_ring3_context
|
||||
mov bl, num
|
||||
jmp exc_c
|
||||
} exc_w_code 8,9,10,11,12,13,17,18
|
||||
|
||||
|
||||
uglobal
|
||||
pf_err_code dd ?
|
||||
endg
|
||||
|
||||
page_fault_exc: ; дуракоусточивость: селекторы испорчены...
|
||||
pop [ss:pf_err_code]; действительно до следующего #PF
|
||||
save_ring3_context
|
||||
mov bl, 14
|
||||
|
||||
exc_c: ; исключения (все, кроме 7-го - #NM)
|
||||
; Фрэйм стека при исключении/прерывании из 3-го кольца + pushad (т.е., именно здесь)
|
||||
reg_ss equ esp+0x30
|
||||
reg_esp3 equ esp+0x2C
|
||||
reg_eflags equ esp+0x28
|
||||
reg_cs3 equ esp+0x24
|
||||
reg_eip equ esp+0x20
|
||||
; это фрэйм от pushad
|
||||
reg_eax equ esp+0x1C
|
||||
reg_ecx equ esp+0x18
|
||||
reg_edx equ esp+0x14
|
||||
reg_ebx equ esp+0x10
|
||||
reg_esp0 equ esp+0x0C
|
||||
reg_ebp equ esp+0x08
|
||||
reg_esi equ esp+0x04
|
||||
reg_edi equ esp+0x00
|
||||
|
||||
mov ax, app_data ;исключение
|
||||
mov ds, ax ;загрузим правильные значения
|
||||
mov es, ax ;в регистры
|
||||
cld ; и приводим DF к стандарту
|
||||
movzx ebx, bl
|
||||
; redirect to V86 manager? (EFLAGS & 0x20000) != 0?
|
||||
test byte[reg_eflags+2], 2
|
||||
jnz v86_exc_c
|
||||
cmp bl, 14 ; #PF
|
||||
jne @f
|
||||
call page_fault_handler ; SEE: core/memory.inc
|
||||
@@:
|
||||
mov esi, [current_slot]
|
||||
btr [esi+APPDATA.except_mask], ebx
|
||||
jnc @f
|
||||
mov eax, [esi+APPDATA.exc_handler]
|
||||
test eax, eax
|
||||
jnz IRetToUserHook
|
||||
@@:
|
||||
cli
|
||||
mov eax, [esi+APPDATA.debugger_slot]
|
||||
test eax, eax
|
||||
jnz .debug
|
||||
sti
|
||||
; not debuggee => say error and terminate
|
||||
call show_error_parameters ;; only ONE using, inline ???
|
||||
;mov edx, [TASK_BASE]
|
||||
mov [edx + TASKDATA.state], byte 4 ; terminate
|
||||
call wakeup_osloop
|
||||
call change_task
|
||||
; If we're here, then the main OS thread has crashed before initializing IDLE thread.
|
||||
; Or they both have crashed. Anyway, things are hopelessly broken.
|
||||
hlt
|
||||
jmp $-1
|
||||
.debug:
|
||||
; we are debugged process, notify debugger and suspend ourself
|
||||
; eax=debugger PID
|
||||
mov ecx, 1 ; debug_message code=other_exception
|
||||
cmp bl, 1 ; #DB
|
||||
jne .notify ; notify debugger and suspend ourself
|
||||
mov ebx, dr6 ; debug_message data=DR6_image
|
||||
xor edx, edx
|
||||
mov dr6, edx
|
||||
mov edx, dr7
|
||||
mov cl, not 8
|
||||
.l1:
|
||||
shl dl, 2
|
||||
jc @f
|
||||
and bl, cl
|
||||
@@:
|
||||
sar cl, 1
|
||||
jc .l1
|
||||
mov cl, 3 ; debug_message code=debug_exception
|
||||
.notify:
|
||||
push ebx ; debug_message data
|
||||
mov ebx, [TASK_BASE]
|
||||
push [ebx+TASKDATA.pid] ; PID
|
||||
push ecx ; debug_message code ((here: ecx==1/3))
|
||||
mov cl, 12 ; debug_message size
|
||||
call debugger_notify ;; only ONE using, inline ??? SEE: core/debug.inc
|
||||
add esp, 12
|
||||
mov edx, [TASK_BASE]
|
||||
mov byte [edx+TASKDATA.state], 1 ; suspended
|
||||
call change_task ; SEE: core/shed.inc
|
||||
restore_ring3_context
|
||||
iretd
|
||||
|
||||
IRetToUserHook:
|
||||
xchg eax, [reg_eip]
|
||||
sub dword[reg_esp3], 8
|
||||
mov edi, [reg_esp3]
|
||||
stosd
|
||||
mov [edi], ebx
|
||||
restore_ring3_context
|
||||
; simply return control to interrupted process
|
||||
unknown_interrupt:
|
||||
iretd
|
||||
|
||||
;-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
|
||||
; bl - error vector
|
||||
show_error_parameters:
|
||||
cmp bl, 0x06
|
||||
jnz .no_ud
|
||||
push ebx
|
||||
mov ebx, ud_user_message
|
||||
mov ebp, notifyapp
|
||||
call fs_execute_from_sysdir_param
|
||||
pop ebx
|
||||
.no_ud:
|
||||
mov edx, [TASK_BASE];not scratched below
|
||||
if lang eq sp
|
||||
DEBUGF 1, "K : Proceso - terminado forzado PID: %x [%s]\n", [edx+TASKDATA.pid], [current_slot]
|
||||
else
|
||||
DEBUGF 1, "K : Process - forced terminate PID: %x [%s]\n", [edx+TASKDATA.pid], [current_slot]
|
||||
end if
|
||||
cmp bl, 0x08
|
||||
jb .l0
|
||||
cmp bl, 0x0e
|
||||
jbe .l1
|
||||
.l0:
|
||||
mov bl, 0x09
|
||||
.l1:
|
||||
mov eax, [msg_fault_sel+ebx*4 - 0x08*4]
|
||||
DEBUGF 1, "K : %s\n", eax
|
||||
mov eax, [reg_cs3+4]
|
||||
mov edi, msg_sel_app
|
||||
mov ebx, [reg_esp3+4]
|
||||
cmp eax, app_code
|
||||
je @f
|
||||
mov edi, msg_sel_ker
|
||||
mov ebx, [reg_esp0+4]
|
||||
@@:
|
||||
DEBUGF 1, "K : EAX : %x EBX : %x ECX : %x\n", [reg_eax+4], [reg_ebx+4], [reg_ecx+4]
|
||||
DEBUGF 1, "K : EDX : %x ESI : %x EDI : %x\n", [reg_edx+4], [reg_esi+4], [reg_edi+4]
|
||||
DEBUGF 1, "K : EBP : %x EIP : %x ESP : %x\n", [reg_ebp+4], [reg_eip+4], ebx
|
||||
DEBUGF 1, "K : Flags : %x CS : %x (%s)\n", [reg_eflags+4], eax, edi
|
||||
|
||||
DEBUGF 1, "K : Stack dump:\n"
|
||||
push eax ebx ecx edx
|
||||
call .check_ESP
|
||||
test eax, eax
|
||||
jnz .error_ESP
|
||||
DEBUGF 1, "K : [ESP+00]: %x",[ebx]
|
||||
add ebx, 4
|
||||
call .check_ESP
|
||||
test eax, eax
|
||||
jnz .error_ESP
|
||||
DEBUGF 1, " [ESP+04]: %x",[ebx]
|
||||
add ebx, 4
|
||||
call .check_ESP
|
||||
test eax, eax
|
||||
jnz .error_ESP
|
||||
DEBUGF 1, " [ESP+08]: %x\n",[ebx]
|
||||
add ebx, 4
|
||||
call .check_ESP
|
||||
test eax, eax
|
||||
jnz .error_ESP
|
||||
DEBUGF 1, "K : [ESP+12]: %x",[ebx]
|
||||
add ebx, 4
|
||||
call .check_ESP
|
||||
test eax, eax
|
||||
jnz .error_ESP
|
||||
DEBUGF 1, " [ESP+16]: %x",[ebx]
|
||||
add ebx, 4
|
||||
call .check_ESP
|
||||
test eax, eax
|
||||
jnz .error_ESP
|
||||
DEBUGF 1, " [ESP+20]: %x\n",[ebx]
|
||||
add ebx, 4
|
||||
call .check_ESP
|
||||
test eax, eax
|
||||
jnz .error_ESP
|
||||
DEBUGF 1, "K : [ESP+24]: %x",[ebx]
|
||||
add ebx, 4
|
||||
call .check_ESP
|
||||
test eax, eax
|
||||
jnz .error_ESP
|
||||
DEBUGF 1, " [ESP+28]: %x",[ebx]
|
||||
add ebx, 4
|
||||
call .check_ESP
|
||||
test eax, eax
|
||||
jnz .error_ESP
|
||||
DEBUGF 1, " [ESP+32]: %x\n",[ebx]
|
||||
pop edx ecx ebx eax
|
||||
ret
|
||||
.error_ESP:
|
||||
pop edx ecx ebx eax
|
||||
DEBUGF 1, "\n"
|
||||
DEBUGF 1, "K : Unexpected end of the stack\n"
|
||||
ret
|
||||
;--------------------------------------
|
||||
.check_ESP:
|
||||
push ebx
|
||||
shr ebx, 12
|
||||
mov ecx, ebx
|
||||
shr ecx, 10
|
||||
mov edx, [master_tab+ecx*4]
|
||||
test edx, PG_MAP
|
||||
jz .fail ;page table is not created
|
||||
;incorrect address in the program
|
||||
|
||||
mov eax, [page_tabs+ebx*4]
|
||||
test eax, 2
|
||||
jz .fail ;address not reserved for use. error
|
||||
|
||||
pop ebx
|
||||
xor eax, eax
|
||||
ret
|
||||
|
||||
.fail:
|
||||
pop ebx
|
||||
xor eax, eax
|
||||
dec eax
|
||||
ret
|
||||
;-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
|
||||
|
||||
restore reg_ss
|
||||
restore reg_esp3
|
||||
restore reg_eflags
|
||||
restore reg_cs
|
||||
restore reg_eip
|
||||
restore reg_eax
|
||||
restore reg_ecx
|
||||
restore reg_edx
|
||||
restore reg_ebx
|
||||
restore reg_esp0
|
||||
restore reg_ebp
|
||||
restore reg_esi
|
||||
restore reg_edi
|
||||
|
||||
|
||||
align 4
|
||||
lock_application_table:
|
||||
push eax ecx edx
|
||||
mov ecx, application_table_mutex
|
||||
call mutex_lock
|
||||
|
||||
mov eax, [CURRENT_TASK]
|
||||
shl eax, 5
|
||||
add eax, CURRENT_TASK+TASKDATA.pid
|
||||
mov eax, [eax]
|
||||
|
||||
mov [application_table_owner], eax
|
||||
|
||||
pop edx ecx eax
|
||||
|
||||
ret
|
||||
|
||||
align 4
|
||||
unlock_application_table:
|
||||
push eax ecx edx
|
||||
|
||||
mov [application_table_owner], 0
|
||||
mov ecx, application_table_mutex
|
||||
call mutex_unlock
|
||||
|
||||
pop edx ecx eax
|
||||
|
||||
ret
|
||||
|
||||
; * eax = 64 - номер функции
|
||||
; * ebx = 1 - единственная подфункция
|
||||
; * ecx = новый размер памяти
|
||||
;Возвращаемое значение:
|
||||
; * eax = 0 - успешно
|
||||
; * eax = 1 - недостаточно памяти
|
||||
|
||||
align 4
|
||||
sys_resize_app_memory:
|
||||
; ebx = 1 - resize
|
||||
; ecx = new amount of memory
|
||||
|
||||
; cmp eax,1
|
||||
dec ebx
|
||||
jnz .no_application_mem_resize
|
||||
|
||||
mov eax, [pg_data.pages_free]
|
||||
shl eax, 12
|
||||
cmp eax, ecx
|
||||
jae @f
|
||||
|
||||
xor eax, eax
|
||||
inc eax
|
||||
jmp .store_result
|
||||
@@:
|
||||
stdcall new_mem_resize, ecx
|
||||
.store_result:
|
||||
mov [esp+32], eax
|
||||
.no_application_mem_resize:
|
||||
ret
|
||||
|
||||
iglobal
|
||||
; process_terminating db 'K : Process - terminating',13,10,0
|
||||
; process_terminated db 'K : Process - done',13,10,0
|
||||
msg_obj_destroy db 'K : destroy app object',13,10,0
|
||||
endg
|
||||
|
||||
; param
|
||||
; esi= slot
|
||||
|
||||
align 4
|
||||
terminate: ; terminate application
|
||||
|
||||
.slot equ esp ;locals
|
||||
|
||||
push esi ;save .slot
|
||||
|
||||
shl esi, 8
|
||||
cmp [SLOT_BASE+esi+APPDATA.process], 0
|
||||
jne @F
|
||||
pop esi
|
||||
shl esi, 5
|
||||
mov [CURRENT_TASK+esi+TASKDATA.state], 9
|
||||
ret
|
||||
@@:
|
||||
lea edx, [SLOT_BASE+esi]
|
||||
call scheduler_remove_thread
|
||||
;mov esi,process_terminating
|
||||
;call sys_msg_board_str
|
||||
call lock_application_table
|
||||
|
||||
; if the process is in V86 mode...
|
||||
mov eax, [.slot]
|
||||
shl eax, 8
|
||||
mov esi, [eax+SLOT_BASE+APPDATA.pl0_stack]
|
||||
add esi, RING0_STACK_SIZE
|
||||
cmp [eax+SLOT_BASE+APPDATA.saved_esp0], esi
|
||||
jz .nov86
|
||||
; ...it has page directory for V86 mode
|
||||
mov esi, [eax+SLOT_BASE+APPDATA.saved_esp0]
|
||||
mov ecx, [esi+4]
|
||||
mov [eax+SLOT_BASE+APPDATA.process], ecx
|
||||
; ...and I/O permission map for V86 mode
|
||||
mov ecx, [esi+12]
|
||||
mov [eax+SLOT_BASE+APPDATA.io_map], ecx
|
||||
mov ecx, [esi+8]
|
||||
mov [eax+SLOT_BASE+APPDATA.io_map+4], ecx
|
||||
.nov86:
|
||||
|
||||
mov esi, [.slot]
|
||||
shl esi, 8
|
||||
add esi, SLOT_BASE+APP_OBJ_OFFSET
|
||||
@@:
|
||||
mov eax, [esi+APPOBJ.fd]
|
||||
test eax, eax
|
||||
jz @F
|
||||
|
||||
cmp eax, esi
|
||||
je @F
|
||||
|
||||
push esi
|
||||
call [eax+APPOBJ.destroy]
|
||||
DEBUGF 1,"%s",msg_obj_destroy
|
||||
pop esi
|
||||
jmp @B
|
||||
@@:
|
||||
|
||||
mov eax, [.slot]
|
||||
shl eax, 8
|
||||
; stdcall destroy_app_space, [SLOT_BASE+eax+APPDATA.process], [SLOT_BASE+eax+APPDATA.dlls_list_ptr]
|
||||
|
||||
mov esi, [.slot]
|
||||
cmp [fpu_owner], esi ; if user fpu last -> fpu user = 2
|
||||
jne @F
|
||||
|
||||
mov [fpu_owner], 2
|
||||
mov eax, [256*2+SLOT_BASE+APPDATA.fpu_state]
|
||||
clts
|
||||
bt [cpu_caps], CAPS_SSE
|
||||
jnc .no_SSE
|
||||
fxrstor [eax]
|
||||
jmp @F
|
||||
.no_SSE:
|
||||
fnclex
|
||||
frstor [eax]
|
||||
@@:
|
||||
|
||||
mov [KEY_COUNT], byte 0 ; empty keyboard buffer
|
||||
mov [BTN_COUNT], byte 0 ; empty button buffer
|
||||
|
||||
|
||||
; remove defined hotkeys
|
||||
mov eax, hotkey_list
|
||||
.loop:
|
||||
cmp [eax+8], esi
|
||||
jnz .cont
|
||||
mov ecx, [eax]
|
||||
jecxz @f
|
||||
push dword [eax+12]
|
||||
pop dword [ecx+12]
|
||||
@@:
|
||||
mov ecx, [eax+12]
|
||||
push dword [eax]
|
||||
pop dword [ecx]
|
||||
xor ecx, ecx
|
||||
mov [eax], ecx
|
||||
mov [eax+4], ecx
|
||||
mov [eax+8], ecx
|
||||
mov [eax+12], ecx
|
||||
.cont:
|
||||
add eax, 16
|
||||
cmp eax, hotkey_list+256*16
|
||||
jb .loop
|
||||
; get process PID
|
||||
mov eax, esi
|
||||
shl eax, 5
|
||||
mov eax, [eax+CURRENT_TASK+TASKDATA.pid]
|
||||
; compare current lock input with process PID
|
||||
cmp eax, [PID_lock_input]
|
||||
jne @f
|
||||
|
||||
xor eax, eax
|
||||
mov [PID_lock_input], eax
|
||||
@@:
|
||||
; remove hotkeys in buffer
|
||||
mov eax, hotkey_buffer
|
||||
.loop2:
|
||||
cmp [eax], esi
|
||||
jnz .cont2
|
||||
and dword [eax+4], 0
|
||||
and dword [eax], 0
|
||||
.cont2:
|
||||
add eax, 8
|
||||
cmp eax, hotkey_buffer+120*8
|
||||
jb .loop2
|
||||
|
||||
mov ecx, esi ; remove buttons
|
||||
bnewba2:
|
||||
mov edi, [BTN_ADDR]
|
||||
mov eax, edi
|
||||
cld
|
||||
movzx ebx, word [edi]
|
||||
inc bx
|
||||
bnewba:
|
||||
dec bx
|
||||
jz bnmba
|
||||
add eax, 0x10
|
||||
cmp cx, [eax]
|
||||
jnz bnewba
|
||||
pusha
|
||||
mov ecx, ebx
|
||||
inc ecx
|
||||
shl ecx, 4
|
||||
mov ebx, eax
|
||||
add eax, 0x10
|
||||
call memmove
|
||||
dec dword [edi]
|
||||
popa
|
||||
jmp bnewba2
|
||||
bnmba:
|
||||
|
||||
pusha ; save window coordinates for window restoring
|
||||
cld
|
||||
shl esi, 5
|
||||
add esi, window_data
|
||||
mov eax, [esi+WDATA.box.left]
|
||||
mov [draw_limits.left], eax
|
||||
add eax, [esi+WDATA.box.width]
|
||||
mov [draw_limits.right], eax
|
||||
mov eax, [esi+WDATA.box.top]
|
||||
mov [draw_limits.top], eax
|
||||
add eax, [esi+WDATA.box.height]
|
||||
mov [draw_limits.bottom], eax
|
||||
|
||||
xor eax, eax
|
||||
mov [esi+WDATA.box.left], eax
|
||||
mov [esi+WDATA.box.width], eax
|
||||
mov [esi+WDATA.box.top], eax
|
||||
mov [esi+WDATA.box.height], eax
|
||||
mov [esi+WDATA.cl_workarea], eax
|
||||
mov [esi+WDATA.cl_titlebar], eax
|
||||
mov [esi+WDATA.cl_frames], eax
|
||||
mov dword [esi+WDATA.reserved], eax; clear all flags: wstate, redraw, wdrawn
|
||||
lea edi, [esi-window_data+draw_data]
|
||||
mov ecx, 32/4
|
||||
rep stosd
|
||||
popa
|
||||
|
||||
; debuggee test
|
||||
pushad
|
||||
mov edi, esi
|
||||
shl edi, 5
|
||||
mov eax, [SLOT_BASE+edi*8+APPDATA.debugger_slot]
|
||||
test eax, eax
|
||||
jz .nodebug
|
||||
movi ecx, 8
|
||||
push dword [CURRENT_TASK+edi+TASKDATA.pid]; PID
|
||||
push 2
|
||||
call debugger_notify
|
||||
pop ecx
|
||||
pop ecx
|
||||
.nodebug:
|
||||
popad
|
||||
|
||||
mov ebx, [.slot]
|
||||
shl ebx, 8
|
||||
push ebx
|
||||
mov ebx, [SLOT_BASE+ebx+APPDATA.pl0_stack]
|
||||
|
||||
stdcall kernel_free, ebx
|
||||
|
||||
pop ebx
|
||||
mov ebx, [SLOT_BASE+ebx+APPDATA.cur_dir]
|
||||
stdcall kernel_free, ebx
|
||||
|
||||
mov edi, [.slot]
|
||||
shl edi, 8
|
||||
add edi, SLOT_BASE
|
||||
|
||||
mov eax, [edi+APPDATA.io_map]
|
||||
cmp eax, [SLOT_BASE+256+APPDATA.io_map]
|
||||
je @F
|
||||
call free_page
|
||||
@@:
|
||||
mov eax, [edi+APPDATA.io_map+4]
|
||||
cmp eax, [SLOT_BASE+256+APPDATA.io_map+4]
|
||||
je @F
|
||||
call free_page
|
||||
@@:
|
||||
mov eax, 0x20202020
|
||||
stosd
|
||||
stosd
|
||||
stosd
|
||||
mov ecx, 244/4
|
||||
xor eax, eax
|
||||
rep stosd
|
||||
|
||||
; activate window
|
||||
movzx eax, word [WIN_STACK + esi*2]
|
||||
cmp eax, [TASK_COUNT]
|
||||
jne .dont_activate
|
||||
pushad
|
||||
.check_next_window:
|
||||
dec eax
|
||||
cmp eax, 1
|
||||
jbe .nothing_to_activate
|
||||
lea esi, [WIN_POS+eax*2]
|
||||
movzx edi, word [esi] ; edi = process
|
||||
shl edi, 5
|
||||
cmp [CURRENT_TASK + edi + TASKDATA.state], byte 9 ; skip dead slots
|
||||
je .check_next_window
|
||||
add edi, window_data
|
||||
; \begin{diamond}[19.09.2006]
|
||||
; skip minimized windows
|
||||
test [edi + WDATA.fl_wstate], WSTATE_MINIMIZED
|
||||
jnz .check_next_window
|
||||
; \end{diamond}
|
||||
call waredraw
|
||||
.nothing_to_activate:
|
||||
popad
|
||||
.dont_activate:
|
||||
|
||||
push esi ; remove hd1 & cd & flp reservation
|
||||
shl esi, 5
|
||||
mov esi, [esi+CURRENT_TASK+TASKDATA.pid]
|
||||
cmp [cd_status], esi
|
||||
jnz @f
|
||||
call free_cd_channel
|
||||
and [cd_status], 0
|
||||
@@:
|
||||
pop esi
|
||||
cmp [bgrlockpid], esi
|
||||
jnz @f
|
||||
and [bgrlockpid], 0
|
||||
and [bgrlock], 0
|
||||
@@:
|
||||
|
||||
pusha ; remove all port reservations
|
||||
mov edx, esi
|
||||
shl edx, 5
|
||||
add edx, CURRENT_TASK
|
||||
mov edx, [edx+TASKDATA.pid]
|
||||
|
||||
rmpr0:
|
||||
|
||||
mov esi, [RESERVED_PORTS]
|
||||
|
||||
test esi, esi
|
||||
jz rmpr9
|
||||
|
||||
rmpr3:
|
||||
|
||||
mov edi, esi
|
||||
shl edi, 4
|
||||
add edi, RESERVED_PORTS
|
||||
|
||||
cmp edx, [edi]
|
||||
je rmpr4
|
||||
|
||||
dec esi
|
||||
jnz rmpr3
|
||||
|
||||
jmp rmpr9
|
||||
|
||||
rmpr4:
|
||||
|
||||
mov ecx, 256
|
||||
sub ecx, esi
|
||||
shl ecx, 4
|
||||
|
||||
mov esi, edi
|
||||
add esi, 16
|
||||
cld
|
||||
rep movsb
|
||||
|
||||
dec dword [RESERVED_PORTS]
|
||||
|
||||
jmp rmpr0
|
||||
|
||||
rmpr9:
|
||||
|
||||
popa
|
||||
mov edi, esi ; do not run this process slot
|
||||
shl edi, 5
|
||||
mov [edi+CURRENT_TASK + TASKDATA.state], byte 9
|
||||
; debugger test - terminate all debuggees
|
||||
mov eax, 2
|
||||
mov ecx, SLOT_BASE+2*0x100+APPDATA.debugger_slot
|
||||
.xd0:
|
||||
cmp eax, [TASK_COUNT]
|
||||
ja .xd1
|
||||
cmp dword [ecx], esi
|
||||
jnz @f
|
||||
and dword [ecx], 0
|
||||
pushad
|
||||
xchg eax, ecx
|
||||
mov ebx, 2
|
||||
call sys_system
|
||||
popad
|
||||
@@:
|
||||
inc eax
|
||||
add ecx, 0x100
|
||||
jmp .xd0
|
||||
.xd1:
|
||||
; call systest
|
||||
sti ; .. and life goes on
|
||||
|
||||
mov eax, [draw_limits.left]
|
||||
mov ebx, [draw_limits.top]
|
||||
mov ecx, [draw_limits.right]
|
||||
mov edx, [draw_limits.bottom]
|
||||
call calculatescreen
|
||||
xor eax, eax
|
||||
xor esi, esi
|
||||
call redrawscreen
|
||||
|
||||
call unlock_application_table
|
||||
;mov esi,process_terminated
|
||||
;call sys_msg_board_str
|
||||
add esp, 4
|
||||
ret
|
||||
restore .slot
|
||||
|
||||
;build_scheduler:
|
||||
; mov esi, boot_sched_1
|
||||
; call boot_log
|
||||
; call build_process_gdt_tss_pointer
|
||||
|
||||
; mov esi,boot_sched_2
|
||||
; call boot_log
|
||||
; ret
|
||||
|
||||
; Three following procedures are used to guarantee that
|
||||
; some part of kernel code will not be terminated from outside
|
||||
; while it is running.
|
||||
; Note: they do not protect a thread from terminating due to errors inside
|
||||
; the thread; accessing a nonexisting memory would still terminate it.
|
||||
|
||||
; First two procedures must be used in pair by thread-to-be-protected
|
||||
; to signal the beginning and the end of an important part.
|
||||
; It is OK to have nested areas.
|
||||
|
||||
; The last procedure must be used by outside wanna-be-terminators;
|
||||
; if it is safe to terminate the given thread immediately, it returns eax=1;
|
||||
; otherwise, it returns eax=0 and notifies the target thread that it should
|
||||
; terminate itself when leaving a critical area (the last critical area if
|
||||
; they are nested).
|
||||
|
||||
; Implementation. Those procedures use one dword in APPDATA for the thread,
|
||||
; APPDATA.terminate_protection.
|
||||
; * The upper bit is 1 during normal operations and 0 when terminate is requested.
|
||||
; * Other bits form a number = depth of critical regions,
|
||||
; plus 1 if the upper bit is 1.
|
||||
; * When this dword goes to zero, the thread should be destructed,
|
||||
; and the procedure in which it happened becomes responsible for destruction.
|
||||
|
||||
; Enter critical area. Called by thread which wants to be protected.
|
||||
proc protect_from_terminate
|
||||
mov edx, [current_slot]
|
||||
; Atomically increment depth of critical areas and get the old value.
|
||||
mov eax, 1
|
||||
lock xadd [edx+APPDATA.terminate_protection], eax
|
||||
; If the old value was zero, somebody has started to terminate us,
|
||||
; so we are destructing and cannot do anything protected.
|
||||
; Otherwise, return to the caller.
|
||||
test eax, eax
|
||||
jz @f
|
||||
ret
|
||||
@@:
|
||||
; Wait for somebody to finish us.
|
||||
call change_task
|
||||
jmp @b
|
||||
endp
|
||||
|
||||
; Leave critical area. Called by thread which wants to be protected.
|
||||
proc unprotect_from_terminate
|
||||
mov edx, [current_slot]
|
||||
; Atomically decrement depth of critical areas.
|
||||
lock dec [edx+APPDATA.terminate_protection]
|
||||
; If the result of decrement is zero, somebody has requested termination,
|
||||
; but at that moment we were inside a critical area; terminate now.
|
||||
jz sys_end
|
||||
; Otherwise, return to the caller.
|
||||
ret
|
||||
endp
|
||||
|
||||
; Request termination of thread identified by edx = SLOT_BASE + slot*256.
|
||||
; Called by anyone.
|
||||
proc request_terminate
|
||||
xor eax, eax ; set return value
|
||||
; Atomically clear the upper bit. If it was already zero, then
|
||||
; somebody has requested termination before us, so just exit.
|
||||
lock btr [edx+APPDATA.terminate_protection], 31
|
||||
jnc .unsafe
|
||||
; Atomically decrement depth of critical areas.
|
||||
lock dec [edx+APPDATA.terminate_protection]
|
||||
; If the result of decrement is nonzero, the target thread is inside a
|
||||
; critical area; leave termination to leaving that area.
|
||||
jnz .unsafe
|
||||
; Otherwise, it is safe to kill the target now and the caller is responsible
|
||||
; for this. Return eax=1.
|
||||
inc eax
|
||||
.unsafe:
|
||||
ret
|
||||
endp
|
||||
|
||||
181
kernel/branches/kolibri-process/core/syscall.inc
Normal file
181
kernel/branches/kolibri-process/core/syscall.inc
Normal file
@@ -0,0 +1,181 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4273 $
|
||||
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; SYSENTER ENTRY ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
align 32
|
||||
sysenter_entry:
|
||||
; Настраиваем стек
|
||||
mov esp, [ss:tss._esp0]
|
||||
sti
|
||||
push ebp ; save app esp + 4
|
||||
mov ebp, [ebp] ; ebp - original ebp
|
||||
;------------------
|
||||
pushad
|
||||
cld
|
||||
|
||||
call protect_from_terminate
|
||||
|
||||
movzx eax, byte [esp+28]
|
||||
mov edx, dword [esp+20]
|
||||
call dword [servetable2 + eax * 4]
|
||||
|
||||
call unprotect_from_terminate
|
||||
popad
|
||||
;------------------
|
||||
xchg ecx, [ss:esp] ; в вершин стека - app ecx, ecx - app esp + 4
|
||||
sub ecx, 4
|
||||
xchg edx, [ecx] ; edx - return point, & save original edx
|
||||
push edx
|
||||
mov edx, [ss:esp + 4]
|
||||
mov [ecx + 4], edx ; save original ecx
|
||||
pop edx
|
||||
sysexit
|
||||
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; SYSTEM CALL ENTRY ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
align 16
|
||||
i40:
|
||||
pushad
|
||||
cld
|
||||
call protect_from_terminate
|
||||
movzx eax, byte [esp+28]
|
||||
mov edx, dword [esp+20]
|
||||
call dword [servetable2 + eax * 4]
|
||||
call unprotect_from_terminate
|
||||
popad
|
||||
iretd
|
||||
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; SYSCALL ENTRY ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
align 32
|
||||
syscall_entry:
|
||||
; cli syscall clear IF
|
||||
xchg esp, [ss:tss._esp0]
|
||||
push ecx
|
||||
lea ecx, [esp+4]
|
||||
xchg ecx, [ss:tss._esp0]
|
||||
sti
|
||||
push ecx
|
||||
mov ecx, [ecx]
|
||||
;------------------
|
||||
pushad
|
||||
cld
|
||||
call protect_from_terminate
|
||||
|
||||
movzx eax, byte [esp+28]
|
||||
mov edx, dword [esp+20]
|
||||
call dword [servetable2 + eax * 4]
|
||||
|
||||
call unprotect_from_terminate
|
||||
popad
|
||||
;------------------
|
||||
mov ecx, [ss:esp+4]
|
||||
pop esp
|
||||
sysret
|
||||
|
||||
iglobal
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; SYSTEM FUNCTIONS TABLE ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
align 4
|
||||
servetable2:
|
||||
|
||||
dd syscall_draw_window ; 0-DrawWindow
|
||||
dd syscall_setpixel ; 1-SetPixel
|
||||
dd sys_getkey ; 2-GetKey
|
||||
dd sys_clock ; 3-GetTime
|
||||
dd syscall_writetext ; 4-WriteText
|
||||
dd delay_hs_unprotected ; 5-DelayHs
|
||||
dd undefined_syscall ; 6-deprecated OpenRamdiskFile
|
||||
dd syscall_putimage ; 7-PutImage
|
||||
dd syscall_button ; 8-DefineButton
|
||||
dd sys_cpuusage ; 9-GetProcessInfo
|
||||
dd sys_waitforevent ; 10-WaitForEvent
|
||||
dd sys_getevent ; 11-CheckForEvent
|
||||
dd sys_redrawstat ; 12-BeginDraw and EndDraw
|
||||
dd syscall_drawrect ; 13-DrawRect
|
||||
dd syscall_getscreensize ; 14-GetScreenSize
|
||||
dd sys_background ; 15-bgr
|
||||
dd sys_cachetodiskette ; 16-FlushFloppyCache
|
||||
dd sys_getbutton ; 17-GetButton
|
||||
dd sys_system ; 18-System Services
|
||||
dd paleholder ; 19-reserved
|
||||
dd sys_midi ; 20-ResetMidi and OutputMidi
|
||||
dd sys_setup ; 21-SetMidiBase,SetKeymap,SetShiftKeymap,.
|
||||
dd sys_settime ; 22-setting date,time,clock and alarm-clock
|
||||
dd sys_wait_event_timeout ; 23-TimeOutWaitForEvent
|
||||
dd syscall_cdaudio ; 24-PlayCdTrack,StopCd and GetCdPlaylist
|
||||
dd syscall_putarea_backgr ; 25-Put Area to background
|
||||
dd sys_getsetup ; 26-GetMidiBase,GetKeymap,GetShiftKeymap,.
|
||||
dd undefined_syscall ; 27-reserved
|
||||
dd undefined_syscall ; 28-reserved
|
||||
dd sys_date ; 29-GetDate
|
||||
dd sys_current_directory ; 30-Get/SetCurrentDirectory
|
||||
dd undefined_syscall ; 31-reserved
|
||||
dd undefined_syscall ; 32-reserved
|
||||
dd undefined_syscall ; 33-reserved
|
||||
dd syscall_getpixel_WinMap ; 34-GetPixel WinMap
|
||||
dd syscall_getpixel ; 35-GetPixel
|
||||
dd syscall_getarea ; 36-GetArea
|
||||
dd readmousepos ; 37-GetMousePosition_ScreenRelative,.
|
||||
dd syscall_drawline ; 38-DrawLine
|
||||
dd sys_getbackground ; 39-GetBackgroundSize,ReadBgrData,.
|
||||
dd set_app_param ; 40-WantEvents
|
||||
dd undefined_syscall ; 41- deprecated GetIrqOwner
|
||||
dd undefined_syscall ; 42- deprecated ReadIrqData
|
||||
dd sys_outport ; 43-SendDeviceData
|
||||
dd undefined_syscall ; 44- deprecated ProgramIrqs
|
||||
dd undefined_syscall ; 45- deprecated ReserveIrq and FreeIrq
|
||||
dd syscall_reserveportarea ; 46-ReservePortArea and FreePortArea
|
||||
dd display_number ; 47-WriteNum
|
||||
dd syscall_display_settings ; 48-SetRedrawType and SetButtonType
|
||||
dd sys_apm ; 49-Advanced Power Management (APM)
|
||||
dd syscall_set_window_shape ; 50-Window shape & scale
|
||||
dd syscall_threads ; 51-Threads
|
||||
dd undefined_syscall ; 52- deprecated Stack driver status
|
||||
dd undefined_syscall ; 53- deprecated Socket interface
|
||||
dd sys_clipboard ; 54-Custom clipboard
|
||||
dd sound_interface ; 55-Sound interface
|
||||
dd undefined_syscall ; 56-reserved
|
||||
dd sys_pcibios ; 57-PCI BIOS32
|
||||
dd undefined_syscall ; 58-deprecated Common file system interface
|
||||
dd undefined_syscall ; 59-reserved
|
||||
dd sys_IPC ; 60-Inter Process Communication
|
||||
dd sys_gs ; 61-Direct graphics access
|
||||
dd pci_api ; 62-PCI functions
|
||||
dd sys_msg_board ; 63-System message board
|
||||
dd sys_resize_app_memory ; 64-Resize application memory usage
|
||||
dd sys_putimage_palette ; 65-PutImagePalette
|
||||
dd sys_process_def ; 66-Process definitions - keyboard
|
||||
dd syscall_move_window ; 67-Window move or resize
|
||||
dd f68 ; 68-Some internal services
|
||||
dd sys_debug_services ; 69-Debug
|
||||
dd file_system_lfn ; 70-Common file system interface, version 2
|
||||
dd syscall_window_settings ; 71-Window settings
|
||||
dd sys_sendwindowmsg ; 72-Send window message
|
||||
dd blit_32 ; 73-blitter;
|
||||
dd sys_network ; 74-reserved for new stack
|
||||
dd sys_socket ; 75-reserved for new stack
|
||||
dd sys_protocols ; 76-reserved for new stack
|
||||
times 255 - ( ($-servetable2) /4 ) dd undefined_syscall
|
||||
dd sys_end ; -1-end application
|
||||
|
||||
endg
|
||||
1257
kernel/branches/kolibri-process/core/taskman.inc
Normal file
1257
kernel/branches/kolibri-process/core/taskman.inc
Normal file
File diff suppressed because it is too large
Load Diff
229
kernel/branches/kolibri-process/core/timers.inc
Normal file
229
kernel/branches/kolibri-process/core/timers.inc
Normal file
@@ -0,0 +1,229 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3598 $
|
||||
|
||||
; Simple implementation of timers. All timers are organized in a double-linked
|
||||
; list, and the OS loop after every timer tick processes the list.
|
||||
|
||||
; This structure describes a timer for the kernel.
|
||||
struct TIMER
|
||||
Next dd ?
|
||||
Prev dd ?
|
||||
; These fields organize a double-linked list of all timers.
|
||||
TimerFunc dd ?
|
||||
; Function to be called when the timer is activated.
|
||||
UserData dd ?
|
||||
; The value that is passed as is to .TimerFunc.
|
||||
Time dd ?
|
||||
; Time at which the timer should be activated.
|
||||
Interval dd ?
|
||||
; Interval between activations of the timer, in 0.01s.
|
||||
ends
|
||||
|
||||
iglobal
|
||||
align 4
|
||||
; The head of timer list.
|
||||
timer_list:
|
||||
dd timer_list
|
||||
dd timer_list
|
||||
endg
|
||||
uglobal
|
||||
; These two variables are used to synchronize access to the global list.
|
||||
; Logically, they form an recursive mutex. Physically, the first variable holds
|
||||
; the slot number of the current owner or 0, the second variable holds the
|
||||
; recursion count.
|
||||
; The mutex should be recursive to allow a timer function to add/delete other
|
||||
; timers or itself.
|
||||
timer_list_owner dd 0
|
||||
timer_list_numlocks dd 0
|
||||
; A timer function can delete any timer, including itself and the next timer in
|
||||
; the chain. To handle such situation correctly, we keep the next timer in a
|
||||
; global variable, so the removing operation can update it.
|
||||
timer_next dd 0
|
||||
endg
|
||||
|
||||
; This internal function acquires the lock for the global list.
|
||||
lock_timer_list:
|
||||
mov edx, [CURRENT_TASK]
|
||||
@@:
|
||||
xor eax, eax
|
||||
lock cmpxchg [timer_list_owner], edx
|
||||
jz @f
|
||||
cmp eax, edx
|
||||
jz @f
|
||||
call change_task
|
||||
jmp @b
|
||||
@@:
|
||||
inc [timer_list_numlocks]
|
||||
ret
|
||||
|
||||
; This internal function releases the lock for the global list.
|
||||
unlock_timer_list:
|
||||
dec [timer_list_numlocks]
|
||||
jnz .nothing
|
||||
mov [timer_list_owner], 0
|
||||
.nothing:
|
||||
ret
|
||||
|
||||
; This function adds a timer.
|
||||
; If deltaStart is nonzero, the timer is activated after deltaStart hundredths
|
||||
; of seconds starting from the current time. If interval is nonzero, the timer
|
||||
; is activated every deltaWork hundredths of seconds starting from the first
|
||||
; activation. The activated timer calls timerFunc as stdcall function with one
|
||||
; argument userData.
|
||||
; Return value is NULL if something has failed or some value which is opaque
|
||||
; for the caller. Later this value can be used for cancel_timer_hs.
|
||||
proc timer_hs stdcall uses ebx, deltaStart:dword, interval:dword, \
|
||||
timerFunc:dword, userData:dword
|
||||
; 1. Allocate memory for the TIMER structure.
|
||||
; 1a. Call the allocator.
|
||||
movi eax, sizeof.TIMER
|
||||
call malloc
|
||||
; 1b. If allocation failed, return (go to 5) with eax = 0.
|
||||
test eax, eax
|
||||
jz .nothing
|
||||
; 2. Setup the TIMER structure.
|
||||
xchg ebx, eax
|
||||
; 2a. Copy values from the arguments.
|
||||
mov ecx, [interval]
|
||||
mov [ebx+TIMER.Interval], ecx
|
||||
mov ecx, [timerFunc]
|
||||
mov [ebx+TIMER.TimerFunc], ecx
|
||||
mov ecx, [userData]
|
||||
mov [ebx+TIMER.UserData], ecx
|
||||
; 2b. Get time of the next activation.
|
||||
mov ecx, [deltaStart]
|
||||
test ecx, ecx
|
||||
jnz @f
|
||||
mov ecx, [interval]
|
||||
@@:
|
||||
add ecx, [timer_ticks]
|
||||
mov [ebx+TIMER.Time], ecx
|
||||
; 3. Insert the TIMER structure to the global list.
|
||||
; 3a. Acquire the lock.
|
||||
call lock_timer_list
|
||||
; 3b. Insert an item at ebx to the tail of the timer_list.
|
||||
mov eax, timer_list
|
||||
mov ecx, [eax+TIMER.Prev]
|
||||
mov [ebx+TIMER.Next], eax
|
||||
mov [ebx+TIMER.Prev], ecx
|
||||
mov [eax+TIMER.Prev], ebx
|
||||
mov [ecx+TIMER.Next], ebx
|
||||
; 3c. Release the lock.
|
||||
call unlock_timer_list
|
||||
; 4. Return with eax = pointer to TIMER structure.
|
||||
xchg ebx, eax
|
||||
.nothing:
|
||||
; 5. Returning.
|
||||
ret
|
||||
endp
|
||||
|
||||
; This function removes a timer.
|
||||
; The only argument is [esp+4] = the value which was returned from timer_hs.
|
||||
cancel_timer_hs:
|
||||
push ebx ; save used register to be stdcall
|
||||
; 1. Remove the TIMER structure from the global list.
|
||||
; 1a. Acquire the lock.
|
||||
call lock_timer_list
|
||||
mov ebx, [esp+4+4]
|
||||
; 1b. Delete an item at ebx from the double-linked list.
|
||||
mov eax, [ebx+TIMER.Next]
|
||||
mov ecx, [ebx+TIMER.Prev]
|
||||
mov [eax+TIMER.Prev], ecx
|
||||
mov [ecx+TIMER.Next], eax
|
||||
; 1c. If we are removing the next timer in currently processing chain,
|
||||
; the next timer for this timer becomes new next timer.
|
||||
cmp ebx, [timer_next]
|
||||
jnz @f
|
||||
mov [timer_next], eax
|
||||
@@:
|
||||
; 1d. Release the lock.
|
||||
call unlock_timer_list
|
||||
; 2. Free the TIMER structure.
|
||||
xchg eax, ebx
|
||||
call free
|
||||
; 3. Return.
|
||||
pop ebx ; restore used register to be stdcall
|
||||
ret 4 ; purge one dword argument to be stdcall
|
||||
|
||||
; This function is regularly called from osloop. It processes the global list
|
||||
; and activates the corresponding timers.
|
||||
check_timers:
|
||||
; 1. Acquire the lock.
|
||||
call lock_timer_list
|
||||
; 2. Loop over all registered timers, checking time.
|
||||
; 2a. Get the first item.
|
||||
mov eax, [timer_list+TIMER.Next]
|
||||
mov [timer_next], eax
|
||||
.loop:
|
||||
; 2b. Check for end of list.
|
||||
cmp eax, timer_list
|
||||
jz .done
|
||||
; 2c. Get and store the next timer.
|
||||
mov edx, [eax+TIMER.Next]
|
||||
mov [timer_next], edx
|
||||
; 2d. Check time for timer activation.
|
||||
; We can't just compare [timer_ticks] and [TIMER.Time], since overflows are
|
||||
; possible: if the current time is 0FFFFFFFFh ticks and timer should be
|
||||
; activated in 3 ticks, the simple comparison will produce incorrect result.
|
||||
; So we calculate the difference [timer_ticks] - [TIMER.Time]; if it is
|
||||
; non-negative, the time is over; if it is negative, then either the time is
|
||||
; not over or we have not processed this timer for 2^31 ticks, what is very
|
||||
; unlikely.
|
||||
mov edx, [timer_ticks]
|
||||
sub edx, [eax+TIMER.Time]
|
||||
js .next
|
||||
; The timer should be activated now.
|
||||
; 2e. Store the timer data in the stack. This is required since 2f can delete
|
||||
; the timer, invalidating the content.
|
||||
push [eax+TIMER.UserData] ; parameter for TimerFunc
|
||||
push [eax+TIMER.TimerFunc] ; to be restored in 2g
|
||||
; 2f. Calculate time of next activation or delete the timer if it is one-shot.
|
||||
mov ecx, [eax+TIMER.Interval]
|
||||
add [eax+TIMER.Time], ecx
|
||||
test ecx, ecx
|
||||
jnz .nodelete
|
||||
stdcall cancel_timer_hs, eax
|
||||
.nodelete:
|
||||
; 2g. Activate timer, using data from the stack.
|
||||
pop eax
|
||||
call eax
|
||||
.next:
|
||||
; 2h. Advance to the next timer and continue the loop.
|
||||
mov eax, [timer_next]
|
||||
jmp .loop
|
||||
.done:
|
||||
; 3. Release the lock.
|
||||
call unlock_timer_list
|
||||
; 4. Return.
|
||||
ret
|
||||
|
||||
; This is a simplified version of check_timers that does not call anything,
|
||||
; just checks whether check_timers should do something.
|
||||
proc check_timers_has_work?
|
||||
pushf
|
||||
cli
|
||||
mov eax, [timer_list+TIMER.Next]
|
||||
.loop:
|
||||
cmp eax, timer_list
|
||||
jz .done_nowork
|
||||
mov edx, [timer_ticks]
|
||||
sub edx, [eax+TIMER.Time]
|
||||
jns .done_haswork
|
||||
mov eax, [eax+TIMER.Next]
|
||||
jmp .loop
|
||||
.done_nowork:
|
||||
popf
|
||||
xor eax, eax
|
||||
ret
|
||||
.done_haswork:
|
||||
popf
|
||||
xor eax, eax
|
||||
inc eax
|
||||
ret
|
||||
endp
|
||||
924
kernel/branches/kolibri-process/core/v86.inc
Normal file
924
kernel/branches/kolibri-process/core/v86.inc
Normal file
@@ -0,0 +1,924 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2007-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3696 $
|
||||
|
||||
; Virtual-8086 mode manager
|
||||
; diamond, 2007, 2008
|
||||
|
||||
DEBUG_SHOW_IO = 0
|
||||
|
||||
struct V86_machine
|
||||
; page directory
|
||||
pagedir dd ?
|
||||
; translation table: V86 address -> flat linear address
|
||||
pages dd ?
|
||||
; mutex to protect all data from writing by multiple threads at one time
|
||||
mutex dd ?
|
||||
; i/o permission map
|
||||
iopm dd ?
|
||||
ends
|
||||
|
||||
; Create V86 machine
|
||||
; in: nothing
|
||||
; out: eax = handle (pointer to struc V86_machine)
|
||||
; eax = NULL => failure
|
||||
; destroys: ebx, ecx, edx (due to malloc)
|
||||
v86_create:
|
||||
; allocate V86_machine structure
|
||||
mov eax, sizeof.V86_machine
|
||||
call malloc
|
||||
test eax, eax
|
||||
jz .fail
|
||||
; initialize mutex
|
||||
and dword [eax+V86_machine.mutex], 0
|
||||
; allocate tables
|
||||
mov ebx, eax
|
||||
; We allocate 4 pages.
|
||||
; First is main page directory for V86 mode.
|
||||
; Second page:
|
||||
; first half (0x800 bytes) is page table for addresses 0 - 0x100000,
|
||||
; second half is for V86-to-linear translation.
|
||||
; Third and fourth are for I/O permission map.
|
||||
push 8000h ; blocks less than 8 pages are discontinuous
|
||||
call kernel_alloc
|
||||
test eax, eax
|
||||
jz .fail2
|
||||
mov [ebx+V86_machine.pagedir], eax
|
||||
push edi eax
|
||||
mov edi, eax
|
||||
add eax, 1800h
|
||||
mov [ebx+V86_machine.pages], eax
|
||||
; initialize tables
|
||||
mov ecx, 2000h/4
|
||||
xor eax, eax
|
||||
rep stosd
|
||||
mov [ebx+V86_machine.iopm], edi
|
||||
dec eax
|
||||
mov ecx, 2000h/4
|
||||
rep stosd
|
||||
pop eax
|
||||
; page directory: first entry is page table...
|
||||
mov edi, eax
|
||||
add eax, 1000h
|
||||
push eax
|
||||
call get_pg_addr
|
||||
or al, PG_UW
|
||||
stosd
|
||||
; ...and also copy system page tables
|
||||
; thx to Serge, system is located at high addresses
|
||||
add edi, (OS_BASE shr 20) - 4
|
||||
push esi
|
||||
mov esi, sys_proc+PROC.pdt_0+(OS_BASE shr 20)
|
||||
mov ecx, 0x80000000 shr 22
|
||||
rep movsd
|
||||
|
||||
mov eax, [ebx+V86_machine.pagedir] ;root dir also is
|
||||
call get_pg_addr ;used as page table
|
||||
or al, PG_SW
|
||||
mov [edi-4096+(page_tabs shr 20)], eax
|
||||
|
||||
pop esi
|
||||
; now V86 specific: initialize known addresses in first Mb
|
||||
pop eax
|
||||
; first page - BIOS data (shared between all machines!)
|
||||
; physical address = 0
|
||||
; linear address = OS_BASE
|
||||
mov dword [eax], 111b
|
||||
mov dword [eax+800h], OS_BASE
|
||||
; page before 0xA0000 - Extended BIOS Data Area (shared between all machines!)
|
||||
; physical address = 0x9C000
|
||||
; linear address = 0x8009C000
|
||||
; (I have seen one computer with EBDA segment = 0x9D80,
|
||||
; all other computers use less memory)
|
||||
mov ecx, 4
|
||||
mov edx, 0x9C000
|
||||
push eax
|
||||
lea edi, [eax+0x9C*4]
|
||||
@@:
|
||||
lea eax, [edx + OS_BASE]
|
||||
mov [edi+800h], eax
|
||||
lea eax, [edx + 111b]
|
||||
stosd
|
||||
add edx, 0x1000
|
||||
loop @b
|
||||
pop eax
|
||||
pop edi
|
||||
; addresses 0xC0000 - 0xFFFFF - BIOS code (shared between all machines!)
|
||||
; physical address = 0xC0000
|
||||
; linear address = 0x800C0000
|
||||
mov ecx, 0xC0
|
||||
@@:
|
||||
mov edx, ecx
|
||||
shl edx, 12
|
||||
push edx
|
||||
or edx, 111b
|
||||
mov [eax+ecx*4], edx
|
||||
pop edx
|
||||
add edx, OS_BASE
|
||||
mov [eax+ecx*4+0x800], edx
|
||||
inc cl
|
||||
jnz @b
|
||||
mov eax, ebx
|
||||
ret
|
||||
.fail2:
|
||||
mov eax, ebx
|
||||
call free
|
||||
.fail:
|
||||
xor eax, eax
|
||||
ret
|
||||
|
||||
; Destroy V86 machine
|
||||
; in: eax = handle
|
||||
; out: nothing
|
||||
; destroys: eax, ebx, ecx, edx (due to free)
|
||||
v86_destroy:
|
||||
push eax
|
||||
stdcall kernel_free, [eax+V86_machine.pagedir]
|
||||
pop eax
|
||||
jmp free
|
||||
|
||||
; Translate V86-address to linear address
|
||||
; in: eax=V86 address
|
||||
; esi=handle
|
||||
; out: eax=linear address
|
||||
; destroys: nothing
|
||||
v86_get_lin_addr:
|
||||
push ecx edx
|
||||
mov ecx, eax
|
||||
mov edx, [esi+V86_machine.pages]
|
||||
shr ecx, 12
|
||||
and eax, 0xFFF
|
||||
add eax, [edx+ecx*4] ; atomic operation, no mutex needed
|
||||
pop edx ecx
|
||||
ret
|
||||
|
||||
; Sets linear address for V86-page
|
||||
; in: eax=linear address (must be page-aligned)
|
||||
; ecx=V86 page (NOT address!)
|
||||
; esi=handle
|
||||
; out: nothing
|
||||
; destroys: nothing
|
||||
v86_set_page:
|
||||
push eax ebx
|
||||
mov ebx, [esi+V86_machine.pagedir]
|
||||
mov [ebx+ecx*4+0x1800], eax
|
||||
call get_pg_addr
|
||||
or al, 111b
|
||||
mov [ebx+ecx*4+0x1000], eax
|
||||
pop ebx eax
|
||||
ret
|
||||
|
||||
; Allocate memory in V86 machine
|
||||
; in: eax=size (in bytes)
|
||||
; esi=handle
|
||||
; out: eax=V86 address, para-aligned (0x10 multiple)
|
||||
; destroys: nothing
|
||||
; недописана!!!
|
||||
;v86_alloc:
|
||||
; push ebx ecx edx edi
|
||||
; lea ebx, [esi+V86_machine.mutex]
|
||||
; call wait_mutex
|
||||
; add eax, 0x1F
|
||||
; shr eax, 4
|
||||
; mov ebx, 0x1000 ; start with address 0x1000 (second page)
|
||||
; mov edi, [esi+V86_machine.tables]
|
||||
;.l:
|
||||
; mov ecx, ebx
|
||||
; shr ecx, 12
|
||||
; mov edx, [edi+0x1000+ecx*4] ; get linear address
|
||||
; test edx, edx ; page allocated?
|
||||
; jz .unalloc
|
||||
; mov ecx, ebx
|
||||
; and ecx, 0xFFF
|
||||
; add edx, ecx
|
||||
; cmp dword [edx], 0 ; free block?
|
||||
; jnz .n
|
||||
; cmp dword [edx+4],
|
||||
; and [esi+V86_machine.mutex], 0
|
||||
; pop edi edx ecx ebx
|
||||
; ret
|
||||
|
||||
uglobal
|
||||
sys_v86_machine dd ?
|
||||
endg
|
||||
|
||||
; Called from kernel.asm at first stages of loading
|
||||
; Initialize system V86 machine (used to simulate BIOS int 13h)
|
||||
init_sys_v86:
|
||||
call v86_create
|
||||
mov [sys_v86_machine], eax
|
||||
test eax, eax
|
||||
jz .ret
|
||||
mov byte [OS_BASE + 0x500], 0xCD
|
||||
mov byte [OS_BASE + 0x501], 0x13
|
||||
mov byte [OS_BASE + 0x502], 0xF4
|
||||
mov byte [OS_BASE + 0x503], 0xCD
|
||||
mov byte [OS_BASE + 0x504], 0x10
|
||||
mov byte [OS_BASE + 0x505], 0xF4
|
||||
mov esi, eax
|
||||
mov ebx, [eax+V86_machine.pagedir]
|
||||
; one page for stack, two pages for results (0x2000 bytes = 16 sectors)
|
||||
mov dword [ebx+0x99*4+0x1000], 0x99000 or 111b
|
||||
mov dword [ebx+0x99*4+0x1800], OS_BASE + 0x99000
|
||||
mov dword [ebx+0x9A*4+0x1000], 0x9A000 or 111b
|
||||
mov dword [ebx+0x9A*4+0x1800], OS_BASE + 0x9A000
|
||||
mov dword [ebx+0x9B*4+0x1000], 0x9B000 or 111b
|
||||
mov dword [ebx+0x9B*4+0x1800], OS_BASE + 0x9B000
|
||||
if ~DEBUG_SHOW_IO
|
||||
; allow access to all ports
|
||||
mov ecx, [esi+V86_machine.iopm]
|
||||
xor eax, eax
|
||||
mov edi, ecx
|
||||
mov ecx, 10000h/8/4
|
||||
rep stosd
|
||||
end if
|
||||
.ret:
|
||||
ret
|
||||
|
||||
struct v86_regs
|
||||
; don't change the order, it is important
|
||||
edi dd ?
|
||||
esi dd ?
|
||||
ebp dd ?
|
||||
dd ? ; ignored
|
||||
ebx dd ?
|
||||
edx dd ?
|
||||
ecx dd ?
|
||||
eax dd ?
|
||||
eip dd ?
|
||||
cs dd ?
|
||||
eflags dd ? ; VM flag must be set!
|
||||
esp dd ?
|
||||
ss dd ?
|
||||
es dd ?
|
||||
ds dd ?
|
||||
fs dd ?
|
||||
gs dd ?
|
||||
ends
|
||||
|
||||
; Run V86 machine
|
||||
; in: ebx -> registers for V86 (two structures: in and out)
|
||||
; esi = handle
|
||||
; ecx = expected end address (CS:IP)
|
||||
; edx = IRQ to hook or -1 if not required
|
||||
; out: structure pointed to by ebx is filled with new values
|
||||
; eax = 1 - exception has occured, cl contains code
|
||||
; eax = 2 - access to disabled i/o port, ecx contains port address
|
||||
; eax = 3 - IRQ is already hooked by another VM
|
||||
; destroys: nothing
|
||||
v86_start:
|
||||
pushad
|
||||
|
||||
cli
|
||||
|
||||
mov ecx, [CURRENT_TASK]
|
||||
shl ecx, 8
|
||||
add ecx, SLOT_BASE
|
||||
|
||||
mov eax, [esi+V86_machine.iopm]
|
||||
call get_pg_addr
|
||||
inc eax
|
||||
push dword [ecx+APPDATA.io_map]
|
||||
push dword [ecx+APPDATA.io_map+4]
|
||||
mov dword [ecx+APPDATA.io_map], eax
|
||||
mov dword [page_tabs + (tss._io_map_0 shr 10)], eax
|
||||
add eax, 0x1000
|
||||
mov dword [ecx+APPDATA.io_map+4], eax
|
||||
mov dword [page_tabs + (tss._io_map_1 shr 10)], eax
|
||||
|
||||
push [ecx+APPDATA.process]
|
||||
push [ecx+APPDATA.saved_esp0]
|
||||
mov [ecx+APPDATA.saved_esp0], esp
|
||||
mov [tss._esp0], esp
|
||||
|
||||
mov eax, [esi+V86_machine.pagedir]
|
||||
call get_pg_addr
|
||||
mov [ecx+APPDATA.process], eax
|
||||
; mov cr3, eax
|
||||
|
||||
; mov [irq_tab+5*4], my05
|
||||
|
||||
; We do not enable interrupts, because V86 IRQ redirector assumes that
|
||||
; machine is running
|
||||
; They will be enabled by IRET.
|
||||
; sti
|
||||
|
||||
mov eax, esi
|
||||
sub esp, sizeof.v86_regs
|
||||
mov esi, ebx
|
||||
mov edi, esp
|
||||
mov ecx, sizeof.v86_regs/4
|
||||
rep movsd
|
||||
|
||||
cmp edx, -1
|
||||
jz .noirqhook
|
||||
uglobal
|
||||
v86_irqhooks rd IRQ_RESERVED * 2
|
||||
endg
|
||||
cmp [v86_irqhooks+edx*8], 0
|
||||
jz @f
|
||||
cmp [v86_irqhooks+edx*8], eax
|
||||
jz @f
|
||||
mov esi, v86_irqerr
|
||||
call sys_msg_board_str
|
||||
inc [v86_irqhooks+edx*8+4]
|
||||
mov eax, 3
|
||||
jmp v86_exc_c.exit
|
||||
@@:
|
||||
mov [v86_irqhooks+edx*8], eax
|
||||
inc [v86_irqhooks+edx*8+4]
|
||||
.noirqhook:
|
||||
|
||||
popad
|
||||
iretd
|
||||
|
||||
; It is only possible to leave virtual-8086 mode by faulting to
|
||||
; a protected-mode interrupt handler (typically the general-protection
|
||||
; exception handler, which in turn calls the virtual 8086-mode monitor).
|
||||
|
||||
iglobal
|
||||
v86_exc_str1 db 'V86 : unexpected exception ',0
|
||||
v86_exc_str2 db ' at ',0
|
||||
v86_exc_str3 db ':',0
|
||||
v86_exc_str4 db 13,10,'V86 : faulted code:',0
|
||||
v86_exc_str5 db ' (unavailable)',0
|
||||
v86_newline db 13,10,0
|
||||
v86_io_str1 db 'V86 : access to disabled i/o port ',0
|
||||
v86_io_byte db ' (byte)',13,10,0
|
||||
v86_io_word db ' (word)',13,10,0
|
||||
v86_io_dword db ' (dword)',13,10,0
|
||||
v86_irqerr db 'V86 : IRQ already hooked',13,10,0
|
||||
endg
|
||||
|
||||
v86_exc_c:
|
||||
; Did we all that we have wanted to do?
|
||||
cmp bl, 1
|
||||
jne @f
|
||||
xor eax, eax
|
||||
mov dr6, eax
|
||||
@@:
|
||||
mov eax, [esp+sizeof.v86_regs+10h+18h]
|
||||
cmp word [esp+v86_regs.eip], ax
|
||||
jnz @f
|
||||
shr eax, 16
|
||||
cmp word [esp+v86_regs.cs], ax
|
||||
jz .done
|
||||
@@:
|
||||
; Various system events, which must be handled, result in #GP
|
||||
cmp bl, 13
|
||||
jnz .nogp
|
||||
; If faulted EIP exceeds 0xFFFF, we have #GP and it is an error
|
||||
cmp word [esp+v86_regs.eip+2], 0
|
||||
jnz .nogp
|
||||
; Otherwise we can safely access byte at CS:IP
|
||||
; (because it is #GP, not #PF handler)
|
||||
; Если бы мы могли схлопотать исключение только из-за чтения байтов кода,
|
||||
; мы бы его уже схлопотали и это было бы не #GP
|
||||
movzx esi, word [esp+v86_regs.cs]
|
||||
shl esi, 4
|
||||
add esi, [esp+v86_regs.eip]
|
||||
lodsb
|
||||
cmp al, 0xCD ; int xx command = CD xx
|
||||
jz .handle_int
|
||||
cmp al, 0xCF
|
||||
jz .handle_iret
|
||||
cmp al, 0xF3
|
||||
jz .handle_rep
|
||||
cmp al, 0xEC
|
||||
jz .handle_in
|
||||
cmp al, 0xED
|
||||
jz .handle_in_word
|
||||
cmp al, 0xEE
|
||||
jz .handle_out
|
||||
cmp al, 0xEF
|
||||
jz .handle_out_word
|
||||
cmp al, 0xE4
|
||||
jz .handle_in_imm
|
||||
cmp al, 0xE6
|
||||
jz .handle_out_imm
|
||||
cmp al, 0x9C
|
||||
jz .handle_pushf
|
||||
cmp al, 0x9D
|
||||
jz .handle_popf
|
||||
cmp al, 0xFA
|
||||
jz .handle_cli
|
||||
cmp al, 0xFB
|
||||
jz .handle_sti
|
||||
cmp al, 0x66
|
||||
jz .handle_66
|
||||
jmp .nogp
|
||||
.handle_int:
|
||||
cmp word [esp+v86_regs.eip], 0xFFFF
|
||||
jae .nogp
|
||||
xor eax, eax
|
||||
lodsb
|
||||
; call sys_msg_board_byte
|
||||
; simulate INT command
|
||||
; N.B. It is possible that some checks need to be corrected,
|
||||
; but at least in case of normal execution the code works.
|
||||
.simulate_int:
|
||||
cmp word [esp+v86_regs.esp], 6
|
||||
jae @f
|
||||
mov bl, 12 ; #SS exception
|
||||
jmp .nogp
|
||||
@@:
|
||||
movzx edx, word [esp+v86_regs.ss]
|
||||
shl edx, 4
|
||||
push eax
|
||||
movzx eax, word [esp+4+v86_regs.esp]
|
||||
sub eax, 6
|
||||
add edx, eax
|
||||
mov eax, edx
|
||||
mov esi, [esp+4+sizeof.v86_regs+10h+4]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14 ; #PF exception
|
||||
jmp .nogp
|
||||
@@:
|
||||
lea eax, [edx+5]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14 ; #PF exception
|
||||
jmp .nogp
|
||||
@@:
|
||||
sub word [esp+4+v86_regs.esp], 6
|
||||
mov eax, [esp+4+v86_regs.eip]
|
||||
cmp byte [esp+1], 0
|
||||
jnz @f
|
||||
inc eax
|
||||
inc eax
|
||||
@@:
|
||||
mov word [edx], ax
|
||||
mov eax, [esp+4+v86_regs.cs]
|
||||
mov word [edx+2], ax
|
||||
mov eax, [esp+4+v86_regs.eflags]
|
||||
mov word [edx+4], ax
|
||||
pop eax
|
||||
mov ah, 0
|
||||
mov cx, [eax*4]
|
||||
mov word [esp+v86_regs.eip], cx
|
||||
mov cx, [eax*4+2]
|
||||
mov word [esp+v86_regs.cs], cx
|
||||
; note that interrupts will be disabled globally at IRET
|
||||
and byte [esp+v86_regs.eflags+1], not 3 ; clear IF and TF flags
|
||||
; continue V86 execution
|
||||
popad
|
||||
iretd
|
||||
.handle_iret:
|
||||
cmp word [esp+v86_regs.esp], 0x10000 - 6
|
||||
jbe @f
|
||||
mov bl, 12
|
||||
jmp .nogp
|
||||
@@:
|
||||
movzx edx, word [esp+v86_regs.ss]
|
||||
shl edx, 4
|
||||
movzx eax, word [esp+v86_regs.esp]
|
||||
add edx, eax
|
||||
mov eax, edx
|
||||
mov esi, [esp+sizeof.v86_regs+10h+4]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14
|
||||
jmp .nogp
|
||||
@@:
|
||||
lea eax, [edx+5]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14
|
||||
jmp .nogp
|
||||
@@:
|
||||
mov ax, [edx]
|
||||
mov word [esp+v86_regs.eip], ax
|
||||
mov ax, [edx+2]
|
||||
mov word [esp+v86_regs.cs], ax
|
||||
mov ax, [edx+4]
|
||||
mov word [esp+v86_regs.eflags], ax
|
||||
add word [esp+v86_regs.esp], 6
|
||||
popad
|
||||
iretd
|
||||
.handle_pushf:
|
||||
cmp word [esp+v86_regs.esp], 1
|
||||
jnz @f
|
||||
mov bl, 12
|
||||
jmp .nogp
|
||||
@@:
|
||||
movzx edx, word [esp+v86_regs.ss]
|
||||
shl edx, 4
|
||||
mov eax, [esp+v86_regs.esp]
|
||||
sub eax, 2
|
||||
movzx eax, ax
|
||||
add edx, eax
|
||||
mov eax, edx
|
||||
mov esi, [esp+sizeof.v86_regs+10h+4]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14 ; #PF exception
|
||||
jmp .nogp
|
||||
@@:
|
||||
lea eax, [edx+1]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14
|
||||
jmp .nogp
|
||||
@@:
|
||||
sub word [esp+v86_regs.esp], 2
|
||||
mov eax, [esp+v86_regs.eflags]
|
||||
mov [edx], ax
|
||||
inc word [esp+v86_regs.eip]
|
||||
popad
|
||||
iretd
|
||||
.handle_pushfd:
|
||||
cmp word [esp+v86_regs.esp], 4
|
||||
jae @f
|
||||
mov bl, 12 ; #SS exception
|
||||
jmp .nogp
|
||||
@@:
|
||||
movzx edx, word [esp+v86_regs.ss]
|
||||
shl edx, 4
|
||||
movzx eax, word [esp+v86_regs.esp]
|
||||
sub eax, 4
|
||||
add edx, eax
|
||||
mov eax, edx
|
||||
mov esi, [esp+sizeof.v86_regs+10h+4]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14 ; #PF exception
|
||||
jmp .nogp
|
||||
@@:
|
||||
lea eax, [edx+3]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14 ; #PF exception
|
||||
jmp .nogp
|
||||
@@:
|
||||
sub word [esp+v86_regs.esp], 4
|
||||
movzx eax, word [esp+v86_regs.eflags]
|
||||
mov [edx], eax
|
||||
add word [esp+v86_regs.eip], 2
|
||||
popad
|
||||
iretd
|
||||
.handle_popf:
|
||||
cmp word [esp+v86_regs.esp], 0xFFFF
|
||||
jnz @f
|
||||
mov bl, 12
|
||||
jmp .nogp
|
||||
@@:
|
||||
movzx edx, word [esp+v86_regs.ss]
|
||||
shl edx, 4
|
||||
movzx eax, word [esp+v86_regs.esp]
|
||||
add edx, eax
|
||||
mov eax, edx
|
||||
mov esi, [esp+sizeof.v86_regs+10h+4]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14 ; #PF exception
|
||||
jmp .nogp
|
||||
@@:
|
||||
lea eax, [edx+1]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14
|
||||
jmp .nogp
|
||||
@@:
|
||||
mov ax, [edx]
|
||||
mov word [esp+v86_regs.eflags], ax
|
||||
add word [esp+v86_regs.esp], 2
|
||||
inc word [esp+v86_regs.eip]
|
||||
popad
|
||||
iretd
|
||||
.handle_popfd:
|
||||
cmp word [esp+v86_regs.esp], 0x10000 - 4
|
||||
jbe @f
|
||||
mov bl, 12
|
||||
jmp .nogp
|
||||
@@:
|
||||
movzx edx, word [esp+v86_regs.ss]
|
||||
shl edx, 4
|
||||
movzx eax, word [esp+v86_regs.esp]
|
||||
add edx, eax
|
||||
mov eax, edx
|
||||
mov esi, [esp+sizeof.v86_regs+10h+4]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14
|
||||
jmp .nogp
|
||||
@@:
|
||||
lea eax, [edx+3]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jae @f
|
||||
mov bl, 14
|
||||
jmp .nogp
|
||||
@@:
|
||||
mov eax, [edx]
|
||||
mov word [esp+v86_regs.eflags], ax
|
||||
add word [esp+v86_regs.esp], 4
|
||||
add word [esp+v86_regs.eip], 2
|
||||
popad
|
||||
iretd
|
||||
.handle_cli:
|
||||
and byte [esp+v86_regs.eflags+1], not 2
|
||||
inc word [esp+v86_regs.eip]
|
||||
popad
|
||||
iretd
|
||||
.handle_sti:
|
||||
or byte [esp+v86_regs.eflags+1], 2
|
||||
inc word [esp+v86_regs.eip]
|
||||
popad
|
||||
iretd
|
||||
.handle_rep:
|
||||
cmp word [esp+v86_regs.eip], 0xFFFF
|
||||
jae .nogp
|
||||
lodsb
|
||||
cmp al, 6Eh
|
||||
jz .handle_rep_outsb
|
||||
jmp .nogp
|
||||
.handle_rep_outsb:
|
||||
.handle_in:
|
||||
.handle_out:
|
||||
.invalid_io_byte:
|
||||
movzx ebx, word [esp+v86_regs.edx]
|
||||
mov ecx, 1
|
||||
jmp .invalid_io
|
||||
.handle_in_imm:
|
||||
.handle_out_imm:
|
||||
cmp word [esp+v86_regs.eip], 0xFFFF
|
||||
jae .nogp
|
||||
lodsb
|
||||
movzx ebx, al
|
||||
mov ecx, 1
|
||||
jmp .invalid_io
|
||||
.handle_66:
|
||||
cmp word [esp+v86_regs.eip], 0xFFFF
|
||||
jae .nogp
|
||||
lodsb
|
||||
cmp al, 0x9C
|
||||
jz .handle_pushfd
|
||||
cmp al, 0x9D
|
||||
jz .handle_popfd
|
||||
cmp al, 0xEF
|
||||
jz .handle_out_dword
|
||||
cmp al, 0xED
|
||||
jz .handle_in_dword
|
||||
jmp .nogp
|
||||
.handle_in_word:
|
||||
.handle_out_word:
|
||||
movzx ebx, word [esp+v86_regs.edx]
|
||||
mov ecx, 2
|
||||
jmp .invalid_io
|
||||
.handle_in_dword:
|
||||
.handle_out_dword:
|
||||
.invalid_io_dword:
|
||||
movzx ebx, word [esp+v86_regs.edx]
|
||||
mov ecx, 4
|
||||
.invalid_io:
|
||||
mov esi, v86_io_str1
|
||||
call sys_msg_board_str
|
||||
mov eax, ebx
|
||||
call sys_msg_board_dword
|
||||
mov esi, v86_io_byte
|
||||
cmp ecx, 1
|
||||
jz @f
|
||||
mov esi, v86_io_word
|
||||
cmp ecx, 2
|
||||
jz @f
|
||||
mov esi, v86_io_dword
|
||||
@@:
|
||||
call sys_msg_board_str
|
||||
if DEBUG_SHOW_IO
|
||||
mov edx, ebx
|
||||
mov ebx, 200
|
||||
call delay_hs
|
||||
mov esi, [esp+v86_regs.size+10h+4]
|
||||
mov eax, [esi+V86_machine.iopm]
|
||||
@@:
|
||||
btr [eax], edx
|
||||
inc edx
|
||||
loop @b
|
||||
popad
|
||||
iretd
|
||||
else
|
||||
mov eax, 2
|
||||
jmp .exit
|
||||
end if
|
||||
.nogp:
|
||||
|
||||
mov esi, v86_exc_str1
|
||||
call sys_msg_board_str
|
||||
mov al, bl
|
||||
call sys_msg_board_byte
|
||||
mov esi, v86_exc_str2
|
||||
call sys_msg_board_str
|
||||
mov ax, [esp+32+4]
|
||||
call sys_msg_board_word
|
||||
mov esi, v86_exc_str3
|
||||
call sys_msg_board_str
|
||||
mov ax, [esp+32]
|
||||
call sys_msg_board_word
|
||||
mov esi, v86_exc_str4
|
||||
call sys_msg_board_str
|
||||
mov ecx, 8
|
||||
movzx edx, word [esp+32+4]
|
||||
shl edx, 4
|
||||
add edx, [esp+32]
|
||||
@@:
|
||||
mov esi, [esp+sizeof.v86_regs+10h+4]
|
||||
mov eax, edx
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jb .nopage
|
||||
mov esi, v86_exc_str3-2
|
||||
call sys_msg_board_str
|
||||
mov al, [edx]
|
||||
call sys_msg_board_byte
|
||||
inc edx
|
||||
loop @b
|
||||
jmp @f
|
||||
.nopage:
|
||||
mov esi, v86_exc_str5
|
||||
call sys_msg_board_str
|
||||
@@:
|
||||
mov esi, v86_newline
|
||||
call sys_msg_board_str
|
||||
mov eax, 1
|
||||
jmp .exit
|
||||
|
||||
.done:
|
||||
xor eax, eax
|
||||
|
||||
.exit:
|
||||
mov [esp+sizeof.v86_regs+10h+1Ch], eax
|
||||
mov [esp+sizeof.v86_regs+10h+18h], ebx
|
||||
|
||||
mov edx, [esp+sizeof.v86_regs+10h+14h]
|
||||
cmp edx, -1
|
||||
jz @f
|
||||
dec [v86_irqhooks+edx*8+4]
|
||||
jnz @f
|
||||
and [v86_irqhooks+edx*8], 0
|
||||
@@:
|
||||
|
||||
mov esi, esp
|
||||
mov edi, [esi+sizeof.v86_regs+10h+10h]
|
||||
add edi, sizeof.v86_regs
|
||||
mov ecx, sizeof.v86_regs/4
|
||||
rep movsd
|
||||
mov esp, esi
|
||||
|
||||
cli
|
||||
mov ecx, [CURRENT_TASK]
|
||||
shl ecx, 8
|
||||
pop eax
|
||||
mov [SLOT_BASE+ecx+APPDATA.saved_esp0], eax
|
||||
mov [tss._esp0], eax
|
||||
pop eax
|
||||
mov [SLOT_BASE+ecx+APPDATA.process], eax
|
||||
pop ebx
|
||||
mov dword [SLOT_BASE+ecx+APPDATA.io_map+4], ebx
|
||||
mov dword [page_tabs + (tss._io_map_1 shr 10)], ebx
|
||||
pop ebx
|
||||
mov dword [SLOT_BASE+ecx+APPDATA.io_map], ebx
|
||||
mov dword [page_tabs + (tss._io_map_0 shr 10)], ebx
|
||||
mov cr3, eax
|
||||
sti
|
||||
|
||||
popad
|
||||
ret
|
||||
|
||||
;my05:
|
||||
; mov dx, 30C2h
|
||||
; mov cx, 4
|
||||
;.0:
|
||||
; in al, dx
|
||||
; cmp al, 0FFh
|
||||
; jz @f
|
||||
; test al, 4
|
||||
; jnz .1
|
||||
;@@:
|
||||
; add dx, 8
|
||||
; in al, dx
|
||||
; cmp al, 0FFh
|
||||
; jz @f
|
||||
; test al, 4
|
||||
; jnz .1
|
||||
;@@:
|
||||
; loop .0
|
||||
; ret
|
||||
;.1:
|
||||
; or al, 84h
|
||||
; out dx, al
|
||||
;.2:
|
||||
; mov dx, 30F7h
|
||||
; in al, dx
|
||||
; mov byte [BOOT_VAR + 48Eh], 0FFh
|
||||
; ret
|
||||
|
||||
align 4
|
||||
v86_irq:
|
||||
; push irq/pushad/jmp v86_irq
|
||||
; ebp = irq
|
||||
lea esi, [esp+1Ch]
|
||||
lea edi, [esi+4]
|
||||
mov ecx, 8
|
||||
std
|
||||
rep movsd
|
||||
cld
|
||||
mov edi, ebp
|
||||
pop eax
|
||||
v86_irq2:
|
||||
mov esi, [v86_irqhooks+edi*8] ; get VM handle
|
||||
mov eax, [esi+V86_machine.pagedir]
|
||||
call get_pg_addr
|
||||
mov ecx, [CURRENT_TASK]
|
||||
shl ecx, 8
|
||||
cmp [SLOT_BASE+ecx+APPDATA.process], eax
|
||||
jnz .notcurrent
|
||||
lea eax, [edi+8]
|
||||
cmp al, 10h
|
||||
mov ah, 1
|
||||
jb @f
|
||||
add al, 60h
|
||||
@@:
|
||||
jmp v86_exc_c.simulate_int
|
||||
.notcurrent:
|
||||
mov ebx, SLOT_BASE + 0x100
|
||||
mov ecx, [TASK_COUNT]
|
||||
.scan:
|
||||
cmp [ebx+APPDATA.process], eax
|
||||
jnz .cont
|
||||
push ecx
|
||||
mov ecx, [ebx+APPDATA.saved_esp0]
|
||||
cmp word [ecx-sizeof.v86_regs+v86_regs.esp], 6
|
||||
jb .cont2
|
||||
movzx edx, word [ecx-sizeof.v86_regs+v86_regs.ss]
|
||||
shl edx, 4
|
||||
push eax
|
||||
movzx eax, word [ecx-sizeof.v86_regs+v86_regs.esp]
|
||||
sub eax, 6
|
||||
add edx, eax
|
||||
mov eax, edx
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jb .cont3
|
||||
lea eax, [edx+5]
|
||||
call v86_get_lin_addr
|
||||
cmp eax, 0x1000
|
||||
jb .cont3
|
||||
pop eax
|
||||
pop ecx
|
||||
jmp .found
|
||||
.cont3:
|
||||
pop eax
|
||||
.cont2:
|
||||
pop ecx
|
||||
.cont:
|
||||
add ebx, 0x100
|
||||
loop .scan
|
||||
mov ecx, edi
|
||||
call irq_eoi
|
||||
popad
|
||||
iretd
|
||||
.found:
|
||||
mov cr3, eax
|
||||
mov esi, [ebx+APPDATA.saved_esp0]
|
||||
sub word [esi-sizeof.v86_regs+v86_regs.esp], 6
|
||||
mov ecx, [esi-sizeof.v86_regs+v86_regs.eip]
|
||||
mov word [edx], cx
|
||||
mov ecx, [esi-sizeof.v86_regs+v86_regs.cs]
|
||||
mov word [edx+2], cx
|
||||
mov ecx, [esi-sizeof.v86_regs+v86_regs.eflags]
|
||||
mov word [edx+4], cx
|
||||
lea eax, [edi+8]
|
||||
cmp al, 10h
|
||||
jb @f
|
||||
add al, 60h
|
||||
@@:
|
||||
mov cx, [eax*4]
|
||||
mov word [esi-sizeof.v86_regs+v86_regs.eip], cx
|
||||
mov cx, [eax*4+2]
|
||||
mov word [esi-sizeof.v86_regs+v86_regs.cs], cx
|
||||
and byte [esi-sizeof.v86_regs+v86_regs.eflags+1], not 3
|
||||
call update_counters
|
||||
lea edi, [ebx + 0x100000000 - SLOT_BASE]
|
||||
shr edi, 3
|
||||
add edi, CURRENT_TASK
|
||||
call find_next_task.found
|
||||
call do_change_task
|
||||
popad
|
||||
iretd
|
||||
91
kernel/branches/kolibri-process/data16.inc
Normal file
91
kernel/branches/kolibri-process/data16.inc
Normal file
@@ -0,0 +1,91 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3539 $
|
||||
|
||||
|
||||
flm db 0
|
||||
preboot_lfb db 0
|
||||
preboot_bootlog db 0
|
||||
boot_drive db 0
|
||||
bx_from_load:
|
||||
dw 'r1' ; структура для хранения параметров- откуда гашрузились, берется ниже из bx ; {SPraid}[13.03.2007]
|
||||
; a,b,c,d - винчестеры, r - рам диск
|
||||
; # диска... символ, а не байт. '1', а не 1
|
||||
|
||||
align 4
|
||||
old_ints_h:
|
||||
dw 0x400
|
||||
dd 0
|
||||
dw 0
|
||||
|
||||
if ~ defined extended_primary_loader ; restart from memory is not supported in extended primary loader cfg
|
||||
kernel_restart_bootblock:
|
||||
db 1 ; version
|
||||
dw 1 ; floppy image is in memory
|
||||
dd 0 ; cannot save parameters
|
||||
end if
|
||||
|
||||
; table for move to extended memory (int 15h, ah=87h)
|
||||
align 8
|
||||
movedesc:
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
|
||||
db 0xff,0xff,0x0,0xa0,0x00,0x93,0x0,0x0
|
||||
db 0xff,0xff,0x0,0x00,0x10,0x93,0x0,0x0
|
||||
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
|
||||
fwmovedesc:
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
|
||||
db 0xff,0xff,0x0,0x00,0x10,0x93,0x0,0x0
|
||||
db 0xff,0xff,0x0,0xa0,0x00,0x93,0x0,0x0
|
||||
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
db 0x00,0x00,0x0,0x00,0x00,0x00,0x0,0x0
|
||||
|
||||
if defined extended_primary_loader
|
||||
; look in PrimaryLoader.txt for the description
|
||||
bootdevice dw 0 ; ax from primary loader
|
||||
bootfs dw 0 ; bx from primary loader
|
||||
bootcallback dd 0 ; ds:si from primary loader
|
||||
; data for configuration file loading, look in PrimaryLoader.txt
|
||||
config_file_struct:
|
||||
dw 0, 4000h ; load to 4000:0000
|
||||
dw 16 ; read no more than 16*4K = 64K
|
||||
db 'config.ini',0
|
||||
; data for configuration file parsing
|
||||
macro config_variable string,parser
|
||||
{
|
||||
local len
|
||||
len dw 0
|
||||
db string
|
||||
store word $ - len - 2 at len
|
||||
dw parser
|
||||
}
|
||||
config_file_variables:
|
||||
config_variable 'timeout', parse_timeout
|
||||
config_variable 'resolution', parse_resolution
|
||||
config_variable 'vbemode', parse_vbemode
|
||||
; config_variable 'vrr', parse_vrr
|
||||
config_variable 'biosdisks', parse_biosdisks
|
||||
config_variable 'imgfrom', parse_imgfrom
|
||||
dw 0
|
||||
; data for image file loading, look in PrimaryLoader.txt
|
||||
image_file_struct:
|
||||
dw 0, 4000h ; load to 4000:0000
|
||||
dw 16 ; read no more than 16*4K = 64K
|
||||
db 'kolibri.img',0
|
||||
end if
|
||||
593
kernel/branches/kolibri-process/data32.inc
Normal file
593
kernel/branches/kolibri-process/data32.inc
Normal file
@@ -0,0 +1,593 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4278 $
|
||||
|
||||
|
||||
keymap:
|
||||
|
||||
db '6',27
|
||||
db '1234567890-=',8,9
|
||||
db 'qwertyuiop[]',13
|
||||
db '~asdfghjkl;',39,96,0,'\zxcvbnm,./',0,'45 '
|
||||
db '@234567890123',180,178,184,'6',176,'7'
|
||||
db 179,'8',181,177,183,185,182
|
||||
db 'AB<D',255,'FGHIJKLMNOPQRSTUVWXYZ'
|
||||
db 'ABCDEFGHIJKLMNOPQRSTUVWXYZ'
|
||||
db 'ABCDEFGHIJKLMNOPQRSTUVWXYZ'
|
||||
db 'ABCDEFGHIJKLMNOPQRSTUVWXYZ'
|
||||
|
||||
keymap_shift:
|
||||
db '6',27
|
||||
db '!@#$%^&*()_+',8,9
|
||||
db 'QWERTYUIOP{}',13
|
||||
db '~ASDFGHJKL:"~',0,'|ZXCVBNM<>?',0,'45 '
|
||||
db '@234567890123',180,178,184,'6',176,'7'
|
||||
db 179,'8',181,177,183,185,182
|
||||
db 'AB>D',255,'FGHIJKLMNOPQRSTUVWXYZ'
|
||||
db 'ABCDEFGHIJKLMNOPQRSTUVWXYZ'
|
||||
db 'ABCDEFGHIJKLMNOPQRSTUVWXYZ'
|
||||
db 'ABCDEFGHIJKLMNOPQRSTUVWXYZ'
|
||||
|
||||
|
||||
keymap_alt:
|
||||
db ' ',27
|
||||
db ' @ $ {[]}\ ',8,9
|
||||
db ' ',13
|
||||
db ' ',0,' ',0,'4',0,' '
|
||||
db ' ',180,178,184,'6',176,'7'
|
||||
db 179,'8',181,177,183,185,182
|
||||
db 'ABCD',255,'FGHIJKLMNOPQRSTUVWXYZ'
|
||||
db 'ABCDEFGHIJKLMNOPQRSTUVWXYZ'
|
||||
db 'ABCDEFGHIJKLMNOPQRSTUVWXYZ'
|
||||
db 'ABCDEFGHIJKLMNOPQRSTUVWXYZ'
|
||||
|
||||
|
||||
|
||||
if lang eq ru
|
||||
boot_initirq cp866 'Инициализация IRQ',0
|
||||
boot_picinit cp866 'Инициализация PIC',0
|
||||
boot_v86machine cp866 'Инициализация системной V86 машины',0
|
||||
boot_inittimer cp866 'Инициализация системного таймера (IRQ0)',0
|
||||
boot_initapic cp866 'Попытка инициализации APIC',0
|
||||
boot_enableirq cp866 'Включить прерывания 2, 13',0
|
||||
boot_disabling_ide cp866 'Запрещение прерываний в контроллере IDE',0
|
||||
boot_enabling_ide cp866 'Разрешение прерываний в контроллере IDE',0
|
||||
boot_set_int_IDE cp866 'Установка обработчиков прерываний IDE',0
|
||||
boot_detectfloppy cp866 'Поиск floppy дисководов',0
|
||||
boot_detecthdcd cp866 'Поиск жестких дисков и ATAPI приводов',0
|
||||
boot_getcache cp866 'Получение памяти для кэша',0
|
||||
boot_detectpart cp866 'Поиск разделов на дисковых устройствах',0
|
||||
boot_init_sys cp866 'Инициализация системного каталога /sys',0
|
||||
boot_loadlibs cp866 'Загрузка библиотек (.obj)',0
|
||||
boot_memdetect cp866 'Количество оперативной памяти',' ',' Мб',0
|
||||
boot_tss cp866 'Установка TSSs',0
|
||||
boot_cpuid cp866 'Чтение CPUIDs',0
|
||||
; boot_devices cp866 'Поиск устройств',0
|
||||
boot_timer cp866 'Установка таймера',0
|
||||
boot_initramdisk cp866 'Инициализация рамдиска',0
|
||||
boot_irqs cp866 'Переопределение IRQ',0
|
||||
boot_setmouse cp866 'Установка мыши',0
|
||||
boot_windefs cp866 'Установка настроек окон по умолчанию',0
|
||||
boot_bgr cp866 'Установка фона',0
|
||||
boot_resirqports cp866 'Резервирование IRQ и портов',0
|
||||
boot_setrports cp866 'Установка адресов IRQ',0
|
||||
boot_setostask cp866 'Создание процесса ядра',0
|
||||
boot_allirqs cp866 'Открытие всех IRQ',0
|
||||
boot_tsc cp866 'Чтение TSC',0
|
||||
boot_cpufreq cp866 'Частота процессора ',' ',' МГц',0
|
||||
boot_pal_ega cp866 'Установка EGA/CGA 320x200 палитры',0
|
||||
boot_pal_vga cp866 'Установка VGA 640x480 палитры',0
|
||||
boot_failed cp866 'Загрузка первого приложения не удалась',0
|
||||
boot_mtrr cp866 'Установка MTRR',0
|
||||
|
||||
boot_APIC_found cp866 'APIC включен', 0
|
||||
boot_APIC_nfound cp866 'APIC не найден', 0
|
||||
if preboot_blogesc
|
||||
boot_tasking cp866 'Все готово для запуска, нажмитре ESC для старта',0
|
||||
end if
|
||||
else if lang eq sp
|
||||
include 'data32sp.inc'
|
||||
else if lang eq et
|
||||
include 'data32et.inc'
|
||||
else
|
||||
boot_initirq db 'Initialize IRQ',0
|
||||
boot_picinit db 'Initialize PIC',0
|
||||
boot_v86machine db 'Initialize system V86 machine',0
|
||||
boot_inittimer db 'Initialize system timer (IRQ0)',0
|
||||
boot_initramdisk db 'Initialize ramdisk',0
|
||||
boot_initapic db 'Try to initialize APIC',0
|
||||
boot_enableirq db 'Enable interrupts 2, 13',0
|
||||
boot_disabling_ide db 'Disable interrupts in IDE controller',0
|
||||
boot_enabling_ide db 'Enable interrupts in IDE controller',0
|
||||
boot_set_int_IDE db 'Set handler of interrupts for IDE',0
|
||||
boot_detectfloppy db 'Search floppy drives',0
|
||||
boot_detecthdcd db 'Search hard drives and ATAPI drives',0
|
||||
boot_getcache db 'Get memory for cache',0
|
||||
boot_detectpart db 'Search partitions on disk devices',0
|
||||
boot_init_sys db 'Initialize system directory /sys',0
|
||||
boot_loadlibs db 'Loading librares (.obj)',0
|
||||
boot_memdetect db 'Determining amount of memory',0
|
||||
boot_tss db 'Setting TSSs',0
|
||||
boot_cpuid db 'Reading CPUIDs',0
|
||||
; boot_devices db 'Detecting devices',0
|
||||
boot_setmouse db 'Setting mouse',0
|
||||
boot_windefs db 'Setting window defaults',0
|
||||
boot_bgr db 'Calculating background',0
|
||||
boot_resirqports db 'Reserving IRQs & ports',0
|
||||
boot_setostask db 'Setting OS task',0
|
||||
boot_allirqs db 'Unmasking IRQs',0
|
||||
boot_tsc db 'Reading TSC',0
|
||||
boot_cpufreq db 'CPU frequency is ',' ',' MHz',0
|
||||
boot_pal_ega db 'Setting EGA/CGA 320x200 palette',0
|
||||
boot_pal_vga db 'Setting VGA 640x480 palette',0
|
||||
boot_failed db 'Failed to start first app',0
|
||||
boot_mtrr db 'Setting MTRR',0
|
||||
|
||||
boot_APIC_found db 'APIC enabled', 0
|
||||
boot_APIC_nfound db 'APIC not found', 0
|
||||
if preboot_blogesc
|
||||
boot_tasking db 'All set - press ESC to start',0
|
||||
end if
|
||||
end if
|
||||
|
||||
;new_process_loading db 'K : New Process - loading',13,10,0
|
||||
;new_process_running db 'K : New Process - done',13,10,0
|
||||
start_not_enough_memory db 'K : New Process - not enough memory',13,10,0
|
||||
|
||||
msg_unresolved db 'unresolved ',0
|
||||
msg_module db 'in module ',0
|
||||
if ~ lang eq sp
|
||||
msg_version db 'incompatible driver version',13,10,0
|
||||
msg_www db 'please visit www.kolibrios.org',13,10,0
|
||||
end if
|
||||
msg_CR db 13,10,0
|
||||
|
||||
intel_str db "GenuineIntel",0
|
||||
AMD_str db "AuthenticAMD",0
|
||||
|
||||
szHwMouse db 'ATI2D',0
|
||||
szPS2MDriver db 'PS2MOUSE',0
|
||||
;szCOM_MDriver db 'COM_MOUSE',0
|
||||
szVidintel db 'vidintel',0
|
||||
szUSB db 'USB',0
|
||||
szAtiHW db '/rd/1/drivers/ati2d.drv',0
|
||||
|
||||
szSTART db 'START',0
|
||||
szEXPORTS db 'EXPORTS',0
|
||||
sz_EXPORTS db '_EXPORTS',0
|
||||
|
||||
szIMPORTS db 'IMPORTS',0
|
||||
|
||||
read_firstapp db '/sys/'
|
||||
firstapp db 'LAUNCHER',0
|
||||
notifyapp db '@notify',0
|
||||
if lang eq ru
|
||||
ud_user_message cp866 'Ошибка: неподдерживаемая инструкция процессора',0
|
||||
else if ~ lang eq sp
|
||||
ud_user_message db 'Error: unsupported processor instruction',0
|
||||
end if
|
||||
|
||||
vmode db '/sys/drivers/VMODE.MDR',0
|
||||
;vrr_m db 'VRR_M',0
|
||||
kernel_file_load:
|
||||
; load kernel.mnt to 0x7000:0
|
||||
dd 0 ; subfunction
|
||||
dq 0 ; offset in file
|
||||
dd 0x30000 ; number of bytes to read
|
||||
dd OS_BASE + 0x70000 ; buffer for data
|
||||
db '/RD/1/KERNEL.MNT',0
|
||||
|
||||
dev_data_path db '/RD/1/DRIVERS/DEVICES.DAT',0
|
||||
|
||||
align 4
|
||||
|
||||
shmem_list:
|
||||
.bk dd shmem_list
|
||||
.fd dd shmem_list
|
||||
|
||||
dll_list:
|
||||
.bk dd dll_list
|
||||
.fd dd dll_list
|
||||
|
||||
pcidev_list:
|
||||
.bk dd pcidev_list
|
||||
.fd dd pcidev_list
|
||||
|
||||
MAX_DEFAULT_DLL_ADDR = 0x80000000
|
||||
MIN_DEFAULT_DLL_ADDR = 0x70000000
|
||||
dll_cur_addr dd MIN_DEFAULT_DLL_ADDR
|
||||
|
||||
; supported videomodes
|
||||
|
||||
|
||||
; mike.dld {
|
||||
;db 0
|
||||
;dd servetable-0x10000
|
||||
;align 4
|
||||
;draw_line dd __sys_draw_line
|
||||
;draw_pointer dd __sys_draw_pointer
|
||||
;//mike.dld, 2006-08-02 [
|
||||
;;drawbar dd __sys_drawbar
|
||||
;;drawbar dd __sys_drawbar.forced
|
||||
;drawbar dd vesa20_drawbar
|
||||
;//mike.dld, 2006-08-02 ]
|
||||
;putpixel dd __sys_putpixel
|
||||
; } mike.dld
|
||||
|
||||
|
||||
align 4
|
||||
keyboard dd 1
|
||||
syslang dd 1
|
||||
|
||||
boot_y dd 10
|
||||
|
||||
pci_bios_entry dd 0
|
||||
dw pci_code_sel
|
||||
|
||||
if __DEBUG__ eq 1
|
||||
include_debug_strings
|
||||
end if
|
||||
|
||||
IncludeIGlobals
|
||||
|
||||
align 16
|
||||
gdts:
|
||||
|
||||
dw gdte-$-1
|
||||
dd gdts
|
||||
dw 0
|
||||
|
||||
; Attention! Do not change the order of the first four selectors. They are used in Fast System Call
|
||||
; must be : os_code, os_data, app_code, app_data, ....
|
||||
|
||||
int_code_l:
|
||||
os_code_l:
|
||||
dw 0xffff
|
||||
dw 0x0000
|
||||
db 0x00
|
||||
dw 11011111b *256 +10011010b
|
||||
db 0x00
|
||||
|
||||
int_data_l:
|
||||
os_data_l:
|
||||
dw 0xffff
|
||||
dw 0x0000
|
||||
db 0x00
|
||||
dw 11011111b *256 +10010010b
|
||||
db 0x00
|
||||
|
||||
app_code_l:
|
||||
dw 0xFFFF
|
||||
dw 0
|
||||
db 0
|
||||
db cpl3
|
||||
dw G32+D32+0xF;
|
||||
|
||||
app_data_l:
|
||||
dw 0xFFFF
|
||||
dw 0
|
||||
db 0
|
||||
db drw3
|
||||
dw G32+D32+0xF;
|
||||
|
||||
; ------------- PCI BIOS ------------------
|
||||
|
||||
pci_code_32:
|
||||
dw 0 ;lim 0-15
|
||||
dw 0 ;base 0-15
|
||||
db 0 ;base 16-23
|
||||
db cpl0 ;type
|
||||
db D32 ;lim 16-19+props
|
||||
db 0 ;base 24-31
|
||||
|
||||
pci_data_32:
|
||||
dw 0 ;lim 0-15
|
||||
dw 0 ;base 0-15
|
||||
db 0 ;base 16-23
|
||||
db dpl0 ;type
|
||||
db D32 ;lim 16-19+props
|
||||
db 0 ;base 24-31
|
||||
|
||||
; --------------- APM ---------------------
|
||||
apm_code_32:
|
||||
dw 0x0f ; limit 64kb
|
||||
db 0, 0, 0
|
||||
dw 11010000b *256 +10011010b
|
||||
db 0x00
|
||||
apm_code_16:
|
||||
dw 0x0f
|
||||
db 0, 0, 0
|
||||
dw 10010000b *256 +10011010b
|
||||
db 0x00
|
||||
apm_data_16:
|
||||
dw 0x0f
|
||||
db 0, 0, 0
|
||||
dw 10010000b *256 +10010010b
|
||||
db 0x00
|
||||
; -----------------------------------------
|
||||
|
||||
graph_data_l:
|
||||
|
||||
dw 0x7ff
|
||||
dw 0x0000
|
||||
db 0x00
|
||||
dw 11010000b *256 +11110010b
|
||||
db 0x00
|
||||
tss0_l:
|
||||
dw sizeof.TSS-1
|
||||
dw tss and 0xFFFF
|
||||
db (tss shr 16) and 0xFF
|
||||
db 10001001b
|
||||
dw (tss shr 16) and 0xFF00
|
||||
|
||||
tls_data_l:
|
||||
dw 0x0FFF
|
||||
dw 0
|
||||
db 0
|
||||
db drw3
|
||||
dw D32
|
||||
|
||||
endofcode:
|
||||
gdte:
|
||||
|
||||
diff16 "end of .data segment",0,$
|
||||
|
||||
align 16
|
||||
cur_saved_data:
|
||||
rb 4096
|
||||
fpu_data:
|
||||
rb 512
|
||||
|
||||
mem_block_list rd 64*2
|
||||
mem_used_list rd 64*2
|
||||
mem_hash_cnt rd 64
|
||||
|
||||
thr_slot_map rd 8
|
||||
|
||||
cpu_freq rq 1
|
||||
|
||||
heap_mutex MUTEX
|
||||
heap_size rd 1
|
||||
heap_free rd 1
|
||||
heap_blocks rd 1
|
||||
free_blocks rd 1
|
||||
|
||||
mem_block_mask rd 2
|
||||
next_memblock rd 1
|
||||
|
||||
|
||||
mst MEM_STATE
|
||||
|
||||
page_start rd 1
|
||||
page_end rd 1
|
||||
sys_page_map rd 1
|
||||
os_stack_seg rd 1
|
||||
|
||||
|
||||
srv.fd rd 1
|
||||
srv.bk rd 1
|
||||
|
||||
|
||||
align 16
|
||||
|
||||
_display display_t
|
||||
|
||||
_WinMapAddress rd 1
|
||||
_WinMapSize rd 1
|
||||
|
||||
LFBAddress rd 1
|
||||
Screen_Max_X rd 1
|
||||
Screen_Max_Y rd 1
|
||||
|
||||
SCR_MODE rw 2
|
||||
|
||||
PUTPIXEL rd 1
|
||||
GETPIXEL rd 1
|
||||
|
||||
if VESA_1_2_VIDEO
|
||||
BANK_SWITCH rd 1 reserved for vesa 1.2
|
||||
BANK_RW rd 1
|
||||
end if
|
||||
|
||||
REDRAW_BACKGROUND rb 4
|
||||
|
||||
align 4
|
||||
draw_data: rb 32*256
|
||||
BPSLine_calc_area rd 1440
|
||||
d_width_calc_area rd 1140
|
||||
|
||||
mouseunder rd 16*24
|
||||
|
||||
MOUSE_PICTURE rd 1
|
||||
|
||||
MOUSE_SCROLL_H rw 1
|
||||
MOUSE_X: rw 1
|
||||
MOUSE_Y: rw 1
|
||||
MOUSE_SCROLL_V rw 1
|
||||
|
||||
X_UNDER rw 1
|
||||
Y_UNDER rw 1
|
||||
COLOR_TEMP rd 1
|
||||
MOUSE_COLOR_MEM rd 1
|
||||
|
||||
BTN_DOWN: rb 4
|
||||
|
||||
align 4
|
||||
def_cursor rd 1
|
||||
def_cursor_clock rd 1
|
||||
current_cursor rd 1
|
||||
hw_cursor rd 1
|
||||
cur_saved_base rd 1
|
||||
|
||||
cur.lock rd 1 ;1 - lock update, 2- hide
|
||||
cur.left rd 1 ;cursor clip box
|
||||
cur.top rd 1
|
||||
cur.right rd 1
|
||||
cur.bottom rd 1
|
||||
cur.w rd 1
|
||||
cur.h rd 1
|
||||
|
||||
ipc_tmp rd 1
|
||||
ipc_pdir rd 1
|
||||
ipc_ptab rd 1
|
||||
|
||||
proc_mem_map rd 1
|
||||
proc_mem_pdir rd 1
|
||||
proc_mem_tab rd 1
|
||||
|
||||
tmp_task_ptab rd 1
|
||||
|
||||
default_io_map rd 1
|
||||
|
||||
LFBSize rd 1
|
||||
|
||||
current_slot rd 1
|
||||
|
||||
; status
|
||||
hd1_status rd 1 ; 0 - free : other - pid
|
||||
application_table_owner rd 1 ; 0 - free : other - pid
|
||||
application_table_mutex MUTEX
|
||||
|
||||
; device addresses
|
||||
mididp rd 1
|
||||
midisp rd 1
|
||||
|
||||
cdbase rd 1
|
||||
cdid rd 1
|
||||
|
||||
hdbase rd 1 ; for boot 0x1f0
|
||||
hdid rd 1
|
||||
hdpos rd 1 ; for boot 0x1
|
||||
label known_part dword
|
||||
fat32part rd 1 ; for boot 0x1
|
||||
cdpos rd 1
|
||||
|
||||
;CPUID information
|
||||
cpu_vendor rd 3
|
||||
cpu_sign rd 1
|
||||
cpu_info rd 1
|
||||
cpu_caps rd 4
|
||||
|
||||
|
||||
pg_data PG_DATA
|
||||
heap_test rd 1
|
||||
|
||||
buttontype rd 1
|
||||
windowtypechanged rd 1
|
||||
|
||||
hd_entries rd 1 ;unused ? 0xfe10
|
||||
|
||||
mouse_active rd 1
|
||||
mouse_pause rd 1
|
||||
|
||||
redrawmouse_unconditional rd 1
|
||||
|
||||
img_background rd 1
|
||||
mem_BACKGROUND rd 1
|
||||
static_background_data rd 1
|
||||
|
||||
BgrDrawMode rd 1
|
||||
BgrDataWidth rd 1
|
||||
BgrDataHeight rd 1
|
||||
|
||||
skin_data rd 1
|
||||
|
||||
cache_ide0:
|
||||
cache_ide0_pointer rd 1
|
||||
cache_ide0_size rd 1 ; not use
|
||||
cache_ide0_data_pointer rd 1
|
||||
cache_ide0_system_data_size rd 1 ; not use
|
||||
cache_ide0_appl_data_size rd 1 ; not use
|
||||
cache_ide0_system_data rd 1
|
||||
cache_ide0_appl_data rd 1
|
||||
cache_ide0_system_sad_size rd 1
|
||||
cache_ide0_appl_sad_size rd 1
|
||||
cache_ide0_search_start rd 1
|
||||
cache_ide0_appl_search_start rd 1
|
||||
|
||||
cache_ide1:
|
||||
cache_ide1_pointer rd 1
|
||||
cache_ide1_size rd 1 ; not use
|
||||
cache_ide1_data_pointer rd 1
|
||||
cache_ide1_system_data_size rd 1 ; not use
|
||||
cache_ide1_appl_data_size rd 1 ; not use
|
||||
cache_ide1_system_data rd 1
|
||||
cache_ide1_appl_data rd 1
|
||||
cache_ide1_system_sad_size rd 1
|
||||
cache_ide1_appl_sad_size rd 1
|
||||
cache_ide1_search_start rd 1
|
||||
cache_ide1_appl_search_start rd 1
|
||||
|
||||
cache_ide2:
|
||||
cache_ide2_pointer rd 1
|
||||
cache_ide2_size rd 1 ; not use
|
||||
cache_ide2_data_pointer rd 1
|
||||
cache_ide2_system_data_size rd 1 ; not use
|
||||
cache_ide2_appl_data_size rd 1 ; not use
|
||||
cache_ide2_system_data rd 1
|
||||
cache_ide2_appl_data rd 1
|
||||
cache_ide2_system_sad_size rd 1
|
||||
cache_ide2_appl_sad_size rd 1
|
||||
cache_ide2_search_start rd 1
|
||||
cache_ide2_appl_search_start rd 1
|
||||
|
||||
cache_ide3:
|
||||
cache_ide3_pointer rd 1
|
||||
cache_ide3_size rd 1 ; not use
|
||||
cache_ide3_data_pointer rd 1
|
||||
cache_ide3_system_data_size rd 1 ; not use
|
||||
cache_ide3_appl_data_size rd 1 ; not use
|
||||
cache_ide3_system_data rd 1
|
||||
cache_ide3_appl_data rd 1
|
||||
cache_ide3_system_sad_size rd 1
|
||||
cache_ide3_appl_sad_size rd 1
|
||||
cache_ide3_search_start rd 1
|
||||
cache_ide3_appl_search_start rd 1
|
||||
|
||||
debug_step_pointer rd 1
|
||||
|
||||
lba_read_enabled rd 1 ; 0 = disabled , 1 = enabled
|
||||
pci_access_enabled rd 1 ; 0 = disabled , 1 = enabled
|
||||
|
||||
hdd_appl_data rb 1 ; 0 = system cache, 1 - application cache
|
||||
cd_appl_data rb 1 ; 0 = system cache, 1 - application cache
|
||||
|
||||
timer_ticks_enable rb 1 ; for cd driver
|
||||
|
||||
align 4
|
||||
NumBiosDisks rd 1
|
||||
BiosDisksData rb 200h
|
||||
BiosDiskCaches rb 80h*(cache_ide1-cache_ide0)
|
||||
BiosDiskPartitions rd 80h
|
||||
|
||||
align 16
|
||||
DRIVE_DATA: rb DRIVE_DATA_SIZE
|
||||
|
||||
IncludeUGlobals
|
||||
|
||||
uglobals_size = $ - endofcode
|
||||
|
||||
if ~ lang eq sp
|
||||
diff16 "end of .bss",0,$
|
||||
end if
|
||||
|
||||
org (OS_BASE+0x0100000)
|
||||
|
||||
RAMDISK: rb 2880*512
|
||||
rb 2856*4 ; not used
|
||||
|
||||
_CLEAN_ZONE:
|
||||
|
||||
align 4096
|
||||
_IDE_DMA rb 16*512
|
||||
BgrAuxTable rb 32768
|
||||
BUTTON_INFO rb 64*1024
|
||||
RESERVED_PORTS: rb 64*1024
|
||||
FLOPPY_BUFF: rb 18*512 ;one track
|
||||
|
||||
sys_pgmap: rb 1024*1024/8
|
||||
38
kernel/branches/kolibri-process/data32et.inc
Normal file
38
kernel/branches/kolibri-process/data32et.inc
Normal file
@@ -0,0 +1,38 @@
|
||||
boot_initirq latin1 'Algväärtustan IRQ',0
|
||||
boot_picinit latin1 'Algväärtustan PIC',0
|
||||
boot_v86machine latin1 'Algväärtustan süsteemi V86 masinat',0
|
||||
boot_inittimer latin1 'Algväärtustan süsteemi taimerit (IRQ0)',0
|
||||
boot_initramdisk latin1 'Initialize ramdisk',0
|
||||
boot_initapic latin1 'Proovin Algväärtustada APIC',0
|
||||
boot_enableirq latin1 'Luban katkestused 2, 13',0
|
||||
boot_disabling_ide latin1 'Keelan IDE kontrolleri katkestused',0
|
||||
boot_enabling_ide latin1 'Luban IDE kontrolleri katkestused',0
|
||||
boot_set_int_IDE latin1 'Määran IDE kontrolleri halduri',0
|
||||
boot_detectfloppy latin1 'Otsin floppi kettaid',0
|
||||
boot_detecthdcd latin1 'Otsin kõvakettaid ja ATAPI seadmeid',0
|
||||
boot_getcache latin1 'Küsin puhvri mälu',0
|
||||
boot_detectpart latin1 'Otsin kettaseadmete partitsioone',0
|
||||
boot_init_sys latin1 'Algväärtustan süsteemi kataloogi /sys',0
|
||||
boot_loadlibs latin1 'Laadin mooduleid (.obj)',0
|
||||
boot_memdetect latin1 'Avastan mälu mahtu',0
|
||||
boot_tss latin1 'Määran TSSe',0
|
||||
boot_cpuid latin1 'Loen CPUIDd',0
|
||||
; boot_devices db 'Detecting devices',0
|
||||
boot_setmouse latin1 'Seadistan hiirt',0
|
||||
boot_windefs latin1 'Seadistan akende vaikeväärtusi',0
|
||||
boot_bgr latin1 'Kalkuleerin tausta',0
|
||||
boot_resirqports latin1 'Reserveerin IRQsi ja porte',0
|
||||
boot_setostask latin1 'Seadistan OS protsessi',0
|
||||
boot_allirqs latin1 'Unmasking IRQs',0
|
||||
boot_tsc latin1 'Loen TSC',0
|
||||
boot_cpufreq latin1 'CPU sagedus on ',' ',' MHz',0
|
||||
boot_pal_ega latin1 'Seadistan EGA/CGA 320x200 paletti',0
|
||||
boot_pal_vga latin1 'Seadistan VGA 640x480 paletti',0
|
||||
boot_failed latin1 'Esimese programmi käivitamine ebaõnnestus',0
|
||||
boot_mtrr latin1 'Määran MTRR',0
|
||||
|
||||
boot_APIC_found latin1 'APIC aktiveeritud', 0
|
||||
boot_APIC_nfound latin1 'APIC ei leitud', 0
|
||||
if preboot_blogesc
|
||||
boot_tasking latin1 'Kõik valmis - vajuta ESC alustamiseks',0
|
||||
end if
|
||||
43
kernel/branches/kolibri-process/data32sp.inc
Normal file
43
kernel/branches/kolibri-process/data32sp.inc
Normal file
@@ -0,0 +1,43 @@
|
||||
boot_initirq: cp850 'Inicializar IRQ',0
|
||||
boot_picinit: cp850 'Inicializar PIC',0
|
||||
boot_v86machine: cp850 'Inicializar sistema V86',0
|
||||
boot_inittimer: cp850 'Inicializar reloj del sistema (IRQ0)',0
|
||||
boot_initramdisk cp850 'Initialize ramdisk',0
|
||||
boot_initapic: cp850 'Prueba inicializar APIC',0
|
||||
boot_enableirq: cp850 'Habilitar interrupciones 2, 13',0
|
||||
boot_disabling_ide:cp850 'Habiliar interrupciones en controladores IDE',0
|
||||
boot_enabling_ide:cp850 'Habilitar interrupciones en controladores IDE',0
|
||||
boot_set_int_IDE: cp850 'Configuración del controlador de interrupciones para el IDE',0
|
||||
boot_detectfloppy:cp850 'Buscar unidades de disquete',0
|
||||
boot_detecthdcd: cp850 'Buscar discos duros y unidades ATAPI',0
|
||||
boot_getcache: cp850 'Tomar memoria para caché',0
|
||||
boot_detectpart: cp850 'Buscar particiones en discos',0
|
||||
boot_init_sys: cp850 'Inicializar directorio del sistema /sys',0
|
||||
boot_loadlibs: cp850 'Cargando librerías (.obj)',0
|
||||
boot_memdetect: cp850 'Determinando cantidad de memoria',0
|
||||
boot_tss: cp850 'Configurando TSSs',0
|
||||
boot_cpuid: cp850 'Leyendo CPUIDs',0
|
||||
; boot_devices: cp850 'Detectando dispositivos',0
|
||||
boot_setmouse: cp850 'Configurando el ratón',0
|
||||
boot_windefs: cp850 'Setting window defaults',0
|
||||
boot_bgr: cp850 'Calculating background',0
|
||||
boot_resirqports: cp850 'Reservando IRQs y puertos',0
|
||||
boot_setostask: cp850 'Configurando tarea OS',0
|
||||
boot_allirqs: cp850 'Desenmascarando IRQs',0
|
||||
boot_tsc: cp850 'Leyendo TSC',0
|
||||
boot_cpufreq: cp850 'La frequencia del CPU es ',' ',' MHz',0
|
||||
boot_pal_ega: cp850 'Configurando paleta EGA/CGA 320x200',0
|
||||
boot_pal_vga: cp850 'Configurando paleta VGA 640x480',0
|
||||
boot_failed: cp850 'Fallo al iniciar la primer aplicación',0
|
||||
boot_mtrr: cp850 'Configurando MTRR',0
|
||||
|
||||
boot_APIC_found: cp850 'APIC habilitado', 0
|
||||
boot_APIC_nfound: cp850 'APIC no encontrado', 0
|
||||
if preboot_blogesc
|
||||
boot_tasking: cp850 'Todo configurado - presiona ESC para iniciar',0
|
||||
end if
|
||||
|
||||
msg_version: cp850 'versión incompatible del controlador',13,10,0
|
||||
msg_www: cp850 'por favor, visita www.kolibrios.org',13,10,0
|
||||
|
||||
ud_user_message:cp850 'Error: instrucción no soportada por el procesador',0
|
||||
109
kernel/branches/kolibri-process/detect/biosdisk.inc
Normal file
109
kernel/branches/kolibri-process/detect/biosdisk.inc
Normal file
@@ -0,0 +1,109 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2008-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
; Detect all BIOS hard drives.
|
||||
; diamond, 2008
|
||||
; Do not include USB mass storages. CleverMouse, 2013
|
||||
|
||||
xor cx, cx
|
||||
mov es, cx
|
||||
mov di, 0x9080
|
||||
mov byte [es:di-1], cl
|
||||
cmp [preboot_biosdisk], 1
|
||||
jnz bdde
|
||||
mov dl, 80h
|
||||
bdds:
|
||||
mov ah, 15h
|
||||
push cx dx di
|
||||
int 13h
|
||||
pop di dx cx
|
||||
jc bddc
|
||||
test ah, ah
|
||||
jz bddc
|
||||
inc cx
|
||||
; We are going to call int 13h/func 48h, Extended get drive parameters.
|
||||
; The latest version of the EDD specification is 3.0.
|
||||
; There are two slightly incompatible variants for version 3.0;
|
||||
; original one from Phoenix in 1998, see e.g.
|
||||
; http://www.t10.org/t13/technical/d98120r0.pdf, and T13 draft,
|
||||
; http://www.t13.org/documents/UploadedDocuments/docs2004/d1572r3-EDD3.pdf
|
||||
; T13 draft addresses more possible buses, so it gives additional 8 bytes
|
||||
; for device path.
|
||||
; Most BIOSes follow Phoenix, but T13 version is also known to be used
|
||||
; (e.g. systems based on AMD Geode).
|
||||
; Fortunately, there is an in/out length field, so
|
||||
; it is easy to tell what variant was selected by the BIOS:
|
||||
; Phoenix-3.0 has 42h bytes, T13-3.0 has 4Ah bytes.
|
||||
; Note that 2.0 has 1Eh bytes, 1.1 has 1Ah bytes; both variants of 3.0 have
|
||||
; the same structure for first 1Eh bytes, compatible with previous versions.
|
||||
; Note also that difference between Phoenix-3.0 and T13-3.0 starts near the
|
||||
; end of the structure, so the current code doesn't even need to distinguish.
|
||||
; It needs, however, give at least 4Ah bytes as input and expect that BIOS
|
||||
; could return 42h bytes as output while still giving all the information.
|
||||
mov ah, 48h
|
||||
push ds
|
||||
push es
|
||||
pop ds
|
||||
mov si, 0xA000
|
||||
mov word [si], 4Ah
|
||||
mov ah, 48h
|
||||
int 13h
|
||||
pop ds
|
||||
jc bddc2
|
||||
cmp word [es:si], 1Eh
|
||||
jb .noide
|
||||
cmp word [es:si+1Ah], 0xFFFF
|
||||
jz .noide
|
||||
inc byte [es:0x907F]
|
||||
mov al, dl
|
||||
stosb
|
||||
push ds
|
||||
lds si, [es:si+1Ah]
|
||||
mov al, [si+6]
|
||||
and al, 0xF
|
||||
stosb
|
||||
mov al, byte [si+4]
|
||||
shr al, 4
|
||||
and ax, 1
|
||||
cmp word [si], 1F0h
|
||||
jz @f
|
||||
inc ax
|
||||
inc ax
|
||||
cmp word [si], 170h
|
||||
jz @f
|
||||
or ax, -1
|
||||
; mov ax, -1
|
||||
@@:
|
||||
stosw
|
||||
pop ds
|
||||
jmp bddc2
|
||||
.noide:
|
||||
cmp word [es:si], 42h
|
||||
jb .nousb
|
||||
cmp word [es:si+28h], 'US'
|
||||
jnz .nousb
|
||||
cmp byte [es:si+2Ah], 'B'
|
||||
jz bddc2
|
||||
.nousb:
|
||||
inc byte [es:0x907F]
|
||||
mov al, dl
|
||||
stosb
|
||||
xor ax, ax
|
||||
stosb
|
||||
dec ax
|
||||
stosw
|
||||
; mov al, 0
|
||||
; stosb
|
||||
; mov ax, -1
|
||||
; stosw
|
||||
bddc2:
|
||||
cmp cl, [es:0x475]
|
||||
jae bdde
|
||||
bddc:
|
||||
inc dl
|
||||
jnz bdds
|
||||
bdde:
|
||||
43
kernel/branches/kolibri-process/detect/biosmem.inc
Normal file
43
kernel/branches/kolibri-process/detect/biosmem.inc
Normal file
@@ -0,0 +1,43 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2009-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
; Query physical memory map from BIOS.
|
||||
; diamond, 2009
|
||||
|
||||
push ds
|
||||
; first call to fn E820
|
||||
mov eax, 0xE820
|
||||
xor ebx, ebx
|
||||
mov es, bx
|
||||
mov ds, bx
|
||||
mov di, 0x9104
|
||||
mov [di-4], ebx ; no blocks yet
|
||||
mov ecx, 20
|
||||
mov edx, 0x534D4150
|
||||
int 15h
|
||||
jc no_E820
|
||||
cmp eax, 0x534D4150
|
||||
jnz no_E820
|
||||
e820_mem_loop:
|
||||
; cmp byte [di+16], 1 ; ignore non-free areas
|
||||
; jnz e820_mem_next
|
||||
inc byte [0x9100]
|
||||
add di, 20
|
||||
e820_mem_next:
|
||||
; consequent calls to fn E820
|
||||
test ebx, ebx
|
||||
jz e820_test_done
|
||||
cmp byte [0x9100], 32
|
||||
jae e820_test_done
|
||||
mov eax, 0xE820
|
||||
int 15h
|
||||
jc e820_test_done
|
||||
jmp e820_mem_loop
|
||||
no_E820:
|
||||
; let's hope for mem_test from init.inc
|
||||
e820_test_done:
|
||||
pop ds
|
||||
38
kernel/branches/kolibri-process/detect/dev_fd.inc
Normal file
38
kernel/branches/kolibri-process/detect/dev_fd.inc
Normal file
@@ -0,0 +1,38 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4273 $
|
||||
|
||||
|
||||
;***************************************************
|
||||
; предварительная очистка области таблицы
|
||||
; поиск и занесение в таблицу приводов FDD
|
||||
; автор Mario79
|
||||
;***************************************************
|
||||
xor eax, eax
|
||||
mov edi, DRIVE_DATA
|
||||
mov ecx, DRIVE_DATA_SIZE/4
|
||||
cld
|
||||
rep stosd
|
||||
|
||||
mov al, 0x10
|
||||
out 0x70, al
|
||||
mov cx, 0xff
|
||||
wait_cmos:
|
||||
dec cx
|
||||
test cx, cx
|
||||
jnz wait_cmos
|
||||
in al, 0x71
|
||||
mov [DRIVE_DATA], al
|
||||
test al, al
|
||||
jz @f
|
||||
|
||||
stdcall attach_int_handler, 6, FDCInterrupt, 0
|
||||
DEBUGF 1, "K : Set IDE IRQ6 return code %x\n", eax
|
||||
call floppy_init
|
||||
@@:
|
||||
|
||||
423
kernel/branches/kolibri-process/detect/dev_hdcd.inc
Normal file
423
kernel/branches/kolibri-process/detect/dev_hdcd.inc
Normal file
@@ -0,0 +1,423 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3881 $
|
||||
|
||||
|
||||
;******************************************************
|
||||
; поиск приводов HDD и CD
|
||||
; автор исходного текста Кулаков Владимир Геннадьевич.
|
||||
; адаптация и доработка Mario79
|
||||
;******************************************************
|
||||
|
||||
;****************************************************
|
||||
;* ПОИСК HDD и CD *
|
||||
;****************************************************
|
||||
cmp [IDEContrProgrammingInterface], 0
|
||||
je EndFindHDD
|
||||
|
||||
FindHDD:
|
||||
mov [ChannelNumber], 1
|
||||
mov [DiskNumber], 0
|
||||
call FindHDD_3
|
||||
; mov ax,[Sector512+176]
|
||||
; mov [DRIVE_DATA+6],ax
|
||||
; mov ax,[Sector512+126]
|
||||
; mov [DRIVE_DATA+8],ax
|
||||
; mov ax,[Sector512+128]
|
||||
; mov [DRIVE_DATA+8],ax
|
||||
mov [DiskNumber], 1
|
||||
call FindHDD_3
|
||||
; mov al,[Sector512+176]
|
||||
; mov [DRIVE_DATA+7],al
|
||||
inc [ChannelNumber]
|
||||
mov [DiskNumber], 0
|
||||
call FindHDD_3
|
||||
; mov al,[Sector512+176]
|
||||
; mov [DRIVE_DATA+8],al
|
||||
mov [DiskNumber], 1
|
||||
call FindHDD_1
|
||||
; mov al,[Sector512+176]
|
||||
; mov [DRIVE_DATA+9],al
|
||||
|
||||
jmp EndFindHDD
|
||||
|
||||
FindHDD_1:
|
||||
DEBUGF 1, "K : Channel %d ",[ChannelNumber]:2
|
||||
DEBUGF 1, "Disk %d\n",[DiskNumber]:1
|
||||
call ReadHDD_ID
|
||||
cmp [DevErrorCode], 0
|
||||
jne FindHDD_2
|
||||
cmp [Sector512+6], word 16
|
||||
ja FindHDD_2
|
||||
cmp [Sector512+12], word 255
|
||||
ja FindHDD_2
|
||||
inc byte [DRIVE_DATA+1]
|
||||
jmp Print_Device_Name
|
||||
FindHDD_2:
|
||||
call DeviceReset
|
||||
cmp [DevErrorCode], 0
|
||||
jne FindHDD_2_2
|
||||
call ReadCD_ID
|
||||
cmp [DevErrorCode], 0
|
||||
jne FindHDD_2_2
|
||||
inc byte [DRIVE_DATA+1]
|
||||
inc byte [DRIVE_DATA+1]
|
||||
Print_Device_Name:
|
||||
pushad
|
||||
pushfd
|
||||
mov esi, Sector512+27*2
|
||||
mov edi, dev_name
|
||||
mov ecx, 20
|
||||
cld
|
||||
@@:
|
||||
lodsw
|
||||
xchg ah, al
|
||||
stosw
|
||||
loop @b
|
||||
popfd
|
||||
popad
|
||||
DEBUGF 1, "K : Dev: %s \n", dev_name
|
||||
|
||||
xor eax, eax
|
||||
mov ax, [Sector512+64*2]
|
||||
DEBUGF 1, "K : PIO mode %x\n", eax
|
||||
mov ax, [Sector512+63*2]
|
||||
DEBUGF 1, "K : Multiword DMA mode %x\n", eax
|
||||
mov ax, [Sector512+88*2]
|
||||
DEBUGF 1, "K : Ultra DMA mode %x\n", eax
|
||||
FindHDD_2_2:
|
||||
ret
|
||||
|
||||
FindHDD_3:
|
||||
call FindHDD_1
|
||||
shl byte [DRIVE_DATA+1], 2
|
||||
ret
|
||||
|
||||
; Адрес считываемого сектора в режиме LBA
|
||||
uglobal
|
||||
SectorAddress DD ?
|
||||
dev_name:
|
||||
rb 41
|
||||
endg
|
||||
;*************************************************
|
||||
;* ЧТЕНИЕ ИДЕНТИФИКАТОРА ЖЕСТКОГО ДИСКА *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* переменные: *
|
||||
;* ChannelNumber - номер канала (1 или 2); *
|
||||
;* DiskNumber - номер диска на канале (0 или 1). *
|
||||
;* Идентификационный блок данных считывается *
|
||||
;* в массив Sector512. *
|
||||
;*************************************************
|
||||
ReadHDD_ID:
|
||||
; Задать режим CHS
|
||||
mov [ATAAddressMode], 0
|
||||
; Послать команду идентификации устройства
|
||||
mov [ATAFeatures], 0
|
||||
mov [ATAHead], 0
|
||||
mov [ATACommand], 0ECh
|
||||
call SendCommandToHDD
|
||||
cmp [DevErrorCode], 0;проверить код ошибки
|
||||
jne @@End ;закончить, сохранив код ошибки
|
||||
mov DX, [ATABasePortAddr]
|
||||
add DX, 7 ;адрес регистра состояни
|
||||
mov ecx, 0xffff
|
||||
@@WaitCompleet:
|
||||
; Проверить время выполнения команды
|
||||
dec ecx
|
||||
; cmp ecx,0
|
||||
jz @@Error1 ;ошибка тайм-аута
|
||||
; Проверить готовность
|
||||
in AL, DX
|
||||
test AL, 80h ;состояние сигнала BSY
|
||||
jnz @@WaitCompleet
|
||||
test AL, 1 ;состояние сигнала ERR
|
||||
jnz @@Error6
|
||||
test AL, 08h ;состояние сигнала DRQ
|
||||
jz @@WaitCompleet
|
||||
; Принять блок данных от контроллера
|
||||
; mov AX,DS
|
||||
; mov ES,AX
|
||||
mov EDI, Sector512 ;offset Sector512
|
||||
mov DX, [ATABasePortAddr];регистр данных
|
||||
mov CX, 256 ;число считываемых слов
|
||||
rep insw ;принять блок данных
|
||||
ret
|
||||
; Записать код ошибки
|
||||
@@Error1:
|
||||
mov [DevErrorCode], 1
|
||||
ret
|
||||
@@Error6:
|
||||
mov [DevErrorCode], 6
|
||||
@@End:
|
||||
ret
|
||||
|
||||
|
||||
iglobal
|
||||
; Стандартные базовые адреса каналов 1 и 2
|
||||
StandardATABases DW 1F0h, 170h
|
||||
endg
|
||||
uglobal
|
||||
; Номер канала
|
||||
ChannelNumber DW ?
|
||||
; Номер диска
|
||||
DiskNumber DB ?
|
||||
; Базовый адрес группы портов контроллера ATA
|
||||
ATABasePortAddr DW ?
|
||||
; Параметры ATA-команды
|
||||
ATAFeatures DB ? ;особенности
|
||||
ATASectorCount DB ? ;количество обрабатываемых секторов
|
||||
ATASectorNumber DB ? ;номер начального сектора
|
||||
ATACylinder DW ? ;номер начального цилиндра
|
||||
ATAHead DB ? ;номер начальной головки
|
||||
ATAAddressMode DB ? ;режим адресации (0 - CHS, 1 - LBA)
|
||||
ATACommand DB ? ;код команды, подлежащей выполнению
|
||||
; Код ошибки (0 - нет ошибок, 1 - превышен допустимый
|
||||
; интервал ожидания, 2 - неверный код режима адресации,
|
||||
; 3 - неверный номер канала, 4 - неверный номер диска,
|
||||
; 5 - неверный номер головки, 6 - ошибка при выполнении
|
||||
; команды)
|
||||
DevErrorCode dd ?
|
||||
endg
|
||||
;****************************************************
|
||||
;* ПОСЛАТЬ КОМАНДУ ЗАДАННОМУ ДИСКУ *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* переменные: *
|
||||
;* ChannelNumber - номер канала (1 или 2); *
|
||||
;* DiskNumber - номер диска (0 или 1); *
|
||||
;* ATAFeatures - "особенности"; *
|
||||
;* ATASectorCount - количество секторов; *
|
||||
;* ATASectorNumber - номер начального сектора; *
|
||||
;* ATACylinder - номер начального цилиндра; *
|
||||
;* ATAHead - номер начальной головки; *
|
||||
;* ATAAddressMode - режим адресации (0-CHS, 1-LBA); *
|
||||
;* ATACommand - код команды. *
|
||||
;* После успешного выполнения функции: *
|
||||
;* в ATABasePortAddr - базовый адрес HDD; *
|
||||
;* в DevErrorCode - ноль. *
|
||||
;* При возникновении ошибки в DevErrorCode будет *
|
||||
;* возвращен код ошибки. *
|
||||
;****************************************************
|
||||
SendCommandToHDD:
|
||||
; Проверить значение кода режима
|
||||
cmp [ATAAddressMode], 1
|
||||
ja @@Err2
|
||||
; Проверить корректность номера канала
|
||||
mov BX, [ChannelNumber]
|
||||
cmp BX, 1
|
||||
jb @@Err3
|
||||
cmp BX, 2
|
||||
ja @@Err3
|
||||
; Установить базовый адрес
|
||||
dec BX
|
||||
shl BX, 1
|
||||
movzx ebx, bx
|
||||
mov AX, [ebx+StandardATABases]
|
||||
mov [ATABasePortAddr], AX
|
||||
; Ожидание готовности HDD к приему команды
|
||||
; Выбрать нужный диск
|
||||
mov DX, [ATABasePortAddr]
|
||||
add DX, 6 ;адрес регистра головок
|
||||
mov AL, [DiskNumber]
|
||||
cmp AL, 1 ;проверить номера диска
|
||||
ja @@Err4
|
||||
shl AL, 4
|
||||
or AL, 10100000b
|
||||
out DX, AL
|
||||
; Ожидать, пока диск не будет готов
|
||||
inc DX
|
||||
mov ecx, 0xfff
|
||||
; mov eax,[timer_ticks]
|
||||
; mov [TickCounter_1],eax
|
||||
@@WaitHDReady:
|
||||
; Проверить время ожидани
|
||||
dec ecx
|
||||
; cmp ecx,0
|
||||
jz @@Err1
|
||||
; mov eax,[timer_ticks]
|
||||
; sub eax,[TickCounter_1]
|
||||
; cmp eax,300 ;ожидать 300 тиков
|
||||
; ja @@Err1 ;ошибка тайм-аута
|
||||
; Прочитать регистр состояни
|
||||
in AL, DX
|
||||
; Проверить состояние сигнала BSY
|
||||
test AL, 80h
|
||||
jnz @@WaitHDReady
|
||||
; Проверить состояние сигнала DRQ
|
||||
test AL, 08h
|
||||
jnz @@WaitHDReady
|
||||
; Загрузить команду в регистры контроллера
|
||||
cli
|
||||
mov DX, [ATABasePortAddr]
|
||||
inc DX ;регистр "особенностей"
|
||||
mov AL, [ATAFeatures]
|
||||
out DX, AL
|
||||
inc DX ;счетчик секторов
|
||||
mov AL, [ATASectorCount]
|
||||
out DX, AL
|
||||
inc DX ;регистр номера сектора
|
||||
mov AL, [ATASectorNumber]
|
||||
out DX, AL
|
||||
inc DX ;номер цилиндра (младший байт)
|
||||
mov AX, [ATACylinder]
|
||||
out DX, AL
|
||||
inc DX ;номер цилиндра (старший байт)
|
||||
mov AL, AH
|
||||
out DX, AL
|
||||
inc DX ;номер головки/номер диска
|
||||
mov AL, [DiskNumber]
|
||||
shl AL, 4
|
||||
cmp [ATAHead], 0Fh;проверить номер головки
|
||||
ja @@Err5
|
||||
or AL, [ATAHead]
|
||||
or AL, 10100000b
|
||||
mov AH, [ATAAddressMode]
|
||||
shl AH, 6
|
||||
or AL, AH
|
||||
out DX, AL
|
||||
; Послать команду
|
||||
mov AL, [ATACommand]
|
||||
inc DX ;регистр команд
|
||||
out DX, AL
|
||||
sti
|
||||
; Сбросить признак ошибки
|
||||
mov [DevErrorCode], 0
|
||||
ret
|
||||
; Записать код ошибки
|
||||
@@Err1:
|
||||
mov [DevErrorCode], 1
|
||||
ret
|
||||
@@Err2:
|
||||
mov [DevErrorCode], 2
|
||||
ret
|
||||
@@Err3:
|
||||
mov [DevErrorCode], 3
|
||||
ret
|
||||
@@Err4:
|
||||
mov [DevErrorCode], 4
|
||||
ret
|
||||
@@Err5:
|
||||
mov [DevErrorCode], 5
|
||||
; Завершение работы программы
|
||||
ret
|
||||
|
||||
;*************************************************
|
||||
;* ЧТЕНИЕ ИДЕНТИФИКАТОРА УСТРОЙСТВА ATAPI *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* перменные: *
|
||||
;* ChannelNumber - номер канала; *
|
||||
;* DiskNumber - номер диска на канале. *
|
||||
;* Идентификационный блок данных считывается *
|
||||
;* в массив Sector512. *
|
||||
;*************************************************
|
||||
ReadCD_ID:
|
||||
; Задать режим CHS
|
||||
mov [ATAAddressMode], 0
|
||||
; Послать команду идентификации устройства
|
||||
mov [ATAFeatures], 0
|
||||
mov [ATASectorCount], 0
|
||||
mov [ATASectorNumber], 0
|
||||
mov [ATACylinder], 0
|
||||
mov [ATAHead], 0
|
||||
mov [ATACommand], 0A1h
|
||||
call SendCommandToHDD
|
||||
cmp [DevErrorCode], 0;проверить код ошибки
|
||||
jne @@End_1 ;закончить, сохранив код ошибки
|
||||
; Ожидать готовность данных HDD
|
||||
mov DX, [ATABasePortAddr]
|
||||
add DX, 7 ;порт 1х7h
|
||||
mov ecx, 0xffff
|
||||
@@WaitCompleet_1:
|
||||
; Проверить врем
|
||||
dec ecx
|
||||
; cmp ecx,0
|
||||
jz @@Error1_1 ;ошибка тайм-аута
|
||||
; Проверить готовность
|
||||
in AL, DX
|
||||
test AL, 80h ;состояние сигнала BSY
|
||||
jnz @@WaitCompleet_1
|
||||
test AL, 1 ;состояние сигнала ERR
|
||||
jnz @@Error6_1
|
||||
test AL, 08h ;состояние сигнала DRQ
|
||||
jz @@WaitCompleet_1
|
||||
; Принять блок данных от контроллера
|
||||
; mov AX,DS
|
||||
; mov ES,AX
|
||||
mov EDI, Sector512 ;offset Sector512
|
||||
mov DX, [ATABasePortAddr];порт 1x0h
|
||||
mov CX, 256;число считываемых слов
|
||||
rep insw
|
||||
ret
|
||||
; Записать код ошибки
|
||||
@@Error1_1:
|
||||
mov [DevErrorCode], 1
|
||||
ret
|
||||
@@Error6_1:
|
||||
mov [DevErrorCode], 6
|
||||
@@End_1:
|
||||
ret
|
||||
|
||||
;*************************************************
|
||||
;* СБРОС УСТРОЙСТВА *
|
||||
;* Входные параметры передаются через глобальные *
|
||||
;* переменные: *
|
||||
;* ChannelNumber - номер канала (1 или 2); *
|
||||
;* DiskNumber - номер диска (0 или 1). *
|
||||
;*************************************************
|
||||
DeviceReset:
|
||||
; Проверить корректность номера канала
|
||||
mov BX, [ChannelNumber]
|
||||
cmp BX, 1
|
||||
jb @@Err3_2
|
||||
cmp BX, 2
|
||||
ja @@Err3_2
|
||||
; Установить базовый адрес
|
||||
dec BX
|
||||
shl BX, 1
|
||||
movzx ebx, bx
|
||||
mov DX, [ebx+StandardATABases]
|
||||
mov [ATABasePortAddr], DX
|
||||
; Выбрать нужный диск
|
||||
add DX, 6 ;адрес регистра головок
|
||||
mov AL, [DiskNumber]
|
||||
cmp AL, 1 ;проверить номера диска
|
||||
ja @@Err4_2
|
||||
shl AL, 4
|
||||
or AL, 10100000b
|
||||
out DX, AL
|
||||
; Послать команду "Сброс"
|
||||
mov AL, 08h
|
||||
inc DX ;регистр команд
|
||||
out DX, AL
|
||||
mov ecx, 0x80000
|
||||
@@WaitHDReady_1:
|
||||
; Проверить время ожидани
|
||||
dec ecx
|
||||
; cmp ecx,0
|
||||
je @@Err1_2 ;ошибка тайм-аута
|
||||
; Прочитать регистр состояни
|
||||
in AL, DX
|
||||
; Проверить состояние сигнала BSY
|
||||
test AL, 80h
|
||||
jnz @@WaitHDReady_1
|
||||
; Сбросить признак ошибки
|
||||
mov [DevErrorCode], 0
|
||||
ret
|
||||
; Обработка ошибок
|
||||
@@Err1_2:
|
||||
mov [DevErrorCode], 1
|
||||
ret
|
||||
@@Err3_2:
|
||||
mov [DevErrorCode], 3
|
||||
ret
|
||||
@@Err4_2:
|
||||
mov [DevErrorCode], 4
|
||||
; Записать код ошибки
|
||||
ret
|
||||
|
||||
EndFindHDD:
|
||||
|
||||
15
kernel/branches/kolibri-process/detect/disks.inc
Normal file
15
kernel/branches/kolibri-process/detect/disks.inc
Normal file
@@ -0,0 +1,15 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
include 'dev_fd.inc'
|
||||
include 'dev_hdcd.inc'
|
||||
include 'getcache.inc'
|
||||
include 'sear_par.inc'
|
||||
|
||||
130
kernel/branches/kolibri-process/detect/getcache.inc
Normal file
130
kernel/branches/kolibri-process/detect/getcache.inc
Normal file
@@ -0,0 +1,130 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3742 $
|
||||
|
||||
pusha
|
||||
|
||||
mov eax, [pg_data.pages_free]
|
||||
; 1/32
|
||||
shr eax, 5
|
||||
; round off up to 8 pages
|
||||
shr eax, 3
|
||||
shl eax, 3
|
||||
; translate pages in butes *4096
|
||||
shl eax, 12
|
||||
; check a upper size of the cache, no more than 1 Mb on the physical device
|
||||
cmp eax, 1024*1024
|
||||
jbe @f
|
||||
mov eax, 1024*1024
|
||||
jmp .continue
|
||||
@@:
|
||||
; check a lower size of the cache, not less than 128 Kb on the physical device
|
||||
cmp eax, 128*1024
|
||||
jae @f
|
||||
mov eax, 128*1024
|
||||
@@:
|
||||
.continue:
|
||||
mov [cache_ide0_size], eax
|
||||
mov [cache_ide1_size], eax
|
||||
mov [cache_ide2_size], eax
|
||||
mov [cache_ide3_size], eax
|
||||
xor eax, eax
|
||||
mov [hdd_appl_data], 1;al
|
||||
mov [cd_appl_data], 1
|
||||
|
||||
test byte [DRIVE_DATA+1], 2
|
||||
je .ide2
|
||||
mov esi, cache_ide3
|
||||
call get_cache_ide
|
||||
.ide2:
|
||||
test byte [DRIVE_DATA+1], 8
|
||||
je .ide1
|
||||
mov esi, cache_ide2
|
||||
call get_cache_ide
|
||||
.ide1:
|
||||
test byte [DRIVE_DATA+1], 0x20
|
||||
je .ide0
|
||||
mov esi, cache_ide1
|
||||
call get_cache_ide
|
||||
.ide0:
|
||||
test byte [DRIVE_DATA+1], 0x80
|
||||
je @f
|
||||
mov esi, cache_ide0
|
||||
call get_cache_ide
|
||||
@@:
|
||||
jmp end_get_cache
|
||||
|
||||
get_cache_ide:
|
||||
and [esi+cache_ide0_search_start-cache_ide0], 0
|
||||
and [esi+cache_ide0_appl_search_start-cache_ide0], 0
|
||||
push ecx
|
||||
stdcall kernel_alloc, [esi+cache_ide0_size-cache_ide0]
|
||||
mov [esi+cache_ide0_pointer-cache_ide0], eax
|
||||
pop ecx
|
||||
mov edx, eax
|
||||
mov eax, [esi+cache_ide0_size-cache_ide0]
|
||||
shr eax, 3
|
||||
mov [esi+cache_ide0_system_data_size-cache_ide0], eax
|
||||
mov ebx, eax
|
||||
imul eax, 7
|
||||
mov [esi+cache_ide0_appl_data_size-cache_ide0], eax
|
||||
add ebx, edx
|
||||
mov [esi+cache_ide0_data_pointer-cache_ide0], ebx
|
||||
|
||||
.cd:
|
||||
push ecx
|
||||
mov eax, [esi+cache_ide0_system_data_size-cache_ide0]
|
||||
call calculate_for_cd
|
||||
add eax, [esi+cache_ide0_pointer-cache_ide0]
|
||||
mov [esi+cache_ide0_system_data-cache_ide0], eax
|
||||
mov [esi+cache_ide0_system_sad_size-cache_ide0], ecx
|
||||
|
||||
push edi
|
||||
mov edi, [esi+cache_ide0_pointer-cache_ide0]
|
||||
call clear_ide_cache
|
||||
pop edi
|
||||
|
||||
mov eax, [esi+cache_ide0_appl_data_size-cache_ide0]
|
||||
call calculate_for_cd
|
||||
add eax, [esi+cache_ide0_data_pointer-cache_ide0]
|
||||
mov [esi+cache_ide0_appl_data-cache_ide0], eax
|
||||
mov [esi+cache_ide0_appl_sad_size-cache_ide0], ecx
|
||||
|
||||
push edi
|
||||
mov edi, [esi+cache_ide0_data_pointer-cache_ide0]
|
||||
call clear_ide_cache
|
||||
pop edi
|
||||
|
||||
pop ecx
|
||||
ret
|
||||
|
||||
calculate_for_cd:
|
||||
push eax
|
||||
mov ebx, eax
|
||||
shr eax, 11
|
||||
shl eax, 3
|
||||
sub ebx, eax
|
||||
shr ebx, 11
|
||||
mov ecx, ebx
|
||||
shl ebx, 11
|
||||
pop eax
|
||||
sub eax, ebx
|
||||
dec ecx
|
||||
ret
|
||||
|
||||
clear_ide_cache:
|
||||
push eax
|
||||
shl ecx, 1
|
||||
xor eax, eax
|
||||
cld
|
||||
rep stosd
|
||||
pop eax
|
||||
ret
|
||||
|
||||
end_get_cache:
|
||||
popa
|
||||
139
kernel/branches/kolibri-process/detect/sear_par.inc
Normal file
139
kernel/branches/kolibri-process/detect/sear_par.inc
Normal file
@@ -0,0 +1,139 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3742 $
|
||||
|
||||
search_partitions:
|
||||
; 1. Fill missing parameters in HD_DATA structures.
|
||||
mov eax, [hd_address_table]
|
||||
mov [hd0_data.hdbase], eax ;0x1f0
|
||||
mov [hd1_data.hdbase], eax
|
||||
mov eax, [hd_address_table+16]
|
||||
mov [hd2_data.hdbase], eax
|
||||
mov [hd3_data.hdbase], eax
|
||||
; 2. Notify the system about /hd* disks.
|
||||
; For every existing disk, call ide_disk_add with correct parameters.
|
||||
; Generate name "hdN" on the stack; this is 4 bytes including terminating zero.
|
||||
; 2a. /hd0: exists if mask 0x40 in [DRIVE_DATA+1] is set,
|
||||
; data: hd0_data,
|
||||
; number of partitions: [DRIVE_DATA+2]
|
||||
test [DRIVE_DATA+1], byte 0x40
|
||||
jz @f
|
||||
push 'hd0'
|
||||
mov eax, esp ; name
|
||||
mov edx, hd0_data
|
||||
call ide_disk_add
|
||||
mov [DRIVE_DATA+2], al
|
||||
pop ecx ; restore the stack
|
||||
@@:
|
||||
; 2b. /hd1: exists if mask 0x10 in [DRIVE_DATA+1] is set,
|
||||
; data: hd1_data,
|
||||
; number of partitions: [DRIVE_DATA+3]
|
||||
test [DRIVE_DATA+1], byte 0x10
|
||||
jz @f
|
||||
push 'hd1'
|
||||
mov eax, esp
|
||||
mov edx, hd1_data
|
||||
call ide_disk_add
|
||||
mov [DRIVE_DATA+3], al
|
||||
pop ecx
|
||||
@@:
|
||||
; 2c. /hd2: exists if mask 4 in [DRIVE_DATA+1] is set,
|
||||
; data: hd2_data,
|
||||
; number of partitions: [DRIVE_DATA+4]
|
||||
test [DRIVE_DATA+1], byte 4
|
||||
jz @f
|
||||
push 'hd2'
|
||||
mov eax, esp
|
||||
mov edx, hd2_data
|
||||
call ide_disk_add
|
||||
mov [DRIVE_DATA+4], al
|
||||
pop ecx
|
||||
@@:
|
||||
; 2d. /hd3: exists if mask 1 in [DRIVE_DATA+1] is set,
|
||||
; data: hd3_data,
|
||||
; number of partitions: [DRIVE_DATA+5]
|
||||
test [DRIVE_DATA+1], byte 1
|
||||
jz @f
|
||||
push 'hd3'
|
||||
mov eax, esp
|
||||
mov edx, hd3_data
|
||||
call ide_disk_add
|
||||
mov [DRIVE_DATA+5], al
|
||||
pop ecx
|
||||
@@:
|
||||
; 3. Notify the system about /bd* disks.
|
||||
; 3a. Check whether there are BIOS disks. If no, skip step 3.
|
||||
xor esi, esi
|
||||
cmp esi, [NumBiosDisks]
|
||||
jz .nobd
|
||||
; Loop over all disks.
|
||||
push 0
|
||||
push 'bd'
|
||||
.bdloop:
|
||||
; 3b. Get the drive number for using in /bd* name.
|
||||
movzx eax, byte [BiosDisksData+esi*4]
|
||||
sub al, 80h
|
||||
; 3c. Convert eax to decimal and store starting with [esp+3].
|
||||
; First 2 bytes in [esp] are "bd".
|
||||
lea edi, [esp+2]
|
||||
; store digits in the stack, ending with -'0'
|
||||
push -'0'
|
||||
@@:
|
||||
xor edx, edx
|
||||
iglobal
|
||||
align 4
|
||||
_10 dd 10
|
||||
endg
|
||||
div [_10]
|
||||
push edx
|
||||
test eax, eax
|
||||
jnz @b
|
||||
; restore digits from the stack, this reverses the order;
|
||||
; add '0', stop, when zero is reached
|
||||
@@:
|
||||
pop eax
|
||||
add al, '0'
|
||||
stosb
|
||||
jnz @b
|
||||
; 3e. Call the API with userdata = 80h + ecx.
|
||||
mov eax, esp
|
||||
lea edx, [esi+80h]
|
||||
stdcall disk_add, bd_callbacks, eax, edx, 0
|
||||
test eax, eax
|
||||
jz @f
|
||||
stdcall disk_media_changed, eax, 1
|
||||
@@:
|
||||
; 3f. Continue the loop.
|
||||
inc esi
|
||||
cmp esi, [NumBiosDisks]
|
||||
jnz .bdloop
|
||||
pop ecx ecx ; restore stack after name
|
||||
.nobd:
|
||||
jmp end_search_partitions
|
||||
|
||||
; Helper procedure for search_partitions, adds one IDE disk.
|
||||
; For compatibility, number of partitions for IDE disks is kept in a separate variable,
|
||||
; so the procedure returns number of partitions.
|
||||
; eax -> name, edx -> disk data
|
||||
proc ide_disk_add
|
||||
stdcall disk_add, ide_callbacks, eax, edx, 0
|
||||
test eax, eax
|
||||
jz @f
|
||||
push eax
|
||||
stdcall disk_media_changed, eax, 1
|
||||
pop eax
|
||||
mov eax, [eax+DISK.NumPartitions]
|
||||
cmp eax, 255
|
||||
jbe @f
|
||||
mov eax, 255
|
||||
@@:
|
||||
ret
|
||||
endp
|
||||
|
||||
end_search_partitions:
|
||||
|
||||
158
kernel/branches/kolibri-process/detect/vortex86.inc
Normal file
158
kernel/branches/kolibri-process/detect/vortex86.inc
Normal file
@@ -0,0 +1,158 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
; 20/11/2013 yogev_ezra: Initial version (Vortex86 SoC type detection)
|
||||
; 26/11/2013 yogev_ezra: Added CPU speed modifier and MMX support flag detection
|
||||
; Thanks for help to: dunkaist, eAndrew, hidnplayr, Mario
|
||||
|
||||
$Revision: 4310 $
|
||||
|
||||
VORTEX86DEBUG = 0 ; For testing in emulators and in non-Vortex86 CPU computers, set this to 1
|
||||
VORTEX86DEBUGVALUE = 0x35504d44 ; FAKE port output = used for testing
|
||||
NORTH_BRIDGE = 0x80000000 ; Base address of Vortex86 PCI North Bridge
|
||||
SOUTH_BRIDGE = 0x80003800 ; Base address of Vortex86 PCI South Bridge
|
||||
|
||||
; Detect Vortex86 CPU and generate CPU name in string format (PCI address at 93H~90H in Vortex86 North Bridge contains SoC type)
|
||||
; Available Vortex86 CPU codes taken from Coreboot project. New codes should be added to "Vortex86SoClist" below
|
||||
; #define DMP_CPUID_SX 0x31504d44 ("DMP1")
|
||||
; #define DMP_CPUID_DX 0x32504d44 ("DMP2")
|
||||
; #define DMP_CPUID_MX 0x33504d44 ("DMP3")
|
||||
; #define DMP_CPUID_DX2 0x34504d44 ("DMP4")
|
||||
; #define DMP_CPUID_MX_PLUS 0x35504d44 ("DMP5")
|
||||
; #define DMP_CPUID_EX 0x37504d44 ("DMP7")
|
||||
|
||||
iglobal
|
||||
Vortex86CPUcode dd ? ; Vortex86 CPU code in HEX format (4 bytes), can be shown as string if converted to ASCII characters
|
||||
Vortex86CPUid db 0 ; Vortex86 CPU id in integer format (1=Vortex86SX, 2=Vortex86DX, ...)
|
||||
Vortex86SoCname db 'Vortex86 ',0 ; This variable will hold the full name of Vortex86 SoC
|
||||
Vortex86SoClist: ; List of Vortex86 CPUs known today. Add new record to this list when new CPU becomes available
|
||||
db 0x31, 'SX ' ; id=1
|
||||
db 0x32, 'DX ' ; id=2
|
||||
db 0x33, 'MX ' ; id=3 MMX is available starting from CPU code 'MX' (id=3)
|
||||
db 0x34, 'DX2' ; id=4
|
||||
db 0x35, 'MX+' ; id=5
|
||||
db 0x37, 'EX ' ; id=7
|
||||
Vortex86SoCnum = ($ - Vortex86SoClist) / 4 ; Calculate the total number of known Vortex86 CPUs
|
||||
endg
|
||||
|
||||
; When in debug mode, perform SoC detection regardless of the actual CPU vendor (even for vendors other than DMP)
|
||||
; When in normal (not debug) mode, check the CPU vendor first, and perform SoC detection only if vendor is 'Vortex86 SoC'
|
||||
if ~ VORTEX86DEBUG
|
||||
cmp [cpu_vendor], 'Vort'
|
||||
jnz .Vortex86end ; If the CPU vendor is not 'Vortex86 SoC', skip the SoC detection
|
||||
end if
|
||||
|
||||
mov eax, NORTH_BRIDGE+0x90 ; 0x80000090 = PCI Configuration Address Register to read from (32-bit register - accessed as DWORD)
|
||||
call .Vortex86PCIreg ; Get the CPU code from Vortex86 SoC North Bridge PCI register (Register Offset: 93H~90H)
|
||||
|
||||
if VORTEX86DEBUG ; When in debug mode, pretend that we received port output equal to "VORTEX86DEBUGVALUE"
|
||||
mov eax, VORTEX86DEBUGVALUE
|
||||
end if
|
||||
|
||||
DEBUGF 1, "K : Vortex86 SoC type register (93H~90H) returned 0x"
|
||||
test eax, eax ; Check whether the port output was '\0'
|
||||
jz .nullPCIoutput ; In case the result is '\0' (NULL), skip further testing and exit
|
||||
mov [Vortex86CPUcode], eax ; Save HEX CPU code to Vortex86CPUcode (so it can be used later)
|
||||
DEBUGF 1, "%x (%s): ", eax, Vortex86CPUcode ; Print the CPU code (as HEX and as string) to debug log
|
||||
|
||||
mov ebx, 0x444d5000 ; Apply Vortex86 CPU code mask (all Vortex86 SoC have ID in form of "0xNN504d44")
|
||||
bswap eax ; Assumed it is Vortex86 SoC, the highest byte identifies the exact CPU, so move it to the lowest byte
|
||||
mov bl, al ; Copy SoC type to BL since EAX (that includes AL) is used implicitly in "LODSD" command below
|
||||
cmp eax, ebx ; Now see whether the 3 higher bytes were "0x504d44" (which means it's Vortex86)
|
||||
jnz .notVortex86 ; If it's not Vortex86 - go say so and exit
|
||||
|
||||
sub al, 0x30 ; Current Vortex86 CPU codes are in the range of 31h-37h, so convert them to integer (1,2,...)
|
||||
mov [Vortex86CPUid], al ; Save the CPUid (1=Vortex86SX, 2=Vortex86DX, ..., 7=Vortex86EX, ...)
|
||||
|
||||
mov esi, Vortex86SoClist ; ESI points to the start of Vortex86SoClist (used implicitly in "LODSD" command below)
|
||||
xor ecx, ecx ; Zero ECX (it is used as counter)
|
||||
cld ; Clears the DF flag in the EFLAGS register (DF=0 --> String operations increment ESI)
|
||||
@@:
|
||||
inc ecx ; Increment our counter
|
||||
cmp ecx, Vortex86SoCnum ; Check if we iterated Vortex86SoCnum times already (i.e. went over the entire Vortex86SoClist)
|
||||
ja .unknownVortex86 ; If the entire list was tested and our CPU is not in that list, it is unknown Vortex86 SoC
|
||||
lodsd ; Load DWORD at address DS:ESI into EAX (puts 1 line from Vortex86SoClist into EAX, then increments ESI)
|
||||
cmp bl, al ; Check if our CPU matches the current record in the list
|
||||
jne @b ; No match --> repeat with next record
|
||||
|
||||
shr eax, 8 ; Match found --> drop the SoC type code from Vortex86SoClist name and replace it with \0
|
||||
mov dword [Vortex86SoCname+8], eax ; Concatenate it with prefix to receive complete SoC name (\0 is string termination)
|
||||
|
||||
DEBUGF 1, "%s (id=%d)\n", Vortex86SoCname, [Vortex86CPUid]:1 ; Say what we have found (CPU name and id)
|
||||
jmp .Vortex86
|
||||
|
||||
.notVortex86: ; In case this register is used by other CPUs for other purpose, it's interesting what it contains
|
||||
DEBUGF 1, "not a Vortex86 CPU\n"
|
||||
jmp .Vortex86end
|
||||
|
||||
.unknownVortex86: ; It is Vortex86 CPU, but it's not in the list above
|
||||
DEBUGF 1, "unknown Vortex86 CPU (id=%d)\n", [Vortex86CPUid]:1 ; Inform the user that the CPU is Vortex86 but name is unknown
|
||||
|
||||
.Vortex86:
|
||||
mov eax, NORTH_BRIDGE+0x60 ; 0x80000060 = PCI Configuration Address Register to read from (32-bit register - accessed as DWORD)
|
||||
call .Vortex86PCIreg ; Get current flags of Vortex86SoC North Bridge STRAP Register (Register Offset: 63h~60h)
|
||||
DEBUGF 1, "K : Vortex86 STRAP Register (63h~60h) returned 0x%x\n",eax
|
||||
|
||||
mov eax, SOUTH_BRIDGE+0xC0 ; 0x800038C0 = PCI Configuration Address Register to read from (32-bit register - accessed as DWORD)
|
||||
call .Vortex86PCIreg ; Flags of Vortex86 South Bridge Internal Peripheral Feature Control Register (Register Offset: C3h~C0h)
|
||||
DEBUGF 1, "K : Vortex86 Internal Peripheral Feature Control Register (C3h~C0h) returned 0x%x\n",eax
|
||||
|
||||
mov eax, SOUTH_BRIDGE+0xCC ; 0x800038CC = PCI Configuration Address Register to read from (8-bit register - accessed as BYTE)
|
||||
call .Vortex86PCIreg ; Flags of Vortex86 South Bridge Internal Peripheral Feature Control Register III (Register Offset: CCh)
|
||||
DEBUGF 1, "K : Vortex86 Internal Peripheral Feature Control Register III (CCh) returned 0x%x\n",al
|
||||
|
||||
mov eax, NORTH_BRIDGE+0xA0 ; 0x800000A0 = PCI Configuration Address Register to read from (32-bit register - accessed as DWORD)
|
||||
call .Vortex86PCIreg ; Get current flags of Vortex86SoC North Bridge Host Control Register (Register Offset: A3h~A0h)
|
||||
DEBUGF 1, "K : Vortex86 Host Control Register (A3h~A0h) returned 0x%x: CPU speed is ",eax
|
||||
mov bl, al ; The lower byte of Vortex86 Host Control Register contains CPU speed modifier and MMX support status
|
||||
mov bh, al ; Backup the current AL value, so later we can test whether the value has changed
|
||||
and bl, 00000111b ; CPU speed modifier is stored in bits 0-2. Value=0 means MAX speed, other values - speed reduction
|
||||
jz .Vortex86CPUspeedMAX ; 0s in bits 0-2: CPU is at MAX speed (no need to modify)
|
||||
inc ebx ; The actual value is 1 less than 'Divide by' setting (value '001' means 'Divide by 2', etc.)
|
||||
DEBUGF 1, "reduced (divide by %d).\nK : Vortex86 changing CPU speed to ", bl ; Print the current CPU speed modifier to the log
|
||||
and al, 11111000b ; At least one of the bits 0-2 contains 1: CPU is at reduced speed. Set bits 0-2 to 0s to change to MAX
|
||||
.Vortex86CPUspeedMAX:
|
||||
DEBUGF 1, "MAX\n" ; Now the CPU should be running at MAX speed (don't write the value to PCI port yet)
|
||||
|
||||
cmp [Vortex86CPUid], 3 ; MMX is available starting from CPU code 'MX' (id=3)
|
||||
jb .skipVortex86MMX ; No MMX support - skip MMX support status detection (for id=1,2)
|
||||
DEBUGF 1, "K : Vortex86 MMX support status: MMX is " ; Bits 5-6 in Host Control Register contain MMX status
|
||||
test al, 100000b ; On MMX-capable Vortex86 SoC, Bit5 = is MMX enabled? (1=Yes/0=No)
|
||||
jnz .Vortex86MMXenabled ; MMX is already enabled (Bit5=1)
|
||||
DEBUGF 1, "DISABLED - enabling it for this session\n" ; Print to the log that MMX is disabled
|
||||
or al, 100000b ; Enable MMX support (don't write the value to PCI port yet)
|
||||
jmp .AfterMMXenabled
|
||||
.Vortex86MMXenabled:
|
||||
DEBUGF 1, "ENABLED\n" ; Print to the log that MMX is enabled
|
||||
.AfterMMXenabled:
|
||||
DEBUGF 1, "K : Vortex86 MMX report to CPUID: " ; Print to the log what CPUID command knowns about MMX support
|
||||
test al, 1000000b ; On MMX-capable Vortex86 SoC, Bit6 = report MMX support to CPUID? (1=Yes/0=No)
|
||||
jnz .Vortex86MMXreported ; MMX is already reported to CPUID (Bit6=1)
|
||||
DEBUGF 1, "OFF - turning it ON for this session\n" ; Print to the log that MMX will now be reported to CPUID
|
||||
or al, 1000000b ; Turn on MMX reporting to CPUID (don't write the value to PCI port yet)
|
||||
jmp .skipVortex86MMX
|
||||
.Vortex86MMXreported:
|
||||
DEBUGF 1, "ON\n" ; Print to the log that MMX reporting to CPUID is enabled
|
||||
|
||||
.skipVortex86MMX:
|
||||
cmp bh, al ; Check whether AL has changed before (if it did, we need to write it back to PCI port)
|
||||
jz .Vortex86end ; No change - no need to write to the port
|
||||
out dx, al ; Write the changed data to PCI port
|
||||
DEBUGF 1, "K : Vortex86 Host Control Register (A3h~A0h) new value is 0x%x\n",eax
|
||||
jmp .Vortex86end
|
||||
|
||||
.Vortex86PCIreg: ; Procedure receives input register value in EAX, and returns the output value also in EAX
|
||||
mov dx, 0xcf8 ; CF8h = Vortex86 PCI Configuration Address port
|
||||
out dx, eax ; Send request to PCI address port to retrieve data from this address
|
||||
mov dl, 0xfc ; CFCh = Vortex86 PCI Configuration Data port
|
||||
in eax, dx ; Read data from PCI data port
|
||||
ret
|
||||
|
||||
.nullPCIoutput: ; Emulators and non-Vortex86 CPU computers will usually return \0 in this register
|
||||
DEBUGF 1, "0 (NULL)\n"
|
||||
|
||||
.Vortex86end:
|
||||
167
kernel/branches/kolibri-process/encoding.inc
Normal file
167
kernel/branches/kolibri-process/encoding.inc
Normal file
@@ -0,0 +1,167 @@
|
||||
; fetch the UTF-8 character in string+offs to char
|
||||
; common part for all encodings: translate pseudographics
|
||||
; Pseudographics for the boot screen:
|
||||
; 0x2500 -> 0xC4, 0x2502 -> 0xB3, 0x250C -> 0xDA, 0x2510 -> 0xBF,
|
||||
; 0x2514 -> 0xC0, 0x2518 -> 0xD9, 0x252C -> 0xC2, 0x2534 -> 0xC1, 0x2551 -> 0xBA
|
||||
macro fetch_utf8_char string, offs, char, graph
|
||||
{ local first_byte, b
|
||||
virtual at 0
|
||||
db string
|
||||
if offs >= $
|
||||
char = -1
|
||||
else
|
||||
; fetch first byte
|
||||
load first_byte byte from offs
|
||||
if first_byte < 0x80
|
||||
char = first_byte
|
||||
offs = offs + 1
|
||||
else if first_byte < 0xC0
|
||||
.err Invalid UTF-8 string
|
||||
else if first_byte < 0xE0
|
||||
char = first_byte and 0x1F
|
||||
load b byte from offs + 1
|
||||
char = (char shl 6) + (b and 0x3F)
|
||||
offs = offs + 2
|
||||
else if first_byte < 0xF0
|
||||
char = first_byte and 0xF
|
||||
load b byte from offs + 1
|
||||
char = (char shl 6) + (b and 0x3F)
|
||||
load b byte from offs + 2
|
||||
char = (char shl 6) + (b and 0x3F)
|
||||
offs = offs + 3
|
||||
else if first_byte < 0xF8
|
||||
char = first_byte and 0x7
|
||||
load b byte from offs + 1
|
||||
char = (char shl 6) + (b and 0x3F)
|
||||
load b byte from offs + 2
|
||||
char = (char shl 6) + (b and 0x3F)
|
||||
load b byte from offs + 3
|
||||
char = (char shl 6) + (b and 0x3F)
|
||||
offs = offs + 4
|
||||
else
|
||||
.err Invalid UTF-8 string
|
||||
end if
|
||||
end if
|
||||
end virtual
|
||||
if char = 0x2500
|
||||
graph = 0xC4
|
||||
else if char = 0x2502
|
||||
graph = 0xB3
|
||||
else if char = 0x250C
|
||||
graph = 0xDA
|
||||
else if char = 0x2510
|
||||
graph = 0xBF
|
||||
else if char = 0x2514
|
||||
graph = 0xC0
|
||||
else if char = 0x2518
|
||||
graph = 0xD9
|
||||
else if char = 0x252C
|
||||
graph = 0xC2
|
||||
else if char = 0x2534
|
||||
graph = 0xC1
|
||||
else if char = 0x2551
|
||||
graph = 0xBA
|
||||
else
|
||||
graph = 0
|
||||
end if
|
||||
}
|
||||
|
||||
; Russian: use CP866.
|
||||
; 0x00-0x7F - trivial map
|
||||
; 0x410-0x43F -> 0x80-0xAF
|
||||
; 0x440-0x44F -> 0xE0-0xEF
|
||||
; 0x401 -> 0xF0, 0x451 -> 0xF1
|
||||
macro cp866 [arg]
|
||||
{ local offs, char, graph
|
||||
offs = 0
|
||||
while 1
|
||||
fetch_utf8_char arg, offs, char, graph
|
||||
if char = -1
|
||||
break
|
||||
end if
|
||||
if graph
|
||||
db graph
|
||||
else if char < 0x80
|
||||
db char
|
||||
else if char = 0x401
|
||||
db 0xF0
|
||||
else if char = 0x451
|
||||
db 0xF1
|
||||
else if (char < 0x410) | (char > 0x44F)
|
||||
.err Failed to convert to CP866
|
||||
else if char < 0x440
|
||||
db char - 0x410 + 0x80
|
||||
else
|
||||
db char - 0x440 + 0xE0
|
||||
end if
|
||||
end while
|
||||
}
|
||||
|
||||
struc cp866 [arg]
|
||||
{
|
||||
common
|
||||
cp866 arg
|
||||
}
|
||||
|
||||
; Latin-1 encoding
|
||||
; 0x00-0xFF - trivial map
|
||||
macro latin1 [arg]
|
||||
{ local offs, char, graph
|
||||
offs = 0
|
||||
while 1
|
||||
fetch_utf8_char arg, offs, char, graph
|
||||
if char = -1
|
||||
break
|
||||
end if
|
||||
if graph
|
||||
db graph
|
||||
else if char < 0x100
|
||||
db char
|
||||
else
|
||||
.err Failed to convert to Latin-1
|
||||
end if
|
||||
end while
|
||||
}
|
||||
|
||||
struc latin1 [arg]
|
||||
{
|
||||
common
|
||||
latin1 arg
|
||||
}
|
||||
|
||||
; CP850 encoding
|
||||
macro cp850 [arg]
|
||||
{ local offs, char, graph
|
||||
offs = 0
|
||||
while 1
|
||||
fetch_utf8_char arg, offs, char, graph
|
||||
if char = -1
|
||||
break
|
||||
end if
|
||||
if graph
|
||||
db graph
|
||||
else if char < 0x80
|
||||
db char
|
||||
else if char = 0xBF
|
||||
db 0xA8
|
||||
else if char = 0xE1
|
||||
db 0xA0
|
||||
else if char = 0xE9
|
||||
db 0x82
|
||||
else if char = 0xED
|
||||
db 0xA1
|
||||
else if char = 0xF3
|
||||
db 0xA2
|
||||
else if char = 0xFA
|
||||
db 0xA3
|
||||
else
|
||||
err Failed to convert to CP850
|
||||
end if
|
||||
end while
|
||||
}
|
||||
|
||||
struc cp850 [arg]
|
||||
{
|
||||
common
|
||||
cp850 arg
|
||||
}
|
||||
441
kernel/branches/kolibri-process/fdo.inc
Normal file
441
kernel/branches/kolibri-process/fdo.inc
Normal file
@@ -0,0 +1,441 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3614 $
|
||||
|
||||
_esp equ esp
|
||||
|
||||
;
|
||||
; Formatted Debug Output (FDO)
|
||||
; Copyright (c) 2005-2006, mike.dld
|
||||
; Created: 2005-01-29, Changed: 2006-11-10
|
||||
;
|
||||
; For questions and bug reports, mail to mike.dld@gmail.com
|
||||
;
|
||||
; Available format specifiers are: %s, %d, %u, %x (with partial width support)
|
||||
;
|
||||
|
||||
; to be defined:
|
||||
; __DEBUG__ equ 1
|
||||
; __DEBUG_LEVEL__ equ 5
|
||||
|
||||
macro debug_func name {
|
||||
if used name
|
||||
name@of@func equ name
|
||||
}
|
||||
|
||||
macro debug_beginf {
|
||||
align 4
|
||||
name@of@func:
|
||||
}
|
||||
|
||||
debug_endf fix end if
|
||||
|
||||
macro DEBUGS _sign,[_str] {
|
||||
common
|
||||
local tp
|
||||
tp equ 0
|
||||
match _arg:_num,_str \{
|
||||
DEBUGS_N _sign,_num,_arg
|
||||
tp equ 1
|
||||
\}
|
||||
match =0 _arg,tp _str \{
|
||||
DEBUGS_N _sign,,_arg
|
||||
\}
|
||||
}
|
||||
|
||||
macro DEBUGS_N _sign,_num,[_str] {
|
||||
common
|
||||
pushf
|
||||
pushad
|
||||
local ..str,..label,is_str
|
||||
is_str = 0
|
||||
forward
|
||||
if _str eqtype ''
|
||||
is_str = 1
|
||||
end if
|
||||
common
|
||||
if is_str = 1
|
||||
jmp ..label
|
||||
..str db _str,0
|
||||
..label:
|
||||
mov edx, ..str
|
||||
else
|
||||
esp equ esp+4*8+4
|
||||
mov edx, _str
|
||||
esp equ _esp
|
||||
end if
|
||||
if ~_num eq
|
||||
if _num eqtype eax
|
||||
if _num in <eax,ebx,ecx,edx,edi,ebp,esp>
|
||||
mov esi, _num
|
||||
else if ~_num eq esi
|
||||
movzx esi, _num
|
||||
end if
|
||||
else if _num eqtype 0
|
||||
mov esi, _num
|
||||
else
|
||||
local tp
|
||||
tp equ 0
|
||||
match [_arg],_num \{
|
||||
mov esi, dword[_arg]
|
||||
tp equ 1
|
||||
\}
|
||||
match =0 =dword[_arg],tp _num \{
|
||||
mov esi, dword[_arg]
|
||||
tp equ 1
|
||||
\}
|
||||
match =0 =word[_arg],tp _num \{
|
||||
movzx esi, word[_arg]
|
||||
tp equ 1
|
||||
\}
|
||||
match =0 =byte[_arg],tp _num \{
|
||||
movzx esi, byte[_arg]
|
||||
tp equ 1
|
||||
\}
|
||||
match =0,tp \{
|
||||
'Error: specified string width is incorrect'
|
||||
\}
|
||||
end if
|
||||
else
|
||||
mov esi, 0x7FFFFFFF
|
||||
end if
|
||||
call fdo_debug_outstr
|
||||
popad
|
||||
popf
|
||||
}
|
||||
|
||||
macro DEBUGD _sign,_dec {
|
||||
local tp
|
||||
tp equ 0
|
||||
match _arg:_num,_dec \{
|
||||
DEBUGD_N _sign,_num,_arg
|
||||
tp equ 1
|
||||
\}
|
||||
match =0 _arg,tp _dec \{
|
||||
DEBUGD_N _sign,,_arg
|
||||
\}
|
||||
}
|
||||
|
||||
macro DEBUGD_N _sign,_num,_dec {
|
||||
pushf
|
||||
pushad
|
||||
if (~_num eq)
|
||||
if (_dec eqtype eax | _dec eqtype 0)
|
||||
'Error: precision allowed only for in-memory variables'
|
||||
end if
|
||||
if (~_num in <1,2,4>)
|
||||
if _sign
|
||||
'Error: 1, 2 and 4 are only allowed for precision in %d'
|
||||
else
|
||||
'Error: 1, 2 and 4 are only allowed for precision in %u'
|
||||
end if
|
||||
end if
|
||||
end if
|
||||
if _dec eqtype eax
|
||||
if _dec in <ebx,ecx,edx,esi,edi,ebp,esp>
|
||||
mov eax, _dec
|
||||
else if ~_dec eq eax
|
||||
if _sign = 1
|
||||
movsx eax, _dec
|
||||
else
|
||||
movzx eax, _dec
|
||||
end if
|
||||
end if
|
||||
else if _dec eqtype 0
|
||||
mov eax, _dec
|
||||
else
|
||||
; add esp,4*8+4
|
||||
esp equ esp+4*8+4
|
||||
if _num eq
|
||||
mov eax, dword _dec
|
||||
else if _num = 1
|
||||
if _sign = 1
|
||||
movsx eax, byte _dec
|
||||
else
|
||||
movzx eax, byte _dec
|
||||
end if
|
||||
else if _num = 2
|
||||
if _sign = 1
|
||||
movsx eax, word _dec
|
||||
else
|
||||
movzx eax, word _dec
|
||||
end if
|
||||
else
|
||||
mov eax, dword _dec
|
||||
end if
|
||||
esp equ _esp
|
||||
; sub esp,4*8+4
|
||||
end if
|
||||
mov cl, _sign
|
||||
call fdo_debug_outdec
|
||||
popad
|
||||
popf
|
||||
}
|
||||
|
||||
macro DEBUGH _sign,_hex {
|
||||
local tp
|
||||
tp equ 0
|
||||
match _arg:_num,_hex \{
|
||||
DEBUGH_N _sign,_num,_arg
|
||||
tp equ 1
|
||||
\}
|
||||
match =0 _arg,tp _hex \{
|
||||
DEBUGH_N _sign,,_arg
|
||||
\}
|
||||
}
|
||||
|
||||
macro DEBUGH_N _sign,_num,_hex {
|
||||
pushf
|
||||
pushad
|
||||
if (~_num eq) & (~_num in <1,2,3,4,5,6,7,8>)
|
||||
'Error: 1..8 are only allowed for precision in %x'
|
||||
end if
|
||||
if _hex eqtype eax
|
||||
if _hex in <eax,ebx,ecx,edx,esi,edi,ebp,esp>
|
||||
if ~_hex eq eax
|
||||
mov eax, _hex
|
||||
end if
|
||||
mov edx, 8
|
||||
else if _hex in <ax,bx,cx,dx,si,di,bp,sp>
|
||||
if ~_hex eq ax
|
||||
movzx eax, _hex
|
||||
end if
|
||||
if (_num eq)
|
||||
mov edx, 4
|
||||
end if
|
||||
else if _hex in <al,ah,bl,bh,cl,ch,dl,dh>
|
||||
if ~_hex eq al
|
||||
movzx eax, _hex
|
||||
end if
|
||||
if (_num eq)
|
||||
mov edx, 2
|
||||
end if
|
||||
end if
|
||||
else if _hex eqtype 0
|
||||
mov eax, _hex
|
||||
else
|
||||
; add esp,4*8+4
|
||||
esp equ esp+4*8+4
|
||||
mov eax, dword _hex
|
||||
esp equ _esp
|
||||
; sub esp,4*8+4
|
||||
end if
|
||||
if ~_num eq
|
||||
mov edx, _num
|
||||
else
|
||||
if ~_hex eqtype eax
|
||||
mov edx, 8
|
||||
end if
|
||||
end if
|
||||
call fdo_debug_outhex
|
||||
popad
|
||||
popf
|
||||
}
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
|
||||
debug_func fdo_debug_outchar
|
||||
debug_beginf
|
||||
pushad
|
||||
movzx ecx, al
|
||||
mov ebx, 1
|
||||
call sys_msg_board
|
||||
popad
|
||||
ret
|
||||
debug_endf
|
||||
|
||||
debug_func fdo_debug_outstr
|
||||
debug_beginf
|
||||
mov ebx, 1
|
||||
.l1:
|
||||
dec esi
|
||||
js .l2
|
||||
movzx ecx, byte[edx]
|
||||
or cl, cl
|
||||
jz .l2
|
||||
call sys_msg_board
|
||||
inc edx
|
||||
jmp .l1
|
||||
.l2:
|
||||
ret
|
||||
debug_endf
|
||||
|
||||
debug_func fdo_debug_outdec
|
||||
debug_beginf
|
||||
or cl, cl
|
||||
jz @f
|
||||
or eax, eax
|
||||
jns @f
|
||||
neg eax
|
||||
push eax
|
||||
mov al, '-'
|
||||
call fdo_debug_outchar
|
||||
pop eax
|
||||
@@:
|
||||
movi ecx, 10
|
||||
push -'0'
|
||||
.l1:
|
||||
xor edx, edx
|
||||
div ecx
|
||||
push edx
|
||||
test eax, eax
|
||||
jnz .l1
|
||||
.l2:
|
||||
pop eax
|
||||
add al, '0'
|
||||
jz .l3
|
||||
call fdo_debug_outchar
|
||||
jmp .l2
|
||||
.l3:
|
||||
ret
|
||||
debug_endf
|
||||
|
||||
debug_func fdo_debug_outhex
|
||||
__fdo_hexdigits db '0123456789ABCDEF'
|
||||
debug_beginf
|
||||
mov cl, dl
|
||||
neg cl
|
||||
add cl, 8
|
||||
shl cl, 2
|
||||
rol eax, cl
|
||||
.l1:
|
||||
rol eax, 4
|
||||
push eax
|
||||
and eax, 0x0000000F
|
||||
mov al, [__fdo_hexdigits+eax]
|
||||
call fdo_debug_outchar
|
||||
pop eax
|
||||
dec edx
|
||||
jnz .l1
|
||||
ret
|
||||
debug_endf
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
|
||||
macro DEBUGF _level,_format,[_arg] {
|
||||
common
|
||||
if __DEBUG__ = 1 & _level >= __DEBUG_LEVEL__
|
||||
local ..f1,f2,a1,a2,c1,c2,c3,..lbl
|
||||
_debug_str_ equ __debug_str_ # a1
|
||||
a1 = 0
|
||||
c2 = 0
|
||||
c3 = 0
|
||||
f2 = 0
|
||||
repeat ..lbl-..f1
|
||||
virtual at 0
|
||||
db _format,0,0
|
||||
load c1 word from %-1
|
||||
end virtual
|
||||
if c1 = '%s'
|
||||
virtual at 0
|
||||
db _format,0,0
|
||||
store word 0 at %-1
|
||||
load c1 from f2-c2
|
||||
end virtual
|
||||
if c1 <> 0
|
||||
DEBUGS 0,_debug_str_+f2-c2
|
||||
end if
|
||||
c2 = c2 + 1
|
||||
f2 = %+1
|
||||
DEBUGF_HELPER S,a1,0,_arg
|
||||
else if c1 = '%x'
|
||||
virtual at 0
|
||||
db _format,0,0
|
||||
store word 0 at %-1
|
||||
load c1 from f2-c2
|
||||
end virtual
|
||||
if c1 <> 0
|
||||
DEBUGS 0,_debug_str_+f2-c2
|
||||
end if
|
||||
c2 = c2 + 1
|
||||
f2 = %+1
|
||||
DEBUGF_HELPER H,a1,0,_arg
|
||||
else if c1 = '%d' | c1 = '%u'
|
||||
local c4
|
||||
if c1 = '%d'
|
||||
c4 = 1
|
||||
else
|
||||
c4 = 0
|
||||
end if
|
||||
virtual at 0
|
||||
db _format,0,0
|
||||
store word 0 at %-1
|
||||
load c1 from f2-c2
|
||||
end virtual
|
||||
if c1 <> 0
|
||||
DEBUGS 0,_debug_str_+f2-c2
|
||||
end if
|
||||
c2 = c2 + 1
|
||||
f2 = %+1
|
||||
DEBUGF_HELPER D,a1,c4,_arg
|
||||
else if c1 = '\n'
|
||||
c3 = c3 + 1
|
||||
end if
|
||||
end repeat
|
||||
virtual at 0
|
||||
db _format,0,0
|
||||
load c1 from f2-c2
|
||||
end virtual
|
||||
if (c1<>0)&(f2<>..lbl-..f1-1)
|
||||
DEBUGS 0,_debug_str_+f2-c2
|
||||
end if
|
||||
virtual at 0
|
||||
..f1 db _format,0
|
||||
..lbl:
|
||||
__debug_strings equ __debug_strings,_debug_str_,<_format>,..lbl-..f1-1-c2-c3
|
||||
end virtual
|
||||
end if
|
||||
}
|
||||
|
||||
macro __include_debug_strings dummy,[_id,_fmt,_len] {
|
||||
common
|
||||
local c1,a1,a2
|
||||
forward
|
||||
if defined _len & ~_len eq
|
||||
_id:
|
||||
a1 = 0
|
||||
a2 = 0
|
||||
repeat _len
|
||||
virtual at 0
|
||||
db _fmt,0,0
|
||||
load c1 word from %+a2-1
|
||||
end virtual
|
||||
if (c1='%s')|(c1='%x')|(c1='%d')|(c1='%u')
|
||||
db 0
|
||||
a2 = a2 + 1
|
||||
else if (c1='\n')
|
||||
dw $0A0D
|
||||
a1 = a1 + 1
|
||||
a2 = a2 + 1
|
||||
else
|
||||
db c1 and 0x0FF
|
||||
end if
|
||||
end repeat
|
||||
db 0
|
||||
end if
|
||||
}
|
||||
|
||||
macro DEBUGF_HELPER _letter,_num,_sign,[_arg] {
|
||||
common
|
||||
local num
|
||||
num = 0
|
||||
forward
|
||||
if num = _num
|
||||
DEBUG#_letter _sign,_arg
|
||||
end if
|
||||
num = num+1
|
||||
common
|
||||
_num = _num+1
|
||||
}
|
||||
|
||||
macro include_debug_strings {
|
||||
if __DEBUG__ = 1
|
||||
match dbg_str,__debug_strings \{
|
||||
__include_debug_strings dbg_str
|
||||
\}
|
||||
end if
|
||||
}
|
||||
409
kernel/branches/kolibri-process/fs/ext2/blocks.inc
Normal file
409
kernel/branches/kolibri-process/fs/ext2/blocks.inc
Normal file
@@ -0,0 +1,409 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Contains ext2 block handling code. ;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
|
||||
;; Distributed under the terms of the new BSD license. ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Write ext2 block from memory to disk.
|
||||
; Input: eax = i_block (block number in ext2 terms);
|
||||
; ebx = buffer address
|
||||
; ebp = pointer to EXTFS
|
||||
; Output: eax = error code (0 implies no error)
|
||||
;---------------------------------------------------------------------
|
||||
ext2_block_write:
|
||||
push edx ebx ecx
|
||||
|
||||
mov edx, fs_write32_sys
|
||||
jmp ext2_block_modify
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Read ext2 block from disk to memory.
|
||||
; Input: eax = i_block (block number in ext2 terms);
|
||||
; ebx = address of where to read block
|
||||
; ebp = pointer to EXTFS
|
||||
; Output: eax = error code (0 implies no error)
|
||||
;---------------------------------------------------------------------
|
||||
ext2_block_read:
|
||||
push edx ebx ecx
|
||||
|
||||
mov edx, fs_read32_sys
|
||||
jmp ext2_block_modify
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Modify ext2 block.
|
||||
; Input: eax = i_block (block number in ext2 terms);
|
||||
; ebx = I/O buffer address;
|
||||
; edx = fs_read/write32_sys
|
||||
; ebp = pointer to EXTFS
|
||||
; edx, ebx, ecx on stack.
|
||||
; Output: eax = error code (0 implies no error)
|
||||
;---------------------------------------------------------------------
|
||||
ext2_block_modify:
|
||||
; Get block number in hard-disk terms in eax.
|
||||
mov ecx, [ebp + EXTFS.log_block_size]
|
||||
shl eax, cl
|
||||
mov ecx, eax
|
||||
push [ebp + EXTFS.count_block_in_block]
|
||||
|
||||
@@:
|
||||
mov eax, ecx
|
||||
call edx
|
||||
test eax, eax
|
||||
jnz .fail
|
||||
|
||||
inc ecx
|
||||
add ebx, 512
|
||||
dec dword[esp]
|
||||
jnz @B
|
||||
|
||||
xor eax, eax
|
||||
@@:
|
||||
pop ecx
|
||||
pop ecx ebx edx
|
||||
ret
|
||||
|
||||
.fail:
|
||||
mov eax, ERROR_DEVICE
|
||||
jmp @B
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Zeroes a block.
|
||||
; Input: ebx = block ID.
|
||||
; ebp = pointer to EXTFS.
|
||||
; Output: eax = error code.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_block_zero:
|
||||
push ebx
|
||||
|
||||
mov eax, ebx
|
||||
mov ebx, [ebp + EXTFS.ext2_temp_block]
|
||||
|
||||
call ext2_block_read
|
||||
test eax, eax
|
||||
jnz .return
|
||||
|
||||
push edi ecx
|
||||
xor eax, eax
|
||||
mov ecx, [ebp + EXTFS.block_size]
|
||||
mov edi, [ebp + EXTFS.ext2_temp_block]
|
||||
rep stosb
|
||||
pop ecx edi
|
||||
|
||||
mov eax, [esp]
|
||||
call ext2_block_write
|
||||
|
||||
.return:
|
||||
pop ebx
|
||||
ret
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Allocates a block.
|
||||
; Input: eax = inode ID for "preference".
|
||||
; ebp = pointer to EXTFS.
|
||||
; Output: Block marked as set in block group.
|
||||
; eax = error code.
|
||||
; ebx = block ID.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_block_alloc:
|
||||
push [ebp + EXTFS.superblock + EXT2_SB_STRUC.blocks_count]
|
||||
push EXT2_BLOCK_GROUP_DESC.free_blocks_count
|
||||
push [ebp + EXTFS.superblock + EXT2_SB_STRUC.blocks_per_group]
|
||||
|
||||
lea ebx, [ebp + EXTFS.superblock + EXT2_SB_STRUC.free_block_count]
|
||||
push ebx
|
||||
|
||||
push ext2_bg_read_blk_bitmap
|
||||
|
||||
call ext2_resource_alloc
|
||||
|
||||
ret
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Zero-allocates a block.
|
||||
; Input: eax = inode ID for "preference".
|
||||
; ebp = pointer to EXTFS.
|
||||
; Output: Block marked as set in block group.
|
||||
; eax = error code.
|
||||
; ebx = block ID.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_block_calloc:
|
||||
call ext2_block_alloc
|
||||
test eax, eax
|
||||
jnz @F
|
||||
|
||||
call ext2_block_zero
|
||||
@@:
|
||||
ret
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Frees a block.
|
||||
; Input: eax = block ID.
|
||||
; ebp = pointer to EXTFS.
|
||||
; Output: Block marked as free in block group.
|
||||
; eax = error code.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_block_free:
|
||||
push edi ecx
|
||||
|
||||
mov edi, ext2_bg_read_blk_bitmap
|
||||
xor ecx, ecx
|
||||
call ext2_resource_free
|
||||
|
||||
pop ecx edi
|
||||
ret
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Find parent from file path in block.
|
||||
; Input: esi = file path.
|
||||
; ebx = pointer to directory block.
|
||||
; ebp = pointer to EXTFS structure.
|
||||
; Output: esi = name without parent, or not changed.
|
||||
; ebx = directory record matched.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_block_find_parent:
|
||||
sub esp, 256 ; Space for EXT2 filename.
|
||||
mov edx, ebx
|
||||
add edx, [ebp + EXTFS.block_size] ; Save block end.
|
||||
|
||||
.start_rec:
|
||||
cmp [ebx + EXT2_DIR_STRUC.inode], 0
|
||||
jz .next_rec
|
||||
|
||||
mov edi, esp
|
||||
push esi
|
||||
movzx ecx, [ebx + EXT2_DIR_STRUC.name_len]
|
||||
lea esi, [ebx + EXT2_DIR_STRUC.name]
|
||||
call utf8_to_cp866
|
||||
|
||||
mov ecx, edi
|
||||
lea edi, [esp + 4]
|
||||
sub ecx, edi ; Number of bytes in resulting string.
|
||||
|
||||
mov esi, [esp]
|
||||
|
||||
; esi: original file path.
|
||||
; edi: converted string stored on stack.
|
||||
; ecx: size of converted string.
|
||||
@@:
|
||||
; If no bytes left in resulting string, test it.
|
||||
jecxz .test_find
|
||||
dec ecx
|
||||
|
||||
lodsb
|
||||
call char_toupper
|
||||
|
||||
mov ah, [edi]
|
||||
inc edi
|
||||
xchg al, ah
|
||||
call char_toupper
|
||||
|
||||
; If both are same, check next byte.
|
||||
cmp al, ah
|
||||
je @B
|
||||
@@: ; Doesn't match.
|
||||
pop esi
|
||||
|
||||
.next_rec:
|
||||
movzx eax, [ebx + EXT2_DIR_STRUC.rec_len]
|
||||
add ebx, eax ; Go to next record.
|
||||
cmp ebx, edx ; Check if this is the end.
|
||||
jb .start_rec
|
||||
|
||||
add esp, 256
|
||||
ret
|
||||
|
||||
.test_find:
|
||||
cmp byte [esi], 0
|
||||
je .ret ; The end reached.
|
||||
cmp byte [esi], '/' ; If not end of directory name, not matched.
|
||||
jne @B
|
||||
inc esi
|
||||
|
||||
.ret:
|
||||
add esp, 256 + 4
|
||||
ret
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Finds free space in a directory block, modifying last entry appropriately.
|
||||
; Input: ebp = pointer to EXTFS.
|
||||
; ecx = size of free space required.
|
||||
; [EXTFS.ext2_temp_block] contains the block relevant.
|
||||
; Output: edi = free entry.
|
||||
; rec_len of free entry is set.
|
||||
; eax = error code; if the block doesn't link to the next one, this is 0x00000001 on failure.
|
||||
; ; else, 0xFFFFFFFF.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_block_find_fspace:
|
||||
push ebx edx
|
||||
|
||||
mov edi, [ebp + EXTFS.ext2_temp_block]
|
||||
mov edx, edi
|
||||
add edx, [ebp + EXTFS.block_size]
|
||||
|
||||
@@:
|
||||
movzx eax, [edi + EXT2_DIR_STRUC.rec_len]
|
||||
test eax, eax
|
||||
jz .zero_len
|
||||
|
||||
cmp [edi + EXT2_DIR_STRUC.inode], 0
|
||||
je .unused_entry
|
||||
|
||||
; It's a used entry, so see if we can fit it between current one and next.
|
||||
; Subtract the size used by the name and the structure from rec_len.
|
||||
movzx ebx, [edi + EXT2_DIR_STRUC.name_len]
|
||||
add ebx, 8 + 3
|
||||
and ebx, 0xfffffffc ; Align it on the next 4-byte boundary.
|
||||
|
||||
sub eax, ebx
|
||||
add edi, ebx
|
||||
cmp eax, ecx
|
||||
jb .next_iter
|
||||
|
||||
sub edi, ebx
|
||||
mov [edi + EXT2_DIR_STRUC.rec_len], bx ; Make previous entry point to us.
|
||||
add edi, ebx
|
||||
|
||||
mov [edi + EXT2_DIR_STRUC.rec_len], ax ; Make current entry point to next one.
|
||||
jmp .found
|
||||
|
||||
.unused_entry:
|
||||
; It's an unused inode.
|
||||
cmp eax, ecx
|
||||
jge .found
|
||||
|
||||
.next_iter:
|
||||
add edi, eax
|
||||
cmp edi, edx
|
||||
jb @B
|
||||
|
||||
.not_found:
|
||||
xor eax, eax
|
||||
not eax
|
||||
jmp .ret
|
||||
|
||||
; Zero length entry means we have the rest of the block for us.
|
||||
.zero_len:
|
||||
mov eax, edx
|
||||
sub eax, edi
|
||||
|
||||
; Point to next block.
|
||||
mov [edi + EXT2_DIR_STRUC.rec_len], ax
|
||||
|
||||
cmp eax, ecx
|
||||
jge .fits
|
||||
|
||||
mov [edi + EXT2_DIR_STRUC.inode], 0
|
||||
|
||||
; It doesn't fit, but the block doesn't link to the next block.
|
||||
xor eax, eax
|
||||
inc eax
|
||||
jmp .ret
|
||||
|
||||
.fits:
|
||||
mov [edi + EXT2_DIR_STRUC.rec_len], cx
|
||||
|
||||
.found:
|
||||
xor eax, eax
|
||||
|
||||
.ret:
|
||||
pop edx ebx
|
||||
ret
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Gets the block group's descriptor.
|
||||
; Input: eax = block group.
|
||||
; Output: eax = if zero, error; else, points to block group descriptor.
|
||||
; [EXTFS.ext2_temp_block] contains relevant block.
|
||||
; ebp = pointer to EXTFS.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_bg_read_desc:
|
||||
push edx ebx
|
||||
mov edx, 32
|
||||
mul edx ; Get index of descriptor in global_desc_table.
|
||||
|
||||
; eax: block group descriptor offset relative to global descriptor table start
|
||||
; Find the block this block descriptor is in.
|
||||
div [ebp + EXTFS.block_size]
|
||||
add eax, [ebp + EXTFS.superblock + EXT2_SB_STRUC.first_data_block]
|
||||
inc eax
|
||||
mov ebx, [ebp + EXTFS.ext2_temp_block]
|
||||
call ext2_block_read
|
||||
test eax, eax
|
||||
jnz .fail
|
||||
|
||||
add ebx, edx ; edx: local index of descriptor inside block
|
||||
mov eax, ebx
|
||||
|
||||
.return:
|
||||
pop ebx edx
|
||||
ret
|
||||
|
||||
.fail:
|
||||
xor eax, eax
|
||||
jmp .return
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Writes a block group's descriptor.
|
||||
; Input: eax = block group.
|
||||
; [EXTFS.ext2_temp_data] contains the block relevant.
|
||||
; ebp = pointer to EXTFS.
|
||||
; Output: eax = error code.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_bg_write_desc:
|
||||
push edx ebx
|
||||
mov edx, 32
|
||||
mul edx ; Get index of descriptor in global_desc_table.
|
||||
|
||||
; eax: block group descriptor offset relative to global descriptor table start
|
||||
; Find the block this block descriptor is in.
|
||||
div [ebp + EXTFS.block_size]
|
||||
add eax, [ebp + EXTFS.superblock + EXT2_SB_STRUC.first_data_block]
|
||||
inc eax
|
||||
mov ebx, [ebp + EXTFS.ext2_temp_block]
|
||||
call ext2_block_write
|
||||
|
||||
.return:
|
||||
pop ebx edx
|
||||
ret
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Gets the block group's block bitmap.
|
||||
; Input: eax = block group.
|
||||
; Output: eax = if zero, error; else, points to block group descriptor.
|
||||
; ebx = block bitmap's block (hard disk).
|
||||
;---------------------------------------------------------------------
|
||||
ext2_bg_read_blk_bitmap:
|
||||
push ecx
|
||||
|
||||
call ext2_bg_read_desc
|
||||
test eax, eax
|
||||
jz .fail
|
||||
|
||||
mov ebx, [eax + EXT2_BLOCK_GROUP_DESC.block_bitmap] ; Block number of block group bitmap - in ext2 terms.
|
||||
|
||||
.return:
|
||||
pop ecx
|
||||
ret
|
||||
|
||||
.fail:
|
||||
xor eax, eax
|
||||
jmp .return
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Updates superblock, plus backups.
|
||||
; Input: ebp = pointer to EXTFS.
|
||||
; Output: eax = error code.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_sb_update:
|
||||
push ebx
|
||||
|
||||
mov eax, 2
|
||||
lea ebx, [ebp + EXTFS.superblock]
|
||||
call fs_write32_sys
|
||||
|
||||
pop ebx
|
||||
ret
|
||||
1718
kernel/branches/kolibri-process/fs/ext2/ext2.asm
Normal file
1718
kernel/branches/kolibri-process/fs/ext2/ext2.asm
Normal file
File diff suppressed because it is too large
Load Diff
670
kernel/branches/kolibri-process/fs/ext2/ext2.inc
Normal file
670
kernel/branches/kolibri-process/fs/ext2/ext2.inc
Normal file
@@ -0,0 +1,670 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Contains ext2 structures, and macros. ;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
|
||||
;; Distributed under the terms of the new BSD license. ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
; Future jobs for driver, in order of preference:
|
||||
; * clean up existing extents support.
|
||||
; * add b-tree directories support.
|
||||
; * add long file support.
|
||||
; * add journal support.
|
||||
; * add minor features that come with ext3/4.
|
||||
|
||||
; Recommended move to some kernel-wide bitmap handling code (with a bit of abstraction, of course).
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Clears a bit.
|
||||
; Input: eax = index into bitmap.
|
||||
; [EXTFS.ext2_save_block] = address of bitmap.
|
||||
; ebp = address of EXTFS.
|
||||
; Output: Bit cleared.
|
||||
; eax = non-zero, if already cleared.
|
||||
;---------------------------------------------------------------------
|
||||
bitmap_clear_bit:
|
||||
push ebx ecx edx
|
||||
|
||||
xor edx, edx
|
||||
mov ecx, 8
|
||||
div ecx
|
||||
|
||||
add eax, [ebp + EXTFS.ext2_save_block]
|
||||
|
||||
; Get the mask.
|
||||
mov ebx, 1
|
||||
mov ecx, edx
|
||||
shl ebx, cl
|
||||
|
||||
test [eax], ebx
|
||||
jz .cleared
|
||||
|
||||
not ebx
|
||||
and [eax], ebx
|
||||
|
||||
xor eax, eax
|
||||
.return:
|
||||
pop edx ecx ebx
|
||||
ret
|
||||
|
||||
; Already cleared.
|
||||
.cleared:
|
||||
xor eax, eax
|
||||
not eax
|
||||
jmp .return
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Finds free bit in the bitmap.
|
||||
; Input: ecx = number of bits in the bitmap.
|
||||
; [EXTFS.ext2_save_block] = address of bitmap.
|
||||
; ebp = address of EXTFS.
|
||||
; Output: eax = index of free bit in the bitmap; marked set.
|
||||
; 0xFFFFFFFF if no free bit found.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_find_free_bit:
|
||||
bitmap_find_free_bit:
|
||||
push esi ebx ecx edx
|
||||
mov esi, [ebp + EXTFS.ext2_save_block]
|
||||
|
||||
; Get total DWORDS in eax; total bits in last dword, if any, in edx.
|
||||
xor edx, edx
|
||||
mov eax, ecx
|
||||
mov ecx, 32
|
||||
div ecx
|
||||
|
||||
mov ecx, eax
|
||||
xor eax, eax
|
||||
push edx
|
||||
|
||||
test ecx, ecx
|
||||
jz .last_bits
|
||||
|
||||
; Check in the DWORDS.
|
||||
.dwords:
|
||||
mov ebx, [esi]
|
||||
not ebx
|
||||
|
||||
bsf edx, ebx
|
||||
|
||||
; If 0, then the original value would be 0xFFFFFFFF, hence no free bits.
|
||||
jz @F
|
||||
|
||||
; We found the value. Let's return with it.
|
||||
add esp, 4
|
||||
|
||||
add eax, edx
|
||||
jmp .return
|
||||
|
||||
@@:
|
||||
add esi, 4
|
||||
add eax, 32
|
||||
loop .dwords
|
||||
|
||||
.last_bits:
|
||||
; Check in the last few bits.
|
||||
pop ecx
|
||||
test ecx, ecx
|
||||
jz @F
|
||||
|
||||
mov ebx, [esi]
|
||||
not ebx
|
||||
bsf ebx, edx
|
||||
|
||||
; If 0, no free bits.
|
||||
jz @F
|
||||
|
||||
; If free bit is greater than the last known bit, then error.
|
||||
cmp edx, ecx
|
||||
jg @F
|
||||
|
||||
add eax, edx
|
||||
jmp .return
|
||||
|
||||
@@:
|
||||
; Didn't find any free bits.
|
||||
xor eax, eax
|
||||
not eax
|
||||
jmp @F
|
||||
|
||||
.return:
|
||||
mov ecx, edx
|
||||
mov edx, 1
|
||||
shl edx, cl
|
||||
or [esi], edx
|
||||
|
||||
@@:
|
||||
pop edx ecx ebx esi
|
||||
ret
|
||||
|
||||
; Recommended move to some kernel-wide string handling code.
|
||||
;---------------------------------------------------------------------
|
||||
; Find the length of a string.
|
||||
; Input: esi = source.
|
||||
; Output: length in ecx
|
||||
;---------------------------------------------------------------------
|
||||
strlen:
|
||||
push eax esi
|
||||
xor ecx, ecx
|
||||
|
||||
@@:
|
||||
lodsb
|
||||
test al, al
|
||||
jz .ret
|
||||
|
||||
inc ecx
|
||||
jmp @B
|
||||
|
||||
.ret:
|
||||
pop esi eax
|
||||
ret
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Convert UTF-8 string to ASCII-string (codepage 866)
|
||||
; Input: esi = source.
|
||||
; edi = buffer.
|
||||
; ecx = length of source.
|
||||
; Output: destroys eax, esi, edi
|
||||
;---------------------------------------------------------------------
|
||||
utf8_to_cp866:
|
||||
; Check for zero-length string.
|
||||
jecxz .return
|
||||
|
||||
.start:
|
||||
lodsw
|
||||
cmp al, 0x80
|
||||
jb .ascii
|
||||
|
||||
xchg al, ah ; Big-endian.
|
||||
cmp ax, 0xd080
|
||||
jz .yo1
|
||||
|
||||
cmp ax, 0xd191
|
||||
jz .yo2
|
||||
|
||||
cmp ax, 0xd090
|
||||
jb .unk
|
||||
|
||||
cmp ax, 0xd180
|
||||
jb .rus1
|
||||
|
||||
cmp ax, 0xd190
|
||||
jb .rus2
|
||||
|
||||
.unk:
|
||||
mov al, '_'
|
||||
jmp .doit
|
||||
|
||||
.yo1:
|
||||
mov al, 0xf0 ; Ё capital.
|
||||
jmp .doit
|
||||
|
||||
.yo2:
|
||||
mov al, 0xf1 ; ё small.
|
||||
jmp .doit
|
||||
|
||||
.rus1:
|
||||
sub ax, 0xd090 - 0x80
|
||||
jmp .doit
|
||||
|
||||
.rus2:
|
||||
sub ax, 0xd18f - 0xEF
|
||||
|
||||
.doit:
|
||||
stosb
|
||||
sub ecx, 2
|
||||
ja .start
|
||||
ret
|
||||
|
||||
.ascii:
|
||||
stosb
|
||||
dec esi
|
||||
dec ecx
|
||||
jnz .start
|
||||
|
||||
.return:
|
||||
ret
|
||||
|
||||
; Recommended move to some kernel-wide time handling code.
|
||||
|
||||
; Total cumulative seconds till each month.
|
||||
cumulative_seconds_in_month:
|
||||
.january: dd 0 * (60 * 60 * 24)
|
||||
.february: dd 31 * (60 * 60 * 24)
|
||||
.march: dd 59 * (60 * 60 * 24)
|
||||
.april: dd 90 * (60 * 60 * 24)
|
||||
.may: dd 120 * (60 * 60 * 24)
|
||||
.june: dd 151 * (60 * 60 * 24)
|
||||
.july: dd 181 * (60 * 60 * 24)
|
||||
.august: dd 212 * (60 * 60 * 24)
|
||||
.september: dd 243 * (60 * 60 * 24)
|
||||
.october: dd 273 * (60 * 60 * 24)
|
||||
.november: dd 304 * (60 * 60 * 24)
|
||||
.december: dd 334 * (60 * 60 * 24)
|
||||
|
||||
current_bdfe_time:
|
||||
dd 0
|
||||
current_bdfe_date:
|
||||
dd 0
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Stores current unix time.
|
||||
; Input: edi = buffer to output Unix time.
|
||||
;---------------------------------------------------------------------
|
||||
current_unix_time:
|
||||
push eax esi
|
||||
mov esi, current_bdfe_time
|
||||
|
||||
; Just a small observation:
|
||||
; The CMOS is a pretty bad source to get time from. One shouldn't rely on it,
|
||||
; since it messes up the time by tiny bits. Of course, this is all technical,
|
||||
; but one can look it up on the osdev wiki. What is better is to get the time
|
||||
; from CMOS during boot, then update system time using a more accurate timer.
|
||||
; I'll probably add that after the Summer of Code, so TODO! TODO! TODO!.
|
||||
|
||||
; Get time from CMOS.
|
||||
; Seconds.
|
||||
mov al, 0x00
|
||||
out 0x70, al
|
||||
in al, 0x71
|
||||
call bcd2bin
|
||||
mov [esi + 0], al
|
||||
|
||||
; Minute.
|
||||
mov al, 0x02
|
||||
out 0x70, al
|
||||
in al, 0x71
|
||||
call bcd2bin
|
||||
mov [esi + 1], al
|
||||
|
||||
; Hour.
|
||||
mov al, 0x04
|
||||
out 0x70, al
|
||||
in al, 0x71
|
||||
call bcd2bin
|
||||
mov [esi + 2], al
|
||||
|
||||
; Get date.
|
||||
|
||||
; Day.
|
||||
mov al, 0x7
|
||||
out 0x70, al
|
||||
in al, 0x71
|
||||
call bcd2bin
|
||||
mov [esi + 4], al
|
||||
|
||||
; Month.
|
||||
mov al, 0x8
|
||||
out 0x70, al
|
||||
in al, 0x71
|
||||
call bcd2bin
|
||||
mov [esi + 5], al
|
||||
|
||||
; Year.
|
||||
mov al, 0x9
|
||||
out 0x70, al
|
||||
in al, 0x71
|
||||
call bcd2bin
|
||||
add ax, 2000 ; CMOS only returns last two digits.
|
||||
; Note that everywhere in KolibriOS this is used.
|
||||
; This is hacky, since the RTC can be incorrectly set
|
||||
; to something before 2000.
|
||||
mov [esi + 6], ax
|
||||
|
||||
call bdfe_to_unix_time
|
||||
pop esi eax
|
||||
ret
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Convert time+date from BDFE to Unix time.
|
||||
; Input: esi = pointer to BDFE time+date.
|
||||
; edi = buffer to output Unix time.
|
||||
;---------------------------------------------------------------------
|
||||
bdfe_to_unix_time:
|
||||
push eax ebx ecx edx
|
||||
mov dword[edi], 0x00000000
|
||||
|
||||
; The minimum representable time is 1901-12-13.
|
||||
cmp word[esi + 6], 1901
|
||||
jb .ret
|
||||
jg .max
|
||||
|
||||
cmp byte[esi + 5], 12
|
||||
jb .ret
|
||||
|
||||
cmp byte[esi + 4], 13
|
||||
jbe .ret
|
||||
jg .convert
|
||||
|
||||
; Check if it is more than the maximum representable time.
|
||||
.max:
|
||||
; The maximum representable time is 2038-01-19.
|
||||
cmp word[esi + 6], 2038
|
||||
jg .ret
|
||||
jb .convert
|
||||
|
||||
cmp byte[esi + 5], 1
|
||||
jg .ret
|
||||
|
||||
cmp byte[esi + 4], 19
|
||||
jge .ret
|
||||
|
||||
; Convert the time.
|
||||
.convert:
|
||||
; Get if current year is leap year in ECX.
|
||||
xor ecx, ecx
|
||||
mov ebx, 4
|
||||
xor edx, edx
|
||||
|
||||
cmp word[esi + 6], 1970
|
||||
jb .negative
|
||||
|
||||
movzx eax, word[esi + 6] ; Year.
|
||||
cmp byte[esi + 5], 3 ; If the month is less than March, than that year doesn't matter.
|
||||
jge @F
|
||||
|
||||
test eax, 3
|
||||
; Not a leap year.
|
||||
jnz @F
|
||||
|
||||
inc ecx
|
||||
@@:
|
||||
; Number of leap years between two years = ((end date - 1)/4) - (1970/4)
|
||||
dec eax
|
||||
div ebx
|
||||
sub eax, 1970/4
|
||||
|
||||
; EAX is the number of leap years.
|
||||
add eax, ecx
|
||||
mov ecx, (60 * 60 * 24) ; Seconds in a day.
|
||||
mul ecx
|
||||
|
||||
; Account for leap years, i.e., one day extra for each.
|
||||
add [edi], eax
|
||||
|
||||
; Get total days in EAX.
|
||||
movzx eax, byte[esi + 4]
|
||||
dec eax
|
||||
mul ecx
|
||||
|
||||
; Account for days.
|
||||
add [edi], eax
|
||||
|
||||
; Account for month.
|
||||
movzx eax, byte[esi + 5]
|
||||
dec eax
|
||||
mov eax, [cumulative_seconds_in_month + (eax * 4)]
|
||||
add [edi], eax
|
||||
|
||||
; Account for year.
|
||||
movzx eax, word[esi + 6]
|
||||
sub eax, 1970
|
||||
mov ecx, (60 * 60 * 24) * 365 ; Seconds in a year.
|
||||
mul ecx
|
||||
add [edi], eax
|
||||
|
||||
; Seconds.
|
||||
movzx eax, byte[esi + 0]
|
||||
add [edi], eax
|
||||
|
||||
; Minutes.
|
||||
movzx eax, byte[esi + 1]
|
||||
mov ecx, 60
|
||||
mul ecx
|
||||
add [edi], eax
|
||||
|
||||
; Hours.
|
||||
movzx eax, byte[esi + 2]
|
||||
mov ecx, (60 * 60)
|
||||
mul ecx
|
||||
add [edi], eax
|
||||
|
||||
; The time wanted is before the epoch; handle it here.
|
||||
.negative:
|
||||
; TODO.
|
||||
|
||||
.ret:
|
||||
pop edx ecx ebx eax
|
||||
ret
|
||||
|
||||
; Recommended move to some kernel-wide alloc handling code.
|
||||
macro KERNEL_ALLOC store, label
|
||||
{
|
||||
call kernel_alloc
|
||||
mov store, eax
|
||||
test eax, eax
|
||||
jz label
|
||||
}
|
||||
|
||||
macro KERNEL_FREE data, label
|
||||
{
|
||||
cmp data, 0
|
||||
jz label
|
||||
push data
|
||||
call kernel_free
|
||||
}
|
||||
|
||||
struct EXTFS PARTITION
|
||||
lock MUTEX
|
||||
partition_flags dd ?
|
||||
log_block_size dd ?
|
||||
block_size dd ?
|
||||
count_block_in_block dd ?
|
||||
blocks_per_group dd ?
|
||||
global_desc_table dd ?
|
||||
root_inode dd ? ; Pointer to root inode in memory.
|
||||
inode_size dd ?
|
||||
count_pointer_in_block dd ? ; (block_size / 4)
|
||||
count_pointer_in_block_square dd ? ; (block_size / 4)**2
|
||||
ext2_save_block dd ? ; Block for 1 global procedure.
|
||||
ext2_temp_block dd ? ; Block for small procedures.
|
||||
ext2_save_inode dd ? ; inode for global procedures.
|
||||
ext2_temp_inode dd ? ; inode for small procedures.
|
||||
groups_count dd ?
|
||||
superblock rd 1024/4
|
||||
ends
|
||||
|
||||
; EXT2 revisions.
|
||||
EXT2_GOOD_OLD_REV = 0
|
||||
|
||||
; For fs_type.
|
||||
FS_TYPE_UNDEFINED = 0
|
||||
FS_TYPE_EXT = 2
|
||||
|
||||
; Some set inodes.
|
||||
EXT2_BAD_INO = 1
|
||||
EXT2_ROOT_INO = 2
|
||||
EXT2_ACL_IDX_INO = 3
|
||||
EXT2_ACL_DATA_INO = 4
|
||||
EXT2_BOOT_LOADER_INO = 5
|
||||
EXT2_UNDEL_DIR_INO = 6
|
||||
|
||||
; EXT2_SUPER_MAGIC.
|
||||
EXT2_SUPER_MAGIC = 0xEF53
|
||||
EXT2_VALID_FS = 1
|
||||
|
||||
; Flags defining i_mode values.
|
||||
EXT2_S_IFMT = 0xF000 ; Mask for file type.
|
||||
|
||||
EXT2_S_IFREG = 0x8000 ; Regular file.
|
||||
EXT2_S_IFDIR = 0x4000 ; Directory.
|
||||
|
||||
EXT2_S_IRUSR = 0x0100 ; User read
|
||||
EXT2_S_IWUSR = 0x0080 ; User write
|
||||
EXT2_S_IXUSR = 0x0040 ; User execute
|
||||
EXT2_S_IRGRP = 0x0020 ; Group read
|
||||
EXT2_S_IWGRP = 0x0010 ; Group write
|
||||
EXT2_S_IXGRP = 0x0008 ; Group execute
|
||||
EXT2_S_IROTH = 0x0004 ; Others read
|
||||
EXT2_S_IWOTH = 0x0002 ; Others write
|
||||
EXT2_S_IXOTH = 0x0001 ; Others execute
|
||||
|
||||
PERMISSIONS = EXT2_S_IRUSR or EXT2_S_IWUSR \
|
||||
or EXT2_S_IRGRP or EXT2_S_IWGRP \
|
||||
or EXT2_S_IROTH or EXT2_S_IWOTH
|
||||
|
||||
; File type defining values in directory entry.
|
||||
EXT2_FT_REG_FILE = 1 ; Regular file.
|
||||
EXT2_FT_DIR = 2 ; Directory.
|
||||
|
||||
; Flags used by KolibriOS.
|
||||
FS_FT_HIDDEN = 2
|
||||
FS_FT_DIR = 0x10 ; Directory.
|
||||
|
||||
; ext2 partition flags.
|
||||
EXT2_RO = 0x01
|
||||
|
||||
FS_FT_ASCII = 0 ; Name in ASCII.
|
||||
FS_FT_UNICODE = 1 ; Name in Unicode.
|
||||
|
||||
EXT2_FEATURE_INCOMPAT_FILETYPE = 0x0002 ; Have file type in directory entry.
|
||||
EXT4_FEATURE_INCOMPAT_EXTENTS = 0x0040 ; Extents.
|
||||
EXT4_FEATURE_INCOMPAT_FLEX_BG = 0x0200 ; Flexible block groups.
|
||||
|
||||
EXT2_FEATURE_RO_COMPAT_SPARSE_SUPER = 0x0001 ; Sparse Superblock
|
||||
EXT2_FEATURE_RO_COMPAT_LARGE_FILE = 0x0002 ; Large file support (64-bit file size)
|
||||
|
||||
; Implemented ext[2,3,4] features.
|
||||
EXT4_FEATURE_INCOMPAT_SUPP = EXT2_FEATURE_INCOMPAT_FILETYPE \
|
||||
or EXT4_FEATURE_INCOMPAT_EXTENTS \
|
||||
or EXT4_FEATURE_INCOMPAT_FLEX_BG
|
||||
|
||||
; Implemented features which otherwise require "read-only" mount.
|
||||
EXT2_FEATURE_RO_COMPAT_SUPP = EXT2_FEATURE_RO_COMPAT_SPARSE_SUPER \
|
||||
or EXT2_FEATURE_RO_COMPAT_LARGE_FILE
|
||||
|
||||
; ext4 features not support for write.
|
||||
EXT4_FEATURE_INCOMPAT_W_NOT_SUPP = EXT4_FEATURE_INCOMPAT_EXTENTS \
|
||||
or EXT4_FEATURE_INCOMPAT_FLEX_BG
|
||||
|
||||
; Flags specified in i_flags.
|
||||
EXT2_EXTENTS_FL = 0x00080000 ; Extents.
|
||||
|
||||
struct EXT2_INODE_STRUC
|
||||
i_mode dw ?
|
||||
i_uid dw ?
|
||||
i_size dd ?
|
||||
i_atime dd ?
|
||||
i_ctime dd ?
|
||||
i_mtime dd ?
|
||||
i_dtime dd ?
|
||||
i_gid dw ?
|
||||
i_links_count dw ?
|
||||
i_blocks dd ?
|
||||
i_flags dd ?
|
||||
i_osd1 dd ?
|
||||
i_block rd 15
|
||||
i_generation dd ?
|
||||
i_file_acl dd ?
|
||||
i_dir_acl dd ?
|
||||
i_faddr dd ?
|
||||
i_osd2 dd ? ; 12 bytes.
|
||||
ends
|
||||
|
||||
struct EXT2_DIR_STRUC
|
||||
inode dd ?
|
||||
rec_len dw ?
|
||||
name_len db ?
|
||||
file_type db ?
|
||||
name db ? ; 255 (max) bytes.
|
||||
ends
|
||||
|
||||
struct EXT2_BLOCK_GROUP_DESC
|
||||
block_bitmap dd ? ; +0
|
||||
inode_bitmap dd ? ; +4
|
||||
inode_table dd ? ; +8
|
||||
free_blocks_count dw ? ; +12
|
||||
free_inodes_count dw ? ; +14
|
||||
used_dirs_count dw ? ; +16
|
||||
pad dw ? ; +18
|
||||
reserved rb 12 ; +20
|
||||
ends
|
||||
|
||||
struct EXT2_SB_STRUC
|
||||
inodes_count dd ? ; +0
|
||||
blocks_count dd ? ; +4
|
||||
r_block_count dd ? ; +8
|
||||
free_block_count dd ? ; +12
|
||||
free_inodes_count dd ? ; +16
|
||||
first_data_block dd ? ; +20
|
||||
log_block_size dd ? ; +24
|
||||
log_frag_size dd ? ; +28
|
||||
blocks_per_group dd ? ; +32
|
||||
frags_per_group dd ? ; +36
|
||||
inodes_per_group dd ? ; +40
|
||||
mtime dd ? ; +44
|
||||
wtime dd ? ; +48
|
||||
mnt_count dw ? ; +52
|
||||
max_mnt_count dw ? ; +54
|
||||
magic dw ? ; +56
|
||||
state dw ? ; +58
|
||||
errors dw ? ; +60
|
||||
minor_rev_level dw ? ; +62
|
||||
lastcheck dd ? ; +64
|
||||
check_intervals dd ? ; +68
|
||||
creator_os dd ? ; +72
|
||||
rev_level dd ? ; +76
|
||||
def_resuid dw ? ; +80
|
||||
def_resgid dw ? ; +82
|
||||
first_ino dd ? ; +84
|
||||
inode_size dw ? ; +88
|
||||
block_group_nr dw ? ; +90
|
||||
feature_compat dd ? ; +92
|
||||
feature_incompat dd ? ; +96
|
||||
feature_ro_compat dd ? ; +100
|
||||
uuid rb 16 ; +104
|
||||
volume_name rb 16 ; +120
|
||||
last_mounted rb 64 ; +136
|
||||
algo_bitmap dd ? ; +200
|
||||
prealloc_blocks db ? ; +204
|
||||
preallock_dir_blocks db ? ; +205
|
||||
reserved_gdt_blocks dw ? ; +206
|
||||
journal_uuid rb 16 ; +208
|
||||
journal_inum dd ? ; +224
|
||||
journal_dev dd ? ; +228
|
||||
last_orphan dd ? ; +232
|
||||
hash_seed rd 4 ; +236
|
||||
def_hash_version db ? ; +252
|
||||
reserved rb 3 ; +253 (reserved)
|
||||
default_mount_options dd ? ; +256
|
||||
first_meta_bg dd ? ; +260
|
||||
mkfs_time dd ? ; +264
|
||||
jnl_blocks rd 17 ; +268
|
||||
blocks_count_hi dd ? ; +336
|
||||
r_blocks_count_hi dd ? ; +340
|
||||
free_blocks_count_hi dd ? ; +344
|
||||
min_extra_isize dw ? ; +348
|
||||
want_extra_isize dw ? ; +350
|
||||
flags dd ? ; +352
|
||||
raid_stride dw ? ; +356
|
||||
mmp_interval dw ? ; +358
|
||||
mmp_block dq ? ; +360
|
||||
raid_stripe_width dd ? ; +368
|
||||
log_groups_per_flex db ? ; +372
|
||||
ends
|
||||
|
||||
; Header block extents.
|
||||
struct EXT4_EXTENT_HEADER
|
||||
eh_magic dw ? ; Magic value of 0xF30A, for ext4.
|
||||
eh_entries dw ? ; Number of blocks covered by the extent.
|
||||
eh_max dw ? ; Capacity of entries.
|
||||
eh_depth dw ? ; Tree depth (if 0, extents in the array are not extent indexes)
|
||||
eh_generation dd ? ; ???
|
||||
ends
|
||||
|
||||
; Extent.
|
||||
struct EXT4_EXTENT
|
||||
ee_block dd ? ; First logical block extent covers.
|
||||
ee_len dw ? ; Number of blocks covered by extent.
|
||||
ee_start_hi dw ? ; Upper 16 bits of 48-bit address (unused in KOS)
|
||||
ee_start_lo dd ? ; Lower 32 bits of 48-bit address.
|
||||
ends
|
||||
|
||||
; Index on-disk structure; pointer to block of extents/indexes.
|
||||
struct EXT4_EXTENT_IDX
|
||||
ei_block dd ? ; Covers logical blocks from here.
|
||||
ei_leaf_lo dd ? ; Lower 32-bits of pointer to the physical block of the next level.
|
||||
ei_leaf_hi dw ? ; Higher 16-bits (unused in KOS).
|
||||
ei_unused dw ? ; Reserved.
|
||||
ends
|
||||
1850
kernel/branches/kolibri-process/fs/ext2/inode.inc
Normal file
1850
kernel/branches/kolibri-process/fs/ext2/inode.inc
Normal file
File diff suppressed because it is too large
Load Diff
223
kernel/branches/kolibri-process/fs/ext2/resource.inc
Normal file
223
kernel/branches/kolibri-process/fs/ext2/resource.inc
Normal file
@@ -0,0 +1,223 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Contains common resource allocation + freeing code. ;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
|
||||
;; Distributed under the terms of the new BSD license. ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Frees a resource (block/inode).
|
||||
; Input: eax = resource ID.
|
||||
; edi = function pointer of ext2_bg_*_bitmap form, to
|
||||
; get bitmap of resource.
|
||||
; ecx = 0, block; 1, inode.
|
||||
; ebp = pointer to EXTFS.
|
||||
; Output: Block marked as free in block group.
|
||||
; eax = error code.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_resource_free:
|
||||
push ebx edx esi
|
||||
|
||||
; Get block group.
|
||||
sub eax, [ebp + EXTFS.superblock + EXT2_SB_STRUC.first_data_block]
|
||||
xor edx, edx
|
||||
div [ebp + EXTFS.superblock + EXT2_SB_STRUC.blocks_per_group]
|
||||
push eax edx
|
||||
|
||||
call edi
|
||||
test eax, eax
|
||||
jz .fail
|
||||
mov esi, eax
|
||||
|
||||
; Read the bitmap.
|
||||
mov eax, ebx
|
||||
mov edx, eax
|
||||
mov ebx, [ebp + EXTFS.ext2_save_block]
|
||||
call ext2_block_read
|
||||
test eax, eax
|
||||
jnz .fail
|
||||
|
||||
pop eax
|
||||
; Mark bit free.
|
||||
call bitmap_clear_bit
|
||||
test eax, eax
|
||||
jz @F
|
||||
|
||||
; No need to save anything.
|
||||
xor eax, eax
|
||||
|
||||
add esp, 4
|
||||
jmp .return
|
||||
|
||||
@@:
|
||||
mov eax, edx
|
||||
mov ebx, [ebp + EXTFS.ext2_save_block]
|
||||
call ext2_block_write
|
||||
test eax, eax
|
||||
jnz .fail
|
||||
|
||||
; Read the descriptor.
|
||||
mov eax, [esp]
|
||||
call ext2_bg_read_desc
|
||||
test eax, eax
|
||||
jz .fail_bg_desc_read
|
||||
|
||||
lea eax, [eax + EXT2_BLOCK_GROUP_DESC.free_blocks_count]
|
||||
shl ecx, 1
|
||||
add eax, ecx
|
||||
inc word[eax]
|
||||
|
||||
lea eax, [ebp + EXTFS.superblock + EXT2_SB_STRUC.free_block_count]
|
||||
shl ecx, 1
|
||||
add eax, ecx
|
||||
inc dword[eax]
|
||||
|
||||
pop eax
|
||||
call ext2_bg_write_desc
|
||||
|
||||
.return:
|
||||
pop esi edx ebx
|
||||
ret
|
||||
|
||||
.fail:
|
||||
add esp, 4
|
||||
.fail_bg_desc_read:
|
||||
add esp, 4
|
||||
xor eax, eax
|
||||
not eax
|
||||
jmp .return
|
||||
|
||||
;---------------------------------------------------------------------
|
||||
; Allocates a resource.
|
||||
; Input: eax = inode ID for "preference".
|
||||
; ebp = pointer to EXTFS.
|
||||
; [esp + 4], func pointer to ext2_bg_*_bitmap
|
||||
; [esp + 8], pointer to free_*_count in SB.
|
||||
; [esp + 12], *_per_group
|
||||
; [esp + 16], offset to free_*_count in bg descriptor.
|
||||
; [esp + 20], *_count
|
||||
; Output: Resource marked as set in block group.
|
||||
; eax = error code.
|
||||
; ebx = resource ID.
|
||||
;---------------------------------------------------------------------
|
||||
ext2_resource_alloc:
|
||||
; Block allocation is a pretty serious area, since bad allocation
|
||||
; can lead to fragmentation. Thus, the best way to allocate that
|
||||
; comes to mind is to allocate around an inode as much as possible.
|
||||
; On the other hand, this isn't about a single inode/file/directory,
|
||||
; and focusing just around the preferred inode would lead to
|
||||
; congestion. Thus, after much thought, the chosen allocation algorithm
|
||||
; is to search forward, then backward.
|
||||
push ecx edx esi edi
|
||||
|
||||
cmp dword[esp + 16 + 8], 0
|
||||
jnz @F
|
||||
|
||||
; No free blocks.
|
||||
xor eax, eax
|
||||
not eax
|
||||
pop edi esi edx ecx
|
||||
ret 20
|
||||
|
||||
@@:
|
||||
; Calculate which block group the preferred inode belongs to.
|
||||
dec eax
|
||||
xor edx, edx
|
||||
|
||||
; EAX = block group.
|
||||
div [ebp + EXTFS.superblock + EXT2_SB_STRUC.inodes_per_group]
|
||||
push eax
|
||||
push eax
|
||||
|
||||
mov edi, .forward
|
||||
|
||||
.test_block_group:
|
||||
call dword[esp + 16 + 8 + 4]
|
||||
test eax, eax
|
||||
jz .fail
|
||||
mov esi, eax
|
||||
|
||||
mov eax, ebx
|
||||
mov edx, eax
|
||||
mov ebx, [ebp + EXTFS.ext2_save_block]
|
||||
call ext2_block_read
|
||||
test eax, eax
|
||||
jnz .fail
|
||||
|
||||
mov ecx, [esp + 16 + 8 + 12]
|
||||
call ext2_find_free_bit
|
||||
cmp eax, 0xFFFFFFFF
|
||||
jne @F
|
||||
|
||||
mov eax, edi
|
||||
jmp eax
|
||||
|
||||
@@:
|
||||
mov ecx, eax
|
||||
|
||||
mov eax, edx
|
||||
mov ebx, [ebp + EXTFS.ext2_save_block]
|
||||
call ext2_block_write
|
||||
test eax, eax
|
||||
jnz .fail
|
||||
|
||||
; ecx: the index of the matched entry.
|
||||
; [esp]: block group where we found.
|
||||
; [esp + 4]: starting block group.
|
||||
; esi: block group descriptor.
|
||||
mov eax, [esp] ; Index of block group in which we found.
|
||||
mul dword[esp + 16 + 8 + 12]
|
||||
add eax, ecx
|
||||
mov ebx, eax
|
||||
|
||||
mov eax, [esp + 16 + 8 + 8]
|
||||
dec dword[eax]
|
||||
|
||||
mov eax, esi
|
||||
add eax, [esp + 16 + 8 + 16]
|
||||
dec word[eax]
|
||||
|
||||
pop eax
|
||||
call ext2_bg_write_desc
|
||||
|
||||
add esp, 4
|
||||
jmp .return
|
||||
|
||||
; Continue forward.
|
||||
.forward:
|
||||
inc dword[esp]
|
||||
mov eax, [esp]
|
||||
mul dword[esp + 16 + 8 + 12]
|
||||
cmp eax, [esp + 16 + 8 + 20]
|
||||
jbe @F
|
||||
|
||||
; We need to go backward.
|
||||
mov eax, [esp + 4]
|
||||
mov [esp], eax
|
||||
mov edi, .backward
|
||||
jmp .backward
|
||||
|
||||
@@:
|
||||
mov eax, [esp]
|
||||
jmp .test_block_group
|
||||
|
||||
; Continue backward.
|
||||
.backward:
|
||||
cmp dword[esp], 0
|
||||
je .fail
|
||||
|
||||
dec dword[esp]
|
||||
mov eax, [esp]
|
||||
jmp .test_block_group
|
||||
|
||||
.return:
|
||||
pop edi esi edx ecx
|
||||
ret 20
|
||||
|
||||
.fail:
|
||||
add esp, 8
|
||||
xor eax, eax
|
||||
not eax
|
||||
jmp .return
|
||||
3705
kernel/branches/kolibri-process/fs/fat.inc
Normal file
3705
kernel/branches/kolibri-process/fs/fat.inc
Normal file
File diff suppressed because it is too large
Load Diff
797
kernel/branches/kolibri-process/fs/fs_lfn.inc
Normal file
797
kernel/branches/kolibri-process/fs/fs_lfn.inc
Normal file
@@ -0,0 +1,797 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4277 $
|
||||
|
||||
ERROR_SUCCESS = 0
|
||||
ERROR_DISK_BASE = 1
|
||||
ERROR_UNSUPPORTED_FS = 2
|
||||
ERROR_UNKNOWN_FS = 3
|
||||
ERROR_PARTITION = 4
|
||||
ERROR_FILE_NOT_FOUND = 5
|
||||
ERROR_END_OF_FILE = 6
|
||||
ERROR_MEMORY_POINTER = 7
|
||||
ERROR_DISK_FULL = 8
|
||||
ERROR_FAT_TABLE = 9 ;deprecated
|
||||
ERROR_FS_FAIL = 9
|
||||
ERROR_ACCESS_DENIED = 10
|
||||
ERROR_DEVICE = 11
|
||||
|
||||
image_of_eax EQU esp+32
|
||||
image_of_ebx EQU esp+20
|
||||
|
||||
; System function 70 - files with long names (LFN)
|
||||
; diamond, 2006
|
||||
|
||||
iglobal
|
||||
; in this table names must be in lowercase
|
||||
rootdirs:
|
||||
;**********************************************
|
||||
db 3,'cd0'
|
||||
dd fs_OnCd0
|
||||
dd fs_NextCd
|
||||
db 3,'cd1'
|
||||
dd fs_OnCd1
|
||||
dd fs_NextCd
|
||||
db 3,'cd2'
|
||||
dd fs_OnCd2
|
||||
dd fs_NextCd
|
||||
db 3,'cd3'
|
||||
dd fs_OnCd3
|
||||
dd fs_NextCd
|
||||
;***********************************************
|
||||
db 0
|
||||
|
||||
|
||||
virtual_root_query:
|
||||
;**********************************************
|
||||
dd fs_HasCd0
|
||||
db 'cd0',0
|
||||
dd fs_HasCd1
|
||||
db 'cd1',0
|
||||
dd fs_HasCd2
|
||||
db 'cd2',0
|
||||
dd fs_HasCd3
|
||||
db 'cd3',0
|
||||
;**********************************************
|
||||
dd 0
|
||||
endg
|
||||
|
||||
file_system_lfn_protected:
|
||||
pushad
|
||||
call protect_from_terminate
|
||||
call file_system_lfn
|
||||
call unprotect_from_terminate
|
||||
popad
|
||||
mov [image_of_eax], eax
|
||||
mov [image_of_ebx], ebx
|
||||
ret
|
||||
|
||||
file_system_lfn:
|
||||
; in: ebx->fileinfo block
|
||||
; operation codes:
|
||||
; 0 : read file
|
||||
; 1 : read folder
|
||||
; 2 : create/rewrite file
|
||||
; 3 : write/append to file
|
||||
; 4 : set end of file
|
||||
; 5 : get file/directory attributes structure
|
||||
; 6 : set file/directory attributes structure
|
||||
; 7 : start application
|
||||
; 8 : delete file
|
||||
; 9 : create directory
|
||||
|
||||
; parse file name
|
||||
lea esi, [ebx+20]
|
||||
lodsb
|
||||
test al, al
|
||||
jnz @f
|
||||
mov esi, [esi]
|
||||
lodsb
|
||||
@@:
|
||||
cmp al, '/'
|
||||
jz .notcurdir
|
||||
dec esi
|
||||
mov ebp, esi
|
||||
test al, al
|
||||
jnz @f
|
||||
xor ebp, ebp
|
||||
@@:
|
||||
mov esi, [current_slot]
|
||||
mov esi, [esi+APPDATA.cur_dir]
|
||||
jmp .parse_normal
|
||||
.notcurdir:
|
||||
cmp byte [esi], 0
|
||||
jz .rootdir
|
||||
call process_replace_file_name
|
||||
.parse_normal:
|
||||
cmp dword [ebx], 7
|
||||
jne @F
|
||||
mov edx, [ebx+4]
|
||||
mov ebx, [ebx+8]
|
||||
call fs_execute; esi+ebp, ebx, edx
|
||||
mov [image_of_eax], eax
|
||||
ret
|
||||
@@:
|
||||
mov edi, rootdirs-8
|
||||
xor ecx, ecx
|
||||
push esi
|
||||
.scan1:
|
||||
pop esi
|
||||
add edi, ecx
|
||||
scasd
|
||||
scasd
|
||||
mov cl, byte [edi]
|
||||
test cl, cl
|
||||
jz .notfound_try
|
||||
inc edi
|
||||
push esi
|
||||
@@:
|
||||
lodsb
|
||||
or al, 20h
|
||||
scasb
|
||||
loopz @b
|
||||
jnz .scan1
|
||||
lodsb
|
||||
cmp al, '/'
|
||||
jz .found1
|
||||
test al, al
|
||||
jnz .scan1
|
||||
pop eax
|
||||
; directory /xxx
|
||||
.maindir:
|
||||
mov esi, [edi+4]
|
||||
.maindir_noesi:
|
||||
cmp dword [ebx], 1
|
||||
jnz .access_denied
|
||||
xor eax, eax
|
||||
mov ebp, [ebx+12] ;количество блоков для считывания
|
||||
mov edx, [ebx+16] ;куда записывать рузельтат
|
||||
; add edx, std_application_base_address
|
||||
push dword [ebx+4] ; first block
|
||||
mov ebx, [ebx+8] ; flags
|
||||
; ebx=flags, [esp]=first block, ebp=number of blocks, edx=return area, esi='Next' handler
|
||||
mov edi, edx
|
||||
push ecx
|
||||
mov ecx, 32/4
|
||||
rep stosd
|
||||
pop ecx
|
||||
mov byte [edx], 1 ; version
|
||||
.maindir_loop:
|
||||
call esi
|
||||
jc .maindir_done
|
||||
inc dword [edx+8]
|
||||
dec dword [esp]
|
||||
jns .maindir_loop
|
||||
dec ebp
|
||||
js .maindir_loop
|
||||
inc dword [edx+4]
|
||||
mov dword [edi], 0x10 ; attributes: folder
|
||||
mov dword [edi+4], 1 ; name type: UNICODE
|
||||
push eax
|
||||
xor eax, eax
|
||||
add edi, 8
|
||||
push ecx
|
||||
mov ecx, 40/4-2
|
||||
rep stosd
|
||||
pop ecx
|
||||
pop eax
|
||||
push eax edx
|
||||
; convert number in eax to decimal UNICODE string
|
||||
push edi
|
||||
push ecx
|
||||
push -'0'
|
||||
mov ecx, 10
|
||||
@@:
|
||||
xor edx, edx
|
||||
div ecx
|
||||
push edx
|
||||
test eax, eax
|
||||
jnz @b
|
||||
@@:
|
||||
pop eax
|
||||
add al, '0'
|
||||
stosb
|
||||
test bl, 1 ; UNICODE name?
|
||||
jz .ansi2
|
||||
mov byte [edi], 0
|
||||
inc edi
|
||||
.ansi2:
|
||||
test al, al
|
||||
jnz @b
|
||||
mov byte [edi-1], 0
|
||||
pop ecx
|
||||
pop edi
|
||||
; UNICODE name length is 520 bytes, ANSI - 264
|
||||
add edi, 520
|
||||
test bl, 1
|
||||
jnz @f
|
||||
sub edi, 520-264
|
||||
@@:
|
||||
pop edx eax
|
||||
jmp .maindir_loop
|
||||
.maindir_done:
|
||||
pop eax
|
||||
mov ebx, [edx+4]
|
||||
xor eax, eax
|
||||
dec ebp
|
||||
js @f
|
||||
mov al, ERROR_END_OF_FILE
|
||||
@@:
|
||||
mov [image_of_eax], eax
|
||||
mov [image_of_ebx], ebx
|
||||
ret
|
||||
; directory /
|
||||
.rootdir:
|
||||
cmp dword [ebx], 1 ; read folder?
|
||||
jz .readroot
|
||||
.access_denied:
|
||||
mov dword [image_of_eax], 10 ; access denied
|
||||
ret
|
||||
|
||||
.readroot:
|
||||
; virtual root folder - special handler
|
||||
mov ebp, [ebx+12]
|
||||
mov edx, [ebx+16]
|
||||
; add edx, std_application_base_address
|
||||
push dword [ebx+4] ; first block
|
||||
mov ebx, [ebx+8] ; flags
|
||||
xor eax, eax
|
||||
; eax=0, [esp]=first block, ebx=flags, ebp=number of blocks, edx=return area
|
||||
mov edi, edx
|
||||
mov ecx, 32/4
|
||||
rep stosd
|
||||
mov byte [edx], 1 ; version
|
||||
sub esp, 16
|
||||
.readroot_ah_loop2:
|
||||
push edi
|
||||
lea edi, [esp+4]
|
||||
call dyndisk_enum_root
|
||||
pop edi
|
||||
test eax, eax
|
||||
jz .readroot_done_dynamic
|
||||
inc dword [edx+8]
|
||||
dec dword [esp+16]
|
||||
jns .readroot_ah_loop2
|
||||
dec ebp
|
||||
js .readroot_ah_loop2
|
||||
push eax
|
||||
xor eax, eax
|
||||
inc dword [edx+4]
|
||||
mov dword [edi], 0x10 ; attributes: folder
|
||||
mov dword [edi+4], ebx
|
||||
add edi, 8
|
||||
mov ecx, 40/4-2
|
||||
rep stosd
|
||||
push esi edi
|
||||
lea esi, [esp+12]
|
||||
@@:
|
||||
lodsb
|
||||
stosb
|
||||
test bl, 1
|
||||
jz .ansi3
|
||||
mov byte [edi], 0
|
||||
inc edi
|
||||
.ansi3:
|
||||
test al, al
|
||||
jnz @b
|
||||
pop edi esi eax
|
||||
add edi, 520
|
||||
test bl, 1
|
||||
jnz .readroot_ah_loop2
|
||||
sub edi, 520-264
|
||||
jmp .readroot_ah_loop2
|
||||
.readroot_done_dynamic:
|
||||
add esp, 16
|
||||
mov esi, virtual_root_query
|
||||
.readroot_loop:
|
||||
cmp dword [esi], eax
|
||||
jz .readroot_done
|
||||
call dword [esi]
|
||||
add esi, 4
|
||||
test eax, eax
|
||||
jnz @f
|
||||
.readroot_next:
|
||||
or ecx, -1
|
||||
xchg esi, edi
|
||||
repnz scasb
|
||||
xchg esi, edi
|
||||
jmp .readroot_loop
|
||||
@@:
|
||||
xor eax, eax
|
||||
inc dword [edx+8]
|
||||
dec dword [esp]
|
||||
jns .readroot_next
|
||||
dec ebp
|
||||
js .readroot_next
|
||||
inc dword [edx+4]
|
||||
mov dword [edi], 0x10 ; attributes: folder
|
||||
mov dword [edi+4], ebx ; name type: UNICODE
|
||||
add edi, 8
|
||||
mov ecx, 40/4-2
|
||||
rep stosd
|
||||
push edi
|
||||
@@:
|
||||
lodsb
|
||||
stosb
|
||||
test bl, 1
|
||||
jz .ansi
|
||||
mov byte [edi], 0
|
||||
inc edi
|
||||
.ansi:
|
||||
test eax, eax
|
||||
jnz @b
|
||||
pop edi
|
||||
add edi, 520
|
||||
test bl, 1
|
||||
jnz .readroot_loop
|
||||
sub edi, 520-264
|
||||
jmp .readroot_loop
|
||||
.readroot_done:
|
||||
pop eax
|
||||
mov ebx, [edx+4]
|
||||
xor eax, eax
|
||||
dec ebp
|
||||
js @f
|
||||
mov al, ERROR_END_OF_FILE
|
||||
@@:
|
||||
mov [image_of_eax], eax
|
||||
mov [image_of_ebx], ebx
|
||||
ret
|
||||
.notfound_try:
|
||||
call dyndisk_handler
|
||||
.notfound:
|
||||
mov dword [image_of_eax], ERROR_FILE_NOT_FOUND
|
||||
and dword [image_of_ebx], 0
|
||||
ret
|
||||
|
||||
.notfounda:
|
||||
cmp edi, esp
|
||||
jnz .notfound
|
||||
call dword [edi+4]
|
||||
add esp, 16
|
||||
jmp .notfound
|
||||
|
||||
.found1:
|
||||
pop eax
|
||||
cmp byte [esi], 0
|
||||
jz .maindir
|
||||
.found2:
|
||||
; read partition number
|
||||
xor ecx, ecx
|
||||
xor eax, eax
|
||||
@@:
|
||||
lodsb
|
||||
cmp al, '/'
|
||||
jz .done1
|
||||
test al, al
|
||||
jz .done1
|
||||
sub al, '0'
|
||||
cmp al, 9
|
||||
ja .notfounda
|
||||
lea ecx, [ecx*5]
|
||||
lea ecx, [ecx*2+eax]
|
||||
jmp @b
|
||||
.done1:
|
||||
jecxz .notfounda
|
||||
test al, al
|
||||
jnz @f
|
||||
dec esi
|
||||
@@:
|
||||
cmp byte [esi], 0
|
||||
jnz @f
|
||||
test ebp, ebp
|
||||
jz @f
|
||||
mov esi, ebp
|
||||
xor ebp, ebp
|
||||
@@:
|
||||
; now [edi] contains handler address, ecx - partition number,
|
||||
; esi points to ASCIIZ string - rest of name
|
||||
jmp dword [edi]
|
||||
|
||||
; handlers for devices
|
||||
; in: ecx = 0 => query virtual directory /xxx
|
||||
; in: ecx = partition number
|
||||
; esi -> relative (for device) name
|
||||
; ebx -> fileinfo
|
||||
; ebp = 0 or pointer to rest of name from folder addressed by esi
|
||||
; out: [image_of_eax]=image of eax, [image_of_ebx]=image of ebx
|
||||
|
||||
fs_NotImplemented:
|
||||
mov eax, 2
|
||||
ret
|
||||
|
||||
;*******************************************************
|
||||
fs_OnCd0:
|
||||
call reserve_cd
|
||||
mov [ChannelNumber], 1
|
||||
mov [DiskNumber], 0
|
||||
push 6
|
||||
push 1
|
||||
jmp fs_OnCd
|
||||
fs_OnCd1:
|
||||
call reserve_cd
|
||||
mov [ChannelNumber], 1
|
||||
mov [DiskNumber], 1
|
||||
push 4
|
||||
push 2
|
||||
jmp fs_OnCd
|
||||
fs_OnCd2:
|
||||
call reserve_cd
|
||||
mov [ChannelNumber], 2
|
||||
mov [DiskNumber], 0
|
||||
push 2
|
||||
push 3
|
||||
jmp fs_OnCd
|
||||
fs_OnCd3:
|
||||
call reserve_cd
|
||||
mov [ChannelNumber], 2
|
||||
mov [DiskNumber], 1
|
||||
push 0
|
||||
push 4
|
||||
fs_OnCd:
|
||||
call reserve_cd_channel
|
||||
pop eax
|
||||
mov [cdpos], eax
|
||||
pop eax
|
||||
cmp ecx, 0x100
|
||||
jae .nf
|
||||
push ecx ebx
|
||||
mov cl, al
|
||||
mov bl, [DRIVE_DATA+1]
|
||||
shr bl, cl
|
||||
test bl, 2
|
||||
pop ebx ecx
|
||||
|
||||
jnz @f
|
||||
.nf:
|
||||
call free_cd_channel
|
||||
and [cd_status], 0
|
||||
mov dword [image_of_eax], 5 ; not found
|
||||
ret
|
||||
@@:
|
||||
mov ecx, [ebx+12]
|
||||
mov edx, [ebx+16]
|
||||
; add edx, std_application_base_address
|
||||
mov eax, [ebx]
|
||||
cmp eax, fs_NumCdServices
|
||||
jae .not_impl
|
||||
add ebx, 4
|
||||
call dword [fs_CdServices + eax*4]
|
||||
call free_cd_channel
|
||||
and [cd_status], 0
|
||||
mov [image_of_eax], eax
|
||||
mov [image_of_ebx], ebx
|
||||
ret
|
||||
.not_impl:
|
||||
call free_cd_channel
|
||||
and [cd_status], 0
|
||||
mov dword [image_of_eax], 2 ; not implemented
|
||||
ret
|
||||
|
||||
fs_CdServices:
|
||||
dd fs_CdRead
|
||||
dd fs_CdReadFolder
|
||||
dd fs_NotImplemented
|
||||
dd fs_NotImplemented
|
||||
dd fs_NotImplemented
|
||||
dd fs_CdGetFileInfo
|
||||
dd fs_NotImplemented
|
||||
dd 0
|
||||
dd fs_NotImplemented
|
||||
dd fs_NotImplemented
|
||||
fs_NumCdServices = ($ - fs_CdServices)/4
|
||||
|
||||
;*******************************************************
|
||||
fs_HasCd0:
|
||||
test byte [DRIVE_DATA+1], 10000000b
|
||||
setnz al
|
||||
ret
|
||||
fs_HasCd1:
|
||||
test byte [DRIVE_DATA+1], 00100000b
|
||||
setnz al
|
||||
ret
|
||||
fs_HasCd2:
|
||||
test byte [DRIVE_DATA+1], 00001000b
|
||||
setnz al
|
||||
ret
|
||||
fs_HasCd3:
|
||||
test byte [DRIVE_DATA+1], 00000010b
|
||||
setnz al
|
||||
ret
|
||||
;*******************************************************
|
||||
|
||||
; fs_NextXXX functions:
|
||||
; in: eax = partition number, from which start to scan
|
||||
; out: CF=1 => no more partitions
|
||||
; CF=0 => eax=next partition number
|
||||
|
||||
;*******************************************************
|
||||
fs_NextCd:
|
||||
; we always have /cdX/1
|
||||
test eax, eax
|
||||
stc
|
||||
jnz @f
|
||||
mov al, 1
|
||||
clc
|
||||
@@:
|
||||
ret
|
||||
;*******************************************************
|
||||
|
||||
;-----------------------------------------------------------------------------
|
||||
process_replace_file_name:
|
||||
; in
|
||||
; esi - path with filename(f.70)
|
||||
;
|
||||
; out
|
||||
; ebp - full filename
|
||||
pushfd
|
||||
cli
|
||||
mov ebp, [full_file_name_table]
|
||||
xor edi, edi
|
||||
.loop:
|
||||
cmp edi, [full_file_name_table.size]
|
||||
jae .notfound
|
||||
push esi edi
|
||||
shl edi, 7 ; edi*128
|
||||
add edi, ebp
|
||||
@@:
|
||||
cmp byte [edi], 0 ; end of dir_name
|
||||
jz .dest_done
|
||||
lodsb
|
||||
test al, al
|
||||
jz .cont
|
||||
or al, 20h ; 32 - space char
|
||||
scasb
|
||||
jz @b
|
||||
jmp .cont
|
||||
.dest_done:
|
||||
cmp byte [esi], 0
|
||||
jz .found
|
||||
cmp byte [esi], '/'
|
||||
jnz .cont
|
||||
inc esi
|
||||
jmp .found
|
||||
.cont:
|
||||
pop edi esi
|
||||
inc edi
|
||||
jmp .loop
|
||||
.found:
|
||||
pop edi eax
|
||||
shl edi, 7 ; edi*128
|
||||
add edi, ebp
|
||||
mov ebp, esi
|
||||
cmp byte [esi], 0
|
||||
lea esi, [edi+64]
|
||||
jnz .ret
|
||||
.notfound:
|
||||
xor ebp, ebp
|
||||
.ret:
|
||||
popfd
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
uglobal
|
||||
lock_flag_for_f30_3 rb 1
|
||||
endg
|
||||
|
||||
sys_current_directory:
|
||||
; mov esi, [current_slot]
|
||||
; mov esi, [esi+APPDATA.cur_dir]
|
||||
; mov edx, esi
|
||||
|
||||
;get length string of appdata.cur_dir
|
||||
mov eax, [current_slot]
|
||||
mov edi, [eax+APPDATA.cur_dir]
|
||||
|
||||
dec ebx
|
||||
jz .set
|
||||
dec ebx
|
||||
jz .get
|
||||
dec ebx
|
||||
jz .mount_additional_directory
|
||||
ret
|
||||
|
||||
.mount_additional_directory:
|
||||
; sysfunction 30.2: [for app] eax=30,ebx=3,ecx->dir name+dir path (128)
|
||||
; for our code: nothing
|
||||
|
||||
; check lock of the function
|
||||
cmp [lock_flag_for_f30_3], 1
|
||||
je @f
|
||||
|
||||
mov esi, ecx
|
||||
mov edi, sysdir_name1
|
||||
; copying fake directory name
|
||||
mov ecx, 63
|
||||
pushfd
|
||||
cli
|
||||
cld
|
||||
rep movsb
|
||||
; terminator of name, in case if we get the inlet trash
|
||||
inc esi
|
||||
xor eax, eax
|
||||
stosb
|
||||
; copying real directory path for mounting
|
||||
mov ecx, 63
|
||||
rep movsb
|
||||
; terminator of name, in case if we get the inlet trash
|
||||
xor eax, eax
|
||||
stosb
|
||||
; increase the pointer of inputs for procedure "process_replace_file_name"
|
||||
mov [full_file_name_table.size], 2
|
||||
; block the ability to call f.30.3 because for one session is necessary
|
||||
; for us only once
|
||||
mov [lock_flag_for_f30_3], 1
|
||||
popfd
|
||||
@@:
|
||||
ret
|
||||
|
||||
.get:
|
||||
; sysfunction 30.2: [for app] eax=30,ebx=2,ecx->buffer,edx=len
|
||||
; for our code: ebx->buffer,ecx=len
|
||||
max_cur_dir equ 0x1000
|
||||
|
||||
mov ebx, edi
|
||||
|
||||
push ecx
|
||||
push edi
|
||||
|
||||
xor eax, eax
|
||||
mov ecx, max_cur_dir
|
||||
|
||||
repne scasb ;find zerro at and string
|
||||
jnz .error ; no zero in cur_dir: internal error, should not happen
|
||||
|
||||
sub edi, ebx ;lenght for copy
|
||||
inc edi
|
||||
mov [esp+32+8], edi ;return in eax
|
||||
|
||||
cmp edx, edi
|
||||
jbe @f
|
||||
mov edx, edi
|
||||
@@:
|
||||
;source string
|
||||
pop esi
|
||||
;destination string
|
||||
pop edi
|
||||
cmp edx, 1
|
||||
jbe .ret
|
||||
|
||||
mov al, '/' ;start string with '/'
|
||||
stosb
|
||||
mov ecx, edx
|
||||
rep movsb ;copy string
|
||||
.ret:
|
||||
ret
|
||||
|
||||
.error:
|
||||
add esp, 8
|
||||
or dword [esp+32], -1 ;error not found zerro at string ->[eax+APPDATA.cur_dir]
|
||||
ret
|
||||
.set:
|
||||
; sysfunction 30.1: [for app] eax=30,ebx=1,ecx->string
|
||||
; for our code: ebx->string to set
|
||||
; use generic resolver with APPDATA.cur_dir as destination
|
||||
push max_cur_dir ;0x1000
|
||||
push edi ;destination
|
||||
mov ebx, ecx
|
||||
call get_full_file_name
|
||||
ret
|
||||
|
||||
; in: ebx = file name, [esp+4] = destination, [esp+8] = sizeof destination
|
||||
; destroys all registers except ebp,esp
|
||||
get_full_file_name:
|
||||
push ebp
|
||||
mov esi, [current_slot]
|
||||
mov esi, [esi+APPDATA.cur_dir]
|
||||
mov edx, esi
|
||||
@@:
|
||||
inc esi
|
||||
cmp byte [esi-1], 0
|
||||
jnz @b
|
||||
dec esi
|
||||
cmp byte [ebx], '/'
|
||||
jz .set_absolute
|
||||
; string gives relative path
|
||||
mov edi, [esp+8] ; destination
|
||||
.relative:
|
||||
cmp byte [ebx], 0
|
||||
jz .set_ok
|
||||
cmp word [ebx], '.'
|
||||
jz .set_ok
|
||||
cmp word [ebx], './'
|
||||
jnz @f
|
||||
add ebx, 2
|
||||
jmp .relative
|
||||
@@:
|
||||
cmp word [ebx], '..'
|
||||
jnz .doset_relative
|
||||
cmp byte [ebx+2], 0
|
||||
jz @f
|
||||
cmp byte [ebx+2], '/'
|
||||
jnz .doset_relative
|
||||
@@:
|
||||
dec esi
|
||||
cmp byte [esi], '/'
|
||||
jnz @b
|
||||
add ebx, 3
|
||||
jmp .relative
|
||||
.set_ok:
|
||||
cmp edx, edi ; is destination equal to APPDATA.cur_dir?
|
||||
jz .set_ok.cur_dir
|
||||
sub esi, edx
|
||||
cmp esi, [esp+12]
|
||||
jb .set_ok.copy
|
||||
.fail:
|
||||
mov byte [edi], 0
|
||||
xor eax, eax ; fail
|
||||
pop ebp
|
||||
ret 8
|
||||
.set_ok.copy:
|
||||
mov ecx, esi
|
||||
mov esi, edx
|
||||
rep movsb
|
||||
mov byte [edi], 0
|
||||
.ret.ok:
|
||||
mov al, 1 ; ok
|
||||
pop ebp
|
||||
ret 8
|
||||
.set_ok.cur_dir:
|
||||
mov byte [esi], 0
|
||||
jmp .ret.ok
|
||||
.doset_relative:
|
||||
cmp edx, edi
|
||||
jz .doset_relative.cur_dir
|
||||
sub esi, edx
|
||||
cmp esi, [esp+12]
|
||||
jae .fail
|
||||
mov ecx, esi
|
||||
mov esi, edx
|
||||
mov edx, edi
|
||||
rep movsb
|
||||
jmp .doset_relative.copy
|
||||
.doset_relative.cur_dir:
|
||||
mov edi, esi
|
||||
.doset_relative.copy:
|
||||
add edx, [esp+12]
|
||||
mov byte [edi], '/'
|
||||
inc edi
|
||||
cmp edi, edx
|
||||
jae .overflow
|
||||
@@:
|
||||
mov al, [ebx]
|
||||
inc ebx
|
||||
stosb
|
||||
test al, al
|
||||
jz .ret.ok
|
||||
cmp edi, edx
|
||||
jb @b
|
||||
.overflow:
|
||||
dec edi
|
||||
jmp .fail
|
||||
.set_absolute:
|
||||
lea esi, [ebx+1]
|
||||
call process_replace_file_name
|
||||
mov edi, [esp+8]
|
||||
mov edx, [esp+12]
|
||||
add edx, edi
|
||||
.set_copy:
|
||||
lodsb
|
||||
stosb
|
||||
test al, al
|
||||
jz .set_part2
|
||||
.set_copy_cont:
|
||||
cmp edi, edx
|
||||
jb .set_copy
|
||||
jmp .overflow
|
||||
.set_part2:
|
||||
mov esi, ebp
|
||||
xor ebp, ebp
|
||||
test esi, esi
|
||||
jz .ret.ok
|
||||
mov byte [edi-1], '/'
|
||||
jmp .set_copy_cont
|
||||
759
kernel/branches/kolibri-process/fs/iso9660.inc
Normal file
759
kernel/branches/kolibri-process/fs/iso9660.inc
Normal file
@@ -0,0 +1,759 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3742 $
|
||||
|
||||
|
||||
uglobal
|
||||
cd_current_pointer_of_input dd 0
|
||||
cd_current_pointer_of_input_2 dd 0
|
||||
cd_mem_location dd 0
|
||||
cd_counter_block dd 0
|
||||
IDE_Channel_1 db 0
|
||||
IDE_Channel_2 db 0
|
||||
endg
|
||||
|
||||
reserve_cd:
|
||||
|
||||
cli
|
||||
cmp [cd_status], 0
|
||||
je reserve_ok2
|
||||
|
||||
sti
|
||||
call change_task
|
||||
jmp reserve_cd
|
||||
|
||||
reserve_ok2:
|
||||
|
||||
push eax
|
||||
mov eax, [CURRENT_TASK]
|
||||
shl eax, 5
|
||||
mov eax, [eax+CURRENT_TASK+TASKDATA.pid]
|
||||
mov [cd_status], eax
|
||||
pop eax
|
||||
sti
|
||||
ret
|
||||
|
||||
reserve_cd_channel:
|
||||
cmp [ChannelNumber], 1
|
||||
jne .IDE_Channel_2
|
||||
.IDE_Channel_1:
|
||||
pushad
|
||||
mov ecx, ide_channel1_mutex
|
||||
call mutex_lock
|
||||
mov [IDE_Channel_1], 1
|
||||
popad
|
||||
ret
|
||||
.IDE_Channel_2:
|
||||
pushad
|
||||
mov ecx, ide_channel2_mutex
|
||||
call mutex_lock
|
||||
mov [IDE_Channel_2], 1
|
||||
popad
|
||||
ret
|
||||
|
||||
free_cd_channel:
|
||||
cmp [ChannelNumber], 1
|
||||
jne .IDE_Channel_2
|
||||
.IDE_Channel_1:
|
||||
mov [IDE_Channel_1], 0
|
||||
pushad
|
||||
mov ecx, ide_channel1_mutex
|
||||
call mutex_unlock
|
||||
popad
|
||||
ret
|
||||
.IDE_Channel_2:
|
||||
mov [IDE_Channel_2], 0
|
||||
pushad
|
||||
mov ecx, ide_channel2_mutex
|
||||
call mutex_unlock
|
||||
popad
|
||||
ret
|
||||
|
||||
uglobal
|
||||
cd_status dd 0
|
||||
endg
|
||||
|
||||
;----------------------------------------------------------------
|
||||
;
|
||||
; fs_CdRead - LFN variant for reading CD disk
|
||||
;
|
||||
; esi points to filename /dir1/dir2/.../dirn/file,0
|
||||
; ebx pointer to 64-bit number = first wanted byte, 0+
|
||||
; may be ebx=0 - start from first byte
|
||||
; ecx number of bytes to read, 0+
|
||||
; edx mem location to return data
|
||||
;
|
||||
; ret ebx = bytes read or 0xffffffff file not found
|
||||
; eax = 0 ok read or other = errormsg
|
||||
;
|
||||
;--------------------------------------------------------------
|
||||
fs_CdRead:
|
||||
push edi
|
||||
cmp byte [esi], 0
|
||||
jnz @f
|
||||
.noaccess:
|
||||
pop edi
|
||||
.noaccess_2:
|
||||
or ebx, -1
|
||||
mov eax, ERROR_ACCESS_DENIED
|
||||
ret
|
||||
|
||||
.noaccess_3:
|
||||
pop eax edx ecx edi
|
||||
jmp .noaccess_2
|
||||
|
||||
@@:
|
||||
call cd_find_lfn
|
||||
jnc .found
|
||||
pop edi
|
||||
cmp [DevErrorCode], 0
|
||||
jne .noaccess_2
|
||||
or ebx, -1
|
||||
mov eax, ERROR_FILE_NOT_FOUND
|
||||
ret
|
||||
|
||||
.found:
|
||||
mov edi, [cd_current_pointer_of_input]
|
||||
test byte [edi+25], 10b; do not allow read directories
|
||||
jnz .noaccess
|
||||
test ebx, ebx
|
||||
jz .l1
|
||||
cmp dword [ebx+4], 0
|
||||
jz @f
|
||||
xor ebx, ebx
|
||||
.reteof:
|
||||
mov eax, 6; end of file
|
||||
pop edi
|
||||
ret
|
||||
@@:
|
||||
mov ebx, [ebx]
|
||||
.l1:
|
||||
push ecx edx
|
||||
push 0
|
||||
mov eax, [edi+10] ; реальный размер файловой секции
|
||||
sub eax, ebx
|
||||
jb .eof
|
||||
cmp eax, ecx
|
||||
jae @f
|
||||
mov ecx, eax
|
||||
mov byte [esp], 6
|
||||
@@:
|
||||
mov eax, [edi+2]
|
||||
mov [CDSectorAddress], eax
|
||||
; now eax=cluster, ebx=position, ecx=count, edx=buffer for data
|
||||
.new_sector:
|
||||
test ecx, ecx
|
||||
jz .done
|
||||
sub ebx, 2048
|
||||
jae .next
|
||||
add ebx, 2048
|
||||
jnz .incomplete_sector
|
||||
cmp ecx, 2048
|
||||
jb .incomplete_sector
|
||||
; we may read and memmove complete sector
|
||||
mov [CDDataBuf_pointer], edx
|
||||
call ReadCDWRetr; читаем сектор файла
|
||||
cmp [DevErrorCode], 0
|
||||
jne .noaccess_3
|
||||
add edx, 2048
|
||||
sub ecx, 2048
|
||||
.next:
|
||||
inc dword [CDSectorAddress]
|
||||
jmp .new_sector
|
||||
.incomplete_sector:
|
||||
; we must read and memmove incomplete sector
|
||||
mov [CDDataBuf_pointer], CDDataBuf
|
||||
call ReadCDWRetr; читаем сектор файла
|
||||
cmp [DevErrorCode], 0
|
||||
jne .noaccess_3
|
||||
push ecx
|
||||
add ecx, ebx
|
||||
cmp ecx, 2048
|
||||
jbe @f
|
||||
mov ecx, 2048
|
||||
@@:
|
||||
sub ecx, ebx
|
||||
push edi esi ecx
|
||||
mov edi, edx
|
||||
lea esi, [CDDataBuf + ebx]
|
||||
cld
|
||||
rep movsb
|
||||
pop ecx esi edi
|
||||
add edx, ecx
|
||||
sub [esp], ecx
|
||||
pop ecx
|
||||
xor ebx, ebx
|
||||
jmp .next
|
||||
|
||||
.done:
|
||||
mov ebx, edx
|
||||
pop eax edx ecx edi
|
||||
sub ebx, edx
|
||||
ret
|
||||
.eof:
|
||||
mov ebx, edx
|
||||
pop eax edx ecx
|
||||
sub ebx, edx
|
||||
jmp .reteof
|
||||
|
||||
;----------------------------------------------------------------
|
||||
;
|
||||
; fs_CdReadFolder - LFN variant for reading CD disk folder
|
||||
;
|
||||
; esi points to filename /dir1/dir2/.../dirn/file,0
|
||||
; ebx pointer to structure 32-bit number = first wanted block, 0+
|
||||
; & flags (bitfields)
|
||||
; flags: bit 0: 0=ANSI names, 1=UNICODE names
|
||||
; ecx number of blocks to read, 0+
|
||||
; edx mem location to return data
|
||||
;
|
||||
; ret ebx = blocks read or 0xffffffff folder not found
|
||||
; eax = 0 ok read or other = errormsg
|
||||
;
|
||||
;--------------------------------------------------------------
|
||||
fs_CdReadFolder:
|
||||
push edi
|
||||
call cd_find_lfn
|
||||
jnc .found
|
||||
pop edi
|
||||
cmp [DevErrorCode], 0
|
||||
jne .noaccess_1
|
||||
or ebx, -1
|
||||
mov eax, ERROR_FILE_NOT_FOUND
|
||||
ret
|
||||
.found:
|
||||
mov edi, [cd_current_pointer_of_input]
|
||||
test byte [edi+25], 10b ; do not allow read directories
|
||||
jnz .found_dir
|
||||
pop edi
|
||||
.noaccess_1:
|
||||
or ebx, -1
|
||||
mov eax, ERROR_ACCESS_DENIED
|
||||
ret
|
||||
.found_dir:
|
||||
mov eax, [edi+2] ; eax=cluster
|
||||
mov [CDSectorAddress], eax
|
||||
mov eax, [edi+10] ; размер директрории
|
||||
.doit:
|
||||
; init header
|
||||
push eax ecx
|
||||
mov edi, edx
|
||||
mov ecx, 32/4
|
||||
xor eax, eax
|
||||
rep stosd
|
||||
pop ecx eax
|
||||
mov byte [edx], 1 ; version
|
||||
mov [cd_mem_location], edx
|
||||
add [cd_mem_location], 32
|
||||
; начинаем переброску БДВК в УСВК
|
||||
;.mainloop:
|
||||
mov [cd_counter_block], dword 0
|
||||
dec dword [CDSectorAddress]
|
||||
push ecx
|
||||
.read_to_buffer:
|
||||
inc dword [CDSectorAddress]
|
||||
mov [CDDataBuf_pointer], CDDataBuf
|
||||
call ReadCDWRetr ; читаем сектор директории
|
||||
cmp [DevErrorCode], 0
|
||||
jne .noaccess_1
|
||||
call .get_names_from_buffer
|
||||
sub eax, 2048
|
||||
; директория закончилась?
|
||||
ja .read_to_buffer
|
||||
mov edi, [cd_counter_block]
|
||||
mov [edx+8], edi
|
||||
mov edi, [ebx]
|
||||
sub [edx+4], edi
|
||||
xor eax, eax
|
||||
dec ecx
|
||||
js @f
|
||||
mov al, ERROR_END_OF_FILE
|
||||
@@:
|
||||
pop ecx edi
|
||||
mov ebx, [edx+4]
|
||||
ret
|
||||
|
||||
.get_names_from_buffer:
|
||||
mov [cd_current_pointer_of_input_2], CDDataBuf
|
||||
push eax esi edi edx
|
||||
.get_names_from_buffer_1:
|
||||
call cd_get_name
|
||||
jc .end_buffer
|
||||
inc dword [cd_counter_block]
|
||||
mov eax, [cd_counter_block]
|
||||
cmp [ebx], eax
|
||||
jae .get_names_from_buffer_1
|
||||
test ecx, ecx
|
||||
jz .get_names_from_buffer_1
|
||||
mov edi, [cd_counter_block]
|
||||
mov [edx+4], edi
|
||||
dec ecx
|
||||
mov esi, ebp
|
||||
mov edi, [cd_mem_location]
|
||||
add edi, 40
|
||||
test dword [ebx+4], 1; 0=ANSI, 1=UNICODE
|
||||
jnz .unicode
|
||||
; jmp .unicode
|
||||
.ansi:
|
||||
cmp [cd_counter_block], 2
|
||||
jbe .ansi_parent_directory
|
||||
cld
|
||||
lodsw
|
||||
xchg ah, al
|
||||
call uni2ansi_char
|
||||
cld
|
||||
stosb
|
||||
; проверка конца файла
|
||||
mov ax, [esi]
|
||||
cmp ax, word 3B00h; сепаратор конца файла ';'
|
||||
je .cd_get_parameters_of_file_1
|
||||
; проверка для файлов не заканчивающихся сепаратором
|
||||
movzx eax, byte [ebp-33]
|
||||
add eax, ebp
|
||||
sub eax, 34
|
||||
cmp esi, eax
|
||||
je .cd_get_parameters_of_file_1
|
||||
; проверка конца папки
|
||||
movzx eax, byte [ebp-1]
|
||||
add eax, ebp
|
||||
cmp esi, eax
|
||||
jb .ansi
|
||||
.cd_get_parameters_of_file_1:
|
||||
mov [edi], byte 0
|
||||
call cd_get_parameters_of_file
|
||||
add [cd_mem_location], 304
|
||||
jmp .get_names_from_buffer_1
|
||||
|
||||
.ansi_parent_directory:
|
||||
cmp [cd_counter_block], 2
|
||||
je @f
|
||||
mov [edi], byte '.'
|
||||
inc edi
|
||||
jmp .cd_get_parameters_of_file_1
|
||||
@@:
|
||||
mov [edi], word '..'
|
||||
add edi, 2
|
||||
jmp .cd_get_parameters_of_file_1
|
||||
|
||||
.unicode:
|
||||
cmp [cd_counter_block], 2
|
||||
jbe .unicode_parent_directory
|
||||
cld
|
||||
movsw
|
||||
; проверка конца файла
|
||||
mov ax, [esi]
|
||||
cmp ax, word 3B00h; сепаратор конца файла ';'
|
||||
je .cd_get_parameters_of_file_2
|
||||
; проверка для файлов не заканчивающихся сепаратором
|
||||
movzx eax, byte [ebp-33]
|
||||
add eax, ebp
|
||||
sub eax, 34
|
||||
cmp esi, eax
|
||||
je .cd_get_parameters_of_file_2
|
||||
; проверка конца папки
|
||||
movzx eax, byte [ebp-1]
|
||||
add eax, ebp
|
||||
cmp esi, eax
|
||||
jb .unicode
|
||||
.cd_get_parameters_of_file_2:
|
||||
mov [edi], word 0
|
||||
call cd_get_parameters_of_file
|
||||
add [cd_mem_location], 560
|
||||
jmp .get_names_from_buffer_1
|
||||
|
||||
.unicode_parent_directory:
|
||||
cmp [cd_counter_block], 2
|
||||
je @f
|
||||
mov [edi], word 2E00h; '.'
|
||||
add edi, 2
|
||||
jmp .cd_get_parameters_of_file_2
|
||||
@@:
|
||||
mov [edi], dword 2E002E00h; '..'
|
||||
add edi, 4
|
||||
jmp .cd_get_parameters_of_file_2
|
||||
|
||||
.end_buffer:
|
||||
pop edx edi esi eax
|
||||
ret
|
||||
|
||||
cd_get_parameters_of_file:
|
||||
mov edi, [cd_mem_location]
|
||||
cd_get_parameters_of_file_1:
|
||||
; получаем атрибуты файла
|
||||
xor eax, eax
|
||||
; файл не архивировался
|
||||
inc eax
|
||||
shl eax, 1
|
||||
; это каталог?
|
||||
test [ebp-8], byte 2
|
||||
jz .file
|
||||
inc eax
|
||||
.file:
|
||||
; метка тома не как в FAT, в этом виде отсутсвует
|
||||
; файл не является системным
|
||||
shl eax, 3
|
||||
; файл является скрытым? (атрибут существование)
|
||||
test [ebp-8], byte 1
|
||||
jz .hidden
|
||||
inc eax
|
||||
.hidden:
|
||||
shl eax, 1
|
||||
; файл всегда только для чтения, так как это CD
|
||||
inc eax
|
||||
mov [edi], eax
|
||||
; получаем время для файла
|
||||
;час
|
||||
movzx eax, byte [ebp-12]
|
||||
shl eax, 8
|
||||
;минута
|
||||
mov al, [ebp-11]
|
||||
shl eax, 8
|
||||
;секунда
|
||||
mov al, [ebp-10]
|
||||
;время создания файла
|
||||
mov [edi+8], eax
|
||||
;время последнего доступа
|
||||
mov [edi+16], eax
|
||||
;время последней записи
|
||||
mov [edi+24], eax
|
||||
; получаем дату для файла
|
||||
;год
|
||||
movzx eax, byte [ebp-15]
|
||||
add eax, 1900
|
||||
shl eax, 8
|
||||
;месяц
|
||||
mov al, [ebp-14]
|
||||
shl eax, 8
|
||||
;день
|
||||
mov al, [ebp-13]
|
||||
;дата создания файла
|
||||
mov [edi+12], eax
|
||||
;время последнего доступа
|
||||
mov [edi+20], eax
|
||||
;время последней записи
|
||||
mov [edi+28], eax
|
||||
; получаем тип данных имени
|
||||
xor eax, eax
|
||||
test dword [ebx+4], 1; 0=ANSI, 1=UNICODE
|
||||
jnz .unicode_1
|
||||
mov [edi+4], eax
|
||||
jmp @f
|
||||
.unicode_1:
|
||||
inc eax
|
||||
mov [edi+4], eax
|
||||
@@:
|
||||
; получаем размер файла в байтах
|
||||
xor eax, eax
|
||||
mov [edi+32+4], eax
|
||||
mov eax, [ebp-23]
|
||||
mov [edi+32], eax
|
||||
ret
|
||||
|
||||
;----------------------------------------------------------------
|
||||
;
|
||||
; fs_CdGetFileInfo - LFN variant for CD
|
||||
; get file/directory attributes structure
|
||||
;
|
||||
;----------------------------------------------------------------
|
||||
fs_CdGetFileInfo:
|
||||
cmp byte [esi], 0
|
||||
jnz @f
|
||||
mov eax, 2
|
||||
ret
|
||||
@@:
|
||||
push edi
|
||||
call cd_find_lfn
|
||||
pushfd
|
||||
cmp [DevErrorCode], 0
|
||||
jz @f
|
||||
popfd
|
||||
pop edi
|
||||
mov eax, 11
|
||||
ret
|
||||
@@:
|
||||
popfd
|
||||
jnc @f
|
||||
pop edi
|
||||
mov eax, ERROR_FILE_NOT_FOUND
|
||||
ret
|
||||
@@:
|
||||
|
||||
mov edi, edx
|
||||
push ebp
|
||||
mov ebp, [cd_current_pointer_of_input]
|
||||
add ebp, 33
|
||||
call cd_get_parameters_of_file_1
|
||||
pop ebp
|
||||
and dword [edi+4], 0
|
||||
pop edi
|
||||
xor eax, eax
|
||||
ret
|
||||
|
||||
;----------------------------------------------------------------
|
||||
cd_find_lfn:
|
||||
mov [cd_appl_data], 0
|
||||
; in: esi+ebp -> name
|
||||
; out: CF=1 - file not found
|
||||
; else CF=0 and [cd_current_pointer_of_input] direntry
|
||||
push eax esi
|
||||
; 16 сектор начало набора дескрипторов томов
|
||||
|
||||
call WaitUnitReady
|
||||
cmp [DevErrorCode], 0
|
||||
jne .access_denied
|
||||
|
||||
call prevent_medium_removal
|
||||
; тестовое чтение
|
||||
mov [CDSectorAddress], dword 16
|
||||
mov [CDDataBuf_pointer], CDDataBuf
|
||||
call ReadCDWRetr;_1
|
||||
cmp [DevErrorCode], 0
|
||||
jne .access_denied
|
||||
|
||||
; вычисление последней сессии
|
||||
call WaitUnitReady
|
||||
cmp [DevErrorCode], 0
|
||||
jne .access_denied
|
||||
call Read_TOC
|
||||
mov ah, [CDDataBuf+4+4]
|
||||
mov al, [CDDataBuf+4+5]
|
||||
shl eax, 16
|
||||
mov ah, [CDDataBuf+4+6]
|
||||
mov al, [CDDataBuf+4+7]
|
||||
add eax, 15
|
||||
mov [CDSectorAddress], eax
|
||||
; mov [CDSectorAddress],dword 15
|
||||
mov [CDDataBuf_pointer], CDDataBuf
|
||||
|
||||
.start:
|
||||
inc dword [CDSectorAddress]
|
||||
call ReadCDWRetr;_1
|
||||
cmp [DevErrorCode], 0
|
||||
jne .access_denied
|
||||
|
||||
.start_check:
|
||||
; проверка на вшивость
|
||||
cmp [CDDataBuf+1], dword 'CD00'
|
||||
jne .access_denied
|
||||
cmp [CDDataBuf+5], byte '1'
|
||||
jne .access_denied
|
||||
; сектор является терминатором набор дескрипторов томов?
|
||||
cmp [CDDataBuf], byte 0xff
|
||||
je .access_denied
|
||||
; сектор является дополнительным и улучшенным дескриптором тома?
|
||||
cmp [CDDataBuf], byte 0x2
|
||||
jne .start
|
||||
; сектор является дополнительным дескриптором тома?
|
||||
cmp [CDDataBuf+6], byte 0x1
|
||||
jne .start
|
||||
|
||||
; параметры root директрории
|
||||
mov eax, [CDDataBuf+0x9c+2]; начало root директрории
|
||||
mov [CDSectorAddress], eax
|
||||
mov eax, [CDDataBuf+0x9c+10]; размер root директрории
|
||||
cmp byte [esi], 0
|
||||
jnz @f
|
||||
mov [cd_current_pointer_of_input], CDDataBuf+0x9c
|
||||
jmp .done
|
||||
@@:
|
||||
; начинаем поиск
|
||||
.mainloop:
|
||||
dec dword [CDSectorAddress]
|
||||
.read_to_buffer:
|
||||
inc dword [CDSectorAddress]
|
||||
mov [CDDataBuf_pointer], CDDataBuf
|
||||
call ReadCDWRetr ; читаем сектор директории
|
||||
cmp [DevErrorCode], 0
|
||||
jne .access_denied
|
||||
push ebp
|
||||
call cd_find_name_in_buffer
|
||||
pop ebp
|
||||
jnc .found
|
||||
sub eax, 2048
|
||||
; директория закончилась?
|
||||
cmp eax, 0
|
||||
ja .read_to_buffer
|
||||
; нет искомого элемента цепочки
|
||||
.access_denied:
|
||||
pop esi eax
|
||||
mov [cd_appl_data], 1
|
||||
stc
|
||||
ret
|
||||
; искомый элемент цепочки найден
|
||||
.found:
|
||||
; конец пути файла
|
||||
cmp byte [esi-1], 0
|
||||
jz .done
|
||||
.nested:
|
||||
mov eax, [cd_current_pointer_of_input]
|
||||
push dword [eax+2]
|
||||
pop dword [CDSectorAddress] ; начало директории
|
||||
mov eax, [eax+2+8]; размер директории
|
||||
jmp .mainloop
|
||||
; указатель файла найден
|
||||
.done:
|
||||
test ebp, ebp
|
||||
jz @f
|
||||
mov esi, ebp
|
||||
xor ebp, ebp
|
||||
jmp .nested
|
||||
@@:
|
||||
pop esi eax
|
||||
mov [cd_appl_data], 1
|
||||
clc
|
||||
ret
|
||||
|
||||
cd_find_name_in_buffer:
|
||||
mov [cd_current_pointer_of_input_2], CDDataBuf
|
||||
.start:
|
||||
call cd_get_name
|
||||
jc .not_found
|
||||
call cd_compare_name
|
||||
jc .start
|
||||
.found:
|
||||
clc
|
||||
ret
|
||||
.not_found:
|
||||
stc
|
||||
ret
|
||||
|
||||
cd_get_name:
|
||||
push eax
|
||||
mov ebp, [cd_current_pointer_of_input_2]
|
||||
mov [cd_current_pointer_of_input], ebp
|
||||
mov eax, [ebp]
|
||||
test eax, eax ; входы закончились?
|
||||
jz .next_sector
|
||||
cmp ebp, CDDataBuf+2048 ; буфер закончился?
|
||||
jae .next_sector
|
||||
movzx eax, byte [ebp]
|
||||
add [cd_current_pointer_of_input_2], eax; следующий вход каталога
|
||||
add ebp, 33; указатель установлен на начало имени
|
||||
pop eax
|
||||
clc
|
||||
ret
|
||||
.next_sector:
|
||||
pop eax
|
||||
stc
|
||||
ret
|
||||
|
||||
cd_compare_name:
|
||||
; compares ASCIIZ-names, case-insensitive (cp866 encoding)
|
||||
; in: esi->name, ebp->name
|
||||
; out: if names match: ZF=1 and esi->next component of name
|
||||
; else: ZF=0, esi is not changed
|
||||
; destroys eax
|
||||
push esi eax edi
|
||||
mov edi, ebp
|
||||
.loop:
|
||||
cld
|
||||
lodsb
|
||||
push eax
|
||||
call char_todown
|
||||
call ansi2uni_char
|
||||
xchg ah, al
|
||||
scasw
|
||||
pop eax
|
||||
je .coincides
|
||||
call char_toupper
|
||||
call ansi2uni_char
|
||||
xchg ah, al
|
||||
sub edi, 2
|
||||
scasw
|
||||
jne .name_not_coincide
|
||||
.coincides:
|
||||
cmp [esi], byte '/'; разделитель пути, конец имени текущего элемента
|
||||
je .done
|
||||
cmp [esi], byte 0; разделитель пути, конец имени текущего элемента
|
||||
je .done
|
||||
jmp .loop
|
||||
.name_not_coincide:
|
||||
pop edi eax esi
|
||||
stc
|
||||
ret
|
||||
.done:
|
||||
; проверка конца файла
|
||||
cmp [edi], word 3B00h; сепаратор конца файла ';'
|
||||
je .done_1
|
||||
; проверка для файлов не заканчивающихся сепаратором
|
||||
movzx eax, byte [ebp-33]
|
||||
add eax, ebp
|
||||
sub eax, 34
|
||||
cmp edi, eax
|
||||
je .done_1
|
||||
; проверка конца папки
|
||||
movzx eax, byte [ebp-1]
|
||||
add eax, ebp
|
||||
cmp edi, eax
|
||||
jne .name_not_coincide
|
||||
.done_1:
|
||||
pop edi eax
|
||||
add esp, 4
|
||||
inc esi
|
||||
clc
|
||||
ret
|
||||
|
||||
char_todown:
|
||||
; convert character to uppercase, using cp866 encoding
|
||||
; in: al=symbol
|
||||
; out: al=converted symbol
|
||||
cmp al, 'A'
|
||||
jb .ret
|
||||
cmp al, 'Z'
|
||||
jbe .az
|
||||
cmp al, 0x80 ; 'А'
|
||||
jb .ret
|
||||
cmp al, 0x90 ; 'Р'
|
||||
jb .rus1
|
||||
cmp al, 0x9F ; 'Я'
|
||||
ja .ret
|
||||
; 0x90-0x9F -> 0xE0-0xEF
|
||||
add al, 0xE0-0x90
|
||||
.ret:
|
||||
ret
|
||||
.rus1:
|
||||
; 0x80-0x8F -> 0xA0-0xAF
|
||||
.az:
|
||||
add al, 0x20
|
||||
ret
|
||||
|
||||
uni2ansi_char:
|
||||
; convert UNICODE character in al to ANSI character in ax, using cp866 encoding
|
||||
; in: ax=UNICODE character
|
||||
; out: al=converted ANSI character
|
||||
cmp ax, 0x80
|
||||
jb .ascii
|
||||
cmp ax, 0x401
|
||||
jz .yo1
|
||||
cmp ax, 0x451
|
||||
jz .yo2
|
||||
cmp ax, 0x410
|
||||
jb .unk
|
||||
cmp ax, 0x440
|
||||
jb .rus1
|
||||
cmp ax, 0x450
|
||||
jb .rus2
|
||||
.unk:
|
||||
mov al, '_'
|
||||
jmp .doit
|
||||
.yo1:
|
||||
mov al, 0xF0 ; 'Ё' in cp866
|
||||
jmp .doit
|
||||
.yo2:
|
||||
mov al, 0xF1 ; 'ё' in cp866
|
||||
jmp .doit
|
||||
.rus1:
|
||||
; 0x410-0x43F -> 0x80-0xAF
|
||||
add al, 0x70
|
||||
jmp .doit
|
||||
.rus2:
|
||||
; 0x440-0x44F -> 0xE0-0xEF
|
||||
add al, 0xA0
|
||||
.ascii:
|
||||
.doit:
|
||||
ret
|
||||
1926
kernel/branches/kolibri-process/fs/ntfs.inc
Normal file
1926
kernel/branches/kolibri-process/fs/ntfs.inc
Normal file
File diff suppressed because it is too large
Load Diff
247
kernel/branches/kolibri-process/fs/parse_fn.inc
Normal file
247
kernel/branches/kolibri-process/fs/parse_fn.inc
Normal file
@@ -0,0 +1,247 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
;-------------------------------------------------------------------------
|
||||
;
|
||||
; File path partial substitution (according to configuration)
|
||||
;
|
||||
;
|
||||
; SPraid
|
||||
;
|
||||
;-------------------------------------------------------------------------
|
||||
|
||||
$Revision: 3780 $
|
||||
|
||||
|
||||
iglobal
|
||||
; pointer to memory for path replace table,
|
||||
; size of one record is 128 bytes: 64 bytes for search pattern + 64 bytes for replace string
|
||||
|
||||
; start with one entry: sys -> <sysdir>
|
||||
full_file_name_table dd sysdir_name
|
||||
.size dd 1
|
||||
|
||||
tmp_file_name_size dd 1
|
||||
endg
|
||||
|
||||
uglobal
|
||||
; Parser_params will initialize: sysdir_name = "sys", sysdir_path = <sysdir>
|
||||
sysdir_name rb 64
|
||||
sysdir_path rb 64
|
||||
sysdir_name1 rb 64
|
||||
sysdir_path1 rb 64
|
||||
|
||||
; for example:
|
||||
;dir_name1 db 'KolibriOS',0
|
||||
; rb 64-8
|
||||
;dir_path1 db 'HD0/1',0
|
||||
; rb 64-6
|
||||
endg
|
||||
|
||||
uglobal
|
||||
tmp_file_name_table dd ?
|
||||
endg
|
||||
|
||||
; use bx_from_load and init system directory /sys
|
||||
proc Parser_params
|
||||
locals
|
||||
buff db 4 dup(?) ; for test cd
|
||||
endl
|
||||
mov eax, [OS_BASE+0x10000+bx_from_load]
|
||||
mov ecx, sysdir_path
|
||||
mov [ecx-64], dword 'sys'
|
||||
cmp al, 'r'; if ram disk
|
||||
jnz @f
|
||||
mov [ecx], dword 'RD/?'
|
||||
mov [ecx+3], byte ah
|
||||
mov [ecx+4], byte 0
|
||||
ret
|
||||
@@:
|
||||
cmp al, 'm'; if ram disk
|
||||
jnz @f
|
||||
mov [ecx], dword 'CD?/'; if cd disk {m}
|
||||
mov [ecx+4], byte '1'
|
||||
mov [ecx+5], dword '/KOL'
|
||||
mov [ecx+9], dword 'IBRI'
|
||||
mov [ecx+13], byte 0
|
||||
.next_cd:
|
||||
mov [ecx+2], byte ah
|
||||
inc ah
|
||||
cmp ah, '5'
|
||||
je .not_found_cd
|
||||
lea edx, [buff]
|
||||
pushad
|
||||
stdcall read_file, read_firstapp, edx, 0, 4
|
||||
popad
|
||||
cmp [edx], dword 'MENU'
|
||||
jne .next_cd
|
||||
jmp .ok
|
||||
|
||||
@@:
|
||||
sub al, 49
|
||||
mov [ecx], dword 'HD?/'; if hard disk
|
||||
mov [ecx+2], byte al
|
||||
mov [ecx+4], byte ah
|
||||
mov [ecx+5], dword '/KOL'
|
||||
mov [ecx+9], dword 'IBRI'
|
||||
mov [ecx+13], byte 0
|
||||
.ok:
|
||||
.not_found_cd:
|
||||
ret
|
||||
endp
|
||||
|
||||
proc load_file_parse_table
|
||||
stdcall kernel_alloc, 0x1000
|
||||
mov [tmp_file_name_table], eax
|
||||
mov edi, eax
|
||||
mov esi, sysdir_name
|
||||
mov ecx, 128/4
|
||||
rep movsd
|
||||
|
||||
invoke ini.enum_keys, conf_fname, conf_path_sect, get_every_key
|
||||
|
||||
mov eax, [tmp_file_name_table]
|
||||
mov [full_file_name_table], eax
|
||||
mov eax, [tmp_file_name_size]
|
||||
mov [full_file_name_table.size], eax
|
||||
ret
|
||||
endp
|
||||
|
||||
uglobal
|
||||
def_val_1 db 0
|
||||
endg
|
||||
|
||||
proc get_every_key stdcall, f_name, sec_name, key_name
|
||||
mov esi, [key_name]
|
||||
mov ecx, esi
|
||||
cmp byte [esi], '/'
|
||||
jnz @f
|
||||
inc esi
|
||||
@@:
|
||||
mov edi, [tmp_file_name_size]
|
||||
shl edi, 7
|
||||
cmp edi, 0x1000
|
||||
jae .stop_parse
|
||||
add edi, [tmp_file_name_table]
|
||||
lea ebx, [edi+64]
|
||||
@@:
|
||||
cmp edi, ebx
|
||||
jae .skip_this_key
|
||||
lodsb
|
||||
test al, al
|
||||
jz @f
|
||||
or al, 20h
|
||||
stosb
|
||||
jmp @b
|
||||
@@:
|
||||
stosb
|
||||
|
||||
invoke ini.get_str, [f_name], [sec_name], ecx, ebx, 64, def_val_1
|
||||
|
||||
cmp byte [ebx], '/'
|
||||
jnz @f
|
||||
lea esi, [ebx+1]
|
||||
mov edi, ebx
|
||||
mov ecx, 63
|
||||
rep movsb
|
||||
@@:
|
||||
push ebp
|
||||
mov ebp, [tmp_file_name_table]
|
||||
mov ecx, [tmp_file_name_size]
|
||||
jecxz .noreplace
|
||||
mov eax, ecx
|
||||
dec eax
|
||||
shl eax, 7
|
||||
add ebp, eax
|
||||
.replace_loop:
|
||||
mov edi, ebx
|
||||
mov esi, ebp
|
||||
@@:
|
||||
lodsb
|
||||
test al, al
|
||||
jz .doreplace
|
||||
mov dl, [edi]
|
||||
inc edi
|
||||
test dl, dl
|
||||
jz .replace_loop_cont
|
||||
or dl, 20h
|
||||
cmp al, dl
|
||||
jz @b
|
||||
jmp .replace_loop_cont
|
||||
.doreplace:
|
||||
cmp byte [edi], 0
|
||||
jz @f
|
||||
cmp byte [edi], '/'
|
||||
jnz .replace_loop_cont
|
||||
@@:
|
||||
lea esi, [ebp+64]
|
||||
call .replace
|
||||
jc .skip_this_key2
|
||||
.replace_loop_cont:
|
||||
sub ebp, 128
|
||||
loop .replace_loop
|
||||
.noreplace:
|
||||
pop ebp
|
||||
|
||||
inc [tmp_file_name_size]
|
||||
.skip_this_key:
|
||||
xor eax, eax
|
||||
inc eax
|
||||
ret
|
||||
.skip_this_key2:
|
||||
pop ebp
|
||||
jmp .skip_this_key
|
||||
.stop_parse:
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
proc get_every_key.replace
|
||||
; in: ebx->destination, esi->first part of name, edi->second part of name
|
||||
; maximum length is 64 bytes
|
||||
; out: CF=1 <=> overflow
|
||||
; 1) allocate temporary buffer in stack
|
||||
sub esp, 64
|
||||
; 2) save second part of name to temporary buffer
|
||||
push esi
|
||||
lea esi, [esp+4] ; esi->tmp buffer
|
||||
xchg esi, edi ; edi->tmp buffer, esi->source
|
||||
@@:
|
||||
lodsb
|
||||
stosb
|
||||
test al, al
|
||||
jnz @b
|
||||
; 3) copy first part of name to destination
|
||||
pop esi
|
||||
mov edi, ebx
|
||||
@@:
|
||||
lodsb
|
||||
test al, al
|
||||
jz @f
|
||||
stosb
|
||||
jmp @b
|
||||
@@:
|
||||
; 4) restore second part of name from temporary buffer to destination
|
||||
; (may cause overflow)
|
||||
lea edx, [ebx+64] ; limit of destination
|
||||
mov esi, esp
|
||||
@@:
|
||||
cmp edi, edx
|
||||
jae .overflow
|
||||
lodsb
|
||||
stosb
|
||||
test al, al
|
||||
jnz @b
|
||||
; all is OK
|
||||
add esp, 64 ; CF is cleared
|
||||
ret
|
||||
.overflow:
|
||||
; name is too long
|
||||
add esp, 64
|
||||
stc
|
||||
ret
|
||||
endp
|
||||
2769
kernel/branches/kolibri-process/fs/xfs.asm
Normal file
2769
kernel/branches/kolibri-process/fs/xfs.asm
Normal file
File diff suppressed because it is too large
Load Diff
518
kernel/branches/kolibri-process/fs/xfs.inc
Normal file
518
kernel/branches/kolibri-process/fs/xfs.inc
Normal file
@@ -0,0 +1,518 @@
|
||||
; from stat.h
|
||||
; distinguish file types
|
||||
S_IFMT = 0170000o ; These bits determine file type.
|
||||
S_IFDIR = 0040000o ; Directory.
|
||||
S_IFCHR = 0020000o ; Character device.
|
||||
S_IFBLK = 0060000o ; Block device.
|
||||
S_IFREG = 0100000o ; Regular file.
|
||||
S_IFIFO = 0010000o ; FIFO.
|
||||
S_IFLNK = 0120000o ; Symbolic link.
|
||||
S_IFSOCK = 0140000o ; Socket.
|
||||
; end stat.h
|
||||
|
||||
|
||||
; XFS null constant: empty fields must be all ones, not zeros!
|
||||
XFS_NULL = -1
|
||||
|
||||
|
||||
; static sector numbers
|
||||
XFS_SECT_SB = 0
|
||||
XFS_SECT_AGF = 1
|
||||
XFS_SECT_AGI = 2
|
||||
XFS_SECT_AGFL = 3
|
||||
|
||||
|
||||
; signatures of file system structures
|
||||
; 'string' numbers are treated by fasm as big endian
|
||||
XFS_SB_MAGIC = 'XFSB'
|
||||
XFS_AGF_MAGIC = 'XAGF'
|
||||
XFS_AGI_MAGIC = 'XAGI'
|
||||
XFS_ABTB_MAGIC = 'ABTB'
|
||||
XFS_ABTC_MAGIC = 'ABTC'
|
||||
XFS_IBT_MAGIC = 'IABT'
|
||||
XFS_DINODE_MAGIC = 'IN'
|
||||
XFS_BMAP_MAGIC = 'BMAP'
|
||||
XFS_DA_NODE_MAGIC = 0xbefe ; those are little endian here
|
||||
XFS_ATTR_LEAF_MAGIC = 0xeefb ; but big endian in docs
|
||||
XFS_DIR2_LEAF1_MAGIC = 0xf1d2 ; pay attention!
|
||||
XFS_DIR2_LEAFN_MAGIC = 0xffd2 ;
|
||||
XFS_DIR2_BLOCK_MAGIC = 'XD2B'
|
||||
XFS_DIR2_DATA_MAGIC = 'XD2D'
|
||||
XFS_DIR2_FREE_MAGIC = 'XD2F'
|
||||
XFS_DQUOT_MAGIC = 'DQ'
|
||||
|
||||
|
||||
; bitfield lengths for packed extent
|
||||
; MSB to LSB / left to right
|
||||
BMBT_EXNTFLAG_BITLEN = 1
|
||||
BMBT_STARTOFF_BITLEN = 54
|
||||
BMBT_STARTBLOCK_BITLEN = 52
|
||||
BMBT_BLOCKCOUNT_BITLEN = 21
|
||||
|
||||
|
||||
; those constants are taken from linux source (xfs_dir2_leaf.h)
|
||||
; they are magic infile offsets for directories
|
||||
XFS_DIR2_DATA_ALIGN_LOG = 3 ; i.e., 8 bytes
|
||||
XFS_DIR2_LEAF_SPACE = 1
|
||||
XFS_DIR2_SPACE_SIZE = (1 SHL (32 + XFS_DIR2_DATA_ALIGN_LOG))
|
||||
XFS_DIR2_LEAF_OFFSET = (XFS_DIR2_LEAF_SPACE * XFS_DIR2_SPACE_SIZE)
|
||||
XFS_DIR2_FREE_SPACE = 2
|
||||
XFS_DIR2_SPACE_SIZE = (1 SHL (32 + XFS_DIR2_DATA_ALIGN_LOG))
|
||||
XFS_DIR2_FREE_OFFSET = (XFS_DIR2_FREE_SPACE * XFS_DIR2_SPACE_SIZE)
|
||||
|
||||
|
||||
; data section magic constants for directories (xfs_dir2_data.h)
|
||||
XFS_DIR2_DATA_FD_COUNT = 3
|
||||
XFS_DIR2_DATA_FREE_TAG = 0xffff
|
||||
|
||||
|
||||
; valid inode formats
|
||||
; enum xfs_dinode_fmt (xfs_dinode.h)
|
||||
XFS_DINODE_FMT_DEV = 0 ; xfs_dev_t
|
||||
XFS_DINODE_FMT_LOCAL = 1 ; one inode is enough (shortdir)
|
||||
XFS_DINODE_FMT_EXTENTS = 2 ; one or more extents (leafdir, nodedir, regular files)
|
||||
XFS_DINODE_FMT_BTREE = 3 ; highly fragmented files or really huge directories
|
||||
XFS_DINODE_FMT_UUID = 4 ; uuid_t
|
||||
|
||||
|
||||
; size of the unlinked inode hash table in the agi
|
||||
XFS_AGI_UNLINKED_BUCKETS = 64
|
||||
|
||||
|
||||
; possible extent states
|
||||
; enum xfs_exntst_t (xfs_bmap_btree.h)
|
||||
XFS_EXT_NORM = 0
|
||||
XFS_EXT_UNWRITTEN = 1
|
||||
XFS_EXT_DMAPI_OFFLINE = 2
|
||||
XFS_EXT_INVALID = 3
|
||||
|
||||
|
||||
; values for inode core flags / di_flags (xfs_dinode.h)
|
||||
XFS_DIFLAG_REALTIME_BIT = 0 ; file's blocks come from rt area
|
||||
XFS_DIFLAG_PREALLOC_BIT = 1 ; file space has been preallocated
|
||||
XFS_DIFLAG_NEWRTBM_BIT = 2 ; for rtbitmap inode, new format
|
||||
XFS_DIFLAG_IMMUTABLE_BIT = 3 ; inode is immutable
|
||||
XFS_DIFLAG_APPEND_BIT = 4 ; inode is append-only
|
||||
XFS_DIFLAG_SYNC_BIT = 5 ; inode is written synchronously
|
||||
XFS_DIFLAG_NOATIME_BIT = 6 ; do not update atime
|
||||
XFS_DIFLAG_NODUMP_BIT = 7 ; do not dump
|
||||
XFS_DIFLAG_RTINHERIT_BIT = 8 ; create with realtime bit set
|
||||
XFS_DIFLAG_PROJINHERIT_BIT = 9 ; create with parents projid
|
||||
XFS_DIFLAG_NOSYMLINKS_BIT = 10 ; disallow symlink creation
|
||||
XFS_DIFLAG_EXTSIZE_BIT = 11 ; inode extent size allocator hint
|
||||
XFS_DIFLAG_EXTSZINHERIT_BIT = 12 ; inherit inode extent size
|
||||
XFS_DIFLAG_NODEFRAG_BIT = 13 ; do not reorganize/defragment
|
||||
XFS_DIFLAG_FILESTREAM_BIT = 14 ; use filestream allocator
|
||||
XFS_DIFLAG_REALTIME = (1 SHL XFS_DIFLAG_REALTIME_BIT)
|
||||
XFS_DIFLAG_PREALLOC = (1 SHL XFS_DIFLAG_PREALLOC_BIT)
|
||||
XFS_DIFLAG_NEWRTBM = (1 SHL XFS_DIFLAG_NEWRTBM_BIT)
|
||||
XFS_DIFLAG_IMMUTABLE = (1 SHL XFS_DIFLAG_IMMUTABLE_BIT)
|
||||
XFS_DIFLAG_APPEND = (1 SHL XFS_DIFLAG_APPEND_BIT)
|
||||
XFS_DIFLAG_SYNC = (1 SHL XFS_DIFLAG_SYNC_BIT)
|
||||
XFS_DIFLAG_NOATIME = (1 SHL XFS_DIFLAG_NOATIME_BIT)
|
||||
XFS_DIFLAG_NODUMP = (1 SHL XFS_DIFLAG_NODUMP_BIT)
|
||||
XFS_DIFLAG_RTINHERIT = (1 SHL XFS_DIFLAG_RTINHERIT_BIT)
|
||||
XFS_DIFLAG_PROJINHERIT = (1 SHL XFS_DIFLAG_PROJINHERIT_BIT)
|
||||
XFS_DIFLAG_NOSYMLINKS = (1 SHL XFS_DIFLAG_NOSYMLINKS_BIT)
|
||||
XFS_DIFLAG_EXTSIZE = (1 SHL XFS_DIFLAG_EXTSIZE_BIT)
|
||||
XFS_DIFLAG_EXTSZINHERIT = (1 SHL XFS_DIFLAG_EXTSZINHERIT_BIT)
|
||||
XFS_DIFLAG_NODEFRAG = (1 SHL XFS_DIFLAG_NODEFRAG_BIT)
|
||||
XFS_DIFLAG_FILESTREAM = (1 SHL XFS_DIFLAG_FILESTREAM_BIT)
|
||||
|
||||
|
||||
; superblock _ondisk_ structure (xfs_sb.h)
|
||||
; this is _not_ the partition structure
|
||||
; for XFS partition structure see XFS below
|
||||
struct xfs_sb
|
||||
sb_magicnum dd ? ; signature, must be XFS_SB_MAGIC
|
||||
sb_blocksize dd ? ; block is the minimal file system unit, in bytes
|
||||
sb_dblocks dq ? ; number of data blocks
|
||||
sb_rblocks dq ? ; number of realtime blocks (not supported yet!)
|
||||
sb_rextents dq ? ; number of realtime extents (not supported yet!)
|
||||
sb_uuid rb 16 ; file system unique identifier
|
||||
sb_logstart dq ? ; starting block of log (for internal journal; journals on separate devices are not supported!)
|
||||
sb_rootino dq ? ; root inode number
|
||||
sb_rbmino dq ? ; bitmap inode for realtime extents (ignored)
|
||||
sb_rsumino dq ? ; summary inode for rt bitmap (ignored)
|
||||
sb_rextsize dd ? ; realtime extent size, blocks
|
||||
sb_agblocks dd ? ; size of an allocation group (the last one may be smaller!)
|
||||
sb_agcount dd ? ; number of allocation groups
|
||||
sb_rbmblocks dd ? ; number of rt bitmap blocks
|
||||
sb_logblocks dd ? ; number of log blocks
|
||||
sb_versionnum dw ? ; header version == XFS_SB_VERSION
|
||||
sb_sectsize dw ? ; volume sector size in bytes (only 512B sectors are supported)
|
||||
sb_inodesize dw ? ; inode size, bytes
|
||||
sb_inopblock dw ? ; inodes per block
|
||||
sb_fname rb 12 ; inodes per block (aka label)
|
||||
sb_blocklog db ? ; log2 of sb_blocksize
|
||||
sb_sectlog db ? ; log2 of sb_blocksize
|
||||
sb_inodelog db ? ; log2 of sb_inodesize
|
||||
sb_inopblog db ? ; log2 of sb_inopblock
|
||||
sb_agblklog db ? ; log2 of sb_agblocks (rounded up!)
|
||||
sb_rextslog db ? ; log2 of sb_rextents
|
||||
sb_inprogress db ? ; mkfs is in progress, don't mount
|
||||
sb_imax_pct db ? ; max % of fs for inode space
|
||||
; statistics
|
||||
sb_icount dq ? ; allocated inodes
|
||||
sb_ifree dq ? ; free inodes
|
||||
sb_fdblocks dq ? ; free data blocks
|
||||
sb_frextents dq ? ; free realtime extents
|
||||
|
||||
sb_uquotino dq ? ; user quota inode
|
||||
sb_gquotino dq ? ; group quota inode
|
||||
sb_qflags dw ? ; quota flags
|
||||
sb_flags db ? ; misc. flags
|
||||
sb_shared_vn db ? ; shared version number
|
||||
sb_inoalignmt dd ? ; inode chunk alignment, fsblocks
|
||||
sb_unit dd ? ; stripe or raid unit
|
||||
sb_width dd ? ; stripe or raid width
|
||||
sb_dirblklog db ? ; log2 of dir block size (fsbs)
|
||||
sb_logsectlog db ? ; log2 of the log sector size
|
||||
sb_logsectsize dw ? ; sector size for the log, bytes
|
||||
sb_logsunit dd ? ; stripe unit size for the log
|
||||
sb_features2 dd ? ; additional feature bits
|
||||
ends
|
||||
|
||||
|
||||
; allocation group inode (xfs_ag.h)
|
||||
struct xfs_agi
|
||||
agi_magicnum dd ? ; magic number == XFS_AGI_MAGIC
|
||||
agi_versionnum dd ? ; header version == XFS_AGI_VERSION
|
||||
agi_seqno dd ? ; sequence number starting from 0
|
||||
agi_length dd ? ; size in blocks of a.g.
|
||||
agi_count dd ? ; count of allocated inodes
|
||||
agi_root dd ? ; root of inode btree
|
||||
agi_level dd ? ; levels in inode btree
|
||||
agi_freecount dd ? ; number of free inodes
|
||||
agi_newino dd ? ; new inode just allocated
|
||||
agi_dirino dd ? ; last directory inode chunk
|
||||
agi_unlinked rd XFS_AGI_UNLINKED_BUCKETS ; Hash table of inodes which have been unlinked but are still being referenced
|
||||
ends
|
||||
|
||||
|
||||
; superblock structure of b+tree node/leaf (same structure, bb_level matters)
|
||||
struct xfs_btree_sblock
|
||||
bb_magic dd ?
|
||||
bb_level dw ? ; distinguishes nodeds and leaves
|
||||
bb_numrecs dw ?
|
||||
bb_leftsib dd ?
|
||||
bb_rightsib dd ?
|
||||
ends
|
||||
|
||||
|
||||
; record of b+tree inode
|
||||
struct xfs_inobt_rec
|
||||
ir_startino dd ?
|
||||
ir_freecount dd ?
|
||||
ir_free dq ?
|
||||
ends
|
||||
|
||||
|
||||
; structure to store create, access and modification time in inode core
|
||||
struct xfs_timestamp
|
||||
t_sec dd ?
|
||||
t_nsec dd ? ; nanoseconds
|
||||
ends
|
||||
|
||||
|
||||
; inode core structure: basic information about file
|
||||
struct xfs_dinode_core
|
||||
di_magic dw ? ; inode magic = XFS_DINODE_MAGIC
|
||||
di_mode dw ? ; mode and type of file
|
||||
di_version db ? ; inode version
|
||||
di_format db ? ; format of di_c data
|
||||
di_onlink dw ? ; old number of links to file
|
||||
di_uid dd ? ; owner's user id
|
||||
di_gid dd ? ; owner's group id
|
||||
di_nlink dd ? ; number of links to file
|
||||
di_projid dw ? ; owner's project id
|
||||
di_pad rb 8 ; unused, zeroed space
|
||||
di_flushiter dw ? ; incremented on flush
|
||||
di_atime xfs_timestamp ; time last accessed
|
||||
di_mtime xfs_timestamp ; time last modified
|
||||
di_ctime xfs_timestamp ; time created/inode modified
|
||||
di_size dq ? ; number of bytes in file
|
||||
di_nblocks dq ? ; number of direct & btree blocks used
|
||||
di_extsize dd ? ; basic/minimum extent size for file
|
||||
di_nextents dd ? ; number of extents in data fork
|
||||
di_anextents dw ? ; number of extents in attribute fork
|
||||
di_forkoff db ? ; attr fork offs, <<3 for 64b align
|
||||
di_aformat db ? ; format of attr fork's data
|
||||
di_dmevmask dd ? ; DMIG event mask
|
||||
di_dmstate dw ? ; DMIG state info
|
||||
di_flags dw ? ; random flags, XFS_DIFLAG_...
|
||||
di_gen dd ? ; generation number
|
||||
ends
|
||||
|
||||
|
||||
; shortform dir header
|
||||
struct xfs_dir2_sf_hdr
|
||||
count db ? ; the number of directory entries, used only if each inode number fits 4 bytes; zero otherwise
|
||||
i8count db ? ; the number of directory entries, used only when count is zero
|
||||
parent dq ? ; parent inode number: xfs_dir2_inou_t (4 or 8 bytes)
|
||||
ends
|
||||
|
||||
|
||||
; shortform dir entry
|
||||
struct xfs_dir2_sf_entry
|
||||
namelen db ? ; actual name length (ASCII)
|
||||
offset rb 2 ; saved offset
|
||||
name db ? ; name, variable size
|
||||
; inumber dq ? ; xfs_dir2_inou_t
|
||||
ends
|
||||
|
||||
|
||||
; active entry in a data block
|
||||
; aligned to 8 bytes
|
||||
; tag appears as the last 2 bytes
|
||||
struct xfs_dir2_data_entry
|
||||
inumber dq ? ; inode number
|
||||
namelen db ? ; name length
|
||||
name db ? ; name bytes, no null
|
||||
; tag dw ? ; starting offset of us
|
||||
ends
|
||||
|
||||
|
||||
; unused entry in a data block
|
||||
; aligned to 8 bytes
|
||||
; tag appears as the last 2 bytes
|
||||
struct xfs_dir2_data_unused
|
||||
freetag dw ? ; XFS_DIR2_DATA_FREE_TAG
|
||||
length dw ? ; total free length
|
||||
; tag dw ? ; starting offset of us
|
||||
ends
|
||||
|
||||
|
||||
; generic data entry
|
||||
struct xfs_dir2_data_union
|
||||
union
|
||||
xentry xfs_dir2_data_entry
|
||||
unused xfs_dir2_data_unused
|
||||
ends
|
||||
ends
|
||||
|
||||
|
||||
; describe a free area in the data block
|
||||
; the freespace will be formatted as a xfs_dir2_data_unused_t
|
||||
struct xfs_dir2_data_free
|
||||
offset dw ? ; start of freespace
|
||||
length dw ? ; length of freespace
|
||||
ends
|
||||
|
||||
|
||||
; header for the data blocks
|
||||
; always at the beginning of a directory-sized block
|
||||
; the code knows that XFS_DIR2_DATA_FD_COUNT is 3
|
||||
struct xfs_dir2_data_hdr
|
||||
magic dd ? ; XFS_DIR2_DATA_MAGIC or XFS_DIR2_BLOCK_MAGIC
|
||||
bestfree xfs_dir2_data_free
|
||||
bestfree2 xfs_dir2_data_free
|
||||
bestfree3 xfs_dir2_data_free
|
||||
ends
|
||||
|
||||
|
||||
; leaf block entry
|
||||
struct xfs_dir2_leaf_entry
|
||||
hashval dd ? ; hash value of name
|
||||
address dd ? ; address of data entry
|
||||
ends
|
||||
|
||||
|
||||
; the tail of directory block
|
||||
struct xfs_dir2_block_tail
|
||||
count dd ? ; count of leaf entries
|
||||
stale dd ? ; count of stale leaf entries
|
||||
ends
|
||||
|
||||
|
||||
; generic single-block structure, for xfs_db
|
||||
struct xfs_dir2_block
|
||||
hdr xfs_dir2_data_hdr
|
||||
u xfs_dir2_data_union
|
||||
; leaf xfs_dir2_leaf_entry
|
||||
; tail xfs_dir2_block_tail
|
||||
ends
|
||||
|
||||
|
||||
;
|
||||
struct xfs_dir2_data
|
||||
hdr xfs_dir2_data_hdr ; magic XFS_DIR2_DATA_MAGIC
|
||||
u xfs_dir2_data_union
|
||||
ends
|
||||
|
||||
|
||||
;
|
||||
struct xfs_da_blkinfo
|
||||
forw dd ? ; previous block in list
|
||||
back dd ? ; following block in list
|
||||
magic dw ? ; validity check on block
|
||||
pad dw ? ; unused
|
||||
ends
|
||||
|
||||
|
||||
; leaf block header
|
||||
struct xfs_dir2_leaf_hdr
|
||||
info xfs_da_blkinfo ; header for da routines
|
||||
count dw ? ; count of entries
|
||||
stale dw ? ; count of stale entries
|
||||
ends
|
||||
|
||||
|
||||
; leaf block tail
|
||||
struct xfs_dir2_leaf_tail
|
||||
bestcount dd ?
|
||||
ends
|
||||
|
||||
|
||||
; leaf block
|
||||
; bests and tail are at the end of the block for single-leaf only
|
||||
; (magic = XFS_DIR2_LEAF1_MAGIC not XFS_DIR2_LEAFN_MAGIC)
|
||||
struct xfs_dir2_leaf
|
||||
hdr xfs_dir2_leaf_hdr ; leaf header
|
||||
ents xfs_dir2_leaf_entry ; entries
|
||||
; bests dw ? ; best free counts
|
||||
; tail xfs_dir2_leaf_tail ; leaf tail
|
||||
ends
|
||||
|
||||
|
||||
; header of 'free' block part
|
||||
struct xfs_dir2_free_hdr
|
||||
magic dd ? ; XFS_DIR2_FREE_MAGIC
|
||||
firstdb dd ? ; db of first entry
|
||||
nvalid dd ? ; count of valid entries
|
||||
nused dd ? ; count of used entries
|
||||
ends
|
||||
|
||||
|
||||
; 'free' part of directiry block
|
||||
struct xfs_dir2_free
|
||||
hdr xfs_dir2_free_hdr ; block header
|
||||
bests dw ? ; best free counts
|
||||
; unused entries are -1 (XFS_NULL)
|
||||
ends
|
||||
|
||||
|
||||
; b+tree node header
|
||||
struct xfs_da_node_hdr
|
||||
info xfs_da_blkinfo
|
||||
count dw ?
|
||||
level dw ?
|
||||
ends
|
||||
|
||||
|
||||
; b+tree node
|
||||
struct xfs_da_node_entry
|
||||
hashval dd ? ; hash value for this descendant
|
||||
before dd ? ; Btree block before this key
|
||||
ends
|
||||
|
||||
|
||||
;
|
||||
struct xfs_da_intnode
|
||||
hdr xfs_da_node_hdr
|
||||
btree xfs_da_node_entry
|
||||
ends
|
||||
|
||||
|
||||
; packet extent
|
||||
struct xfs_bmbt_rec
|
||||
l0 dq ?
|
||||
l1 dq ?
|
||||
ends
|
||||
|
||||
|
||||
; unpacked extent
|
||||
struct xfs_bmbt_irec
|
||||
br_startoff dq ? ; starting file offset
|
||||
br_startblock dq ? ; starting block number
|
||||
br_blockcount dd ? ; number of blocks
|
||||
br_state dd ? ; extent state
|
||||
ends
|
||||
|
||||
|
||||
; bmap root header, on-disk form only
|
||||
struct xfs_bmdr_block
|
||||
bb_level dw ? ; 0 is a leaf
|
||||
bb_numrecs dw ? ; current number of data records
|
||||
ends
|
||||
|
||||
|
||||
; key structure for non-leaf levels of the tree
|
||||
struct xfs_bmbt_key
|
||||
br_startoff dq ? ; starting file offset
|
||||
ends
|
||||
|
||||
|
||||
sizeof.xfs_bmbt_ptr = 8 ; workaround
|
||||
sizeof.xfs_bmdr_ptr = 8 ; workaround
|
||||
|
||||
|
||||
; long form header: bmap btrees
|
||||
; xfs_btree_lblock is xfs_bmbt_block (xfs_btree.h)
|
||||
struct xfs_bmbt_block
|
||||
bb_magic dd ? ; magic number for block type
|
||||
bb_level dw ? ; 0 is a leaf
|
||||
bb_numrecs dw ? ; current number of data records
|
||||
bb_leftsib dq ? ; left sibling block or NULLDFSBNO
|
||||
bb_rightsib dq ? ; right sibling block or NULLDFSBNO
|
||||
ends
|
||||
|
||||
|
||||
; high level inode structure
|
||||
struct xfs_inode
|
||||
di_core xfs_dinode_core ; main info, aka core
|
||||
di_next_unlinked dd ? ; unlinked but still used inode (if any, XFS_NULL otherwise)
|
||||
di_u db ? ; data fork inode part
|
||||
; di_a db ? ; data attribute
|
||||
ends
|
||||
|
||||
|
||||
; internal data for every XFS partition
|
||||
; this _is_ XFS partition structure
|
||||
; most fields are unpacked or bswap'ed values from the superblock, so see xfs_sb structure above
|
||||
struct XFS PARTITION
|
||||
Lock MUTEX ? ; access mutex
|
||||
blocksize dd ?
|
||||
sectsize dd ?
|
||||
dirblocksize dd ?
|
||||
rootino dq ?
|
||||
cur_block dd ?
|
||||
cur_inode dd ?
|
||||
cur_sect dd ?
|
||||
cur_dirblock dd ?
|
||||
tmp_inode dd ?
|
||||
versionnum dd ?
|
||||
features2 dd ?
|
||||
inodesize dd ?
|
||||
inopblock dd ?
|
||||
blocklog dd ?
|
||||
sectlog dd ?
|
||||
inodelog dd ?
|
||||
inopblog dd ?
|
||||
agblklog dd ?
|
||||
blockmsectlog dd ?
|
||||
inodetoblocklog dd ?
|
||||
dirblklog dd ?
|
||||
sectpblock dd ?
|
||||
agblocks dd ?
|
||||
; helpers, temporary vars, etc
|
||||
agblockmask dq ?
|
||||
extent xfs_bmbt_irec
|
||||
left_extents dd ?
|
||||
left_leaves dd ?
|
||||
bytes_to_read dd ?
|
||||
bytes_read dd ?
|
||||
entries_read dd ?
|
||||
file_offset dq ?
|
||||
max_dirblockaddr dd ?
|
||||
next_block_num dq ?
|
||||
dir2_leaf_offset_blocks dd ?
|
||||
dir2_free_offset_blocks dd ?
|
||||
cur_inode_save dd ?
|
||||
bytes_left_in_file dq ?
|
||||
ro_nextents dd ?
|
||||
bb_ptrs dd ?
|
||||
maxnumrecs dd ?
|
||||
buffer_pos dd ?
|
||||
eof dd ?
|
||||
ends
|
||||
508
kernel/branches/kolibri-process/gui/button.inc
Normal file
508
kernel/branches/kolibri-process/gui/button.inc
Normal file
@@ -0,0 +1,508 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Copyright (C) MenuetOS 2000-2004 Ville Mikael Turjanmaa ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
;==============================================================================
|
||||
;///// public functions ///////////////////////////////////////////////////////
|
||||
;==============================================================================
|
||||
|
||||
button.MAX_BUTTONS = 4095
|
||||
|
||||
struct SYS_BUTTON
|
||||
pslot dw ?
|
||||
id_lo dw ?
|
||||
left dw ?
|
||||
width dw ?
|
||||
top dw ?
|
||||
height dw ?
|
||||
id_hi dw ?
|
||||
dw ?
|
||||
ends
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
syscall_button: ;///// system function 8 //////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Define/undefine GUI button object
|
||||
;------------------------------------------------------------------------------
|
||||
;; Define button:
|
||||
;> ebx = pack[16(x), 16(width)]
|
||||
;> ecx = pack[16(y), 16(height)]
|
||||
;> edx = pack[8(flags), 24(button identifier)]
|
||||
;> flags bits:
|
||||
;> 7 (31) = 0
|
||||
;> 6 (30) = don't draw button
|
||||
;> 5 (29) = don't draw button frame when pressed
|
||||
;> esi = button color
|
||||
; - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - -
|
||||
;; Undefine button:
|
||||
;> edx = pack[8(flags), 24(button identifier)]
|
||||
;> flags bits:
|
||||
;> 7 (31) = 1
|
||||
;------------------------------------------------------------------------------
|
||||
; do we actually need to undefine the button?
|
||||
test edx, 0x80000000
|
||||
jnz .remove_button
|
||||
|
||||
; do we have free button slots available?
|
||||
mov edi, [BTN_ADDR]
|
||||
mov eax, [edi]
|
||||
cmp eax, button.MAX_BUTTONS
|
||||
jge .exit
|
||||
|
||||
; does it have positive size? (otherwise it doesn't have sense)
|
||||
or bx, bx
|
||||
jle .exit
|
||||
or cx, cx
|
||||
jle .exit
|
||||
|
||||
; make coordinates clientbox-relative
|
||||
push eax
|
||||
mov eax, [current_slot]
|
||||
rol ebx, 16
|
||||
add bx, word[eax + APPDATA.wnd_clientbox.left]
|
||||
rol ebx, 16
|
||||
rol ecx, 16
|
||||
add cx, word[eax + APPDATA.wnd_clientbox.top]
|
||||
rol ecx, 16
|
||||
pop eax
|
||||
|
||||
; basic checks passed, define the button
|
||||
push ebx ecx edx
|
||||
inc eax
|
||||
mov [edi], ax
|
||||
shl eax, 4
|
||||
add edi, eax
|
||||
; NOTE: this code doesn't rely on SYS_BUTTON struct, please revise it
|
||||
; if you change something
|
||||
mov ax, [CURRENT_TASK]
|
||||
stosw
|
||||
mov ax, dx
|
||||
stosw ; button id number: bits 0-15
|
||||
mov eax, ebx
|
||||
rol eax, 16
|
||||
stosd ; x start | x size
|
||||
mov eax, ecx
|
||||
rol eax, 16
|
||||
stosd ; y start | y size
|
||||
mov eax, edx
|
||||
shr eax, 16
|
||||
stosw ; button id number: bits 16-31
|
||||
pop edx ecx ebx
|
||||
|
||||
; do we also need to draw the button?
|
||||
test edx, 0x40000000
|
||||
jnz .exit
|
||||
|
||||
; draw button body
|
||||
|
||||
pushad
|
||||
|
||||
; calculate window-relative coordinates
|
||||
movzx edi, cx
|
||||
shr ebx, 16
|
||||
shr ecx, 16
|
||||
mov eax, [TASK_BASE]
|
||||
add ebx, [eax - twdw + WDATA.box.left]
|
||||
add ecx, [eax - twdw + WDATA.box.top]
|
||||
mov eax, ebx
|
||||
shl eax, 16
|
||||
mov ax, bx
|
||||
add ax, word[esp + 16]
|
||||
mov ebx, ecx
|
||||
shl ebx, 16
|
||||
mov bx, cx
|
||||
|
||||
; calculate initial color
|
||||
mov ecx, esi
|
||||
cmp [buttontype], 0
|
||||
je @f
|
||||
call button._.incecx2
|
||||
|
||||
; set button height counter
|
||||
@@:
|
||||
mov edx, edi
|
||||
|
||||
.next_line:
|
||||
call button._.button_dececx
|
||||
push edi
|
||||
xor edi, edi
|
||||
; call [draw_line]
|
||||
call __sys_draw_line
|
||||
pop edi
|
||||
add ebx, 0x00010001
|
||||
dec edx
|
||||
jnz .next_line
|
||||
|
||||
popad
|
||||
|
||||
; draw button frame
|
||||
|
||||
push ebx ecx
|
||||
|
||||
; calculate window-relative coordinates
|
||||
shr ebx, 16
|
||||
shr ecx, 16
|
||||
mov eax, [TASK_BASE]
|
||||
add ebx, [eax - twdw + WDATA.box.left]
|
||||
add ecx, [eax - twdw + WDATA.box.top]
|
||||
|
||||
; top border
|
||||
mov eax, ebx
|
||||
shl eax, 16
|
||||
mov ax, bx
|
||||
add ax, [esp + 4]
|
||||
mov ebx, ecx
|
||||
shl ebx, 16
|
||||
mov bx, cx
|
||||
push ebx
|
||||
xor edi, edi
|
||||
mov ecx, esi
|
||||
call button._.incecx
|
||||
; call [draw_line]
|
||||
call __sys_draw_line
|
||||
|
||||
; bottom border
|
||||
movzx edx, word[esp + 4 + 0]
|
||||
add ebx, edx
|
||||
shl edx, 16
|
||||
add ebx, edx
|
||||
mov ecx, esi
|
||||
call button._.dececx
|
||||
; call [draw_line]
|
||||
call __sys_draw_line
|
||||
|
||||
; left border
|
||||
pop ebx
|
||||
push edx
|
||||
mov edx, eax
|
||||
shr edx, 16
|
||||
mov ax, dx
|
||||
mov edx, ebx
|
||||
shr edx, 16
|
||||
mov bx, dx
|
||||
add bx, [esp + 4 + 0]
|
||||
pop edx
|
||||
mov ecx, esi
|
||||
call button._.incecx
|
||||
; call [draw_line]
|
||||
call __sys_draw_line
|
||||
|
||||
; right border
|
||||
mov dx, [esp + 4]
|
||||
add ax, dx
|
||||
shl edx, 16
|
||||
add eax, edx
|
||||
add ebx, 0x00010000
|
||||
mov ecx, esi
|
||||
call button._.dececx
|
||||
; call [draw_line]
|
||||
call __sys_draw_line
|
||||
|
||||
pop ecx ebx
|
||||
|
||||
.exit:
|
||||
ret
|
||||
|
||||
; FIXME: mutex needed
|
||||
syscall_button.remove_button:
|
||||
and edx, 0x00ffffff
|
||||
mov edi, [BTN_ADDR]
|
||||
mov ebx, [edi]
|
||||
inc ebx
|
||||
imul esi, ebx, sizeof.SYS_BUTTON
|
||||
add esi, edi
|
||||
xor ecx, ecx
|
||||
add ecx, -sizeof.SYS_BUTTON
|
||||
add esi, sizeof.SYS_BUTTON
|
||||
|
||||
.next_button:
|
||||
dec ebx
|
||||
jz .exit
|
||||
|
||||
add ecx, sizeof.SYS_BUTTON
|
||||
add esi, -sizeof.SYS_BUTTON
|
||||
|
||||
; does it belong to our process?
|
||||
mov ax, [CURRENT_TASK]
|
||||
cmp ax, [esi + SYS_BUTTON.pslot]
|
||||
jne .next_button
|
||||
|
||||
; does the identifier match?
|
||||
mov eax, dword[esi + SYS_BUTTON.id_hi - 2]
|
||||
mov ax, [esi + SYS_BUTTON.id_lo]
|
||||
and eax, 0x00ffffff
|
||||
cmp edx, eax
|
||||
jne .next_button
|
||||
|
||||
; okay, undefine it
|
||||
push ebx
|
||||
mov ebx, esi
|
||||
lea eax, [esi + sizeof.SYS_BUTTON]
|
||||
call memmove
|
||||
dec dword[edi]
|
||||
add ecx, -sizeof.SYS_BUTTON
|
||||
pop ebx
|
||||
jmp .next_button
|
||||
|
||||
.exit:
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
sys_button_activate_handler: ;/////////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? <description>
|
||||
;------------------------------------------------------------------------------
|
||||
;> eax = pack[8(process slot), 24(button id)]
|
||||
;> ebx = pack[16(button x coord), 16(button y coord)]
|
||||
;> cl = mouse button mask this system button was pressed with
|
||||
;------------------------------------------------------------------------------
|
||||
call button._.find_button
|
||||
or eax, eax
|
||||
jz .exit
|
||||
|
||||
mov ebx, dword[eax + SYS_BUTTON.id_hi - 2]
|
||||
call button._.negative_button
|
||||
|
||||
.exit:
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
sys_button_deactivate_handler: ;///////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? <description>
|
||||
;------------------------------------------------------------------------------
|
||||
;> eax = pack[8(process slot), 24(button id)]
|
||||
;> ebx = pack[16(button x coord), 16(button y coord)]
|
||||
;> cl = mouse button mask this system button was pressed with
|
||||
;------------------------------------------------------------------------------
|
||||
call button._.find_button
|
||||
or eax, eax
|
||||
jz .exit
|
||||
|
||||
mov ebx, dword[eax + SYS_BUTTON.id_hi - 2]
|
||||
call button._.negative_button
|
||||
|
||||
.exit:
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
sys_button_perform_handler: ;//////////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? <description>
|
||||
;------------------------------------------------------------------------------
|
||||
;> eax = pack[8(process slot), 24(button id)]
|
||||
;> ebx = pack[16(button x coord), 16(button y coord)]
|
||||
;> cl = mouse button mask this system button was pressed with
|
||||
;------------------------------------------------------------------------------
|
||||
shl eax, 8
|
||||
mov al, cl
|
||||
movzx ebx, byte[BTN_COUNT]
|
||||
mov [BTN_BUFF + ebx * 4], eax
|
||||
inc bl
|
||||
mov [BTN_COUNT], bl
|
||||
ret
|
||||
|
||||
;==============================================================================
|
||||
;///// private functions //////////////////////////////////////////////////////
|
||||
;==============================================================================
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
button._.find_button: ;////////////////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Find system button by specified process slot, id and coordinates
|
||||
;------------------------------------------------------------------------------
|
||||
;> eax = pack[8(process slot), 24(button id)] or 0
|
||||
;> ebx = pack[16(button x coord), 16(button y coord)]
|
||||
;------------------------------------------------------------------------------
|
||||
;< eax = pointer to SYS_BUTTON struct or 0
|
||||
;------------------------------------------------------------------------------
|
||||
push ecx edx esi edi
|
||||
|
||||
mov edx, eax
|
||||
shr edx, 24
|
||||
and eax, 0x0ffffff
|
||||
|
||||
mov edi, [BTN_ADDR]
|
||||
mov ecx, [edi]
|
||||
imul esi, ecx, sizeof.SYS_BUTTON
|
||||
add esi, edi
|
||||
inc ecx
|
||||
add esi, sizeof.SYS_BUTTON
|
||||
|
||||
.next_button:
|
||||
dec ecx
|
||||
jz .not_found
|
||||
|
||||
add esi, -sizeof.SYS_BUTTON
|
||||
|
||||
; does it belong to our process?
|
||||
cmp dx, [esi + SYS_BUTTON.pslot]
|
||||
jne .next_button
|
||||
|
||||
; does id match?
|
||||
mov edi, dword[esi + SYS_BUTTON.id_hi - 2]
|
||||
mov di, [esi + SYS_BUTTON.id_lo]
|
||||
and edi, 0x0ffffff
|
||||
cmp eax, edi
|
||||
jne .next_button
|
||||
|
||||
; does coordinates match?
|
||||
mov edi, dword[esi + SYS_BUTTON.left - 2]
|
||||
mov di, [esi + SYS_BUTTON.top]
|
||||
cmp ebx, edi
|
||||
jne .next_button
|
||||
|
||||
; okay, return it
|
||||
mov eax, esi
|
||||
jmp .exit
|
||||
|
||||
.not_found:
|
||||
xor eax, eax
|
||||
|
||||
.exit:
|
||||
pop edi esi edx ecx
|
||||
ret
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
button._.dececx: ;/////////////////////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? <description>
|
||||
;------------------------------------------------------------------------------
|
||||
sub cl, 0x20
|
||||
jnc @f
|
||||
xor cl, cl
|
||||
@@:
|
||||
sub ch, 0x20
|
||||
jnc @f
|
||||
xor ch, ch
|
||||
@@:
|
||||
rol ecx, 16
|
||||
sub cl, 0x20
|
||||
jnc @f
|
||||
xor cl, cl
|
||||
@@:
|
||||
rol ecx, 16
|
||||
ret
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
button._.incecx: ;/////////////////////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? <description>
|
||||
;------------------------------------------------------------------------------
|
||||
add cl, 0x20
|
||||
jnc @f
|
||||
or cl, -1
|
||||
@@:
|
||||
add ch, 0x20
|
||||
jnc @f
|
||||
or ch, -1
|
||||
@@:
|
||||
rol ecx, 16
|
||||
add cl, 0x20
|
||||
jnc @f
|
||||
or cl, -1
|
||||
@@:
|
||||
rol ecx, 16
|
||||
ret
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
button._.incecx2: ;////////////////////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? <description>
|
||||
;------------------------------------------------------------------------------
|
||||
add cl, 0x14
|
||||
jnc @f
|
||||
or cl, -1
|
||||
@@:
|
||||
add ch, 0x14
|
||||
jnc @f
|
||||
or ch, -1
|
||||
@@:
|
||||
rol ecx, 16
|
||||
add cl, 0x14
|
||||
jnc @f
|
||||
or cl, -1
|
||||
@@:
|
||||
rol ecx, 16
|
||||
ret
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
button._.button_dececx: ;//////////////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? <description>
|
||||
;------------------------------------------------------------------------------
|
||||
cmp [buttontype], 1
|
||||
jne .finish
|
||||
|
||||
push eax
|
||||
mov al, 1
|
||||
cmp edi, 20
|
||||
jg @f
|
||||
mov al, 2
|
||||
|
||||
@@:
|
||||
sub cl, al
|
||||
jnc @f
|
||||
xor cl, cl
|
||||
@@:
|
||||
sub ch, al
|
||||
jnc @f
|
||||
xor ch, ch
|
||||
@@:
|
||||
rol ecx, 16
|
||||
sub cl, al
|
||||
jnc @f
|
||||
xor cl, cl
|
||||
@@:
|
||||
rol ecx, 16
|
||||
|
||||
pop eax
|
||||
|
||||
.finish:
|
||||
ret
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
button._.negative_button: ;////////////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Invert system button border
|
||||
;------------------------------------------------------------------------------
|
||||
; if requested, do not display button border on press.
|
||||
test ebx, 0x20000000
|
||||
jnz .exit
|
||||
|
||||
pushad
|
||||
|
||||
xchg esi, eax
|
||||
|
||||
movzx ecx, [esi + SYS_BUTTON.pslot]
|
||||
shl ecx, 5
|
||||
add ecx, window_data
|
||||
|
||||
mov eax, dword[esi + SYS_BUTTON.left]
|
||||
mov ebx, dword[esi + SYS_BUTTON.top]
|
||||
add eax, [ecx + WDATA.box.left]
|
||||
add ebx, [ecx + WDATA.box.top]
|
||||
push eax ebx
|
||||
pop edx ecx
|
||||
rol eax, 16
|
||||
rol ebx, 16
|
||||
add ax, cx
|
||||
add bx, dx
|
||||
|
||||
mov esi, 0x01000000
|
||||
call draw_rectangle.forced
|
||||
|
||||
popad
|
||||
|
||||
.exit:
|
||||
ret
|
||||
BIN
kernel/branches/kolibri-process/gui/char.mt
Normal file
BIN
kernel/branches/kolibri-process/gui/char.mt
Normal file
Binary file not shown.
BIN
kernel/branches/kolibri-process/gui/char2.mt
Normal file
BIN
kernel/branches/kolibri-process/gui/char2.mt
Normal file
Binary file not shown.
BIN
kernel/branches/kolibri-process/gui/char2_et.mt
Normal file
BIN
kernel/branches/kolibri-process/gui/char2_et.mt
Normal file
Binary file not shown.
BIN
kernel/branches/kolibri-process/gui/char2_sp.mt
Normal file
BIN
kernel/branches/kolibri-process/gui/char2_sp.mt
Normal file
Binary file not shown.
BIN
kernel/branches/kolibri-process/gui/char_et.mt
Normal file
BIN
kernel/branches/kolibri-process/gui/char_et.mt
Normal file
Binary file not shown.
BIN
kernel/branches/kolibri-process/gui/char_sp.mt
Normal file
BIN
kernel/branches/kolibri-process/gui/char_sp.mt
Normal file
Binary file not shown.
616
kernel/branches/kolibri-process/gui/event.inc
Normal file
616
kernel/branches/kolibri-process/gui/event.inc
Normal file
@@ -0,0 +1,616 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Copyright (C) MenuetOS 2000-2004 Ville Mikael Turjanmaa ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3565 $
|
||||
|
||||
WINDOW_MOVE_AND_RESIZE_FLAGS = \
|
||||
mouse.WINDOW_RESIZE_N_FLAG + \
|
||||
mouse.WINDOW_RESIZE_W_FLAG + \
|
||||
mouse.WINDOW_RESIZE_S_FLAG + \
|
||||
mouse.WINDOW_RESIZE_E_FLAG + \
|
||||
mouse.WINDOW_MOVE_FLAG
|
||||
|
||||
uglobal
|
||||
align 4
|
||||
event_start dd ?
|
||||
event_end dd ?
|
||||
event_uid dd 0
|
||||
endg
|
||||
EV_SPACE = 512
|
||||
FreeEvents = event_start-EVENT.fd ; "виртуальный" event, используются только поля:
|
||||
; FreeEvents.fd=event_start и FreeEvents.bk=event_end
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
init_events: ;; used from kernel.asm
|
||||
stdcall kernel_alloc, EV_SPACE*sizeof.EVENT
|
||||
or eax, eax
|
||||
jz .fail
|
||||
; eax - current event, ebx - previos event below
|
||||
mov ecx, EV_SPACE ; current - in allocated space
|
||||
mov ebx, FreeEvents ; previos - начало списка
|
||||
push ebx ; оно же и конец потом будет
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
mov [ebx+EVENT.fd], eax
|
||||
mov [eax+EVENT.bk], ebx
|
||||
mov ebx, eax ; previos <- current
|
||||
add eax, sizeof.EVENT ; new current
|
||||
loop @b
|
||||
pop eax ; вот оно концом и стало
|
||||
mov [ebx+EVENT.fd], eax
|
||||
mov [eax+EVENT.bk], ebx
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.fail:
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
EVENT_WATCHED equ 0x10000000 ;бит 28
|
||||
EVENT_SIGNALED equ 0x20000000 ;бит 29
|
||||
MANUAL_RESET equ 0x40000000 ;бит 30
|
||||
MANUAL_DESTROY equ 0x80000000 ;бит 31
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
create_event: ;; EXPORT use
|
||||
;info:
|
||||
; Переносим EVENT из списка FreeEvents в список ObjList текущего слота
|
||||
; EVENT.state устанавливаем из ecx, EVENT.code косвенно из esi (если esi<>0)
|
||||
;param:
|
||||
; esi - event data
|
||||
; ecx - flags
|
||||
;retval:
|
||||
; eax - event (=0 => fail)
|
||||
; edx - uid
|
||||
;scratched: ebx,ecx,esi,edi
|
||||
mov ebx, [current_slot]
|
||||
add ebx, APP_OBJ_OFFSET
|
||||
mov edx, [TASK_BASE]
|
||||
mov edx, [edx+TASKDATA.pid]
|
||||
pushfd
|
||||
cli
|
||||
;--------------------------------------
|
||||
align 4
|
||||
set_event: ;; INTERNAL use !!! don't use for Call
|
||||
;info:
|
||||
; Берем новый event из FreeEvents, заполняем его поля, как указано в ecx,edx,esi
|
||||
; и устанавливаем в список, указанный в ebx.
|
||||
; Возвращаем сам event (в eax), и его uid (в edx)
|
||||
;param:
|
||||
; ebx - start-chain "virtual" event for entry new event Right of him
|
||||
; ecx - flags (copied to EVENT.state)
|
||||
; edx - pid (copied to EVENT.pid)
|
||||
; esi - event data (copied to EVENT.code indirect, =0 => skip)
|
||||
;retval:
|
||||
; eax - event (=0 => fail)
|
||||
; edx - uid
|
||||
;scratched: ebx,ecx,esi,edi
|
||||
mov eax, FreeEvents
|
||||
cmp eax, [eax+EVENT.fd]
|
||||
jne @f ; not empty ???
|
||||
pushad
|
||||
call init_events
|
||||
popad
|
||||
jz RemoveEventTo.break ; POPF+RET
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
mov eax, [eax+EVENT.fd]
|
||||
mov [eax+EVENT.magic], 'EVNT'
|
||||
mov [eax+EVENT.destroy], destroy_event.internal
|
||||
mov [eax+EVENT.state], ecx
|
||||
mov [eax+EVENT.pid], edx
|
||||
inc [event_uid]
|
||||
Mov [eax+EVENT.id],edx,[event_uid]
|
||||
or esi, esi
|
||||
jz RemoveEventTo
|
||||
lea edi, [eax+EVENT.code]
|
||||
mov ecx, (sizeof.EVENT -EVENT.code)/4
|
||||
cld
|
||||
rep movsd
|
||||
;--------------------------------------
|
||||
align 4
|
||||
RemoveEventTo: ;; INTERNAL use !!! don't use for Call
|
||||
;param:
|
||||
; eax - указатель на event, КОТОРЫЙ вставляем
|
||||
; ebx - указатель на event, ПОСЛЕ которого вставляем
|
||||
;scratched: ebx,ecx
|
||||
mov ecx, eax ; ecx=eax=Self, ebx=NewLeft
|
||||
xchg ecx, [ebx+EVENT.fd] ; NewLeft.fd=Self, ecx=NewRight
|
||||
cmp eax, ecx ; стоп, себе думаю...
|
||||
je .break ; - а не дурак ли я?
|
||||
mov [ecx+EVENT.bk], eax ; NewRight.bk=Self
|
||||
xchg ebx, [eax+EVENT.bk] ; Self.bk=NewLeft, ebx=OldLeft
|
||||
xchg ecx, [eax+EVENT.fd] ; Self.fd=NewRight, ecx=OldRight
|
||||
mov [ebx+EVENT.fd], ecx ; OldLeft.fd=OldRight
|
||||
mov [ecx+EVENT.bk], ebx ; OldRight.bk=OldLeft
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.break:
|
||||
popfd
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
NotDummyTest: ;; INTERNAL use (not returned for fail !!!)
|
||||
pop edi
|
||||
call DummyTest ; not returned for fail !!!
|
||||
mov ebx, eax
|
||||
mov eax, [ebx+EVENT.pid]
|
||||
push edi
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.small: ; криво как-то...
|
||||
pop edi
|
||||
pushfd
|
||||
cli
|
||||
call pid_to_slot ; saved all registers (eax - retval)
|
||||
shl eax, 8
|
||||
jz RemoveEventTo.break ; POPF+RET
|
||||
jmp edi ; штатный возврат
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
raise_event: ;; EXPORT use
|
||||
;info:
|
||||
; Устанавливаем данные EVENT.code
|
||||
; Если там флаг EVENT_SIGNALED уже активен - больше ничего
|
||||
; Иначе: этот флаг взводится, за исключением случая наличия флага EVENT_WATCHED в edx
|
||||
; В этом случае EVENT_SIGNALED взводится лишь при наличие EVENT_WATCHED в самом событии
|
||||
;param:
|
||||
; eax - event
|
||||
; ebx - uid (for Dummy testing)
|
||||
; edx - flags
|
||||
; esi - event data (=0 => skip)
|
||||
;scratched: ebx,ecx,esi,edi
|
||||
call NotDummyTest ; not returned for fail !!!
|
||||
or esi, esi
|
||||
jz @f
|
||||
lea edi, [ebx+EVENT.code]
|
||||
mov ecx, (sizeof.EVENT -EVENT.code)/4
|
||||
cld
|
||||
rep movsd
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
test byte[ebx+EVENT.state+3], EVENT_SIGNALED shr 24
|
||||
jnz RemoveEventTo.break ; POPF+RET
|
||||
bt edx, 28 ;EVENT_WATCHED
|
||||
jnc @f
|
||||
test byte[ebx+EVENT.state+3], EVENT_WATCHED shr 24
|
||||
jz RemoveEventTo.break ; POPF+RET
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
or byte[ebx+EVENT.state+3], EVENT_SIGNALED shr 24
|
||||
add eax, SLOT_BASE+APP_EV_OFFSET
|
||||
xchg eax, ebx
|
||||
jmp RemoveEventTo
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
clear_event: ;; EXPORT use
|
||||
;info:
|
||||
;
|
||||
;param:
|
||||
; eax - event
|
||||
; ebx - uid (for Dummy testing)
|
||||
;scratched: ebx,ecx
|
||||
call NotDummyTest ; not returned for fail !!!
|
||||
add eax, SLOT_BASE+APP_OBJ_OFFSET
|
||||
and byte[ebx+EVENT.state+3], not((EVENT_SIGNALED+EVENT_WATCHED)shr 24)
|
||||
xchg eax, ebx
|
||||
jmp RemoveEventTo
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
send_event: ;; EXPORT use
|
||||
;info:
|
||||
; Создает новый EVENT (вытаскивает из списка FreeEvents) в списке EventList
|
||||
; целевого слота (eax=pid), с данными из esi косвенно, и state=EVENT_SIGNALED
|
||||
;param:
|
||||
; eax - slots pid, to sending new event
|
||||
; esi - pointer to sending data (in code field of new event)
|
||||
;retval:
|
||||
; eax - event (=0 => fail)
|
||||
; edx - uid
|
||||
;warning:
|
||||
; may be used as CDECL with such prefix...
|
||||
; mov esi,[esp+8]
|
||||
; mov eax,[esp+4]
|
||||
; but not as STDCALL :(
|
||||
;scratched: ebx,ecx,esi,edi
|
||||
mov edx, eax
|
||||
call NotDummyTest.small ; not returned for fail !!!
|
||||
lea ebx, [eax+SLOT_BASE+APP_EV_OFFSET]
|
||||
mov ecx, EVENT_SIGNALED
|
||||
jmp set_event
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
DummyTest: ;; INTERNAL use (not returned for fail !!!)
|
||||
;param:
|
||||
; eax - event
|
||||
; ebx - uid (for Dummy testing)
|
||||
cmp [eax+EVENT.magic], 'EVNT'
|
||||
jne @f
|
||||
cmp [eax+EVENT.id], ebx
|
||||
je .ret
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
pop eax
|
||||
xor eax, eax
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.ret:
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
Wait_events:
|
||||
or ebx, -1; infinite timeout
|
||||
;--------------------------------------
|
||||
align 4
|
||||
Wait_events_ex:
|
||||
;info:
|
||||
; Ожидание "абстрактного" события через перевод слота в 5-ю позицию.
|
||||
; Абстрактность заключена в том, что факт события определяется функцией APPDATA.wait_test,
|
||||
; которая задается клиентом и может быть фактически любой.
|
||||
; Это позволяет shed-у надежно определить факт события, и не совершать "холостых" переключений,
|
||||
; предназначенных для разборок типа "свой/чужой" внутри задачи.
|
||||
;param:
|
||||
; edx - wait_test, клиентская ф-я тестирования (адрес кода)
|
||||
; ecx - wait_param, дополнительный параметр, возможно необходимый для [wait_test]
|
||||
; ebx - wait_timeout
|
||||
;retval:
|
||||
; eax - результат вызова [wait_test] (=0 => timeout)
|
||||
;scratched: esi
|
||||
mov esi, [current_slot]
|
||||
mov [esi+APPDATA.wait_param], ecx
|
||||
pushad
|
||||
mov ebx, esi;пока это вопрос, чего куды сувать..........
|
||||
pushfd ; это следствие общей концепции: пусть ф-я тестирования имеет
|
||||
cli ; право рассчитывать на закрытые прерывания, как при вызове из shed
|
||||
call edx
|
||||
popfd
|
||||
mov [esp+28], eax
|
||||
popad
|
||||
or eax, eax
|
||||
jnz @f ;RET
|
||||
mov [esi+APPDATA.wait_test], edx
|
||||
mov [esi+APPDATA.wait_timeout], ebx
|
||||
Mov [esi+APPDATA.wait_begin],eax,[timer_ticks]
|
||||
mov eax, [TASK_BASE]
|
||||
mov [eax+TASKDATA.state], 5
|
||||
call change_task
|
||||
mov eax, [esi+APPDATA.wait_param]
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
wait_event: ;; EXPORT use
|
||||
;info:
|
||||
; Ожидание флага EVENT_SIGNALED в совершенно конкретном Event
|
||||
; (устанавливаемого, надо полагать, через raise_event)
|
||||
; При активном флаге MANUAL_RESET - больше ничего
|
||||
; Иначе: флаги EVENT_SIGNALED и EVENT_WATCHED у полученного события сбрасываются,
|
||||
; и, при активном MANUAL_DESTROY - перемещается в список ObjList текущего слота,
|
||||
; а при не активном - уничтожается штатно (destroy_event.internal)
|
||||
;param:
|
||||
; eax - event
|
||||
; ebx - uid (for Dummy testing)
|
||||
;scratched: ecx,edx,esi
|
||||
call DummyTest
|
||||
mov ecx, eax ; wait_param
|
||||
mov edx, get_event_alone ; wait_test
|
||||
call Wait_events ; timeout ignored
|
||||
jmp wait_finish
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
wait_event_timeout:
|
||||
;param:
|
||||
; eax - event
|
||||
; ebx - uid (for Dummy testing)
|
||||
; ecx - timeout in timer ticks
|
||||
;retval:
|
||||
; eax - EVENT handle or 0 if timeout
|
||||
call DummyTest
|
||||
mov ebx, ecx
|
||||
mov ecx, eax ; wait_param
|
||||
mov edx, get_event_alone ; wait_test
|
||||
call Wait_events_ex
|
||||
test eax, eax
|
||||
jnz wait_finish
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
get_event_ex: ;; f68:14
|
||||
;info:
|
||||
; Ожидание любого события в очереди EventList текущего слота
|
||||
; Данные события code - копируются в память приложения (косвенно по edi)
|
||||
; При активном флаге MANUAL_RESET - больше ничего
|
||||
; Иначе: флаги EVENT_SIGNALED и EVENT_WATCHED у полученного события сбрасываются,
|
||||
; и, при активном MANUAL_DESTROY - перемещается в список ObjList текущего слота,
|
||||
; а при не активном - уничтожается штатно (destroy_event.internal)
|
||||
;param:
|
||||
; edi - адрес в коде приложения для копирования данных из EVENT.code
|
||||
;retval:
|
||||
; eax - собственно EVENT (будем называть это его хэндлом)
|
||||
;scratched: ebx,ecx,edx,esi,edi
|
||||
mov edx, get_event_queue ; wait_test
|
||||
call Wait_events ; timeout ignored
|
||||
lea esi, [eax+EVENT.code]
|
||||
mov ecx, (sizeof.EVENT-EVENT.code)/4
|
||||
cld
|
||||
rep movsd
|
||||
mov byte[edi-(sizeof.EVENT-EVENT.code)+2], cl;clear priority field
|
||||
;--------------------------------------
|
||||
align 4
|
||||
wait_finish:
|
||||
test byte[eax+EVENT.state+3], MANUAL_RESET shr 24
|
||||
jnz get_event_queue.ret ; RET
|
||||
and byte[eax+EVENT.state+3], not((EVENT_SIGNALED+EVENT_WATCHED)shr 24)
|
||||
test byte[eax+EVENT.state+3], MANUAL_DESTROY shr 24
|
||||
jz destroy_event.internal
|
||||
mov ebx, [current_slot]
|
||||
add ebx, APP_OBJ_OFFSET
|
||||
pushfd
|
||||
cli
|
||||
jmp RemoveEventTo
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
destroy_event: ;; EXPORT use
|
||||
;info:
|
||||
; Переносим EVENT в список FreeEvents, чистим поля magic,destroy,pid,id
|
||||
;param:
|
||||
; eax - event
|
||||
; ebx - uid (for Dummy testing)
|
||||
;retval:
|
||||
; eax - адрес объекта EVENT (=0 => fail)
|
||||
;scratched: ebx,ecx
|
||||
call DummyTest ; not returned for fail !!!
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.internal:
|
||||
xor ecx, ecx ; clear common header
|
||||
pushfd
|
||||
cli
|
||||
mov [eax+EVENT.magic], ecx
|
||||
mov [eax+EVENT.destroy], ecx
|
||||
mov [eax+EVENT.pid], ecx
|
||||
mov [eax+EVENT.id], ecx
|
||||
mov ebx, FreeEvents
|
||||
jmp RemoveEventTo
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
get_event_queue:
|
||||
;info:
|
||||
; клиентская ф-я тестирования для get_event_ex
|
||||
;warning:
|
||||
; -don't use [TASK_BASE],[current_slot],[CURRENT_TASK] - it is not for your slot
|
||||
; -may be assumed, that interrupt are disabled
|
||||
; -it is not restriction for scratched registers
|
||||
;param:
|
||||
; ebx - адрес APPDATA слота тестирования
|
||||
;retval:
|
||||
; eax - адрес объекта EVENT (=0 => fail)
|
||||
add ebx, APP_EV_OFFSET
|
||||
mov eax, [ebx+APPOBJ.bk] ; выбираем с конца, по принципу FIFO
|
||||
cmp eax, ebx ; empty ???
|
||||
je get_event_alone.ret0
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.ret:
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
get_event_alone:
|
||||
;info:
|
||||
; клиентская ф-я тестирования для wait_event
|
||||
;warning:
|
||||
; -don't use [TASK_BASE],[current_slot],[CURRENT_TASK] - it is not for your slot
|
||||
; -may be assumed, that interrupt are disabled
|
||||
; -it is not restriction for scratched registers
|
||||
;param:
|
||||
; ebx - адрес APPDATA слота тестирования
|
||||
;retval:
|
||||
; eax - адрес объекта EVENT (=0 => fail)
|
||||
mov eax, [ebx+APPDATA.wait_param]
|
||||
test byte[eax+EVENT.state+3], EVENT_SIGNALED shr 24
|
||||
jnz .ret
|
||||
or byte[eax+EVENT.state+3], EVENT_WATCHED shr 24
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.ret0:
|
||||
xor eax, eax; NO event!!!
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.ret:
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
sys_sendwindowmsg: ;; f72
|
||||
dec ebx
|
||||
jnz .ret ;subfunction==1 ?
|
||||
pushfd
|
||||
cli
|
||||
sub ecx, 2
|
||||
je .sendkey
|
||||
dec ecx
|
||||
jnz .retf
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.sendbtn:
|
||||
cmp byte[BTN_COUNT], 1
|
||||
jae .result ;overflow
|
||||
inc byte[BTN_COUNT]
|
||||
shl edx, 8
|
||||
mov [BTN_BUFF], edx
|
||||
jmp .result
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.sendkey:
|
||||
movzx eax, byte[KEY_COUNT]
|
||||
cmp al, 120
|
||||
jae .result ;overflow
|
||||
inc byte[KEY_COUNT]
|
||||
mov [KEY_COUNT+1+eax], dl
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.result:
|
||||
setae byte[esp+32+4] ;считаем, что исходно: dword[esp+32+4]==72
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.retf:
|
||||
popfd
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.ret:
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
sys_getevent: ;; f11
|
||||
mov ebx, [current_slot];пока это вопрос, чего куды сувать..........
|
||||
pushfd ; это следствие общей концепции: пусть ф-я тестирования имеет
|
||||
cli ; право рассчитывать на закрытые прерывания, как при вызове из shed
|
||||
call get_event_for_app
|
||||
popfd
|
||||
mov [esp+32], eax
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
sys_waitforevent: ;; f10
|
||||
or ebx, -1; infinite timeout
|
||||
;--------------------------------------
|
||||
align 4
|
||||
sys_wait_event_timeout: ;; f23
|
||||
call unprotect_from_terminate
|
||||
mov edx, get_event_for_app; wait_test
|
||||
call Wait_events_ex ; ebx - timeout
|
||||
mov [esp+32], eax
|
||||
call protect_from_terminate
|
||||
ret
|
||||
;-----------------------------------------------------------------------------
|
||||
align 4
|
||||
get_event_for_app: ;; used from f10,f11,f23
|
||||
;info:
|
||||
; клиентская ф-я тестирования для приложений (f10,f23)
|
||||
;warning:
|
||||
; -don't use [TASK_BASE],[current_slot],[CURRENT_TASK] - it is not for your slot
|
||||
; -may be assumed, that interrupt are disabled
|
||||
; -it is not restriction for scratched registers
|
||||
;param:
|
||||
; ebx - адрес APPDATA слота тестирования
|
||||
;retval:
|
||||
; eax - номер события (=0 => no events)
|
||||
movzx edi, bh ; bh is assumed as [CURRENT_TASK]
|
||||
shl edi, 5
|
||||
add edi, CURRENT_TASK ; edi is assumed as [TASK_BASE]
|
||||
mov ecx, [edi+TASKDATA.event_mask]
|
||||
and ecx, 0x7FFFFFFF
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.loop: ; пока не исчерпаем все биты маски
|
||||
bsr eax, ecx ; находим ненулевой бит маски (31 -> 0)
|
||||
jz .no_events ; исчерпали все биты маски, но ничего не нашли ???
|
||||
btr ecx, eax ; сбрасываем проверяемый бит маски
|
||||
; переходим на обработчик этого (eax) бита
|
||||
cmp eax, 10
|
||||
jae .loop ; eax=[10..31], ignored (event 11...32)
|
||||
|
||||
cmp eax, 3
|
||||
je .loop ; eax=3, ignored (event 4)
|
||||
|
||||
cmp eax, 4
|
||||
je .FlagAutoReset ; eax=4, retvals=eax+1 (event 5)
|
||||
|
||||
cmp eax, 5
|
||||
je .mouse_check ; eax=5, retvals=eax+1 (event 6)
|
||||
|
||||
ja .FlagAutoReset ; eax=[6..9], retvals=eax+1 (event 7...10)
|
||||
|
||||
cmp eax, 1
|
||||
jae .BtKy ; eax=[1,2], retvals=eax+1 (event 2,3)
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.WndRedraw: ; eax=0, retval WndRedraw=1
|
||||
cmp [edi-twdw+WDATA.fl_redraw], al;al==0
|
||||
jne .result
|
||||
jmp .loop
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.no_events:
|
||||
xor eax, eax
|
||||
ret
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.mouse_check: ; Mouse 5+1=6
|
||||
push eax
|
||||
mov eax, [TASK_BASE]
|
||||
mov eax, [eax + TASKDATA.event_mask]
|
||||
test eax, 0x80000000 ; bit 31: active/inactive filter f.40
|
||||
jz @f
|
||||
pop eax
|
||||
jmp .FlagAutoReset
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
; If the window is captured and moved by the user, then no mouse events!!!
|
||||
mov al, [mouse.active_sys_window.action]
|
||||
and al, WINDOW_MOVE_AND_RESIZE_FLAGS
|
||||
test al, al
|
||||
pop eax
|
||||
jnz .loop
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.FlagAutoReset: ; retvals: BgrRedraw=5, IPC=7, Stack=8, Debug=9
|
||||
btr [ebx+APPDATA.event_mask], eax
|
||||
jnc .loop
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.result: ; retval = eax+1
|
||||
inc eax
|
||||
ret
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.BtKy:
|
||||
movzx edx, bh
|
||||
movzx edx, word[WIN_STACK+edx*2]
|
||||
je .Keys ; eax=1, retval Keys=2
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.Buttons: ; eax=2, retval Buttons=3
|
||||
cmp byte[BTN_COUNT], 0
|
||||
je .loop ; empty ???
|
||||
cmp edx, [TASK_COUNT]
|
||||
jne .loop ; not Top ???
|
||||
mov edx, [BTN_BUFF]
|
||||
shr edx, 8
|
||||
cmp edx, 0xFFFF ;-ID for Minimize-Button of Form
|
||||
jne .result
|
||||
mov [window_minimize], 1
|
||||
call wakeup_osloop
|
||||
dec byte[BTN_COUNT]
|
||||
jmp .loop
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.Keys: ; eax==1
|
||||
cmp edx, [TASK_COUNT]
|
||||
jne @f ; not Top ???
|
||||
cmp [KEY_COUNT], al; al==1
|
||||
jae .result ; not empty ???
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
mov edx, hotkey_buffer
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
cmp [edx], bh ; bh - slot for testing
|
||||
je .result
|
||||
add edx, 8
|
||||
cmp edx, hotkey_buffer+120*8
|
||||
jb @b
|
||||
jmp .loop
|
||||
;end.
|
||||
;-----------------------------------------------------------------------------
|
||||
251
kernel/branches/kolibri-process/gui/font.inc
Normal file
251
kernel/branches/kolibri-process/gui/font.inc
Normal file
@@ -0,0 +1,251 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3927 $
|
||||
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
dtext_asciiz_esi: ; for skins title out
|
||||
push eax
|
||||
xor eax, eax
|
||||
inc eax
|
||||
jmp dtext.1
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
dtext:
|
||||
; ebx x & y
|
||||
; ecx style ( 0xX0000000 ) & color ( 0x00RRGGBB )
|
||||
; X = ABnnb:
|
||||
; nn = font
|
||||
; A = 0 <=> output esi characters; otherwise output ASCIIZ string
|
||||
; B = 1 <=> fill background with color eax
|
||||
; edx start of text
|
||||
; edi 1 force or user area for redirect
|
||||
push eax
|
||||
xor eax, eax
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.1:
|
||||
pushad
|
||||
movsx eax, bx ; eax=y
|
||||
sar ebx, 16 ; ebx=x
|
||||
xchg eax, ebx ; eax=x, ebx=y
|
||||
cmp esi, 255
|
||||
jb .loop
|
||||
|
||||
mov esi, 255
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.loop:
|
||||
test ecx, ecx
|
||||
js .test_asciiz
|
||||
|
||||
dec esi
|
||||
js .end
|
||||
|
||||
jmp @f
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.test_asciiz:
|
||||
cmp byte [edx], 0
|
||||
jz .end
|
||||
|
||||
cmp byte [esp+28], 1
|
||||
jne @f
|
||||
|
||||
dec esi
|
||||
js .end
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
inc edx
|
||||
pushad
|
||||
movzx edx, byte [edx-1]
|
||||
test ecx, 0x10000000
|
||||
jnz .font2
|
||||
|
||||
mov esi, 9
|
||||
lea ebp, [FONT_I+8*edx+edx]
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.symloop1:
|
||||
mov dl, byte [ebp]
|
||||
or dl, 1 shl 6
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.pixloop1:
|
||||
shr dl, 1
|
||||
jz .pixloop1end
|
||||
|
||||
jnc .nopix
|
||||
|
||||
test ecx, 0x08000000 ; redirect the output to the user area
|
||||
jz @f
|
||||
|
||||
call draw_text_to_user_area
|
||||
jmp .pixloop1cont
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
and ecx, 0xFBFFFFFF ;negate 0x04000000 save to mouseunder area
|
||||
; call [putpixel]
|
||||
call __sys_putpixel
|
||||
jmp .pixloop1cont
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.nopix:
|
||||
test ecx, 0x40000000
|
||||
jz .pixloop1cont
|
||||
|
||||
push ecx
|
||||
mov ecx, [esp+4+20h+20h]
|
||||
|
||||
test ecx, 0x08000000 ; redirect the output to the user area
|
||||
jz @f
|
||||
|
||||
call draw_text_to_user_area
|
||||
pop ecx
|
||||
jmp .pixloop1cont
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
and ecx, 0xFBFFFFFF ;negate 0x04000000 save to mouseunder area
|
||||
; call [putpixel]
|
||||
call __sys_putpixel
|
||||
pop ecx
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.pixloop1cont:
|
||||
inc eax
|
||||
jmp .pixloop1
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.pixloop1end:
|
||||
sub eax, 6
|
||||
inc ebx
|
||||
inc ebp
|
||||
dec esi
|
||||
jnz .symloop1
|
||||
|
||||
popad
|
||||
add eax, 6
|
||||
jmp .loop
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.font2:
|
||||
add edx, edx
|
||||
lea ebp, [FONT_II+4*edx+edx+1]
|
||||
push 9
|
||||
movzx esi, byte [ebp-1]
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.symloop2:
|
||||
mov dl, byte [ebp]
|
||||
push esi
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.pixloop2:
|
||||
shr dl, 1
|
||||
jnc .nopix2
|
||||
|
||||
test ecx, 0x08000000 ; redirect the output to the user area
|
||||
jz @f
|
||||
|
||||
call draw_text_to_user_area
|
||||
jmp .pixloop2cont
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
and ecx, 0xFBFFFFFF ;negate 0x04000000 save to mouseunder area
|
||||
; call [putpixel]
|
||||
call __sys_putpixel
|
||||
jmp .pixloop2cont
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.nopix2:
|
||||
test ecx, 0x40000000
|
||||
jz .pixloop2cont
|
||||
|
||||
push ecx
|
||||
mov ecx, [esp+12+20h+20h]
|
||||
|
||||
test ecx, 0x08000000 ; redirect the output to the user area
|
||||
jz @f
|
||||
|
||||
call draw_text_to_user_area
|
||||
pop ecx
|
||||
jmp .pixloop2cont
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
and ecx, 0xFBFFFFFF ;negate 0x04000000 save to mouseunder area
|
||||
; call [putpixel]
|
||||
call __sys_putpixel
|
||||
pop ecx
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.pixloop2cont:
|
||||
inc eax
|
||||
dec esi
|
||||
jnz .pixloop2
|
||||
|
||||
pop esi
|
||||
sub eax, esi
|
||||
inc ebx
|
||||
inc ebp
|
||||
dec dword [esp]
|
||||
jnz .symloop2
|
||||
|
||||
pop eax
|
||||
add dword [esp+28], esi
|
||||
popad
|
||||
jmp .loop
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.end:
|
||||
popad
|
||||
pop eax
|
||||
ret
|
||||
;------------------------------------------------------------------------------
|
||||
; eax = x coordinate
|
||||
; ebx = y coordinate
|
||||
; ecx = ?? RR GG BB
|
||||
; edi = user area
|
||||
align 4
|
||||
draw_text_to_user_area:
|
||||
pushad
|
||||
imul ebx, [edi+0]
|
||||
add eax, ebx
|
||||
shl eax, 2
|
||||
add eax, edi
|
||||
add eax, 8
|
||||
and ecx, 0xffffff
|
||||
or ecx, 0xff000000 ; not transparent
|
||||
mov [eax], ecx ; store pixel
|
||||
popad
|
||||
ret
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
FONT_I:
|
||||
if lang eq sp
|
||||
file 'char_sp.mt'
|
||||
else if lang eq et
|
||||
file 'char_et.mt'
|
||||
else
|
||||
file 'char.mt'
|
||||
end if
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
FONT_II:
|
||||
if lang eq sp
|
||||
file 'char2_sp.mt'
|
||||
else if lang eq et
|
||||
file 'char2_et.mt'
|
||||
else
|
||||
file 'char2.mt'
|
||||
end if
|
||||
;------------------------------------------------------------------------------
|
||||
711
kernel/branches/kolibri-process/gui/mouse.inc
Normal file
711
kernel/branches/kolibri-process/gui/mouse.inc
Normal file
@@ -0,0 +1,711 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2010-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 4424 $
|
||||
|
||||
include 'mousepointer.inc'
|
||||
|
||||
;==============================================================================
|
||||
;///// public functions ///////////////////////////////////////////////////////
|
||||
;==============================================================================
|
||||
|
||||
mouse.LEFT_BUTTON_FLAG = 0001b
|
||||
mouse.RIGHT_BUTTON_FLAG = 0010b
|
||||
mouse.MIDDLE_BUTTON_FLAG = 0100b
|
||||
|
||||
mouse.BUTTONS_MASK = \
|
||||
mouse.LEFT_BUTTON_FLAG or \
|
||||
mouse.RIGHT_BUTTON_FLAG or \
|
||||
mouse.MIDDLE_BUTTON_FLAG
|
||||
|
||||
mouse.WINDOW_RESIZE_N_FLAG = 000001b
|
||||
mouse.WINDOW_RESIZE_W_FLAG = 000010b
|
||||
mouse.WINDOW_RESIZE_S_FLAG = 000100b
|
||||
mouse.WINDOW_RESIZE_E_FLAG = 001000b
|
||||
mouse.WINDOW_MOVE_FLAG = 010000b
|
||||
|
||||
mouse.WINDOW_RESIZE_SW_FLAG = \
|
||||
mouse.WINDOW_RESIZE_S_FLAG or \
|
||||
mouse.WINDOW_RESIZE_W_FLAG
|
||||
mouse.WINDOW_RESIZE_SE_FLAG = \
|
||||
mouse.WINDOW_RESIZE_S_FLAG or \
|
||||
mouse.WINDOW_RESIZE_E_FLAG
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse_check_events: ;//////////////////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Check if mouse buttons state or cursor position has changed and call
|
||||
;? appropriate handlers
|
||||
;------------------------------------------------------------------------------
|
||||
push eax ebx
|
||||
|
||||
mov al, [BTN_DOWN]
|
||||
mov bl, [mouse.state.buttons]
|
||||
and al, mouse.BUTTONS_MASK
|
||||
mov cl, al
|
||||
xchg cl, [mouse.state.buttons]
|
||||
xor bl, al
|
||||
push eax ebx
|
||||
|
||||
; did any mouse button changed its state?
|
||||
or bl, bl
|
||||
jz .check_position
|
||||
|
||||
; yes it did, is that the first button of all pressed down?
|
||||
or cl, cl
|
||||
jnz .check_buttons_released
|
||||
|
||||
; yes it is, activate window user is pointing at, if needed
|
||||
call mouse._.activate_sys_window_under_cursor
|
||||
|
||||
; NOTE: this code wouldn't be necessary if we knew window did
|
||||
; already redraw itself after call above
|
||||
or eax, eax
|
||||
jnz .exit
|
||||
|
||||
; is there any system button under cursor?
|
||||
call mouse._.find_sys_button_under_cursor
|
||||
or eax, eax
|
||||
jz .check_buttons_released
|
||||
|
||||
; yes there is, activate it and exit
|
||||
mov [mouse.active_sys_button.pbid], eax
|
||||
mov [mouse.active_sys_button.coord], ebx
|
||||
mov cl, [mouse.state.buttons]
|
||||
mov [mouse.active_sys_button.buttons], cl
|
||||
call sys_button_activate_handler
|
||||
jmp .exit
|
||||
|
||||
.check_buttons_released:
|
||||
cmp [mouse.state.buttons], 0
|
||||
jnz .buttons_changed
|
||||
|
||||
; did we press some button earlier?
|
||||
cmp [mouse.active_sys_button.pbid], 0
|
||||
je .buttons_changed
|
||||
|
||||
; yes we did, deactivate it
|
||||
xor eax, eax
|
||||
xchg eax, [mouse.active_sys_button.pbid]
|
||||
mov ebx, [mouse.active_sys_button.coord]
|
||||
mov cl, [mouse.active_sys_button.buttons]
|
||||
push eax ebx
|
||||
call sys_button_deactivate_handler
|
||||
pop edx ecx
|
||||
|
||||
; is the button under cursor the one we deactivated?
|
||||
call mouse._.find_sys_button_under_cursor
|
||||
cmp eax, ecx
|
||||
jne .exit
|
||||
cmp ebx, edx
|
||||
jne .exit
|
||||
|
||||
; yes it is, perform associated action
|
||||
mov cl, [mouse.active_sys_button.buttons]
|
||||
call sys_button_perform_handler
|
||||
jmp .exit
|
||||
|
||||
.buttons_changed:
|
||||
test byte[esp], mouse.LEFT_BUTTON_FLAG
|
||||
jz @f
|
||||
mov eax, [esp + 4]
|
||||
call .call_left_button_handler
|
||||
|
||||
@@:
|
||||
test byte[esp], mouse.RIGHT_BUTTON_FLAG
|
||||
jz @f
|
||||
mov eax, [esp + 4]
|
||||
call .call_right_button_handler
|
||||
|
||||
@@:
|
||||
test byte[esp], mouse.MIDDLE_BUTTON_FLAG
|
||||
jz .check_position
|
||||
mov eax, [esp + 4]
|
||||
call .call_middle_button_handler
|
||||
|
||||
.check_position:
|
||||
movzx eax, word[MOUSE_X]
|
||||
movzx ebx, word[MOUSE_Y]
|
||||
cmp eax, [mouse.state.pos.x]
|
||||
jne .position_changed
|
||||
cmp ebx, [mouse.state.pos.y]
|
||||
je .exit
|
||||
|
||||
.position_changed:
|
||||
xchg eax, [mouse.state.pos.x]
|
||||
xchg ebx, [mouse.state.pos.y]
|
||||
|
||||
call mouse._.move_handler
|
||||
|
||||
.exit:
|
||||
add esp, 8
|
||||
pop ebx eax
|
||||
ret
|
||||
|
||||
.call_left_button_handler:
|
||||
test eax, mouse.LEFT_BUTTON_FLAG
|
||||
jnz mouse._.left_button_press_handler
|
||||
jmp mouse._.left_button_release_handler
|
||||
|
||||
.call_right_button_handler:
|
||||
test eax, mouse.RIGHT_BUTTON_FLAG
|
||||
jnz mouse._.right_button_press_handler
|
||||
jmp mouse._.right_button_release_handler
|
||||
|
||||
.call_middle_button_handler:
|
||||
test eax, mouse.MIDDLE_BUTTON_FLAG
|
||||
jnz mouse._.middle_button_press_handler
|
||||
jmp mouse._.middle_button_release_handler
|
||||
|
||||
;==============================================================================
|
||||
;///// private functions //////////////////////////////////////////////////////
|
||||
;==============================================================================
|
||||
|
||||
uglobal
|
||||
mouse.state:
|
||||
.pos POINT
|
||||
.buttons db ?
|
||||
|
||||
; NOTE: since there's no unique and lifetime-constant button identifiers,
|
||||
; we're using two dwords to identify each of them:
|
||||
; * pbid - process slot (high 8 bits) and button id (low 24 bits) pack
|
||||
; * coord - left (high 16 bits) and top (low 16 bits) coordinates pack
|
||||
align 4
|
||||
mouse.active_sys_button:
|
||||
.pbid dd ?
|
||||
.coord dd ?
|
||||
.buttons db ?
|
||||
|
||||
align 4
|
||||
mouse.active_sys_window:
|
||||
.pslot dd ?
|
||||
.old_box BOX
|
||||
.new_box BOX
|
||||
.delta POINT
|
||||
.last_ticks dd ?
|
||||
.action db ?
|
||||
endg
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.left_button_press_handler: ;///////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Called when left mouse button has been pressed down
|
||||
;------------------------------------------------------------------------------
|
||||
test [mouse.state.buttons], not mouse.LEFT_BUTTON_FLAG
|
||||
jnz .exit
|
||||
|
||||
call mouse._.find_sys_window_under_cursor
|
||||
call mouse._.check_sys_window_actions
|
||||
mov [mouse.active_sys_window.action], al
|
||||
or eax, eax
|
||||
jz .exit
|
||||
|
||||
xchg eax, edx
|
||||
test dl, mouse.WINDOW_MOVE_FLAG
|
||||
jz @f
|
||||
|
||||
mov eax, [timer_ticks]
|
||||
mov ebx, eax
|
||||
xchg ebx, [mouse.active_sys_window.last_ticks]
|
||||
sub eax, ebx
|
||||
cmp eax, 50
|
||||
jg @f
|
||||
|
||||
mov [mouse.active_sys_window.last_ticks], 0
|
||||
call sys_window_maximize_handler
|
||||
jmp .exit
|
||||
|
||||
@@:
|
||||
test [edi + WDATA.fl_wstate], WSTATE_MAXIMIZED
|
||||
jnz .exit
|
||||
mov [mouse.active_sys_window.pslot], esi
|
||||
lea eax, [edi + WDATA.box]
|
||||
mov ebx, mouse.active_sys_window.old_box
|
||||
mov ecx, sizeof.BOX
|
||||
call memmove
|
||||
mov ebx, mouse.active_sys_window.new_box
|
||||
call memmove
|
||||
test edx, mouse.WINDOW_MOVE_FLAG
|
||||
jz @f
|
||||
|
||||
call .calculate_n_delta
|
||||
call .calculate_w_delta
|
||||
jmp .call_window_handler
|
||||
|
||||
@@:
|
||||
test dl, mouse.WINDOW_RESIZE_W_FLAG
|
||||
jz @f
|
||||
call .calculate_w_delta
|
||||
|
||||
@@:
|
||||
test dl, mouse.WINDOW_RESIZE_S_FLAG
|
||||
jz @f
|
||||
call .calculate_s_delta
|
||||
|
||||
@@:
|
||||
test dl, mouse.WINDOW_RESIZE_E_FLAG
|
||||
jz .call_window_handler
|
||||
call .calculate_e_delta
|
||||
|
||||
.call_window_handler:
|
||||
; mov eax, mouse.active_sys_window.old_box
|
||||
; call sys_window_start_moving_handler
|
||||
|
||||
.exit:
|
||||
ret
|
||||
|
||||
.calculate_n_delta:
|
||||
mov eax, [mouse.state.pos.y]
|
||||
sub eax, [mouse.active_sys_window.old_box.top]
|
||||
mov [mouse.active_sys_window.delta.y], eax
|
||||
ret
|
||||
|
||||
.calculate_w_delta:
|
||||
mov eax, [mouse.state.pos.x]
|
||||
sub eax, [mouse.active_sys_window.old_box.left]
|
||||
mov [mouse.active_sys_window.delta.x], eax
|
||||
ret
|
||||
|
||||
.calculate_s_delta:
|
||||
mov eax, [mouse.active_sys_window.old_box.top]
|
||||
add eax, [mouse.active_sys_window.old_box.height]
|
||||
sub eax, [mouse.state.pos.y]
|
||||
mov [mouse.active_sys_window.delta.y], eax
|
||||
ret
|
||||
|
||||
.calculate_e_delta:
|
||||
mov eax, [mouse.active_sys_window.old_box.left]
|
||||
add eax, [mouse.active_sys_window.old_box.width]
|
||||
sub eax, [mouse.state.pos.x]
|
||||
mov [mouse.active_sys_window.delta.x], eax
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.left_button_release_handler: ;/////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Called when left mouse button has been released
|
||||
;------------------------------------------------------------------------------
|
||||
xor esi, esi
|
||||
xchg esi, [mouse.active_sys_window.pslot]
|
||||
or esi, esi
|
||||
jz .exit
|
||||
|
||||
mov eax, esi
|
||||
shl eax, 5
|
||||
add eax, window_data + WDATA.box
|
||||
mov ebx, mouse.active_sys_window.old_box
|
||||
mov ecx, sizeof.BOX
|
||||
call memmove
|
||||
|
||||
mov eax, mouse.active_sys_window.old_box
|
||||
mov ebx, mouse.active_sys_window.new_box
|
||||
call sys_window_end_moving_handler
|
||||
|
||||
.exit:
|
||||
and [mouse.active_sys_window.action], 0
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.right_button_press_handler: ;//////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Called when right mouse button has been pressed down
|
||||
;------------------------------------------------------------------------------
|
||||
test [mouse.state.buttons], not mouse.RIGHT_BUTTON_FLAG
|
||||
jnz .exit
|
||||
|
||||
call mouse._.find_sys_window_under_cursor
|
||||
call mouse._.check_sys_window_actions
|
||||
test al, mouse.WINDOW_MOVE_FLAG
|
||||
jz .exit
|
||||
|
||||
call sys_window_rollup_handler
|
||||
|
||||
.exit:
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.right_button_release_handler: ;////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Called when right mouse button has been released
|
||||
;------------------------------------------------------------------------------
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.middle_button_press_handler: ;/////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Called when middle mouse button has been pressed down
|
||||
;------------------------------------------------------------------------------
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.middle_button_release_handler: ;///////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Called when middle mouse button has been released
|
||||
;------------------------------------------------------------------------------
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.move_handler: ;////////////////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Called when cursor has been moved
|
||||
;------------------------------------------------------------------------------
|
||||
;> eax = old x coord
|
||||
;> ebx = old y coord
|
||||
;------------------------------------------------------------------------------
|
||||
cmp [mouse.active_sys_button.pbid], 0
|
||||
jnz .exit
|
||||
|
||||
mov esi, [mouse.active_sys_window.pslot]
|
||||
or esi, esi
|
||||
jz .exit
|
||||
|
||||
mov eax, mouse.active_sys_window.new_box
|
||||
mov ebx, mouse.active_sys_window.old_box
|
||||
mov ecx, sizeof.BOX
|
||||
call memmove
|
||||
|
||||
mov dl, [mouse.active_sys_window.action]
|
||||
test dl, mouse.WINDOW_MOVE_FLAG
|
||||
jz .check_resize_w
|
||||
|
||||
mov eax, [mouse.state.pos.x]
|
||||
sub eax, [mouse.active_sys_window.delta.x]
|
||||
mov [mouse.active_sys_window.new_box.left], eax
|
||||
mov eax, [mouse.state.pos.y]
|
||||
sub eax, [mouse.active_sys_window.delta.y]
|
||||
mov [mouse.active_sys_window.new_box.top], eax
|
||||
|
||||
mov eax, [mouse.active_sys_window.new_box.left]
|
||||
or eax, eax
|
||||
jge @f
|
||||
xor eax, eax
|
||||
mov [mouse.active_sys_window.new_box.left], eax
|
||||
@@:
|
||||
add eax, [mouse.active_sys_window.new_box.width]
|
||||
cmp eax, [Screen_Max_X]
|
||||
jl @f
|
||||
sub eax, [Screen_Max_X]
|
||||
sub [mouse.active_sys_window.new_box.left], eax
|
||||
@@:
|
||||
mov eax, [mouse.active_sys_window.new_box.top]
|
||||
or eax, eax
|
||||
jge @f
|
||||
xor eax, eax
|
||||
mov [mouse.active_sys_window.new_box.top], eax
|
||||
@@:
|
||||
add eax, [mouse.active_sys_window.new_box.height]
|
||||
cmp eax, [Screen_Max_Y]
|
||||
jle .call_window_handler
|
||||
sub eax, [Screen_Max_Y]
|
||||
sub [mouse.active_sys_window.new_box.top], eax
|
||||
jmp .call_window_handler
|
||||
|
||||
.check_resize_w:
|
||||
test dl, mouse.WINDOW_RESIZE_W_FLAG
|
||||
jz .check_resize_s
|
||||
|
||||
mov eax, [mouse.state.pos.x]
|
||||
sub eax, [mouse.active_sys_window.delta.x]
|
||||
mov [mouse.active_sys_window.new_box.left], eax
|
||||
sub eax, [mouse.active_sys_window.old_box.left]
|
||||
sub [mouse.active_sys_window.new_box.width], eax
|
||||
|
||||
mov eax, [mouse.active_sys_window.new_box.width]
|
||||
sub eax, 127
|
||||
jge @f
|
||||
add [mouse.active_sys_window.new_box.left], eax
|
||||
mov [mouse.active_sys_window.new_box.width], 127
|
||||
@@:
|
||||
mov eax, [mouse.active_sys_window.new_box.left]
|
||||
or eax, eax
|
||||
jge .check_resize_s
|
||||
add [mouse.active_sys_window.new_box.width], eax
|
||||
xor eax, eax
|
||||
mov [mouse.active_sys_window.new_box.left], eax
|
||||
|
||||
.check_resize_s:
|
||||
test dl, mouse.WINDOW_RESIZE_S_FLAG
|
||||
jz .check_resize_e
|
||||
|
||||
mov eax, [mouse.state.pos.y]
|
||||
add eax, [mouse.active_sys_window.delta.y]
|
||||
sub eax, [mouse.active_sys_window.old_box.top]
|
||||
mov [mouse.active_sys_window.new_box.height], eax
|
||||
|
||||
push eax
|
||||
mov edi, esi
|
||||
shl edi, 5
|
||||
add edi, window_data
|
||||
call window._.get_rolledup_height
|
||||
mov ecx, eax
|
||||
pop eax
|
||||
mov eax, [mouse.active_sys_window.new_box.height]
|
||||
cmp eax, ecx
|
||||
jge @f
|
||||
mov eax, ecx
|
||||
mov [mouse.active_sys_window.new_box.height], eax
|
||||
@@:
|
||||
add eax, [mouse.active_sys_window.new_box.top]
|
||||
cmp eax, [Screen_Max_Y]
|
||||
jle .check_resize_e
|
||||
sub eax, [Screen_Max_Y]
|
||||
neg eax
|
||||
add [mouse.active_sys_window.new_box.height], eax
|
||||
mov ecx, [Screen_Max_Y]
|
||||
cmp ecx, eax
|
||||
jge .check_resize_e
|
||||
mov [mouse.active_sys_window.new_box.height], ecx
|
||||
|
||||
.check_resize_e:
|
||||
test dl, mouse.WINDOW_RESIZE_E_FLAG
|
||||
jz .call_window_handler
|
||||
|
||||
mov eax, [mouse.state.pos.x]
|
||||
add eax, [mouse.active_sys_window.delta.x]
|
||||
sub eax, [mouse.active_sys_window.old_box.left]
|
||||
mov [mouse.active_sys_window.new_box.width], eax
|
||||
|
||||
mov eax, [mouse.active_sys_window.new_box.width]
|
||||
cmp eax, 127
|
||||
jge @f
|
||||
mov eax, 127
|
||||
mov [mouse.active_sys_window.new_box.width], eax
|
||||
@@:
|
||||
add eax, [mouse.active_sys_window.new_box.left]
|
||||
cmp eax, [Screen_Max_X]
|
||||
jle .call_window_handler
|
||||
sub eax, [Screen_Max_X]
|
||||
neg eax
|
||||
add [mouse.active_sys_window.new_box.width], eax
|
||||
mov ecx, [Screen_Max_X]
|
||||
cmp ecx, eax
|
||||
jge .call_window_handler
|
||||
mov [mouse.active_sys_window.new_box.width], ecx
|
||||
|
||||
.call_window_handler:
|
||||
mov eax, mouse.active_sys_window.old_box
|
||||
mov ebx, mouse.active_sys_window.new_box
|
||||
|
||||
push esi
|
||||
mov esi, mouse.active_sys_window.old_box
|
||||
mov edi, mouse.active_sys_window.new_box
|
||||
mov ecx, sizeof.BOX / 4
|
||||
repe
|
||||
cmpsd
|
||||
pop esi
|
||||
je .exit
|
||||
|
||||
mov [mouse.active_sys_window.last_ticks], 0
|
||||
call sys_window_moving_handler
|
||||
|
||||
.exit:
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.find_sys_window_under_cursor: ;////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Find system window object which is currently visible on screen and has
|
||||
;? mouse cursor within its bounds
|
||||
;------------------------------------------------------------------------------
|
||||
;< esi = process slot
|
||||
;< edi = pointer to WDATA struct
|
||||
;------------------------------------------------------------------------------
|
||||
mov esi, [mouse.state.pos.y]
|
||||
mov esi, [d_width_calc_area + esi*4]
|
||||
|
||||
add esi, [_WinMapAddress]
|
||||
add esi, [mouse.state.pos.x]
|
||||
movzx esi, byte[esi]
|
||||
mov edi, esi
|
||||
shl edi, 5
|
||||
add edi, window_data
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.activate_sys_window_under_cursor: ;////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? <description>
|
||||
;------------------------------------------------------------------------------
|
||||
; activate and redraw window under cursor (if necessary)
|
||||
call mouse._.find_sys_window_under_cursor
|
||||
movzx esi, word[WIN_STACK + esi * 2]
|
||||
lea esi, [WIN_POS + esi * 2]
|
||||
jmp waredraw
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.find_sys_button_under_cursor: ;////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? Find system button object which is currently visible on screen and has
|
||||
;? mouse cursor within its bounds
|
||||
;------------------------------------------------------------------------------
|
||||
;< eax = pack[8(process slot), 24(button id)] or 0
|
||||
;< ebx = pack[16(button x coord), 16(button y coord)]
|
||||
;------------------------------------------------------------------------------
|
||||
push ecx edx esi edi
|
||||
|
||||
call mouse._.find_sys_window_under_cursor
|
||||
mov edx, esi
|
||||
|
||||
; check if any process button contains cursor
|
||||
mov eax, [BTN_ADDR]
|
||||
mov ecx, [eax]
|
||||
imul esi, ecx, sizeof.SYS_BUTTON
|
||||
add esi, eax
|
||||
inc ecx
|
||||
add esi, sizeof.SYS_BUTTON
|
||||
|
||||
.next_button:
|
||||
dec ecx
|
||||
jz .not_found
|
||||
|
||||
add esi, -sizeof.SYS_BUTTON
|
||||
|
||||
; does it belong to our process?
|
||||
cmp dx, [esi + SYS_BUTTON.pslot]
|
||||
jne .next_button
|
||||
|
||||
; does it contain cursor coordinates?
|
||||
mov eax, [mouse.state.pos.x]
|
||||
sub eax, [edi + WDATA.box.left]
|
||||
sub ax, [esi + SYS_BUTTON.left]
|
||||
jl .next_button
|
||||
sub ax, [esi + SYS_BUTTON.width]
|
||||
jge .next_button
|
||||
mov eax, [mouse.state.pos.y]
|
||||
sub eax, [edi + WDATA.box.top]
|
||||
sub ax, [esi + SYS_BUTTON.top]
|
||||
jl .next_button
|
||||
sub ax, [esi + SYS_BUTTON.height]
|
||||
jge .next_button
|
||||
|
||||
; okay, return it
|
||||
shl edx, 24
|
||||
mov eax, dword[esi + SYS_BUTTON.id_hi - 2]
|
||||
mov ax, [esi + SYS_BUTTON.id_lo]
|
||||
and eax, 0x0ffffff
|
||||
or eax, edx
|
||||
mov ebx, dword[esi + SYS_BUTTON.left - 2]
|
||||
mov bx, [esi + SYS_BUTTON.top]
|
||||
jmp .exit
|
||||
|
||||
.not_found:
|
||||
xor eax, eax
|
||||
xor ebx, ebx
|
||||
|
||||
.exit:
|
||||
pop edi esi edx ecx
|
||||
ret
|
||||
|
||||
align 4
|
||||
;------------------------------------------------------------------------------
|
||||
mouse._.check_sys_window_actions: ;////////////////////////////////////////////
|
||||
;------------------------------------------------------------------------------
|
||||
;? <description>
|
||||
;------------------------------------------------------------------------------
|
||||
;< eax = action flags or 0
|
||||
;------------------------------------------------------------------------------
|
||||
; is window movable?
|
||||
test byte[edi + WDATA.cl_titlebar + 3], 0x01
|
||||
jnz .no_action
|
||||
|
||||
mov eax, [mouse.state.pos.x]
|
||||
mov ebx, [mouse.state.pos.y]
|
||||
sub eax, [edi + WDATA.box.left]
|
||||
sub ebx, [edi + WDATA.box.top]
|
||||
|
||||
; is there a window titlebar under cursor?
|
||||
push eax
|
||||
call window._.get_titlebar_height
|
||||
cmp ebx, eax
|
||||
pop eax
|
||||
jl .move_action
|
||||
|
||||
; no there isn't, can it be resized then?
|
||||
mov dl, [edi + WDATA.fl_wstyle]
|
||||
and dl, 0x0f
|
||||
; NOTE: dangerous optimization, revise if window types changed;
|
||||
; this currently implies only types 2 and 3 could be resized
|
||||
test dl, 2
|
||||
jz .no_action
|
||||
|
||||
mov ecx, [edi + WDATA.box.width]
|
||||
add ecx, -window.BORDER_SIZE
|
||||
mov edx, [edi + WDATA.box.height]
|
||||
add edx, -window.BORDER_SIZE
|
||||
|
||||
; is it rolled up?
|
||||
test [edi + WDATA.fl_wstate], WSTATE_ROLLEDUP
|
||||
jnz .resize_w_or_e_action
|
||||
|
||||
cmp eax, window.BORDER_SIZE
|
||||
jl .resize_w_action
|
||||
cmp eax, ecx
|
||||
jg .resize_e_action
|
||||
cmp ebx, edx
|
||||
jle .no_action
|
||||
|
||||
.resize_s_action:
|
||||
cmp eax, window.BORDER_SIZE + 10
|
||||
jl .resize_sw_action
|
||||
add ecx, -10
|
||||
cmp eax, ecx
|
||||
jge .resize_se_action
|
||||
mov eax, mouse.WINDOW_RESIZE_S_FLAG
|
||||
jmp .exit
|
||||
|
||||
.resize_w_or_e_action:
|
||||
cmp eax, window.BORDER_SIZE + 10
|
||||
jl .resize_w_action.direct
|
||||
add ecx, -10
|
||||
cmp eax, ecx
|
||||
jg .resize_e_action.direct
|
||||
jmp .no_action
|
||||
|
||||
.resize_w_action:
|
||||
add edx, -10
|
||||
cmp ebx, edx
|
||||
jge .resize_sw_action
|
||||
.resize_w_action.direct:
|
||||
mov eax, mouse.WINDOW_RESIZE_W_FLAG
|
||||
jmp .exit
|
||||
|
||||
.resize_e_action:
|
||||
add edx, -10
|
||||
cmp ebx, edx
|
||||
jge .resize_se_action
|
||||
.resize_e_action.direct:
|
||||
mov eax, mouse.WINDOW_RESIZE_E_FLAG
|
||||
jmp .exit
|
||||
|
||||
.resize_sw_action:
|
||||
mov eax, mouse.WINDOW_RESIZE_SW_FLAG
|
||||
jmp .exit
|
||||
|
||||
.resize_se_action:
|
||||
mov eax, mouse.WINDOW_RESIZE_SE_FLAG
|
||||
jmp .exit
|
||||
|
||||
.move_action:
|
||||
mov eax, mouse.WINDOW_MOVE_FLAG
|
||||
jmp .exit
|
||||
|
||||
.no_action:
|
||||
xor eax, eax
|
||||
|
||||
.exit:
|
||||
ret
|
||||
250
kernel/branches/kolibri-process/gui/mousepointer.inc
Normal file
250
kernel/branches/kolibri-process/gui/mousepointer.inc
Normal file
@@ -0,0 +1,250 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
|
||||
;; Copyright (C) MenuetOS 2000-2004 Ville Mikael Turjanmaa ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 2455 $
|
||||
|
||||
|
||||
iglobal
|
||||
|
||||
align 4
|
||||
mousepointer:
|
||||
db 0x00,0x00,0x00,0x74,0x74,0x74,0x6e,0x6e,0x6e,0x6f
|
||||
db 0x6f,0x6f,0x71,0x71,0x71,0x75,0x75,0x75,0x79,0x79
|
||||
db 0x79,0x7c,0x7c,0x7c,0x7e,0x7e,0x7e,0x80,0x80,0x80
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x00,0x00,0x00,0x63,0x63,0x63,0x63,0x63,0x63
|
||||
db 0x66,0x66,0x66,0x6c,0x6c,0x6c,0x72,0x72,0x72,0x78
|
||||
db 0x78,0x78,0x7c,0x7c,0x7c,0x7e,0x7e,0x7e,0x80,0x80
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0xc0
|
||||
db 0xc0,0xc0,0x00,0x00,0x00,0x54,0x54,0x54,0x57,0x57
|
||||
db 0x57,0x5f,0x5f,0x5f,0x68,0x68,0x68,0x71,0x71,0x71
|
||||
db 0x77,0x77,0x77,0x7c,0x7c,0x7c,0x7e,0x7e,0x7e,0x80
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0xc0,0xc0,0xc0
|
||||
db 0xc0,0xc0,0xc0,0x00,0x00,0x00,0x47,0x47,0x47,0x50
|
||||
db 0x50,0x50,0x5b,0x5b,0x5b,0x67,0x67,0x67,0x70,0x70
|
||||
db 0x70,0x77,0x77,0x77,0x7c,0x7c,0x7c,0x7e,0x7e,0x7e
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x80,0x80,0x80,0x80,0xff,0xff,0xff,0xc0,0xc0
|
||||
db 0xc0,0xc0,0xc0,0xc0,0x00,0x00,0x00,0x3f,0x3f,0x3f
|
||||
db 0x4b,0x4b,0x4b,0x59,0x59,0x59,0x66,0x66,0x66,0x70
|
||||
db 0x70,0x70,0x77,0x77,0x77,0x7c,0x7c,0x7c,0x7e,0x7e
|
||||
db 0x7e,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x80,0x80,0xff,0xff,0xff,0xc0,0xc0,0xc0,0xc0
|
||||
db 0xc0,0xc0,0xc0,0xc0,0xc0,0x00,0x00,0x00,0x3a,0x3a
|
||||
db 0x3a,0x49,0x49,0x49,0x59,0x59,0x59,0x66,0x66,0x66
|
||||
db 0x70,0x70,0x70,0x77,0x77,0x77,0x7c,0x7c,0x7c,0x7e
|
||||
db 0x7e,0x7e,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x80,0xff,0xff,0xff,0xff,0xff,0xff,0xc0,0xc0,0xc0
|
||||
db 0xc0,0xc0,0xc0,0xc0,0xc0,0xc0,0x00,0x00,0x00,0x39
|
||||
db 0x39,0x39,0x49,0x49,0x49,0x59,0x59,0x59,0x66,0x66
|
||||
db 0x66,0x71,0x71,0x71,0x78,0x78,0x78,0x7c,0x7c,0x7c
|
||||
db 0x7e,0x7e,0x7e,0x80,0x80,0x80,0x80,0x80,0x80,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xc0,0xc0,0xc0,0xc0,0xc0
|
||||
db 0xc0,0xc0,0xc0,0xc0,0xc0,0xc0,0xc0,0x00,0x00,0x00
|
||||
db 0x39,0x39,0x39,0x4a,0x4a,0x4a,0x5a,0x5a,0x5a,0x68
|
||||
db 0x68,0x68,0x72,0x72,0x72,0x79,0x79,0x79,0x7d,0x7d
|
||||
db 0x7d,0x7f,0x7f,0x7f,0x80,0x80,0x80,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xc0,0xc0,0xc0,0xc0
|
||||
db 0xc0,0xc0,0xc0,0xc0,0xc0,0xc0,0xc0,0xc0,0x00,0x00
|
||||
db 0x00,0x3c,0x3c,0x3c,0x4e,0x4e,0x4e,0x5e,0x5e,0x5e
|
||||
db 0x6b,0x6b,0x6b,0x75,0x75,0x75,0x7a,0x7a,0x7a,0x7e
|
||||
db 0x7e,0x7e,0x80,0x80,0x80,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xc0,0xc0,0xc0,0xc0,0xc0,0xc0
|
||||
db 0xc0,0xc0,0xc0,0xc0,0xc0,0xc0,0xc0,0xc0,0xc0,0x00
|
||||
db 0x00,0x00,0x43,0x43,0x43,0x55,0x55,0x55,0x64,0x64
|
||||
db 0x64,0x70,0x70,0x70,0x78,0x78,0x78,0x7d,0x7d,0x7d
|
||||
db 0x80,0x80,0x80,0xff,0xff,0xff,0xff,0xff,0xff,0xc0
|
||||
db 0xc0,0xc0,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x4e,0x4e,0x4e,0x5f,0x5f,0x5f,0x6d
|
||||
db 0x6d,0x6d,0x76,0x76,0x76,0x7c,0x7c,0x7c,0x80,0x80
|
||||
db 0x80,0xff,0xff,0xff,0xc0,0xc0,0xc0,0x00,0x00,0x00
|
||||
db 0xff,0xff,0xff,0xc0,0xc0,0xc0,0x00,0x00,0x00,0x14
|
||||
db 0x14,0x14,0x1b,0x1b,0x1b,0x29,0x29,0x29,0x3a,0x3a
|
||||
db 0x3a,0x4c,0x4c,0x4c,0x5d,0x5d,0x5d,0x6c,0x6c,0x6c
|
||||
db 0x75,0x75,0x75,0x7b,0x7b,0x7b,0x80,0x80,0x80,0xc0
|
||||
db 0xc0,0xc0,0x00,0x00,0x00,0x2f,0x2f,0x2f,0x80,0x80
|
||||
db 0x80,0xff,0xff,0xff,0xc0,0xc0,0xc0,0x00,0x00,0x00
|
||||
db 0x21,0x21,0x21,0x2e,0x2e,0x2e,0x40,0x40,0x40,0x52
|
||||
db 0x52,0x52,0x62,0x62,0x62,0x6f,0x6f,0x6f,0x77,0x77
|
||||
db 0x77,0x7c,0x7c,0x7c,0x80,0x80,0x80,0x00,0x00,0x00
|
||||
db 0x47,0x47,0x47,0x3b,0x3b,0x3b,0x80,0x80,0x80,0xff
|
||||
db 0xff,0xff,0xc0,0xc0,0xc0,0x00,0x00,0x00,0x25,0x25
|
||||
db 0x25,0x30,0x30,0x30,0x42,0x42,0x42,0x54,0x54,0x54
|
||||
db 0x64,0x64,0x64,0x70,0x70,0x70,0x78,0x78,0x78,0x7d
|
||||
db 0x7d,0x7d,0x00,0x00,0x00,0x62,0x62,0x62,0x52,0x52
|
||||
db 0x52,0x4a,0x4a,0x4a,0x43,0x43,0x43,0x80,0x80,0x80
|
||||
db 0xff,0xff,0xff,0xc0,0xc0,0xc0,0x00,0x00,0x00,0x33
|
||||
db 0x33,0x33,0x42,0x42,0x42,0x54,0x54,0x54,0x64,0x64
|
||||
db 0x64,0x71,0x71,0x71,0x79,0x79,0x79,0x7d,0x7d,0x7d
|
||||
db 0x72,0x72,0x72,0x6b,0x6b,0x6b,0x5f,0x5f,0x5f,0x5a
|
||||
db 0x5a,0x5a,0x54,0x54,0x54,0x80,0x80,0x80,0xff,0xff
|
||||
db 0xff,0xc0,0xc0,0xc0,0x00,0x00,0x00,0x35,0x35,0x35
|
||||
db 0x41,0x41,0x41,0x53,0x53,0x53,0x63,0x63,0x63,0x70
|
||||
db 0x70,0x70,0x78,0x78,0x78,0x7d,0x7d,0x7d,0x77,0x77
|
||||
db 0x77,0x73,0x73,0x73,0x6c,0x6c,0x6c,0x68,0x68,0x68
|
||||
db 0x62,0x62,0x62,0x5a,0x5a,0x5a,0x80,0x80,0x80,0xff
|
||||
db 0xff,0xff,0xc0,0xc0,0xc0,0x00,0x00,0x00,0x41,0x41
|
||||
db 0x41,0x52,0x52,0x52,0x62,0x62,0x62,0x6f,0x6f,0x6f
|
||||
db 0x78,0x78,0x78,0x7d,0x7d,0x7d,0x7b,0x7b,0x7b,0x79
|
||||
db 0x79,0x79,0x74,0x74,0x74,0x72,0x72,0x72,0x6e,0x6e
|
||||
db 0x6e,0x66,0x66,0x66,0x80,0x80,0x80,0xc0,0xc0,0xc0
|
||||
db 0xc0,0xc0,0xc0,0x00,0x00,0x00,0x44,0x44,0x44,0x52
|
||||
db 0x52,0x52,0x62,0x62,0x62,0x6e,0x6e,0x6e,0x77,0x77
|
||||
db 0x77,0x7c,0x7c,0x7c,0x7e,0x7e,0x7e,0x7c,0x7c,0x7c
|
||||
db 0x7a,0x7a,0x7a,0x79,0x79,0x79,0x75,0x75,0x75,0x6f
|
||||
db 0x6f,0x6f,0x65,0x65,0x65,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x48,0x48,0x48,0x4b,0x4b,0x4b,0x56,0x56,0x56
|
||||
db 0x65,0x65,0x65,0x70,0x70,0x70,0x78,0x78,0x78,0x7d
|
||||
db 0x7d,0x7d,0x80,0x80,0x80,0x7f,0x7f,0x7f,0x7e,0x7e
|
||||
db 0x7e,0x7d,0x7d,0x7d,0x7a,0x7a,0x7a,0x76,0x76,0x76
|
||||
db 0x6f,0x6f,0x6f,0x65,0x65,0x65,0x5c,0x5c,0x5c,0x56
|
||||
db 0x56,0x56,0x58,0x58,0x58,0x60,0x60,0x60,0x6b,0x6b
|
||||
db 0x6b,0x73,0x73,0x73,0x7a,0x7a,0x7a,0x7d,0x7d,0x7d
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x7f
|
||||
db 0x7f,0x7f,0x7d,0x7d,0x7d,0x7a,0x7a,0x7a,0x76,0x76
|
||||
db 0x76,0x70,0x70,0x70,0x6a,0x6a,0x6a,0x66,0x66,0x66
|
||||
db 0x66,0x66,0x66,0x6c,0x6c,0x6c,0x72,0x72,0x72,0x78
|
||||
db 0x78,0x78,0x7c,0x7c,0x7c,0x7e,0x7e,0x7e,0x80,0x80
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x7f,0x7f,0x7f,0x7d,0x7d,0x7d,0x7b,0x7b,0x7b,0x77
|
||||
db 0x77,0x77,0x73,0x73,0x73,0x71,0x71,0x71,0x71,0x71
|
||||
db 0x71,0x74,0x74,0x74,0x78,0x78,0x78,0x7b,0x7b,0x7b
|
||||
db 0x7d,0x7d,0x7d,0x7f,0x7f,0x7f,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x7f,0x7f,0x7f,0x7d,0x7d,0x7d,0x7c,0x7c,0x7c
|
||||
db 0x7a,0x7a,0x7a,0x78,0x78,0x78,0x78,0x78,0x78,0x7a
|
||||
db 0x7a,0x7a,0x7c,0x7c,0x7c,0x7e,0x7e,0x7e,0x7f,0x7f
|
||||
db 0x7f,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x80,0x7f,0x7f,0x7f,0x7e,0x7e,0x7e,0x7e,0x7e
|
||||
db 0x7e,0x7d,0x7d,0x7d,0x7d,0x7d,0x7d,0x7e,0x7e,0x7e
|
||||
db 0x7e,0x7e,0x7e,0x7f,0x7f,0x7f,0x80,0x80,0x80,0x80
|
||||
db 0x80,0x80
|
||||
|
||||
mousepointer1:
|
||||
db 0xff,0xff,0xff,0x06,0x06,0x06,0x0a,0x0a
|
||||
db 0x0a,0x08,0x08,0x08,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0x19,0x19,0x19,0x16
|
||||
db 0x16,0x16,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0x2e,0x2e,0x2e
|
||||
db 0x23,0x23,0x23,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0x3f,0x3f
|
||||
db 0x3f,0x29,0x29,0x29,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0x47
|
||||
db 0x47,0x47,0x2c,0x2c,0x2c,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0x48,0x48,0x48,0x2c,0x2c,0x2c,0x16,0x16,0x16,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0x48,0x48,0x48,0x2c,0x2c,0x2c,0x16,0x16,0x16
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0x48,0x48,0x48,0x2c,0x2c,0x2c,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0x48,0x48,0x48,0x2c,0x2c,0x2c,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0x47,0x47,0x47,0x29,0x29,0x29
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0x40,0x40,0x40,0x23,0x23
|
||||
db 0x23,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xaa,0xaa,0xaa,0x9f,0x9f,0x9f,0x8c,0x8c,0x8c
|
||||
db 0x70,0x70,0x70,0x4f,0x4f,0x4f,0x30,0x30,0x30,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0x8f,0x8f,0x8f
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0x9c,0x9c,0x9c,0x87,0x87,0x87,0x6c,0x6c
|
||||
db 0x6c,0x4f,0x4f,0x4f,0x32,0x32,0x32,0x19,0x19,0x19
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0x69,0x69,0x69,0x84,0x84,0x84,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0x92,0x92,0x92,0x79,0x79,0x79,0x59,0x59,0x59,0x3c
|
||||
db 0x3c,0x3c,0x24,0x24,0x24,0x11,0x11,0x11,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0xff,0xff,0xff,0x37,0x37,0x37
|
||||
db 0x5d,0x5d,0x5d,0x70,0x70,0x70,0x76,0x76,0x76,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0xff,0x75,0x75,0x75,0x51,0x51,0x51,0x31,0x31,0x31
|
||||
db 0x19,0x19,0x19,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x16,0x16,0x16,0x2d,0x2d,0x2d,0x49,0x49
|
||||
db 0x49,0x53,0x53,0x53,0x54,0x54,0x54,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0x78
|
||||
db 0x78,0x78,0x54,0x54,0x54,0x30,0x30,0x30,0x16,0x16
|
||||
db 0x16,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x0f,0x0f,0x0f,0x1f,0x1f,0x1f,0x30,0x30,0x30,0x33
|
||||
db 0x33,0x33,0x33,0x33,0x33,0x3b,0x3b,0x3b,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff
|
||||
db 0x62,0x62,0x62,0x3b,0x3b,0x3b,0x1c,0x1c,0x1c,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x08,0x08
|
||||
db 0x08,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x24,0x24,0x24,0xff,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0x6e,0x6e
|
||||
db 0x6e,0x48,0x48,0x48,0x25,0x25,0x25,0x0e,0x0e,0x0e
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x04,0x04,0x04,0x00
|
||||
db 0x00,0x00,0x0a,0x0a,0x0a,0x09,0x09,0x09,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x29,0x29,0x29,0xff,0xff,0xff
|
||||
db 0xff,0xff,0xff,0x7c,0x7c,0x7c,0x71,0x71,0x71,0x50
|
||||
db 0x50,0x50,0x2b,0x2b,0x2b,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x02,0x02,0x02,0x04,0x04,0x04,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x36,0x36,0x36,0x56,0x56
|
||||
db 0x56,0x69,0x69,0x69,0x64,0x64,0x64,0x4a,0x4a,0x4a
|
||||
db 0x28,0x28,0x28,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x01,0x01,0x01,0x05,0x05,0x05
|
||||
db 0x00,0x00,0x00,0x21,0x21,0x21,0x39,0x39,0x39,0x49
|
||||
db 0x49,0x49,0x48,0x48,0x48,0x35,0x35,0x35,0x1d,0x1d
|
||||
db 0x1d,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x01,0x01,0x01,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x1d,0x1d,0x1d,0x27,0x27,0x27
|
||||
db 0x27,0x27,0x27,0x1d,0x1d,0x1d,0x0f,0x0f,0x0f,0x06
|
||||
db 0x06,0x06,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
|
||||
db 0x00,0x00,0x00,0x00
|
||||
|
||||
endg
|
||||
525
kernel/branches/kolibri-process/gui/skincode.inc
Normal file
525
kernel/branches/kolibri-process/gui/skincode.inc
Normal file
@@ -0,0 +1,525 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
$Revision: 3711 $
|
||||
|
||||
|
||||
include "skindata.inc"
|
||||
|
||||
;skin_data = 0x00778000
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
read_skin_file:
|
||||
stdcall load_file, ebx
|
||||
test eax, eax
|
||||
jz .notfound
|
||||
|
||||
cmp dword [eax], 'SKIN'
|
||||
jnz .noskin
|
||||
|
||||
xchg eax, [skin_data]
|
||||
test eax, eax
|
||||
jz @f
|
||||
|
||||
stdcall kernel_free, eax
|
||||
@@:
|
||||
call parse_skin_data
|
||||
xor eax, eax
|
||||
ret
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.notfound:
|
||||
xor eax, eax
|
||||
inc eax
|
||||
ret
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.noskin:
|
||||
stdcall kernel_free, eax
|
||||
mov eax, 2
|
||||
ret
|
||||
;------------------------------------------------------------------------------
|
||||
struct SKIN_HEADER
|
||||
ident dd ?
|
||||
version dd ?
|
||||
params dd ?
|
||||
buttons dd ?
|
||||
bitmaps dd ?
|
||||
ends
|
||||
|
||||
struct SKIN_PARAMS
|
||||
skin_height dd ?
|
||||
margin.right dw ?
|
||||
margin.left dw ?
|
||||
margin.bottom dw ?
|
||||
margin.top dw ?
|
||||
colors.inner dd ?
|
||||
colors.outer dd ?
|
||||
colors.frame dd ?
|
||||
colors_1.inner dd ?
|
||||
colors_1.outer dd ?
|
||||
colors_1.frame dd ?
|
||||
dtp.size dd ?
|
||||
dtp.data rb 40
|
||||
ends
|
||||
|
||||
struct SKIN_BUTTONS
|
||||
type dd ?
|
||||
; position
|
||||
left dw ?
|
||||
top dw ?
|
||||
; size
|
||||
width dw ?
|
||||
height dw ?
|
||||
ends
|
||||
|
||||
struct SKIN_BITMAPS
|
||||
kind dw ?
|
||||
type dw ?
|
||||
data dd ?
|
||||
ends
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
load_default_skin:
|
||||
mov [_skinh], 22
|
||||
mov ebx, _skin_file_default
|
||||
call read_skin_file
|
||||
ret
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
parse_skin_data:
|
||||
mov ebp, [skin_data]
|
||||
cmp [ebp+SKIN_HEADER.ident], 'SKIN'
|
||||
jne .exit
|
||||
|
||||
mov edi, skin_udata
|
||||
mov ecx, (skin_udata.end-skin_udata)/4
|
||||
xor eax, eax
|
||||
cld
|
||||
rep stosd
|
||||
|
||||
mov ebx, [ebp+SKIN_HEADER.params]
|
||||
add ebx, [skin_data]
|
||||
mov eax, [ebx+SKIN_PARAMS.skin_height]
|
||||
mov [_skinh], eax
|
||||
mov eax, [ebx+SKIN_PARAMS.colors.inner]
|
||||
mov [skin_active.colors.inner], eax
|
||||
mov eax, [ebx+SKIN_PARAMS.colors.outer]
|
||||
mov [skin_active.colors.outer], eax
|
||||
mov eax, [ebx+SKIN_PARAMS.colors.frame]
|
||||
mov [skin_active.colors.frame], eax
|
||||
mov eax, [ebx+SKIN_PARAMS.colors_1.inner]
|
||||
mov [skin_inactive.colors.inner], eax
|
||||
mov eax, [ebx+SKIN_PARAMS.colors_1.outer]
|
||||
mov [skin_inactive.colors.outer], eax
|
||||
mov eax, [ebx+SKIN_PARAMS.colors_1.frame]
|
||||
mov [skin_inactive.colors.frame], eax
|
||||
lea esi, [ebx+SKIN_PARAMS.dtp.data]
|
||||
mov edi, common_colours
|
||||
mov ecx, [ebx+SKIN_PARAMS.dtp.size]
|
||||
and ecx, 127
|
||||
rep movsb
|
||||
mov eax, dword[ebx+SKIN_PARAMS.margin.right]
|
||||
mov dword[_skinmargins+0], eax
|
||||
mov eax, dword[ebx+SKIN_PARAMS.margin.bottom]
|
||||
mov dword[_skinmargins+4], eax
|
||||
|
||||
mov ebx, [ebp+SKIN_HEADER.bitmaps]
|
||||
add ebx, [skin_data]
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.lp1:
|
||||
cmp dword[ebx], 0
|
||||
je .end_bitmaps
|
||||
movzx eax, [ebx+SKIN_BITMAPS.kind]
|
||||
movzx ecx, [ebx+SKIN_BITMAPS.type]
|
||||
dec eax
|
||||
jnz .not_left
|
||||
xor eax, eax
|
||||
mov edx, skin_active.left.data
|
||||
or ecx, ecx
|
||||
jnz @f
|
||||
mov edx, skin_inactive.left.data
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
jmp .next_bitmap
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.not_left:
|
||||
dec eax
|
||||
jnz .not_oper
|
||||
mov esi, [ebx+SKIN_BITMAPS.data]
|
||||
add esi, [skin_data]
|
||||
mov eax, [esi+0]
|
||||
neg eax
|
||||
mov edx, skin_active.oper.data
|
||||
or ecx, ecx
|
||||
jnz @f
|
||||
mov edx, skin_inactive.oper.data
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
jmp .next_bitmap
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.not_oper:
|
||||
dec eax
|
||||
jnz .not_base
|
||||
mov eax, [skin_active.left.width]
|
||||
mov edx, skin_active.base.data
|
||||
or ecx, ecx
|
||||
jnz @f
|
||||
mov eax, [skin_inactive.left.width]
|
||||
mov edx, skin_inactive.base.data
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
jmp .next_bitmap
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.not_base:
|
||||
add ebx, 8
|
||||
jmp .lp1
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.next_bitmap:
|
||||
mov ecx, [ebx+SKIN_BITMAPS.data]
|
||||
add ecx, [skin_data]
|
||||
mov [edx+4], eax
|
||||
mov eax, [ecx+0]
|
||||
mov [edx+8], eax
|
||||
add ecx, 8
|
||||
mov [edx+0], ecx
|
||||
add ebx, 8
|
||||
jmp .lp1
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.end_bitmaps:
|
||||
mov ebx, [ebp+SKIN_HEADER.buttons]
|
||||
add ebx, [skin_data]
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.lp2:
|
||||
cmp dword[ebx], 0
|
||||
je .end_buttons
|
||||
mov eax, [ebx+SKIN_BUTTONS.type]
|
||||
dec eax
|
||||
jnz .not_close
|
||||
mov edx, skin_btn_close
|
||||
jmp .next_button
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.not_close:
|
||||
dec eax
|
||||
jnz .not_minimize
|
||||
mov edx, skin_btn_minimize
|
||||
jmp .next_button
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.not_minimize:
|
||||
add ebx, 12
|
||||
jmp .lp2
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.next_button:
|
||||
movsx eax, [ebx+SKIN_BUTTONS.left]
|
||||
mov [edx+SKIN_BUTTON.left], eax
|
||||
movsx eax, [ebx+SKIN_BUTTONS.top]
|
||||
mov [edx+SKIN_BUTTON.top], eax
|
||||
movsx eax, [ebx+SKIN_BUTTONS.width]
|
||||
mov [edx+SKIN_BUTTON.width], eax
|
||||
movsx eax, [ebx+SKIN_BUTTONS.height]
|
||||
mov [edx+SKIN_BUTTON.height], eax
|
||||
add ebx, 12
|
||||
jmp .lp2
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.end_buttons:
|
||||
.exit:
|
||||
ret
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
drawwindow_IV_caption:
|
||||
|
||||
mov ebp, skin_active
|
||||
or al, al
|
||||
jnz @f
|
||||
mov ebp, skin_inactive
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
mov esi, [esp+4]
|
||||
mov eax, [esi+WDATA.box.width] ; window width
|
||||
mov edx, [ebp+SKIN_DATA.left.left]
|
||||
shl edx, 16
|
||||
mov ecx, [ebp+SKIN_DATA.left.width]
|
||||
shl ecx, 16
|
||||
add ecx, [_skinh]
|
||||
|
||||
mov ebx, [ebp+SKIN_DATA.left.data]
|
||||
or ebx, ebx
|
||||
jz @f
|
||||
call sys_putimage.forced
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
mov esi, [esp+4]
|
||||
mov eax, [esi+WDATA.box.width]
|
||||
sub eax, [ebp+SKIN_DATA.left.width]
|
||||
sub eax, [ebp+SKIN_DATA.oper.width]
|
||||
cmp eax, [ebp+SKIN_DATA.base.left]
|
||||
jng .non_base
|
||||
xor edx, edx
|
||||
mov ecx, [ebp+SKIN_DATA.base.width]
|
||||
jecxz .non_base
|
||||
div ecx
|
||||
|
||||
inc eax
|
||||
|
||||
mov ebx, [ebp+SKIN_DATA.base.data]
|
||||
mov ecx, [ebp+SKIN_DATA.base.width]
|
||||
shl ecx, 16
|
||||
add ecx, [_skinh]
|
||||
mov edx, [ebp+SKIN_DATA.base.left]
|
||||
sub edx, [ebp+SKIN_DATA.base.width]
|
||||
shl edx, 16
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.baseskinloop:
|
||||
shr edx, 16
|
||||
add edx, [ebp+SKIN_DATA.base.width]
|
||||
shl edx, 16
|
||||
|
||||
push eax ebx ecx edx
|
||||
|
||||
or ebx, ebx
|
||||
jz @f
|
||||
call sys_putimage.forced
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
pop edx ecx ebx eax
|
||||
|
||||
dec eax
|
||||
jnz .baseskinloop
|
||||
;--------------------------------------
|
||||
align 4
|
||||
.non_base:
|
||||
|
||||
mov esi, [esp+4]
|
||||
mov edx, [esi+WDATA.box.width]
|
||||
sub edx, [ebp+SKIN_DATA.oper.width]
|
||||
inc edx
|
||||
shl edx, 16
|
||||
mov ebx, [ebp+SKIN_DATA.oper.data]
|
||||
|
||||
mov ecx, [ebp+SKIN_DATA.oper.width]
|
||||
shl ecx, 16
|
||||
add ecx, [_skinh]
|
||||
|
||||
or ebx, ebx
|
||||
jz @f
|
||||
call sys_putimage.forced
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
ret
|
||||
;------------------------------------------------------------------------------
|
||||
align 4
|
||||
drawwindow_IV:
|
||||
;param1 - aw_yes
|
||||
pusha
|
||||
|
||||
push edx
|
||||
|
||||
mov edi, edx
|
||||
|
||||
mov ebp, skin_active
|
||||
cmp byte [esp+32+4+4], 0
|
||||
jne @f
|
||||
mov ebp, skin_inactive
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
mov eax, [edi+WDATA.box.left]
|
||||
shl eax, 16
|
||||
mov ax, word [edi+WDATA.box.left]
|
||||
add ax, word [edi+WDATA.box.width]
|
||||
mov ebx, [edi+WDATA.box.top]
|
||||
shl ebx, 16
|
||||
mov bx, word [edi+WDATA.box.top]
|
||||
add bx, word [edi+WDATA.box.height]
|
||||
mov esi, [ebp+SKIN_DATA.colors.outer]
|
||||
or esi, 1 shl 25 ; 0x02000000 used for draw_rectangle without top line
|
||||
ror ebx, 16
|
||||
add ebx, [_skinh]
|
||||
sub bx, 1
|
||||
rol ebx, 16
|
||||
call draw_rectangle
|
||||
mov ecx, 3
|
||||
;--------------------------------------
|
||||
align 4
|
||||
_dw3l:
|
||||
add eax, 1*65536-1
|
||||
add ebx, 0*65536-1
|
||||
test ax, ax
|
||||
js no_skin_add_button
|
||||
test bx, bx
|
||||
js no_skin_add_button
|
||||
mov esi, [ebp+SKIN_DATA.colors.frame];[edi+24]
|
||||
or esi, 1 shl 25; 0x02000000 used for draw_rectangle without top line
|
||||
call draw_rectangle
|
||||
dec ecx
|
||||
jnz _dw3l
|
||||
mov esi, [ebp+SKIN_DATA.colors.inner]
|
||||
or esi, 1 shl 25; 0x02000000 used for draw_rectangle without top line
|
||||
add eax, 1*65536-1
|
||||
add ebx, 0*65536-1
|
||||
test ax, ax
|
||||
js no_skin_add_button
|
||||
test bx, bx
|
||||
js no_skin_add_button
|
||||
test [edi + WDATA.fl_wstate], WSTATE_ROLLEDUP
|
||||
jnz @f
|
||||
call draw_rectangle
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
mov eax, [skin_data]
|
||||
cmp [eax], dword 'SKIN'
|
||||
je @f
|
||||
xor eax, eax
|
||||
xor ebx, ebx
|
||||
mov esi, [esp]
|
||||
mov ecx, [esi+WDATA.box.width]
|
||||
inc ecx
|
||||
mov edx, [_skinh]
|
||||
mov edi, [common_colours+4]; standard grab color
|
||||
; call [drawbar]
|
||||
call vesa20_drawbar
|
||||
jmp draw_clientbar
|
||||
;--------------------------------------
|
||||
align 4
|
||||
@@:
|
||||
mov al, [esp+32+4+4]
|
||||
call drawwindow_IV_caption
|
||||
;--------------------------------------
|
||||
align 4
|
||||
draw_clientbar:
|
||||
mov esi, [esp]
|
||||
|
||||
mov edx, [esi+WDATA.box.top] ; WORK AREA
|
||||
add edx, 21+5
|
||||
mov ebx, [esi+WDATA.box.top]
|
||||
add ebx, [esi+WDATA.box.height]
|
||||
cmp edx, ebx
|
||||
jg _noinside2
|
||||
mov eax, 5
|
||||
mov ebx, [_skinh]
|
||||
mov ecx, [esi+WDATA.box.width]
|
||||
mov edx, [esi+WDATA.box.height]
|
||||
sub ecx, 4
|
||||
sub edx, 4
|
||||
mov edi, [esi+WDATA.cl_workarea]
|
||||
test edi, 0x40000000
|
||||
jnz _noinside2
|
||||
; call [drawbar]
|
||||
call vesa20_drawbar
|
||||
;--------------------------------------
|
||||
align 4
|
||||
_noinside2:
|
||||
mov eax, [skin_data]
|
||||
cmp [eax], dword 'SKIN'
|
||||
jne no_skin_add_button
|
||||
;* close button
|
||||
mov edi, [BTN_ADDR]
|
||||
movzx eax, word [edi]
|
||||
cmp eax, 1000
|
||||
jge no_skin_add_button
|
||||
inc eax
|
||||
mov [edi], ax
|
||||
|
||||
shl eax, 4
|
||||
add eax, edi
|
||||
|
||||
mov bx, [CURRENT_TASK]
|
||||
mov [eax], bx
|
||||
|
||||
add eax, 2 ; save button id number
|
||||
mov bx, 1
|
||||
mov [eax], bx
|
||||
add eax, 2 ; x start
|
||||
xor ebx, ebx
|
||||
cmp [skin_btn_close.left], 0
|
||||
jge _bCx_at_right
|
||||
mov ebx, [esp]
|
||||
mov ebx, [ebx+WDATA.box.width]
|
||||
inc ebx
|
||||
;--------------------------------------
|
||||
align 4
|
||||
_bCx_at_right:
|
||||
add ebx, [skin_btn_close.left]
|
||||
mov [eax], bx
|
||||
add eax, 2 ; x size
|
||||
mov ebx, [skin_btn_close.width]
|
||||
dec ebx
|
||||
mov [eax], bx
|
||||
add eax, 2 ; y start
|
||||
mov ebx, [skin_btn_close.top]
|
||||
mov [eax], bx
|
||||
add eax, 2 ; y size
|
||||
mov ebx, [skin_btn_close.height]
|
||||
dec ebx
|
||||
mov [eax], bx
|
||||
;* minimize button
|
||||
mov edi, [BTN_ADDR]
|
||||
movzx eax, word [edi]
|
||||
cmp eax, 1000
|
||||
jge no_skin_add_button
|
||||
inc eax
|
||||
mov [edi], ax
|
||||
|
||||
shl eax, 4
|
||||
add eax, edi
|
||||
|
||||
mov bx, [CURRENT_TASK]
|
||||
mov [eax], bx
|
||||
|
||||
add eax, 2 ; save button id number
|
||||
mov bx, 65535;999
|
||||
mov [eax], bx
|
||||
add eax, 2 ; x start
|
||||
xor ebx, ebx
|
||||
cmp [skin_btn_minimize.left], 0
|
||||
jge _bMx_at_right
|
||||
mov ebx, [esp]
|
||||
mov ebx, [ebx+WDATA.box.width]
|
||||
inc ebx
|
||||
;--------------------------------------
|
||||
align 4
|
||||
_bMx_at_right:
|
||||
add ebx, [skin_btn_minimize.left]
|
||||
mov [eax], bx
|
||||
add eax, 2 ; x size
|
||||
mov ebx, [skin_btn_minimize.width]
|
||||
dec ebx
|
||||
mov [eax], bx
|
||||
add eax, 2 ; y start
|
||||
mov ebx, [skin_btn_minimize.top]
|
||||
mov [eax], bx
|
||||
add eax, 2 ; y size
|
||||
mov ebx, [skin_btn_minimize.height]
|
||||
dec ebx
|
||||
mov [eax], bx
|
||||
;--------------------------------------
|
||||
align 4
|
||||
no_skin_add_button:
|
||||
pop edi
|
||||
popa
|
||||
ret 4
|
||||
;------------------------------------------------------------------------------
|
||||
Some files were not shown because too many files have changed in this diff Show More
Reference in New Issue
Block a user