blob: a0c280ece15662c4ac088d57d0b4c7a92ca6c055 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
|
\ *****************************************************************************
\ * Copyright (c) 2004, 2008 IBM Corporation
\ * All rights reserved.
\ * This program and the accompanying materials
\ * are made available under the terms of the BSD License
\ * which accompanies this distribution, and is available at
\ * http://www.opensource.org/licenses/bsd-license.php
\ *
\ * Contributors:
\ * IBM Corporation - initial implementation
\ ****************************************************************************/
( max-#blocks rsrc id -- )
new-device
lwsplit swap wbsplit rot set-unit
s" disk" device-name s" block" device-type
CONSTANT resource-id
CONSTANT max-#blocks
get-parent CONSTANT ppack
: our-disk-read ( lba count addr -- )
>r >r >r resource-id r> r> r> s" do-read" ppack $call-static ;
0 pci-alias-disk
\ Required interface for deblocker
200 CONSTANT block-size
40000 CONSTANT max-transfer
: read-blocks ( addr block# #blocks -- #read )
\ my-unit s" dev-read-blocks" $call-parent
\ check if the read is within max-#blocks
2dup + max-#blocks 1 + > IF
\ 2drop drop 0 \ return 0
\ returning 0 would be correct (maybe?) but it confuses the deblocker...
\ so i erase whatever would have been read and return the "expected" #read
dup >r
swap drop \ drop block# (not needed)
block-size * erase \ erase at addr #blocks * block-size
r> \ return #read
ELSE
dup >r rot our-disk-read r>
THEN
;
INSTANCE VARIABLE deblocker
: open ( -- okay? )
0 0 s" deblocker" $open-package dup deblocker ! dup IF
s" disk-label" find-package IF
my-args rot interpose
THEN
THEN 0<> ;
: close ( -- )
deblocker @ close-package ;
: seek ( pos.lo pos.hi -- status )
2dup lxjoin max-#blocks 1 + block-size * > IF
\ illegal seek, return -1
2drop -1
ELSE
s" seek" deblocker @ $call-method
THEN
;
: read ( addr len -- actual )
s" read" deblocker @ $call-method ;
finish-device
|
