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
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
|
/*
* Creation Date: <2003/12/07 19:08:33 samuel>
* Time-stamp: <2004/01/07 19:38:36 samuel>
*
* <osi-blk.c>
*
* OSI-block interface
*
* Copyright (C) 2003, 2004 Samuel Rydh (samuel@ibrium.se)
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* version 2
*
*/
#include "config.h"
#include "libopenbios/bindings.h"
#include "mol/mol.h"
#include "osi_calls.h"
typedef struct {
int unit;
int channel;
} osiblk_data_t;
DECLARE_NODE( osiblk, INSTALL_OPEN, sizeof(osiblk_data_t),
"/pci/pci-bridge/mol-blk/disk", "/mol/mol-blk" );
static void
osiblk_open( osiblk_data_t *pb )
{
phandle_t ph;
fword("my-unit");
pb->unit = POP();
pb->channel = 0; /* FIXME */
selfword("open-deblocker");
/* interpose disk-label */
ph = find_dev("/packages/disk-label");
fword("my-args");
PUSH_ph( ph );
fword("interpose");
/* printk("osi-blk: open %d\n", pb->unit ); */
PUSH( -1 );
}
static void
osiblk_close( osiblk_data_t *pb )
{
selfword("close-deblocker");
}
/* ( buf blk nblks -- actual ) */
static void
osiblk_read_blocks( osiblk_data_t *pb )
{
int i, n = POP();
int blk = POP();
char *dest = (char*)POP();
/* printk("osiblk_read_blocks %x block=%d n=%d\n", (int)dest, blk, n ); */
for( i=0; i<n; ) {
char buf[4096];
int m = MIN( n-i, sizeof(buf)/512 );
if( OSI_ABlkSyncRead(pb->channel, pb->unit, blk+i, (int)buf, m*512) < 0 ) {
printk("SyncRead: error\n");
RET(0);
}
memcpy( dest, buf, m * 512 );
i += m;
dest += m * 512;
}
PUSH( n );
}
/* ( -- bs ) */
static void
osiblk_block_size( osiblk_data_t *pb )
{
PUSH( 512 );
}
/* ( -- maxbytes ) */
static void
osiblk_max_transfer( osiblk_data_t *pb )
{
PUSH( 1024*1024 );
}
static void
osiblk_initialize( osiblk_data_t *pb )
{
fword("is-deblocker");
}
NODE_METHODS( osiblk ) = {
{ NULL, osiblk_initialize },
{ "open", osiblk_open },
{ "close", osiblk_close },
{ "read-blocks", osiblk_read_blocks },
{ "block-size", osiblk_block_size },
{ "max-transfer", osiblk_max_transfer },
};
void
osiblk_init( void )
{
REGISTER_NODE( osiblk );
}
|
