… | |
… | |
10 | #include <netinet/in.h> |
10 | #include <netinet/in.h> |
11 | #include <byteswap.h> |
11 | #include <byteswap.h> |
12 | |
12 | |
13 | typedef uint32_t u32; |
13 | typedef uint32_t u32; |
14 | typedef uint64_t u64; |
14 | typedef uint64_t u64; |
15 | #include <linux/nbd.h> |
15 | #include "nbd.h" |
16 | |
16 | |
17 | #if __BYTE_ORDER == __BIG_ENDIAN |
17 | #if __BYTE_ORDER == __BIG_ENDIAN |
18 | #define ntohll(netlong) (netlong) |
18 | #define ntohll(netlong) (netlong) |
19 | #elif __BYTE_ORDER == __LITTLE_ENDIAN |
19 | #elif __BYTE_ORDER == __LITTLE_ENDIAN |
20 | #define ntohll(netlong) __bswap_64(netlong) |
20 | #define ntohll(netlong) __bswap_64(netlong) |
21 | #else |
21 | #else |
22 | error, you should not exist |
22 | error, you should not exist |
23 | #endif |
23 | #endif |
24 | |
24 | |
|
|
25 | struct rstate { |
|
|
26 | struct nbd_request req; |
|
|
27 | u32 req_read; /* how many octets of req are valid */ |
|
|
28 | u32 data_read; /* how many octets of the data sv are valid */ |
|
|
29 | }; |
|
|
30 | |
25 | MODULE = Linux::NBD PACKAGE = Linux::NBD::Client |
31 | MODULE = Linux::NBD PACKAGE = Linux::NBD::Client |
|
|
32 | |
|
|
33 | PROTOTYPES: DISABLE |
26 | |
34 | |
27 | void |
35 | void |
28 | _set_sock (int dev, int fd) |
36 | _set_sock (int dev, int fd) |
29 | CODE: |
37 | CODE: |
30 | ioctl (dev, NBD_SET_SOCK, (unsigned long)fd); |
38 | ioctl (dev, NBD_SET_SOCK, (unsigned long)fd); |
… | |
… | |
47 | CODE: |
55 | CODE: |
48 | ioctl (dev, NBD_DISCONNECT); |
56 | ioctl (dev, NBD_DISCONNECT); |
49 | |
57 | |
50 | void |
58 | void |
51 | _clear_sock (int dev) |
59 | _clear_sock (int dev) |
|
|
60 | ALIAS: |
|
|
61 | _clear_sock = NBD_CLEAR_SOCK |
|
|
62 | _clear_que = NBD_CLEAR_QUE |
52 | CODE: |
63 | CODE: |
53 | ioctl (dev, NBD_CLEAR_SOCK); |
64 | ioctl (dev, ix); |
54 | |
65 | |
55 | void |
66 | void |
56 | _clear_que (int dev) |
|
|
57 | CODE: |
|
|
58 | ioctl (dev, NBD_CLEAR_QUE); |
|
|
59 | |
|
|
60 | void |
|
|
61 | _set_blksize (int dev, unsigned long blocksize) |
|
|
62 | CODE: |
|
|
63 | ioctl (dev, NBD_SET_BLKSIZE, blocksize); |
|
|
64 | |
|
|
65 | void |
|
|
66 | _set_size (int dev, unsigned long size) |
67 | _set_blksize (int dev, unsigned long arg) |
|
|
68 | ALIAS: |
|
|
69 | _set_blksize = NBD_SET_BLKSIZE |
|
|
70 | _set_size = NBD_SET_SIZE |
|
|
71 | _set_size_blocks = NBD_SET_SIZE_BLOCKS |
|
|
72 | _set_timeout = NBD_SET_TIMEOUT |
|
|
73 | _set_flags = NBD_SET_FLAGS |
67 | CODE: |
74 | CODE: |
68 | ioctl (dev, NBD_SET_BLKSIZE, size); |
75 | ioctl (dev, ix, arg); |
69 | |
76 | |
70 | void |
77 | void |
71 | _set_size_blocks (int dev, unsigned long nblocks) |
78 | _print_debug (int dev) |
72 | CODE: |
79 | CODE: |
73 | ioctl (dev, NBD_SET_SIZE_BLOCKS, nblocks); |
80 | ioctl (dev, NBD_PRINT_DEBUG, 0); |
74 | |
81 | |
75 | MODULE = Linux::NBD PACKAGE = Linux::NBD::Server |
82 | MODULE = Linux::NBD PACKAGE = Linux::NBD::Server |
76 | |
83 | |
77 | void |
84 | void |
78 | _one_request (SV *obj, int fd) |
85 | _one_request (SV *obj, int fd) |
79 | CODE: |
86 | CODE: |
80 | struct nbd_request req; |
87 | { |
|
|
88 | struct rstate *s; |
|
|
89 | u64 from; |
|
|
90 | u32 len; |
|
|
91 | char *method; |
|
|
92 | int cmd; |
|
|
93 | MAGIC *mg = mg_find (SvRV (obj), PERL_MAGIC_ext); |
81 | |
94 | |
82 | if (read (fd, &req, sizeof (req)) == sizeof (req)) |
95 | if (!mg) |
83 | { |
96 | { |
|
|
97 | mg = sv_magicext (SvRV (obj), 0, PERL_MAGIC_ext, 0, 0, 0); |
|
|
98 | mg->mg_len = sizeof (struct rstate); |
|
|
99 | New (0, mg->mg_ptr, mg->mg_len, char); |
|
|
100 | |
|
|
101 | ((struct rstate *)mg->mg_ptr)->req_read = 0; /* initialise the state machine */ |
|
|
102 | } |
|
|
103 | |
|
|
104 | s = (struct rstate *)mg->mg_ptr; |
|
|
105 | |
|
|
106 | if (s->req_read < sizeof (struct nbd_request)) |
|
|
107 | { |
|
|
108 | int res = read (fd, s->req_read + (char *)&s->req, sizeof (struct nbd_request) - s->req_read); |
|
|
109 | |
|
|
110 | if (res > 0) |
|
|
111 | s->req_read += res; |
|
|
112 | else if (res == 0) |
|
|
113 | XSRETURN_UNDEF; /* should req->eof */ |
|
|
114 | else if (errno != EAGAIN && errno != EWOULDBLOCK) |
|
|
115 | XSRETURN_UNDEF; /* should req->error */ |
|
|
116 | |
|
|
117 | s->data_read = 0; |
|
|
118 | |
|
|
119 | if (s->req_read < sizeof (struct nbd_request)) |
|
|
120 | XSRETURN_NO; |
|
|
121 | } |
|
|
122 | |
|
|
123 | /* now we have a full request, so check for data */ |
84 | if (req.magic == htonl (NBD_REQUEST_MAGIC)) |
124 | if (s->req.magic != htonl (NBD_REQUEST_MAGIC)) |
|
|
125 | croak ("Linux::NBD::Server received illegal request magic %08lx - protocol error.\n", ntohl (s->req.magic)); |
|
|
126 | |
|
|
127 | from = ntohll (s->req.from); |
|
|
128 | len = ntohl (s->req.len); |
|
|
129 | cmd = ntohl (s->req.type) & NBD_CMD_MASK_COMMAND; |
|
|
130 | |
|
|
131 | switch (cmd) |
85 | { |
132 | { |
86 | if (req.type < 2) |
133 | case NBD_CMD_WRITE: |
|
|
134 | if (!mg->mg_obj) |
87 | { |
135 | { |
88 | u64 from = ntohll (req.from); |
136 | mg->mg_flags |= MGf_REFCOUNTED; |
|
|
137 | mg->mg_obj = NEWSV (0, len); |
|
|
138 | SvPOK_only (mg->mg_obj); |
|
|
139 | SvCUR_set (mg->mg_obj, len); |
|
|
140 | } |
89 | |
141 | |
90 | PUSHMARK (SP); |
142 | if (s->data_read < len) |
91 | EXTEND (SP, 3); |
143 | { |
92 | PUSHs (obj); |
144 | int res = read (fd, s->data_read + SvPVX (mg->mg_obj), len - s->data_read); |
93 | PUSHs (sv_2mortal (newSVpvn (req.handle, sizeof (req.handle)))); |
|
|
94 | PUSHs (sv_2mortal (sizeof (UV) < 8 && from > (0xffffffffUL) |
|
|
95 | ? newSVnv (from) |
|
|
96 | : newSVuv (from))); |
|
|
97 | PUSHs (sv_2mortal (newSVuv (ntohl (req.len)))); |
|
|
98 | PUTBACK; |
|
|
99 | call_method (req.type ? "req_write" : "req_read", G_DISCARD); |
|
|
100 | SPAGAIN; |
|
|
101 | |
145 | |
|
|
146 | if (res > 0) |
|
|
147 | s->data_read += res; |
|
|
148 | else if (res == 0) |
|
|
149 | XSRETURN_UNDEF; /* should req->eof */ |
|
|
150 | else if (errno != EAGAIN && errno != EWOULDBLOCK) |
|
|
151 | XSRETURN_UNDEF; /* should req->error */ |
|
|
152 | |
|
|
153 | if (s->data_read < len) |
102 | XSRETURN_NO; |
154 | XSRETURN_NO; |
103 | } |
155 | } |
|
|
156 | |
|
|
157 | /* fallthrough */ |
|
|
158 | case NBD_CMD_READ: |
|
|
159 | case NBD_CMD_FLUSH: |
|
|
160 | case NBD_CMD_TRIM: |
|
|
161 | case NBD_CMD_WRITE_ZEROES: |
|
|
162 | s->req_read = 0; |
|
|
163 | |
|
|
164 | PUSHMARK (SP); |
|
|
165 | EXTEND (SP, 4); |
|
|
166 | PUSHs (obj); |
|
|
167 | PUSHs (sv_2mortal (newSVpvn (s->req.handle, sizeof (s->req.handle)))); |
|
|
168 | PUSHs (sv_2mortal (sizeof (UV) < 8 && from > 0xffffffffUL |
|
|
169 | ? newSVnv (from) |
|
|
170 | : newSVuv (from))); |
|
|
171 | |
|
|
172 | if (mg->mg_obj) |
|
|
173 | { |
|
|
174 | PUSHs (sv_2mortal (mg->mg_obj)); |
|
|
175 | mg->mg_obj = 0; |
|
|
176 | method = "req_write"; |
104 | } |
177 | } |
|
|
178 | else |
|
|
179 | { |
|
|
180 | PUSHs (sv_2mortal (newSVuv (len))); |
|
|
181 | method = cmd == NBD_CMD_READ ? "req_read" |
|
|
182 | : cmd == NBD_CMD_FLUSH ? "req_flush" |
|
|
183 | : cmd == NBD_CMD_TRIM ? "req_trim" |
|
|
184 | : cmd == NBD_CMD_WRITE_ZEROES ? "req_write_zeroes" |
|
|
185 | : (abort (), ""); |
|
|
186 | } |
|
|
187 | |
|
|
188 | break; |
|
|
189 | |
|
|
190 | case NBD_CMD_DISC: |
|
|
191 | s->req_read = 0; |
|
|
192 | |
|
|
193 | method = "req_disc"; |
|
|
194 | |
|
|
195 | PUSHMARK (SP); |
|
|
196 | XPUSHs (obj); |
|
|
197 | |
|
|
198 | break; |
|
|
199 | |
|
|
200 | default: |
|
|
201 | croak ("Linux::NBD::Server received unsupported request type %d.\n", ntohl (s->req.type)); |
105 | } |
202 | } |
106 | |
203 | |
|
|
204 | PUTBACK; |
|
|
205 | call_method (method, G_DISCARD); |
|
|
206 | SPAGAIN; |
|
|
207 | |
107 | XSRETURN_YES; |
208 | XSRETURN_YES; |
|
|
209 | } |
108 | |
210 | |
109 | SV * |
211 | SV * |
110 | _format_reply (SV *handle, unsigned int error = 0, SV *data = 0) |
212 | format_reply (SV *unused, SV *handle, unsigned int error = 0, SV *data = 0) |
111 | CODE: |
213 | CODE: |
|
|
214 | { |
112 | struct nbd_reply rep; |
215 | struct nbd_reply rep; |
113 | STRLEN len; |
216 | STRLEN len; |
114 | char *h = SvPV (handle, len); |
217 | char *h = SvPV (handle, len); |
115 | |
218 | |
116 | if (len != sizeof (rep.handle)) |
219 | if (len != sizeof (rep.handle)) |
… | |
… | |
122 | |
225 | |
123 | RETVAL = newSVpvn ((char *)&rep, sizeof (rep)); |
226 | RETVAL = newSVpvn ((char *)&rep, sizeof (rep)); |
124 | |
227 | |
125 | if (data && !error) |
228 | if (data && !error) |
126 | sv_catsv (RETVAL, data); |
229 | sv_catsv (RETVAL, data); |
127 | |
230 | } |
128 | OUTPUT: |
231 | OUTPUT: |
129 | RETVAL |
232 | RETVAL |
130 | |
233 | |