2 Copyright (C) 2010 by Ronnie Sahlberg <ronniesahlberg@gmail.com>
4 This program is free software; you can redistribute it and/or modify
5 it under the terms of the GNU Lesser General Public License as published by
6 the Free Software Foundation; either version 2.1 of the License, or
7 (at your option) any later version.
9 This program is distributed in the hope that it will be useful,
10 but WITHOUT ANY WARRANTY; without even the implied warranty of
11 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 GNU Lesser General Public License for more details.
14 You should have received a copy of the GNU Lesser General Public License
15 along with this program; if not, see <http://www.gnu.org/licenses/>.
27 #include <arpa/inet.h>
28 #include <sys/ioctl.h>
30 #include "libnfs-raw.h"
31 #include "libnfs-private.h"
34 static void set_nonblocking(int fd
)
37 v
= fcntl(fd
, F_GETFL
, 0);
38 fcntl(fd
, F_SETFL
, v
| O_NONBLOCK
);
41 int rpc_get_fd(struct rpc_context
*rpc
)
46 int rpc_which_events(struct rpc_context
*rpc
)
48 int events
= rpc
->is_connected
? POLLIN
: POLLOUT
;
50 if (rpc
->is_udp
!= 0) {
51 /* for udp sockets we only wait for pollin */
61 static int rpc_write_to_socket(struct rpc_context
*rpc
)
69 rpc_set_error(rpc
, "trying to write but not connected");
73 while (rpc
->outqueue
!= NULL
) {
76 total
= rpc
->outqueue
->outdata
.size
;
78 count
= write(rpc
->fd
, rpc
->outqueue
->outdata
.data
+ rpc
->outqueue
->written
, total
- rpc
->outqueue
->written
);
80 if (errno
== EAGAIN
|| errno
== EWOULDBLOCK
) {
83 rpc_set_error(rpc
, "Error when writing to socket :%s(%d)", strerror(errno
), errno
);
87 rpc
->outqueue
->written
+= count
;
88 if (rpc
->outqueue
->written
== total
) {
89 struct rpc_pdu
*pdu
= rpc
->outqueue
;
91 SLIST_REMOVE(&rpc
->outqueue
, pdu
);
92 SLIST_ADD_END(&rpc
->waitpdu
, pdu
);
98 static int rpc_read_from_socket(struct rpc_context
*rpc
)
105 if (ioctl(rpc
->fd
, FIONREAD
, &available
) != 0) {
106 rpc_set_error(rpc
, "Ioctl FIONREAD returned error : %d. Closing socket.", errno
);
109 if (available
== 0) {
110 rpc_set_error(rpc
, "Socket has been closed");
116 socklen_t socklen
= sizeof(rpc
->udp_src
);
118 buf
= malloc(available
);
120 rpc_set_error(rpc
, "Failed to malloc buffer for recvfrom");
123 count
= recvfrom(rpc
->fd
, buf
, available
, MSG_DONTWAIT
, (struct sockaddr
*)&rpc
->udp_src
, &socklen
);
125 rpc_set_error(rpc
, "Failed recvfrom: %s", strerror(errno
));
128 if (rpc_process_pdu(rpc
, buf
, count
) != 0) {
129 rpc_set_error(rpc
, "Invalid/garbage pdu received from server. Ignoring PDU");
137 /* read record marker, 4 bytes at the beginning of every pdu */
138 if (rpc
->inbuf
== NULL
) {
140 rpc
->inbuf
= malloc(rpc
->insize
);
141 if (rpc
->inbuf
== NULL
) {
142 rpc_set_error(rpc
, "Failed to allocate buffer for record marker, errno:%d. Closing socket.", errno
);
146 if (rpc
->inpos
< 4) {
147 size
= 4 - rpc
->inpos
;
149 count
= read(rpc
->fd
, rpc
->inbuf
+ rpc
->inpos
, size
);
151 if (errno
== EINTR
) {
154 rpc_set_error(rpc
, "Read from socket failed, errno:%d. Closing socket.", errno
);
161 if (available
== 0) {
165 pdu_size
= rpc_get_pdu_size(rpc
->inbuf
);
166 if (rpc
->insize
< pdu_size
) {
169 buf
= malloc(pdu_size
);
171 rpc_set_error(rpc
, "Failed to allocate buffer of %d bytes for pdu, errno:%d. Closing socket.", pdu_size
, errno
);
174 memcpy(buf
, rpc
->inbuf
, rpc
->insize
);
177 rpc
->insize
= rpc_get_pdu_size(rpc
->inbuf
);
181 if (size
> rpc
->insize
- rpc
->inpos
) {
182 size
= rpc
->insize
- rpc
->inpos
;
185 count
= read(rpc
->fd
, rpc
->inbuf
+ rpc
->inpos
, size
);
187 if (errno
== EINTR
) {
190 rpc_set_error(rpc
, "Read from socket failed, errno:%d. Closing socket.", errno
);
196 if (rpc
->inpos
== rpc
->insize
) {
197 if (rpc_process_pdu(rpc
, rpc
->inbuf
, pdu_size
) != 0) {
198 rpc_set_error(rpc
, "Invalid/garbage pdu received from server. Closing socket");
212 int rpc_service(struct rpc_context
*rpc
, int revents
)
214 if (revents
& POLLERR
) {
216 socklen_t err_size
= sizeof(err
);
218 if (getsockopt(rpc
->fd
, SOL_SOCKET
, SO_ERROR
,
219 &err
, &err_size
) != 0 || err
!= 0) {
223 rpc_set_error(rpc
, "rpc_service: socket error "
227 rpc_set_error(rpc
, "rpc_service: POLLERR, "
228 "Unknown socket error.");
230 rpc
->connect_cb(rpc
, RPC_STATUS_ERROR
, rpc
->error_string
, rpc
->connect_data
);
233 if (revents
& POLLHUP
) {
234 rpc_set_error(rpc
, "Socket failed with POLLHUP");
235 rpc
->connect_cb(rpc
, RPC_STATUS_ERROR
, rpc
->error_string
, rpc
->connect_data
);
239 if (rpc
->is_connected
== 0 && rpc
->fd
!= -1 && revents
&POLLOUT
) {
241 socklen_t err_size
= sizeof(err
);
243 if (getsockopt(rpc
->fd
, SOL_SOCKET
, SO_ERROR
,
244 &err
, &err_size
) != 0 || err
!= 0) {
248 rpc_set_error(rpc
, "rpc_service: socket error "
249 "%s(%d) while connecting.",
251 rpc
->connect_cb(rpc
, RPC_STATUS_ERROR
,
252 NULL
, rpc
->connect_data
);
256 rpc
->is_connected
= 1;
257 rpc
->connect_cb(rpc
, RPC_STATUS_SUCCESS
, NULL
, rpc
->connect_data
);
261 if (revents
& POLLOUT
&& rpc
->outqueue
!= NULL
) {
262 if (rpc_write_to_socket(rpc
) != 0) {
263 rpc_set_error(rpc
, "write to socket failed");
268 if (revents
& POLLIN
) {
269 if (rpc_read_from_socket(rpc
) != 0) {
270 rpc_disconnect(rpc
, rpc_get_error(rpc
));
279 int rpc_connect_async(struct rpc_context
*rpc
, const char *server
, int port
, rpc_cb cb
, void *private_data
)
281 struct sockaddr_storage s
;
282 struct sockaddr_in
*sin
= (struct sockaddr_in
*)&s
;
286 rpc_set_error(rpc
, "Trying to connect while already connected");
290 sin
->sin_family
= AF_INET
;
291 sin
->sin_port
= htons(port
);
292 if (inet_pton(AF_INET
, server
, &sin
->sin_addr
) != 1) {
293 rpc_set_error(rpc
, "Not a valid server ip address");
297 switch (s
.ss_family
) {
299 socksize
= sizeof(struct sockaddr_in
);
300 #ifdef HAVE_SOCK_SIN_LEN
301 sin
->sin_len
= socksize
;
303 rpc
->fd
= socket(AF_INET
, SOCK_STREAM
, 0);
308 rpc_set_error(rpc
, "Failed to open socket");
312 rpc
->connect_cb
= cb
;
313 rpc
->connect_data
= private_data
;
315 set_nonblocking(rpc
->fd
);
317 if (connect(rpc
->fd
, (struct sockaddr
*)&s
, socksize
) != 0 && errno
!= EINPROGRESS
) {
318 rpc_set_error(rpc
, "connect() to server failed");
325 int rpc_disconnect(struct rpc_context
*rpc
, char *error
)
332 rpc
->is_connected
= 0;
334 rpc_error_all_pdus(rpc
, error
);