2 * Copyright (C) 2011 Instituto Nokia de Tecnologia
5 * Aloisio Almeida Jr <aloisio.almeida@openbossa.org>
6 * Lauro Ramos Venancio <lauro.venancio@openbossa.org>
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the
20 * Free Software Foundation, Inc.,
21 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
24 #define pr_fmt(fmt) KBUILD_MODNAME ": %s: " fmt, __func__
26 #include <net/tcp_states.h>
27 #include <linux/nfc.h>
28 #include <linux/export.h>
32 static void rawsock_write_queue_purge(struct sock
*sk
)
34 pr_debug("sk=%p\n", sk
);
36 spin_lock_bh(&sk
->sk_write_queue
.lock
);
37 __skb_queue_purge(&sk
->sk_write_queue
);
38 nfc_rawsock(sk
)->tx_work_scheduled
= false;
39 spin_unlock_bh(&sk
->sk_write_queue
.lock
);
42 static void rawsock_report_error(struct sock
*sk
, int err
)
44 pr_debug("sk=%p err=%d\n", sk
, err
);
46 sk
->sk_shutdown
= SHUTDOWN_MASK
;
48 sk
->sk_error_report(sk
);
50 rawsock_write_queue_purge(sk
);
53 static int rawsock_release(struct socket
*sock
)
55 struct sock
*sk
= sock
->sk
;
57 pr_debug("sock=%p\n", sock
);
65 static int rawsock_connect(struct socket
*sock
, struct sockaddr
*_addr
,
68 struct sock
*sk
= sock
->sk
;
69 struct sockaddr_nfc
*addr
= (struct sockaddr_nfc
*)_addr
;
73 pr_debug("sock=%p sk=%p flags=%d\n", sock
, sk
, flags
);
75 if (!addr
|| len
< sizeof(struct sockaddr_nfc
) ||
76 addr
->sa_family
!= AF_NFC
)
79 pr_debug("addr dev_idx=%u target_idx=%u protocol=%u\n",
80 addr
->dev_idx
, addr
->target_idx
, addr
->nfc_protocol
);
84 if (sock
->state
== SS_CONNECTED
) {
89 dev
= nfc_get_device(addr
->dev_idx
);
95 if (addr
->target_idx
> dev
->target_next_idx
- 1 ||
96 addr
->target_idx
< dev
->target_next_idx
- dev
->n_targets
) {
101 rc
= nfc_activate_target(dev
, addr
->target_idx
, addr
->nfc_protocol
);
105 nfc_rawsock(sk
)->dev
= dev
;
106 nfc_rawsock(sk
)->target_idx
= addr
->target_idx
;
107 sock
->state
= SS_CONNECTED
;
108 sk
->sk_state
= TCP_ESTABLISHED
;
109 sk
->sk_state_change(sk
);
121 static int rawsock_add_header(struct sk_buff
*skb
)
123 *skb_push(skb
, NFC_HEADER_SIZE
) = 0;
128 static void rawsock_data_exchange_complete(void *context
, struct sk_buff
*skb
,
131 struct sock
*sk
= (struct sock
*) context
;
135 pr_debug("sk=%p err=%d\n", sk
, err
);
140 err
= rawsock_add_header(skb
);
144 err
= sock_queue_rcv_skb(sk
, skb
);
148 spin_lock_bh(&sk
->sk_write_queue
.lock
);
149 if (!skb_queue_empty(&sk
->sk_write_queue
))
150 schedule_work(&nfc_rawsock(sk
)->tx_work
);
152 nfc_rawsock(sk
)->tx_work_scheduled
= false;
153 spin_unlock_bh(&sk
->sk_write_queue
.lock
);
159 rawsock_report_error(sk
, err
);
163 static void rawsock_tx_work(struct work_struct
*work
)
165 struct sock
*sk
= to_rawsock_sk(work
);
166 struct nfc_dev
*dev
= nfc_rawsock(sk
)->dev
;
167 u32 target_idx
= nfc_rawsock(sk
)->target_idx
;
171 pr_debug("sk=%p target_idx=%u\n", sk
, target_idx
);
173 if (sk
->sk_shutdown
& SEND_SHUTDOWN
) {
174 rawsock_write_queue_purge(sk
);
178 skb
= skb_dequeue(&sk
->sk_write_queue
);
181 rc
= nfc_data_exchange(dev
, target_idx
, skb
,
182 rawsock_data_exchange_complete
, sk
);
184 rawsock_report_error(sk
, rc
);
189 static int rawsock_sendmsg(struct kiocb
*iocb
, struct socket
*sock
,
190 struct msghdr
*msg
, size_t len
)
192 struct sock
*sk
= sock
->sk
;
193 struct nfc_dev
*dev
= nfc_rawsock(sk
)->dev
;
197 pr_debug("sock=%p sk=%p len=%zu\n", sock
, sk
, len
);
199 if (msg
->msg_namelen
)
202 if (sock
->state
!= SS_CONNECTED
)
205 skb
= nfc_alloc_send_skb(dev
, sk
, msg
->msg_flags
, len
, &rc
);
209 rc
= memcpy_fromiovec(skb_put(skb
, len
), msg
->msg_iov
, len
);
215 spin_lock_bh(&sk
->sk_write_queue
.lock
);
216 __skb_queue_tail(&sk
->sk_write_queue
, skb
);
217 if (!nfc_rawsock(sk
)->tx_work_scheduled
) {
218 schedule_work(&nfc_rawsock(sk
)->tx_work
);
219 nfc_rawsock(sk
)->tx_work_scheduled
= true;
221 spin_unlock_bh(&sk
->sk_write_queue
.lock
);
226 static int rawsock_recvmsg(struct kiocb
*iocb
, struct socket
*sock
,
227 struct msghdr
*msg
, size_t len
, int flags
)
229 int noblock
= flags
& MSG_DONTWAIT
;
230 struct sock
*sk
= sock
->sk
;
235 pr_debug("sock=%p sk=%p len=%zu flags=%d\n", sock
, sk
, len
, flags
);
237 skb
= skb_recv_datagram(sk
, flags
, noblock
, &rc
);
241 msg
->msg_namelen
= 0;
245 msg
->msg_flags
|= MSG_TRUNC
;
249 rc
= skb_copy_datagram_iovec(skb
, 0, msg
->msg_iov
, copied
);
251 skb_free_datagram(sk
, skb
);
253 return rc
? : copied
;
257 static const struct proto_ops rawsock_ops
= {
259 .owner
= THIS_MODULE
,
260 .release
= rawsock_release
,
261 .bind
= sock_no_bind
,
262 .connect
= rawsock_connect
,
263 .socketpair
= sock_no_socketpair
,
264 .accept
= sock_no_accept
,
265 .getname
= sock_no_getname
,
266 .poll
= datagram_poll
,
267 .ioctl
= sock_no_ioctl
,
268 .listen
= sock_no_listen
,
269 .shutdown
= sock_no_shutdown
,
270 .setsockopt
= sock_no_setsockopt
,
271 .getsockopt
= sock_no_getsockopt
,
272 .sendmsg
= rawsock_sendmsg
,
273 .recvmsg
= rawsock_recvmsg
,
274 .mmap
= sock_no_mmap
,
277 static void rawsock_destruct(struct sock
*sk
)
279 pr_debug("sk=%p\n", sk
);
281 if (sk
->sk_state
== TCP_ESTABLISHED
) {
282 nfc_deactivate_target(nfc_rawsock(sk
)->dev
,
283 nfc_rawsock(sk
)->target_idx
);
284 nfc_put_device(nfc_rawsock(sk
)->dev
);
287 skb_queue_purge(&sk
->sk_receive_queue
);
289 if (!sock_flag(sk
, SOCK_DEAD
)) {
290 pr_err("Freeing alive NFC raw socket %p\n", sk
);
295 static int rawsock_create(struct net
*net
, struct socket
*sock
,
296 const struct nfc_protocol
*nfc_proto
)
300 pr_debug("sock=%p\n", sock
);
302 if (sock
->type
!= SOCK_SEQPACKET
)
303 return -ESOCKTNOSUPPORT
;
305 sock
->ops
= &rawsock_ops
;
307 sk
= sk_alloc(net
, PF_NFC
, GFP_ATOMIC
, nfc_proto
->proto
);
311 sock_init_data(sock
, sk
);
312 sk
->sk_protocol
= nfc_proto
->id
;
313 sk
->sk_destruct
= rawsock_destruct
;
314 sock
->state
= SS_UNCONNECTED
;
316 INIT_WORK(&nfc_rawsock(sk
)->tx_work
, rawsock_tx_work
);
317 nfc_rawsock(sk
)->tx_work_scheduled
= false;
322 static struct proto rawsock_proto
= {
324 .owner
= THIS_MODULE
,
325 .obj_size
= sizeof(struct nfc_rawsock
),
328 static const struct nfc_protocol rawsock_nfc_proto
= {
329 .id
= NFC_SOCKPROTO_RAW
,
330 .proto
= &rawsock_proto
,
331 .owner
= THIS_MODULE
,
332 .create
= rawsock_create
335 int __init
rawsock_init(void)
339 rc
= nfc_proto_register(&rawsock_nfc_proto
);
344 void rawsock_exit(void)
346 nfc_proto_unregister(&rawsock_nfc_proto
);