^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * File: pep.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Phonet pipe protocol end point socket
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Copyright (C) 2008 Nokia Corporation.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * Author: Rémi Denis-Courmont
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/sched/signal.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/socket.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <net/sock.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <net/tcp_states.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <asm/ioctls.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/phonet.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <net/phonet/phonet.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <net/phonet/pep.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <net/phonet/gprs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) /* sk_state values:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) * TCP_CLOSE sock not in use yet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) * TCP_CLOSE_WAIT disconnected pipe
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) * TCP_LISTEN listening pipe endpoint
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) * TCP_SYN_RECV connected pipe in disabled state
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) * TCP_ESTABLISHED connected pipe in enabled state
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) * pep_sock locking:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) * - sk_state, hlist: sock lock needed
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) * - listener: read only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) * - pipe_handle: read only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define CREDITS_MAX 10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define CREDITS_THR 7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define pep_sb_size(s) (((s) + 5) & ~3) /* 2-bytes head, 32-bits aligned */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) /* Get the next TLV sub-block. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) static unsigned char *pep_get_sb(struct sk_buff *skb, u8 *ptype, u8 *plen,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) void *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) void *data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) struct {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) u8 sb_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) u8 sb_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) } *ph, h;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) int buflen = *plen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) ph = skb_header_pointer(skb, 0, 2, &h);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) if (ph == NULL || ph->sb_len < 2 || !pskb_may_pull(skb, ph->sb_len))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) ph->sb_len -= 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) *ptype = ph->sb_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) *plen = ph->sb_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) if (buflen > ph->sb_len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) buflen = ph->sb_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) data = skb_header_pointer(skb, 2, buflen, buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) __skb_pull(skb, 2 + ph->sb_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) return data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) static struct sk_buff *pep_alloc_skb(struct sock *sk, const void *payload,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) int len, gfp_t priority)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) struct sk_buff *skb = alloc_skb(MAX_PNPIPE_HEADER + len, priority);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) skb_set_owner_w(skb, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) skb_reserve(skb, MAX_PNPIPE_HEADER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) __skb_put(skb, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) skb_copy_to_linear_data(skb, payload, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) __skb_push(skb, sizeof(struct pnpipehdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) skb_reset_transport_header(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) return skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) static int pep_reply(struct sock *sk, struct sk_buff *oskb, u8 code,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) const void *data, int len, gfp_t priority)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) const struct pnpipehdr *oph = pnp_hdr(oskb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) struct pnpipehdr *ph;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) struct sockaddr_pn peer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) skb = pep_alloc_skb(sk, data, len, priority);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) ph = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) ph->utid = oph->utid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) ph->message_id = oph->message_id + 1; /* REQ -> RESP */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) ph->pipe_handle = oph->pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) ph->error_code = code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) pn_skb_get_src_sockaddr(oskb, &peer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) return pn_skb_send(sk, skb, &peer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) static int pep_indicate(struct sock *sk, u8 id, u8 code,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) const void *data, int len, gfp_t priority)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) struct pnpipehdr *ph;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) skb = pep_alloc_skb(sk, data, len, priority);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) ph = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) ph->utid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) ph->message_id = id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) ph->pipe_handle = pn->pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) ph->error_code = code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) return pn_skb_send(sk, skb, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) #define PAD 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) static int pipe_handler_request(struct sock *sk, u8 id, u8 code,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) const void *data, int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) struct pnpipehdr *ph;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) skb = pep_alloc_skb(sk, data, len, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) ph = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) ph->utid = id; /* whatever */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) ph->message_id = id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) ph->pipe_handle = pn->pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) ph->error_code = code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) return pn_skb_send(sk, skb, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) static int pipe_handler_send_created_ind(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) u8 data[4] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) PN_PIPE_SB_NEGOTIATED_FC, pep_sb_size(2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) pn->tx_fc, pn->rx_fc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) return pep_indicate(sk, PNS_PIPE_CREATED_IND, 1 /* sub-blocks */,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) data, 4, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) static int pep_accept_conn(struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) static const u8 data[20] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) PAD, PAD, PAD, 2 /* sub-blocks */,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) PN_PIPE_SB_REQUIRED_FC_TX, pep_sb_size(5), 3, PAD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) PN_MULTI_CREDIT_FLOW_CONTROL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) PN_ONE_CREDIT_FLOW_CONTROL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) PN_LEGACY_FLOW_CONTROL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) PAD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) PN_PIPE_SB_PREFERRED_FC_RX, pep_sb_size(5), 3, PAD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) PN_MULTI_CREDIT_FLOW_CONTROL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) PN_ONE_CREDIT_FLOW_CONTROL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) PN_LEGACY_FLOW_CONTROL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) PAD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) might_sleep();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) return pep_reply(sk, skb, PN_PIPE_NO_ERROR, data, sizeof(data),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) static int pep_reject_conn(struct sock *sk, struct sk_buff *skb, u8 code,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) gfp_t priority)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) static const u8 data[4] = { PAD, PAD, PAD, 0 /* sub-blocks */ };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) WARN_ON(code == PN_PIPE_NO_ERROR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) return pep_reply(sk, skb, code, data, sizeof(data), priority);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) /* Control requests are not sent by the pipe service and have a specific
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) * message format. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) static int pep_ctrlreq_error(struct sock *sk, struct sk_buff *oskb, u8 code,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) gfp_t priority)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) const struct pnpipehdr *oph = pnp_hdr(oskb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) struct pnpipehdr *ph;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) struct sockaddr_pn dst;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) u8 data[4] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) oph->pep_type, /* PEP type */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) code, /* error code, at an unusual offset */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) PAD, PAD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) skb = pep_alloc_skb(sk, data, 4, priority);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) ph = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) ph->utid = oph->utid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) ph->message_id = PNS_PEP_CTRL_RESP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) ph->pipe_handle = oph->pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) ph->data0 = oph->data[0]; /* CTRL id */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) pn_skb_get_src_sockaddr(oskb, &dst);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) return pn_skb_send(sk, skb, &dst);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) static int pipe_snd_status(struct sock *sk, u8 type, u8 status, gfp_t priority)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) u8 data[4] = { type, PAD, PAD, status };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) return pep_indicate(sk, PNS_PEP_STATUS_IND, PN_PEP_TYPE_COMMON,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) data, 4, priority);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) /* Send our RX flow control information to the sender.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) * Socket must be locked. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) static void pipe_grant_credits(struct sock *sk, gfp_t priority)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) BUG_ON(sk->sk_state != TCP_ESTABLISHED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) switch (pn->rx_fc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) case PN_LEGACY_FLOW_CONTROL: /* TODO */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) case PN_ONE_CREDIT_FLOW_CONTROL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) if (pipe_snd_status(sk, PN_PEP_IND_FLOW_CONTROL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) PEP_IND_READY, priority) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) pn->rx_credits = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) case PN_MULTI_CREDIT_FLOW_CONTROL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) if ((pn->rx_credits + CREDITS_THR) > CREDITS_MAX)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) if (pipe_snd_status(sk, PN_PEP_IND_ID_MCFC_GRANT_CREDITS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) CREDITS_MAX - pn->rx_credits,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) priority) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) pn->rx_credits = CREDITS_MAX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) static int pipe_rcv_status(struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) struct pnpipehdr *hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) int wake = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) if (!pskb_may_pull(skb, sizeof(*hdr) + 4))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) hdr = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) if (hdr->pep_type != PN_PEP_TYPE_COMMON) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) net_dbg_ratelimited("Phonet unknown PEP type: %u\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) (unsigned int)hdr->pep_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) switch (hdr->data[0]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) case PN_PEP_IND_FLOW_CONTROL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) switch (pn->tx_fc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) case PN_LEGACY_FLOW_CONTROL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) switch (hdr->data[3]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) case PEP_IND_BUSY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) atomic_set(&pn->tx_credits, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) case PEP_IND_READY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) atomic_set(&pn->tx_credits, wake = 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) case PN_ONE_CREDIT_FLOW_CONTROL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) if (hdr->data[3] == PEP_IND_READY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) atomic_set(&pn->tx_credits, wake = 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) case PN_PEP_IND_ID_MCFC_GRANT_CREDITS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) if (pn->tx_fc != PN_MULTI_CREDIT_FLOW_CONTROL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) atomic_add(wake = hdr->data[3], &pn->tx_credits);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) net_dbg_ratelimited("Phonet unknown PEP indication: %u\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) (unsigned int)hdr->data[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) if (wake)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) sk->sk_write_space(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) static int pipe_rcv_created(struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) struct pnpipehdr *hdr = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) u8 n_sb = hdr->data0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) pn->rx_fc = pn->tx_fc = PN_LEGACY_FLOW_CONTROL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) __skb_pull(skb, sizeof(*hdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) while (n_sb > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) u8 type, buf[2], len = sizeof(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) u8 *data = pep_get_sb(skb, &type, &len, buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) if (data == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) case PN_PIPE_SB_NEGOTIATED_FC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) if (len < 2 || (data[0] | data[1]) > 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) pn->tx_fc = data[0] & 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) pn->rx_fc = data[1] & 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) n_sb--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) /* Queue an skb to a connected sock.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) * Socket lock must be held. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) static int pipe_do_rcv(struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) struct pnpipehdr *hdr = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) struct sk_buff_head *queue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) int err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) BUG_ON(sk->sk_state == TCP_CLOSE_WAIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) switch (hdr->message_id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) case PNS_PEP_CONNECT_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) pep_reject_conn(sk, skb, PN_PIPE_ERR_PEP_IN_USE, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) case PNS_PEP_DISCONNECT_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) pep_reply(sk, skb, PN_PIPE_NO_ERROR, NULL, 0, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) sk->sk_state = TCP_CLOSE_WAIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) if (!sock_flag(sk, SOCK_DEAD))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) sk->sk_state_change(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) case PNS_PEP_ENABLE_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) /* Wait for PNS_PIPE_(ENABLED|REDIRECTED)_IND */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) pep_reply(sk, skb, PN_PIPE_NO_ERROR, NULL, 0, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) case PNS_PEP_RESET_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) switch (hdr->state_after_reset) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) case PN_PIPE_DISABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) pn->init_enable = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) case PN_PIPE_ENABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) pn->init_enable = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) default: /* not allowed to send an error here!? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) case PNS_PEP_DISABLE_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) atomic_set(&pn->tx_credits, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) pep_reply(sk, skb, PN_PIPE_NO_ERROR, NULL, 0, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) case PNS_PEP_CTRL_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) if (skb_queue_len(&pn->ctrlreq_queue) >= PNPIPE_CTRLREQ_MAX) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) atomic_inc(&sk->sk_drops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) __skb_pull(skb, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) queue = &pn->ctrlreq_queue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) goto queue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) case PNS_PIPE_ALIGNED_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) __skb_pull(skb, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) case PNS_PIPE_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) __skb_pull(skb, 3); /* Pipe data header */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) if (!pn_flow_safe(pn->rx_fc)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) err = sock_queue_rcv_skb(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) if (!err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) return NET_RX_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) err = -ENOBUFS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) if (pn->rx_credits == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) atomic_inc(&sk->sk_drops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) err = -ENOBUFS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) pn->rx_credits--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) queue = &sk->sk_receive_queue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) goto queue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) case PNS_PEP_STATUS_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) pipe_rcv_status(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) case PNS_PIPE_REDIRECTED_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) err = pipe_rcv_created(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) case PNS_PIPE_CREATED_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) err = pipe_rcv_created(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) case PNS_PIPE_RESET_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) if (!pn->init_enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) case PNS_PIPE_ENABLED_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) if (!pn_flow_safe(pn->tx_fc)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) atomic_set(&pn->tx_credits, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) sk->sk_write_space(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) if (sk->sk_state == TCP_ESTABLISHED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) break; /* Nothing to do */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) sk->sk_state = TCP_ESTABLISHED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) pipe_grant_credits(sk, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) case PNS_PIPE_DISABLED_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) sk->sk_state = TCP_SYN_RECV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) pn->rx_credits = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) net_dbg_ratelimited("Phonet unknown PEP message: %u\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) hdr->message_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) return (err == -ENOBUFS) ? NET_RX_DROP : NET_RX_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) queue:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) skb->dev = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) skb_set_owner_r(skb, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) skb_queue_tail(queue, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) if (!sock_flag(sk, SOCK_DEAD))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) sk->sk_data_ready(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) return NET_RX_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) /* Destroy connected sock. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) static void pipe_destruct(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) skb_queue_purge(&sk->sk_receive_queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) skb_queue_purge(&pn->ctrlreq_queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) static u8 pipe_negotiate_fc(const u8 *fcs, unsigned int n)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) u8 final_fc = PN_NO_FLOW_CONTROL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) for (i = 0; i < n; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) u8 fc = fcs[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) if (fc > final_fc && fc < PN_MAX_FLOW_CONTROL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) final_fc = fc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) return final_fc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) static int pep_connresp_rcv(struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) struct pnpipehdr *hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) u8 n_sb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) if (!pskb_pull(skb, sizeof(*hdr) + 4))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) hdr = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) if (hdr->error_code != PN_PIPE_NO_ERROR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) return -ECONNREFUSED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) /* Parse sub-blocks */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) n_sb = hdr->data[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) while (n_sb > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) u8 type, buf[6], len = sizeof(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) const u8 *data = pep_get_sb(skb, &type, &len, buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) if (data == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) case PN_PIPE_SB_REQUIRED_FC_TX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) if (len < 2 || len < data[0])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) pn->tx_fc = pipe_negotiate_fc(data + 2, len - 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) case PN_PIPE_SB_PREFERRED_FC_RX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) if (len < 2 || len < data[0])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) pn->rx_fc = pipe_negotiate_fc(data + 2, len - 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) n_sb--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) return pipe_handler_send_created_ind(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) static int pep_enableresp_rcv(struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) struct pnpipehdr *hdr = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) if (hdr->error_code != PN_PIPE_NO_ERROR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) return -ECONNREFUSED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) return pep_indicate(sk, PNS_PIPE_ENABLED_IND, 0 /* sub-blocks */,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) NULL, 0, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) static void pipe_start_flow_control(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) if (!pn_flow_safe(pn->tx_fc)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) atomic_set(&pn->tx_credits, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) sk->sk_write_space(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) pipe_grant_credits(sk, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) /* Queue an skb to an actively connected sock.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) * Socket lock must be held. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) static int pipe_handler_do_rcv(struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) struct pnpipehdr *hdr = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) int err = NET_RX_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) switch (hdr->message_id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) case PNS_PIPE_ALIGNED_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) __skb_pull(skb, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) case PNS_PIPE_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) __skb_pull(skb, 3); /* Pipe data header */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) if (!pn_flow_safe(pn->rx_fc)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) err = sock_queue_rcv_skb(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) if (!err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) return NET_RX_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) err = NET_RX_DROP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) if (pn->rx_credits == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) atomic_inc(&sk->sk_drops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) err = NET_RX_DROP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) pn->rx_credits--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) skb->dev = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) skb_set_owner_r(skb, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) skb_queue_tail(&sk->sk_receive_queue, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) if (!sock_flag(sk, SOCK_DEAD))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) sk->sk_data_ready(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) return NET_RX_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) case PNS_PEP_CONNECT_RESP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) if (sk->sk_state != TCP_SYN_SENT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) if (!sock_flag(sk, SOCK_DEAD))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) sk->sk_state_change(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) if (pep_connresp_rcv(sk, skb)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) sk->sk_state = TCP_CLOSE_WAIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) if (pn->init_enable == PN_PIPE_DISABLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) sk->sk_state = TCP_SYN_RECV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) sk->sk_state = TCP_ESTABLISHED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) pipe_start_flow_control(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) case PNS_PEP_ENABLE_RESP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) if (sk->sk_state != TCP_SYN_SENT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) if (pep_enableresp_rcv(sk, skb)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) sk->sk_state = TCP_CLOSE_WAIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) sk->sk_state = TCP_ESTABLISHED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) pipe_start_flow_control(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) case PNS_PEP_DISCONNECT_RESP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) /* sock should already be dead, nothing to do */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) case PNS_PEP_STATUS_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) pipe_rcv_status(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) /* Listening sock must be locked */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) static struct sock *pep_find_pipe(const struct hlist_head *hlist,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) const struct sockaddr_pn *dst,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) u8 pipe_handle)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) struct sock *sknode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) u16 dobj = pn_sockaddr_get_object(dst);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) sk_for_each(sknode, hlist) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) struct pep_sock *pnnode = pep_sk(sknode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) /* Ports match, but addresses might not: */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) if (pnnode->pn_sk.sobject != dobj)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) if (pnnode->pipe_handle != pipe_handle)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) if (sknode->sk_state == TCP_CLOSE_WAIT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) sock_hold(sknode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) return sknode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) * Deliver an skb to a listening sock.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) * Socket lock must be held.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) * We then queue the skb to the right connected sock (if any).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) static int pep_do_rcv(struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) struct sock *sknode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) struct pnpipehdr *hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) struct sockaddr_pn dst;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) u8 pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) if (!pskb_may_pull(skb, sizeof(*hdr)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) goto drop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) hdr = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) pipe_handle = hdr->pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) if (pipe_handle == PN_PIPE_INVALID_HANDLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) goto drop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) pn_skb_get_dst_sockaddr(skb, &dst);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) /* Look for an existing pipe handle */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) sknode = pep_find_pipe(&pn->hlist, &dst, pipe_handle);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) if (sknode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) return sk_receive_skb(sknode, skb, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) switch (hdr->message_id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) case PNS_PEP_CONNECT_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) if (sk->sk_state != TCP_LISTEN || sk_acceptq_is_full(sk)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) pep_reject_conn(sk, skb, PN_PIPE_ERR_PEP_IN_USE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) skb_queue_head(&sk->sk_receive_queue, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) sk_acceptq_added(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) if (!sock_flag(sk, SOCK_DEAD))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) sk->sk_data_ready(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) return NET_RX_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) case PNS_PEP_DISCONNECT_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) pep_reply(sk, skb, PN_PIPE_NO_ERROR, NULL, 0, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) case PNS_PEP_CTRL_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) pep_ctrlreq_error(sk, skb, PN_PIPE_INVALID_HANDLE, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) case PNS_PEP_RESET_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) case PNS_PEP_ENABLE_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) case PNS_PEP_DISABLE_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) /* invalid handle is not even allowed here! */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) if ((1 << sk->sk_state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) & ~(TCPF_CLOSE|TCPF_LISTEN|TCPF_CLOSE_WAIT))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) /* actively connected socket */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) return pipe_handler_do_rcv(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) drop:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) return NET_RX_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) static int pipe_do_remove(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) struct pnpipehdr *ph;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) skb = pep_alloc_skb(sk, NULL, 0, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) ph = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) ph->utid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) ph->message_id = PNS_PIPE_REMOVE_REQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) ph->pipe_handle = pn->pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) ph->data0 = PAD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) return pn_skb_send(sk, skb, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) /* associated socket ceases to exist */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) static void pep_sock_close(struct sock *sk, long timeout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) int ifindex = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) sock_hold(sk); /* keep a reference after sk_common_release() */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) sk_common_release(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) if ((1 << sk->sk_state) & (TCPF_SYN_RECV|TCPF_ESTABLISHED)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) if (sk->sk_backlog_rcv == pipe_do_rcv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) /* Forcefully remove dangling Phonet pipe */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) pipe_do_remove(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) pipe_handler_request(sk, PNS_PEP_DISCONNECT_REQ, PAD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) NULL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) sk->sk_state = TCP_CLOSE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) ifindex = pn->ifindex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) pn->ifindex = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) if (ifindex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) gprs_detach(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) sock_put(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) static struct sock *pep_sock_accept(struct sock *sk, int flags, int *errp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) bool kern)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) struct pep_sock *pn = pep_sk(sk), *newpn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) struct sock *newsk = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) struct pnpipehdr *hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) struct sockaddr_pn dst, src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) u16 peer_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) u8 pipe_handle, enabled, n_sb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) u8 aligned = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) skb = skb_recv_datagram(sk, 0, flags & O_NONBLOCK, errp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) if (sk->sk_state != TCP_LISTEN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) goto drop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) sk_acceptq_removed(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) err = -EPROTO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) if (!pskb_may_pull(skb, sizeof(*hdr) + 4))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) goto drop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) hdr = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) pipe_handle = hdr->pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) switch (hdr->state_after_connect) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) case PN_PIPE_DISABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) enabled = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) case PN_PIPE_ENABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) enabled = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) pep_reject_conn(sk, skb, PN_PIPE_ERR_INVALID_PARAM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) goto drop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) peer_type = hdr->other_pep_type << 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806) /* Parse sub-blocks (options) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) n_sb = hdr->data[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) while (n_sb > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) u8 type, buf[1], len = sizeof(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) const u8 *data = pep_get_sb(skb, &type, &len, buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) if (data == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) goto drop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) case PN_PIPE_SB_CONNECT_REQ_PEP_SUB_TYPE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816) if (len < 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) goto drop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) peer_type = (peer_type & 0xff00) | data[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820) case PN_PIPE_SB_ALIGNED_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) aligned = data[0] != 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824) n_sb--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) /* Check for duplicate pipe handle */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828) newsk = pep_find_pipe(&pn->hlist, &dst, pipe_handle);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) if (unlikely(newsk)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830) __sock_put(newsk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831) newsk = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) pep_reject_conn(sk, skb, PN_PIPE_ERR_PEP_IN_USE, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833) goto drop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836) /* Create a new to-be-accepted sock */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) newsk = sk_alloc(sock_net(sk), PF_PHONET, GFP_KERNEL, sk->sk_prot,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) kern);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839) if (!newsk) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) pep_reject_conn(sk, skb, PN_PIPE_ERR_OVERLOAD, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) err = -ENOBUFS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842) goto drop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) sock_init_data(NULL, newsk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846) newsk->sk_state = TCP_SYN_RECV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) newsk->sk_backlog_rcv = pipe_do_rcv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848) newsk->sk_protocol = sk->sk_protocol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) newsk->sk_destruct = pipe_destruct;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851) newpn = pep_sk(newsk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) pn_skb_get_dst_sockaddr(skb, &dst);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853) pn_skb_get_src_sockaddr(skb, &src);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854) newpn->pn_sk.sobject = pn_sockaddr_get_object(&dst);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) newpn->pn_sk.dobject = pn_sockaddr_get_object(&src);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) newpn->pn_sk.resource = pn_sockaddr_get_resource(&dst);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857) sock_hold(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) newpn->listener = sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859) skb_queue_head_init(&newpn->ctrlreq_queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860) newpn->pipe_handle = pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861) atomic_set(&newpn->tx_credits, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862) newpn->ifindex = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) newpn->peer_type = peer_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) newpn->rx_credits = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) newpn->rx_fc = newpn->tx_fc = PN_LEGACY_FLOW_CONTROL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) newpn->init_enable = enabled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867) newpn->aligned = aligned;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) err = pep_accept_conn(newsk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) __sock_put(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872) sock_put(newsk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873) newsk = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) goto drop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) sk_add_node(newsk, &pn->hlist);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877) drop:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) *errp = err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) return newsk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884) static int pep_sock_connect(struct sock *sk, struct sockaddr *addr, int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) u8 data[4] = { 0 /* sub-blocks */, PAD, PAD, PAD };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890) if (pn->pipe_handle == PN_PIPE_INVALID_HANDLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891) pn->pipe_handle = 1; /* anything but INVALID_HANDLE */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893) err = pipe_handler_request(sk, PNS_PEP_CONNECT_REQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) pn->init_enable, data, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 896) pn->pipe_handle = PN_PIPE_INVALID_HANDLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 897) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 898) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 899)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 900) sk->sk_state = TCP_SYN_SENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 901)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 902) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 903) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 904)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 905) static int pep_sock_enable(struct sock *sk, struct sockaddr *addr, int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 906) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 907) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 908)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 909) err = pipe_handler_request(sk, PNS_PEP_ENABLE_REQ, PAD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 910) NULL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 911) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 912) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 913)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 914) sk->sk_state = TCP_SYN_SENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 915)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 916) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 917) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 918)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 919) static int pep_ioctl(struct sock *sk, int cmd, unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 920) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 921) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 922) int answ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 923) int ret = -ENOIOCTLCMD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 924)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 925) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 926) case SIOCINQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 927) if (sk->sk_state == TCP_LISTEN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 928) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 929) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 930) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 931)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 932) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 933) if (sock_flag(sk, SOCK_URGINLINE) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 934) !skb_queue_empty(&pn->ctrlreq_queue))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 935) answ = skb_peek(&pn->ctrlreq_queue)->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 936) else if (!skb_queue_empty(&sk->sk_receive_queue))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 937) answ = skb_peek(&sk->sk_receive_queue)->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 938) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 939) answ = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 940) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 941) ret = put_user(answ, (int __user *)arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 942) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 943)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 944) case SIOCPNENABLEPIPE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 945) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 946) if (sk->sk_state == TCP_SYN_SENT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 947) ret = -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 948) else if (sk->sk_state == TCP_ESTABLISHED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 949) ret = -EISCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 950) else if (!pn->pn_sk.sobject)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 951) ret = -EADDRNOTAVAIL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 952) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 953) ret = pep_sock_enable(sk, NULL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 954) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 955) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 956) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 957)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 958) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 959) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 960)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 961) static int pep_init(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 962) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 963) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 964)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 965) sk->sk_destruct = pipe_destruct;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 966) INIT_HLIST_HEAD(&pn->hlist);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 967) pn->listener = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 968) skb_queue_head_init(&pn->ctrlreq_queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 969) atomic_set(&pn->tx_credits, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 970) pn->ifindex = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 971) pn->peer_type = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 972) pn->pipe_handle = PN_PIPE_INVALID_HANDLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 973) pn->rx_credits = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 974) pn->rx_fc = pn->tx_fc = PN_LEGACY_FLOW_CONTROL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 975) pn->init_enable = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 976) pn->aligned = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 977) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 978) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 979)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 980) static int pep_setsockopt(struct sock *sk, int level, int optname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 981) sockptr_t optval, unsigned int optlen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 982) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 983) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 984) int val = 0, err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 985)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 986) if (level != SOL_PNPIPE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 987) return -ENOPROTOOPT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 988) if (optlen >= sizeof(int)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 989) if (copy_from_sockptr(&val, optval, sizeof(int)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 990) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 991) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 992)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 993) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 994) switch (optname) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 995) case PNPIPE_ENCAP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 996) if (val && val != PNPIPE_ENCAP_IP) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 997) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 998) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 999) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1000) if (!pn->ifindex == !val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1001) break; /* Nothing to do! */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1002) if (!capable(CAP_NET_ADMIN)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1003) err = -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1004) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1005) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1006) if (val) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1007) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1008) err = gprs_attach(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1009) if (err > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1010) pn->ifindex = err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1011) err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1012) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1013) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1014) pn->ifindex = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1015) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1016) gprs_detach(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1017) err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1018) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1019) goto out_norel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1020)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1021) case PNPIPE_HANDLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1022) if ((sk->sk_state == TCP_CLOSE) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1023) (val >= 0) && (val < PN_PIPE_INVALID_HANDLE))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1024) pn->pipe_handle = val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1025) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1026) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1027) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1028)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1029) case PNPIPE_INITSTATE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1030) pn->init_enable = !!val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1031) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1032)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1033) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1034) err = -ENOPROTOOPT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1035) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1036) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1037)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1038) out_norel:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1039) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1040) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1041)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1042) static int pep_getsockopt(struct sock *sk, int level, int optname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1043) char __user *optval, int __user *optlen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1044) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1045) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1046) int len, val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1047)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1048) if (level != SOL_PNPIPE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1049) return -ENOPROTOOPT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1050) if (get_user(len, optlen))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1051) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1052)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1053) switch (optname) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1054) case PNPIPE_ENCAP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1055) val = pn->ifindex ? PNPIPE_ENCAP_IP : PNPIPE_ENCAP_NONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1056) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1057)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1058) case PNPIPE_IFINDEX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1059) val = pn->ifindex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1060) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1061)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1062) case PNPIPE_HANDLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1063) val = pn->pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1064) if (val == PN_PIPE_INVALID_HANDLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1065) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1066) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1067)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1068) case PNPIPE_INITSTATE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1069) val = pn->init_enable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1070) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1071)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1072) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1073) return -ENOPROTOOPT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1074) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1075)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1076) len = min_t(unsigned int, sizeof(int), len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1077) if (put_user(len, optlen))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1078) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1079) if (put_user(val, (int __user *) optval))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1080) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1081) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1082) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1083)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1084) static int pipe_skb_send(struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1085) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1086) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1087) struct pnpipehdr *ph;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1088) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1089)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1090) if (pn_flow_safe(pn->tx_fc) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1091) !atomic_add_unless(&pn->tx_credits, -1, 0)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1092) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1093) return -ENOBUFS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1094) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1095)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1096) skb_push(skb, 3 + pn->aligned);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1097) skb_reset_transport_header(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1098) ph = pnp_hdr(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1099) ph->utid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1100) if (pn->aligned) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1101) ph->message_id = PNS_PIPE_ALIGNED_DATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1102) ph->data0 = 0; /* padding */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1103) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1104) ph->message_id = PNS_PIPE_DATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1105) ph->pipe_handle = pn->pipe_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1106) err = pn_skb_send(sk, skb, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1108) if (err && pn_flow_safe(pn->tx_fc))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1109) atomic_inc(&pn->tx_credits);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1110) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1112) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1114) static int pep_sendmsg(struct sock *sk, struct msghdr *msg, size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1115) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1116) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1117) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1118) long timeo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1119) int flags = msg->msg_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1120) int err, done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1122) if (len > USHRT_MAX)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1123) return -EMSGSIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1125) if ((msg->msg_flags & ~(MSG_DONTWAIT|MSG_EOR|MSG_NOSIGNAL|
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1126) MSG_CMSG_COMPAT)) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1127) !(msg->msg_flags & MSG_EOR))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1128) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1130) skb = sock_alloc_send_skb(sk, MAX_PNPIPE_HEADER + len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1131) flags & MSG_DONTWAIT, &err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1132) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1133) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1135) skb_reserve(skb, MAX_PHONET_HEADER + 3 + pn->aligned);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1136) err = memcpy_from_msg(skb_put(skb, len), msg, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1137) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1138) goto outfree;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1140) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1141) timeo = sock_sndtimeo(sk, flags & MSG_DONTWAIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1142) if ((1 << sk->sk_state) & (TCPF_LISTEN|TCPF_CLOSE)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1143) err = -ENOTCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1144) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1145) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1146) if (sk->sk_state != TCP_ESTABLISHED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1147) /* Wait until the pipe gets to enabled state */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1148) disabled:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1149) err = sk_stream_wait_connect(sk, &timeo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1150) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1151) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1153) if (sk->sk_state == TCP_CLOSE_WAIT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1154) err = -ECONNRESET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1155) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1156) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1157) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1158) BUG_ON(sk->sk_state != TCP_ESTABLISHED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1160) /* Wait until flow control allows TX */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1161) done = atomic_read(&pn->tx_credits);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1162) while (!done) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1163) DEFINE_WAIT_FUNC(wait, woken_wake_function);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1165) if (!timeo) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1166) err = -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1167) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1168) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1169) if (signal_pending(current)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1170) err = sock_intr_errno(timeo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1171) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1172) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1174) add_wait_queue(sk_sleep(sk), &wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1175) done = sk_wait_event(sk, &timeo, atomic_read(&pn->tx_credits), &wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1176) remove_wait_queue(sk_sleep(sk), &wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1177)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1178) if (sk->sk_state != TCP_ESTABLISHED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1179) goto disabled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1180) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1181)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1182) err = pipe_skb_send(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1183) if (err >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1184) err = len; /* success! */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1185) skb = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1186) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1187) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1188) outfree:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1189) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1190) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1191) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1193) int pep_writeable(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1194) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1195) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1197) return atomic_read(&pn->tx_credits);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1198) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1199)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1200) int pep_write(struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1201) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1202) struct sk_buff *rskb, *fs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1203) int flen = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1205) if (pep_sk(sk)->aligned)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1206) return pipe_skb_send(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1208) rskb = alloc_skb(MAX_PNPIPE_HEADER, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1209) if (!rskb) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1210) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1211) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1212) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1213) skb_shinfo(rskb)->frag_list = skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1214) rskb->len += skb->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1215) rskb->data_len += rskb->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1216) rskb->truesize += rskb->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1218) /* Avoid nested fragments */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1219) skb_walk_frags(skb, fs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1220) flen += fs->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1221) skb->next = skb_shinfo(skb)->frag_list;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1222) skb_frag_list_init(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1223) skb->len -= flen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1224) skb->data_len -= flen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1225) skb->truesize -= flen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1227) skb_reserve(rskb, MAX_PHONET_HEADER + 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1228) return pipe_skb_send(sk, rskb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1229) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1231) struct sk_buff *pep_read(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1232) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1233) struct sk_buff *skb = skb_dequeue(&sk->sk_receive_queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1234)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1235) if (sk->sk_state == TCP_ESTABLISHED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1236) pipe_grant_credits(sk, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1237) return skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1238) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1240) static int pep_recvmsg(struct sock *sk, struct msghdr *msg, size_t len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1241) int noblock, int flags, int *addr_len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1242) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1243) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1244) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1245)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1246) if (flags & ~(MSG_OOB|MSG_PEEK|MSG_TRUNC|MSG_DONTWAIT|MSG_WAITALL|
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1247) MSG_NOSIGNAL|MSG_CMSG_COMPAT))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1248) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1250) if (unlikely(1 << sk->sk_state & (TCPF_LISTEN | TCPF_CLOSE)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1251) return -ENOTCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1252)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1253) if ((flags & MSG_OOB) || sock_flag(sk, SOCK_URGINLINE)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1254) /* Dequeue and acknowledge control request */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1255) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1257) if (flags & MSG_PEEK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1258) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1259) skb = skb_dequeue(&pn->ctrlreq_queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1260) if (skb) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1261) pep_ctrlreq_error(sk, skb, PN_PIPE_NO_ERROR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1262) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1263) msg->msg_flags |= MSG_OOB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1264) goto copy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1265) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1266) if (flags & MSG_OOB)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1267) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1268) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1269)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1270) skb = skb_recv_datagram(sk, flags, noblock, &err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1271) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1272) if (skb == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1273) if (err == -ENOTCONN && sk->sk_state == TCP_CLOSE_WAIT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1274) err = -ECONNRESET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1275) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1276) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1277) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1279) if (sk->sk_state == TCP_ESTABLISHED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1280) pipe_grant_credits(sk, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1281) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1282) copy:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1283) msg->msg_flags |= MSG_EOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1284) if (skb->len > len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1285) msg->msg_flags |= MSG_TRUNC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1286) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1287) len = skb->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1288)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1289) err = skb_copy_datagram_msg(skb, 0, msg, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1290) if (!err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1291) err = (flags & MSG_TRUNC) ? skb->len : len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1292)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1293) skb_free_datagram(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1294) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1295) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1296)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1297) static void pep_sock_unhash(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1298) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1299) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1300) struct sock *skparent = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1302) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1304) if (pn->listener != NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1305) skparent = pn->listener;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1306) pn->listener = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1307) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1308)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1309) pn = pep_sk(skparent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1310) lock_sock(skparent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1311) sk_del_node_init(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1312) sk = skparent;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1313) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1315) /* Unhash a listening sock only when it is closed
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1316) * and all of its active connected pipes are closed. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1317) if (hlist_empty(&pn->hlist))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1318) pn_sock_unhash(&pn->pn_sk.sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1319) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1321) if (skparent)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1322) sock_put(skparent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1323) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1325) static struct proto pep_proto = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1326) .close = pep_sock_close,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1327) .accept = pep_sock_accept,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1328) .connect = pep_sock_connect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1329) .ioctl = pep_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1330) .init = pep_init,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1331) .setsockopt = pep_setsockopt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1332) .getsockopt = pep_getsockopt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1333) .sendmsg = pep_sendmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1334) .recvmsg = pep_recvmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1335) .backlog_rcv = pep_do_rcv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1336) .hash = pn_sock_hash,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1337) .unhash = pep_sock_unhash,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1338) .get_port = pn_sock_get_port,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1339) .obj_size = sizeof(struct pep_sock),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1340) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1341) .name = "PNPIPE",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1342) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1344) static const struct phonet_protocol pep_pn_proto = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1345) .ops = &phonet_stream_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1346) .prot = &pep_proto,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1347) .sock_type = SOCK_SEQPACKET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1348) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1350) static int __init pep_register(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1351) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1352) return phonet_proto_register(PN_PROTO_PIPE, &pep_pn_proto);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1353) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1355) static void __exit pep_unregister(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1356) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1357) phonet_proto_unregister(PN_PROTO_PIPE, &pep_pn_proto);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1358) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1359)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1360) module_init(pep_register);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1361) module_exit(pep_unregister);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1362) MODULE_AUTHOR("Remi Denis-Courmont, Nokia");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1363) MODULE_DESCRIPTION("Phonet pipe protocol");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1364) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1365) MODULE_ALIAS_NET_PF_PROTO(PF_PHONET, PN_PROTO_PIPE);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags