Commit 9b73896a authored by Tom Herbert's avatar Tom Herbert Committed by David S. Miller

kcm: Use stream parser

Adapt KCM to use the stream parser. This mostly involves removing
the RX handling and setting up the strparser using the interface.
Signed-off-by: default avatarTom Herbert <tom@herbertland.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 43a0c675
...@@ -13,6 +13,7 @@ ...@@ -13,6 +13,7 @@
#include <linux/skbuff.h> #include <linux/skbuff.h>
#include <net/sock.h> #include <net/sock.h>
#include <net/strparser.h>
#include <uapi/linux/kcm.h> #include <uapi/linux/kcm.h>
extern unsigned int kcm_net_id; extern unsigned int kcm_net_id;
...@@ -21,16 +22,8 @@ extern unsigned int kcm_net_id; ...@@ -21,16 +22,8 @@ extern unsigned int kcm_net_id;
#define KCM_STATS_INCR(stat) ((stat)++) #define KCM_STATS_INCR(stat) ((stat)++)
struct kcm_psock_stats { struct kcm_psock_stats {
unsigned long long rx_msgs;
unsigned long long rx_bytes;
unsigned long long tx_msgs; unsigned long long tx_msgs;
unsigned long long tx_bytes; unsigned long long tx_bytes;
unsigned int rx_aborts;
unsigned int rx_mem_fail;
unsigned int rx_need_more_hdr;
unsigned int rx_msg_too_big;
unsigned int rx_msg_timeouts;
unsigned int rx_bad_hdr_len;
unsigned long long reserved; unsigned long long reserved;
unsigned long long unreserved; unsigned long long unreserved;
unsigned int tx_aborts; unsigned int tx_aborts;
...@@ -64,13 +57,6 @@ struct kcm_tx_msg { ...@@ -64,13 +57,6 @@ struct kcm_tx_msg {
struct sk_buff *last_skb; struct sk_buff *last_skb;
}; };
struct kcm_rx_msg {
int full_len;
int accum_len;
int offset;
int early_eaten;
};
/* Socket structure for KCM client sockets */ /* Socket structure for KCM client sockets */
struct kcm_sock { struct kcm_sock {
struct sock sk; struct sock sk;
...@@ -87,6 +73,7 @@ struct kcm_sock { ...@@ -87,6 +73,7 @@ struct kcm_sock {
struct work_struct tx_work; struct work_struct tx_work;
struct list_head wait_psock_list; struct list_head wait_psock_list;
struct sk_buff *seq_skb; struct sk_buff *seq_skb;
u32 tx_stopped : 1;
/* Don't use bit fields here, these are set under different locks */ /* Don't use bit fields here, these are set under different locks */
bool tx_wait; bool tx_wait;
...@@ -104,11 +91,11 @@ struct bpf_prog; ...@@ -104,11 +91,11 @@ struct bpf_prog;
/* Structure for an attached lower socket */ /* Structure for an attached lower socket */
struct kcm_psock { struct kcm_psock {
struct sock *sk; struct sock *sk;
struct strparser strp;
struct kcm_mux *mux; struct kcm_mux *mux;
int index; int index;
u32 tx_stopped : 1; u32 tx_stopped : 1;
u32 rx_stopped : 1;
u32 done : 1; u32 done : 1;
u32 unattaching : 1; u32 unattaching : 1;
...@@ -121,18 +108,12 @@ struct kcm_psock { ...@@ -121,18 +108,12 @@ struct kcm_psock {
struct kcm_psock_stats stats; struct kcm_psock_stats stats;
/* Receive */ /* Receive */
struct sk_buff *rx_skb_head;
struct sk_buff **rx_skb_nextp;
struct sk_buff *ready_rx_msg;
struct list_head psock_ready_list; struct list_head psock_ready_list;
struct work_struct rx_work;
struct delayed_work rx_delayed_work;
struct bpf_prog *bpf_prog; struct bpf_prog *bpf_prog;
struct kcm_sock *rx_kcm; struct kcm_sock *rx_kcm;
unsigned long long saved_rx_bytes; unsigned long long saved_rx_bytes;
unsigned long long saved_rx_msgs; unsigned long long saved_rx_msgs;
struct timer_list rx_msg_timer; struct sk_buff *ready_rx_msg;
unsigned int rx_need_bytes;
/* Transmit */ /* Transmit */
struct kcm_sock *tx_kcm; struct kcm_sock *tx_kcm;
...@@ -146,6 +127,7 @@ struct kcm_net { ...@@ -146,6 +127,7 @@ struct kcm_net {
struct mutex mutex; struct mutex mutex;
struct kcm_psock_stats aggregate_psock_stats; struct kcm_psock_stats aggregate_psock_stats;
struct kcm_mux_stats aggregate_mux_stats; struct kcm_mux_stats aggregate_mux_stats;
struct strp_aggr_stats aggregate_strp_stats;
struct list_head mux_list; struct list_head mux_list;
int count; int count;
}; };
...@@ -163,6 +145,7 @@ struct kcm_mux { ...@@ -163,6 +145,7 @@ struct kcm_mux {
struct kcm_mux_stats stats; struct kcm_mux_stats stats;
struct kcm_psock_stats aggregate_psock_stats; struct kcm_psock_stats aggregate_psock_stats;
struct strp_aggr_stats aggregate_strp_stats;
/* Receive */ /* Receive */
spinlock_t rx_lock ____cacheline_aligned_in_smp; spinlock_t rx_lock ____cacheline_aligned_in_smp;
...@@ -190,14 +173,6 @@ static inline void aggregate_psock_stats(struct kcm_psock_stats *stats, ...@@ -190,14 +173,6 @@ static inline void aggregate_psock_stats(struct kcm_psock_stats *stats,
/* Save psock statistics in the mux when psock is being unattached. */ /* Save psock statistics in the mux when psock is being unattached. */
#define SAVE_PSOCK_STATS(_stat) (agg_stats->_stat += stats->_stat) #define SAVE_PSOCK_STATS(_stat) (agg_stats->_stat += stats->_stat)
SAVE_PSOCK_STATS(rx_msgs);
SAVE_PSOCK_STATS(rx_bytes);
SAVE_PSOCK_STATS(rx_aborts);
SAVE_PSOCK_STATS(rx_mem_fail);
SAVE_PSOCK_STATS(rx_need_more_hdr);
SAVE_PSOCK_STATS(rx_msg_too_big);
SAVE_PSOCK_STATS(rx_msg_timeouts);
SAVE_PSOCK_STATS(rx_bad_hdr_len);
SAVE_PSOCK_STATS(tx_msgs); SAVE_PSOCK_STATS(tx_msgs);
SAVE_PSOCK_STATS(tx_bytes); SAVE_PSOCK_STATS(tx_bytes);
SAVE_PSOCK_STATS(reserved); SAVE_PSOCK_STATS(reserved);
......
...@@ -172,6 +172,5 @@ static void __exit ila_fini(void) ...@@ -172,6 +172,5 @@ static void __exit ila_fini(void)
module_init(ila_init); module_init(ila_init);
module_exit(ila_fini); module_exit(ila_fini);
MODULE_ALIAS_RTNL_LWT(ILA);
MODULE_AUTHOR("Tom Herbert <tom@herbertland.com>"); MODULE_AUTHOR("Tom Herbert <tom@herbertland.com>");
MODULE_LICENSE("GPL"); MODULE_LICENSE("GPL");
...@@ -3,6 +3,7 @@ config AF_KCM ...@@ -3,6 +3,7 @@ config AF_KCM
tristate "KCM sockets" tristate "KCM sockets"
depends on INET depends on INET
select BPF_SYSCALL select BPF_SYSCALL
select STREAM_PARSER
---help--- ---help---
KCM (Kernel Connection Multiplexor) sockets provide a method KCM (Kernel Connection Multiplexor) sockets provide a method
for multiplexing messages of a message based application for multiplexing messages of a message based application
......
...@@ -155,8 +155,8 @@ static void kcm_format_psock(struct kcm_psock *psock, struct seq_file *seq, ...@@ -155,8 +155,8 @@ static void kcm_format_psock(struct kcm_psock *psock, struct seq_file *seq,
seq_printf(seq, seq_printf(seq,
" psock-%-5u %-10llu %-16llu %-10llu %-16llu %-8d %-8d %-8d %-8d ", " psock-%-5u %-10llu %-16llu %-10llu %-16llu %-8d %-8d %-8d %-8d ",
psock->index, psock->index,
psock->stats.rx_msgs, psock->strp.stats.rx_msgs,
psock->stats.rx_bytes, psock->strp.stats.rx_bytes,
psock->stats.tx_msgs, psock->stats.tx_msgs,
psock->stats.tx_bytes, psock->stats.tx_bytes,
psock->sk->sk_receive_queue.qlen, psock->sk->sk_receive_queue.qlen,
...@@ -170,9 +170,12 @@ static void kcm_format_psock(struct kcm_psock *psock, struct seq_file *seq, ...@@ -170,9 +170,12 @@ static void kcm_format_psock(struct kcm_psock *psock, struct seq_file *seq,
if (psock->tx_stopped) if (psock->tx_stopped)
seq_puts(seq, "TxStop "); seq_puts(seq, "TxStop ");
if (psock->rx_stopped) if (psock->strp.rx_stopped)
seq_puts(seq, "RxStop "); seq_puts(seq, "RxStop ");
if (psock->strp.rx_paused)
seq_puts(seq, "RxPause ");
if (psock->tx_kcm) if (psock->tx_kcm)
seq_printf(seq, "Rsvd-%d ", psock->tx_kcm->index); seq_printf(seq, "Rsvd-%d ", psock->tx_kcm->index);
...@@ -275,6 +278,7 @@ static int kcm_stats_seq_show(struct seq_file *seq, void *v) ...@@ -275,6 +278,7 @@ static int kcm_stats_seq_show(struct seq_file *seq, void *v)
{ {
struct kcm_psock_stats psock_stats; struct kcm_psock_stats psock_stats;
struct kcm_mux_stats mux_stats; struct kcm_mux_stats mux_stats;
struct strp_aggr_stats strp_stats;
struct kcm_mux *mux; struct kcm_mux *mux;
struct kcm_psock *psock; struct kcm_psock *psock;
struct net *net = seq->private; struct net *net = seq->private;
...@@ -282,20 +286,28 @@ static int kcm_stats_seq_show(struct seq_file *seq, void *v) ...@@ -282,20 +286,28 @@ static int kcm_stats_seq_show(struct seq_file *seq, void *v)
memset(&mux_stats, 0, sizeof(mux_stats)); memset(&mux_stats, 0, sizeof(mux_stats));
memset(&psock_stats, 0, sizeof(psock_stats)); memset(&psock_stats, 0, sizeof(psock_stats));
memset(&strp_stats, 0, sizeof(strp_stats));
mutex_lock(&knet->mutex); mutex_lock(&knet->mutex);
aggregate_mux_stats(&knet->aggregate_mux_stats, &mux_stats); aggregate_mux_stats(&knet->aggregate_mux_stats, &mux_stats);
aggregate_psock_stats(&knet->aggregate_psock_stats, aggregate_psock_stats(&knet->aggregate_psock_stats,
&psock_stats); &psock_stats);
aggregate_strp_stats(&knet->aggregate_strp_stats,
&strp_stats);
list_for_each_entry_rcu(mux, &knet->mux_list, kcm_mux_list) { list_for_each_entry_rcu(mux, &knet->mux_list, kcm_mux_list) {
spin_lock_bh(&mux->lock); spin_lock_bh(&mux->lock);
aggregate_mux_stats(&mux->stats, &mux_stats); aggregate_mux_stats(&mux->stats, &mux_stats);
aggregate_psock_stats(&mux->aggregate_psock_stats, aggregate_psock_stats(&mux->aggregate_psock_stats,
&psock_stats); &psock_stats);
list_for_each_entry(psock, &mux->psocks, psock_list) aggregate_strp_stats(&mux->aggregate_strp_stats,
&strp_stats);
list_for_each_entry(psock, &mux->psocks, psock_list) {
aggregate_psock_stats(&psock->stats, &psock_stats); aggregate_psock_stats(&psock->stats, &psock_stats);
save_strp_stats(&psock->strp, &strp_stats);
}
spin_unlock_bh(&mux->lock); spin_unlock_bh(&mux->lock);
} }
...@@ -328,7 +340,7 @@ static int kcm_stats_seq_show(struct seq_file *seq, void *v) ...@@ -328,7 +340,7 @@ static int kcm_stats_seq_show(struct seq_file *seq, void *v)
mux_stats.rx_ready_drops); mux_stats.rx_ready_drops);
seq_printf(seq, seq_printf(seq,
"%-8s %-10s %-16s %-10s %-16s %-10s %-10s %-10s %-10s %-10s %-10s %-10s %-10s %-10s\n", "%-8s %-10s %-16s %-10s %-16s %-10s %-10s %-10s %-10s %-10s %-10s %-10s %-10s %-10s %-10s %-10s\n",
"Psock", "Psock",
"RX-Msgs", "RX-Msgs",
"RX-Bytes", "RX-Bytes",
...@@ -337,6 +349,8 @@ static int kcm_stats_seq_show(struct seq_file *seq, void *v) ...@@ -337,6 +349,8 @@ static int kcm_stats_seq_show(struct seq_file *seq, void *v)
"Reserved", "Reserved",
"Unreserved", "Unreserved",
"RX-Aborts", "RX-Aborts",
"RX-Intr",
"RX-Unrecov",
"RX-MemFail", "RX-MemFail",
"RX-NeedMor", "RX-NeedMor",
"RX-BadLen", "RX-BadLen",
...@@ -345,20 +359,22 @@ static int kcm_stats_seq_show(struct seq_file *seq, void *v) ...@@ -345,20 +359,22 @@ static int kcm_stats_seq_show(struct seq_file *seq, void *v)
"TX-Aborts"); "TX-Aborts");
seq_printf(seq, seq_printf(seq,
"%-8s %-10llu %-16llu %-10llu %-16llu %-10llu %-10llu %-10u %-10u %-10u %-10u %-10u %-10u %-10u\n", "%-8s %-10llu %-16llu %-10llu %-16llu %-10llu %-10llu %-10u %-10u %-10u %-10u %-10u %-10u %-10u %-10u %-10u\n",
"", "",
psock_stats.rx_msgs, strp_stats.rx_msgs,
psock_stats.rx_bytes, strp_stats.rx_bytes,
psock_stats.tx_msgs, psock_stats.tx_msgs,
psock_stats.tx_bytes, psock_stats.tx_bytes,
psock_stats.reserved, psock_stats.reserved,
psock_stats.unreserved, psock_stats.unreserved,
psock_stats.rx_aborts, strp_stats.rx_aborts,
psock_stats.rx_mem_fail, strp_stats.rx_interrupted,
psock_stats.rx_need_more_hdr, strp_stats.rx_unrecov_intr,
psock_stats.rx_bad_hdr_len, strp_stats.rx_mem_fail,
psock_stats.rx_msg_too_big, strp_stats.rx_need_more_hdr,
psock_stats.rx_msg_timeouts, strp_stats.rx_bad_hdr_len,
strp_stats.rx_msg_too_big,
strp_stats.rx_msg_timeouts,
psock_stats.tx_aborts); psock_stats.tx_aborts);
return 0; return 0;
......
/*
* Kernel Connection Multiplexor
*
* Copyright (c) 2016 Tom Herbert <tom@herbertland.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2
* as published by the Free Software Foundation.
*/
#include <linux/bpf.h> #include <linux/bpf.h>
#include <linux/errno.h> #include <linux/errno.h>
#include <linux/errqueue.h> #include <linux/errqueue.h>
...@@ -35,38 +45,12 @@ static inline struct kcm_tx_msg *kcm_tx_msg(struct sk_buff *skb) ...@@ -35,38 +45,12 @@ static inline struct kcm_tx_msg *kcm_tx_msg(struct sk_buff *skb)
return (struct kcm_tx_msg *)skb->cb; return (struct kcm_tx_msg *)skb->cb;
} }
static inline struct kcm_rx_msg *kcm_rx_msg(struct sk_buff *skb)
{
return (struct kcm_rx_msg *)((void *)skb->cb +
offsetof(struct qdisc_skb_cb, data));
}
static void report_csk_error(struct sock *csk, int err) static void report_csk_error(struct sock *csk, int err)
{ {
csk->sk_err = EPIPE; csk->sk_err = EPIPE;
csk->sk_error_report(csk); csk->sk_error_report(csk);
} }
/* Callback lock held */
static void kcm_abort_rx_psock(struct kcm_psock *psock, int err,
struct sk_buff *skb)
{
struct sock *csk = psock->sk;
/* Unrecoverable error in receive */
del_timer(&psock->rx_msg_timer);
if (psock->rx_stopped)
return;
psock->rx_stopped = 1;
KCM_STATS_INCR(psock->stats.rx_aborts);
/* Report an error on the lower socket */
report_csk_error(csk, err);
}
static void kcm_abort_tx_psock(struct kcm_psock *psock, int err, static void kcm_abort_tx_psock(struct kcm_psock *psock, int err,
bool wakeup_kcm) bool wakeup_kcm)
{ {
...@@ -109,12 +93,13 @@ static void kcm_abort_tx_psock(struct kcm_psock *psock, int err, ...@@ -109,12 +93,13 @@ static void kcm_abort_tx_psock(struct kcm_psock *psock, int err,
static void kcm_update_rx_mux_stats(struct kcm_mux *mux, static void kcm_update_rx_mux_stats(struct kcm_mux *mux,
struct kcm_psock *psock) struct kcm_psock *psock)
{ {
KCM_STATS_ADD(mux->stats.rx_bytes, STRP_STATS_ADD(mux->stats.rx_bytes,
psock->stats.rx_bytes - psock->saved_rx_bytes); psock->strp.stats.rx_bytes -
psock->saved_rx_bytes);
mux->stats.rx_msgs += mux->stats.rx_msgs +=
psock->stats.rx_msgs - psock->saved_rx_msgs; psock->strp.stats.rx_msgs - psock->saved_rx_msgs;
psock->saved_rx_msgs = psock->stats.rx_msgs; psock->saved_rx_msgs = psock->strp.stats.rx_msgs;
psock->saved_rx_bytes = psock->stats.rx_bytes; psock->saved_rx_bytes = psock->strp.stats.rx_bytes;
} }
static void kcm_update_tx_mux_stats(struct kcm_mux *mux, static void kcm_update_tx_mux_stats(struct kcm_mux *mux,
...@@ -167,11 +152,11 @@ static void kcm_rcv_ready(struct kcm_sock *kcm) ...@@ -167,11 +152,11 @@ static void kcm_rcv_ready(struct kcm_sock *kcm)
*/ */
list_del(&psock->psock_ready_list); list_del(&psock->psock_ready_list);
psock->ready_rx_msg = NULL; psock->ready_rx_msg = NULL;
/* Commit clearing of ready_rx_msg for queuing work */ /* Commit clearing of ready_rx_msg for queuing work */
smp_mb(); smp_mb();
queue_work(kcm_wq, &psock->rx_work); strp_unpause(&psock->strp);
strp_check_rcv(&psock->strp);
} }
/* Buffer limit is okay now, add to ready list */ /* Buffer limit is okay now, add to ready list */
...@@ -285,6 +270,7 @@ static struct kcm_sock *reserve_rx_kcm(struct kcm_psock *psock, ...@@ -285,6 +270,7 @@ static struct kcm_sock *reserve_rx_kcm(struct kcm_psock *psock,
if (list_empty(&mux->kcm_rx_waiters)) { if (list_empty(&mux->kcm_rx_waiters)) {
psock->ready_rx_msg = head; psock->ready_rx_msg = head;
strp_pause(&psock->strp);
list_add_tail(&psock->psock_ready_list, list_add_tail(&psock->psock_ready_list,
&mux->psocks_ready); &mux->psocks_ready);
spin_unlock_bh(&mux->rx_lock); spin_unlock_bh(&mux->rx_lock);
...@@ -353,343 +339,57 @@ static void unreserve_rx_kcm(struct kcm_psock *psock, ...@@ -353,343 +339,57 @@ static void unreserve_rx_kcm(struct kcm_psock *psock,
spin_unlock_bh(&mux->rx_lock); spin_unlock_bh(&mux->rx_lock);
} }
static void kcm_start_rx_timer(struct kcm_psock *psock) /* Lower sock lock held */
{ static void psock_tcp_data_ready(struct sock *sk)
if (psock->sk->sk_rcvtimeo)
mod_timer(&psock->rx_msg_timer, psock->sk->sk_rcvtimeo);
}
/* Macro to invoke filter function. */
#define KCM_RUN_FILTER(prog, ctx) \
(*prog->bpf_func)(ctx, prog->insnsi)
/* Lower socket lock held */
static int kcm_tcp_recv(read_descriptor_t *desc, struct sk_buff *orig_skb,
unsigned int orig_offset, size_t orig_len)
{ {
struct kcm_psock *psock = (struct kcm_psock *)desc->arg.data; struct kcm_psock *psock;
struct kcm_rx_msg *rxm;
struct kcm_sock *kcm;
struct sk_buff *head, *skb;
size_t eaten = 0, cand_len;
ssize_t extra;
int err;
bool cloned_orig = false;
if (psock->ready_rx_msg)
return 0;
head = psock->rx_skb_head;
if (head) {
/* Message already in progress */
rxm = kcm_rx_msg(head);
if (unlikely(rxm->early_eaten)) {
/* Already some number of bytes on the receive sock
* data saved in rx_skb_head, just indicate they
* are consumed.
*/
eaten = orig_len <= rxm->early_eaten ?
orig_len : rxm->early_eaten;
rxm->early_eaten -= eaten;
return eaten;
}
if (unlikely(orig_offset)) {
/* Getting data with a non-zero offset when a message is
* in progress is not expected. If it does happen, we
* need to clone and pull since we can't deal with
* offsets in the skbs for a message expect in the head.
*/
orig_skb = skb_clone(orig_skb, GFP_ATOMIC);
if (!orig_skb) {
KCM_STATS_INCR(psock->stats.rx_mem_fail);
desc->error = -ENOMEM;
return 0;
}
if (!pskb_pull(orig_skb, orig_offset)) {
KCM_STATS_INCR(psock->stats.rx_mem_fail);
kfree_skb(orig_skb);
desc->error = -ENOMEM;
return 0;
}
cloned_orig = true;
orig_offset = 0;
}
if (!psock->rx_skb_nextp) {
/* We are going to append to the frags_list of head.
* Need to unshare the frag_list.
*/
err = skb_unclone(head, GFP_ATOMIC);
if (err) {
KCM_STATS_INCR(psock->stats.rx_mem_fail);
desc->error = err;
return 0;
}
if (unlikely(skb_shinfo(head)->frag_list)) {
/* We can't append to an sk_buff that already
* has a frag_list. We create a new head, point
* the frag_list of that to the old head, and
* then are able to use the old head->next for
* appending to the message.
*/
if (WARN_ON(head->next)) {
desc->error = -EINVAL;
return 0;
}
skb = alloc_skb(0, GFP_ATOMIC);
if (!skb) {
KCM_STATS_INCR(psock->stats.rx_mem_fail);
desc->error = -ENOMEM;
return 0;
}
skb->len = head->len;
skb->data_len = head->len;
skb->truesize = head->truesize;
*kcm_rx_msg(skb) = *kcm_rx_msg(head);
psock->rx_skb_nextp = &head->next;
skb_shinfo(skb)->frag_list = head;
psock->rx_skb_head = skb;
head = skb;
} else {
psock->rx_skb_nextp =
&skb_shinfo(head)->frag_list;
}
}
}
while (eaten < orig_len) {
/* Always clone since we will consume something */
skb = skb_clone(orig_skb, GFP_ATOMIC);
if (!skb) {
KCM_STATS_INCR(psock->stats.rx_mem_fail);
desc->error = -ENOMEM;
break;
}
cand_len = orig_len - eaten;
head = psock->rx_skb_head;
if (!head) {
head = skb;
psock->rx_skb_head = head;
/* Will set rx_skb_nextp on next packet if needed */
psock->rx_skb_nextp = NULL;
rxm = kcm_rx_msg(head);
memset(rxm, 0, sizeof(*rxm));
rxm->offset = orig_offset + eaten;
} else {
/* Unclone since we may be appending to an skb that we
* already share a frag_list with.
*/
err = skb_unclone(skb, GFP_ATOMIC);
if (err) {
KCM_STATS_INCR(psock->stats.rx_mem_fail);
desc->error = err;
break;
}
rxm = kcm_rx_msg(head);
*psock->rx_skb_nextp = skb;
psock->rx_skb_nextp = &skb->next;
head->data_len += skb->len;
head->len += skb->len;
head->truesize += skb->truesize;
}
if (!rxm->full_len) {
ssize_t len;
len = KCM_RUN_FILTER(psock->bpf_prog, head);
if (!len) {
/* Need more header to determine length */
if (!rxm->accum_len) {
/* Start RX timer for new message */
kcm_start_rx_timer(psock);
}
rxm->accum_len += cand_len;
eaten += cand_len;
KCM_STATS_INCR(psock->stats.rx_need_more_hdr);
WARN_ON(eaten != orig_len);
break;
} else if (len > psock->sk->sk_rcvbuf) {
/* Message length exceeds maximum allowed */
KCM_STATS_INCR(psock->stats.rx_msg_too_big);
desc->error = -EMSGSIZE;
psock->rx_skb_head = NULL;
kcm_abort_rx_psock(psock, EMSGSIZE, head);
break;
} else if (len <= (ssize_t)head->len -
skb->len - rxm->offset) {
/* Length must be into new skb (and also
* greater than zero)
*/
KCM_STATS_INCR(psock->stats.rx_bad_hdr_len);
desc->error = -EPROTO;
psock->rx_skb_head = NULL;
kcm_abort_rx_psock(psock, EPROTO, head);
break;
}
rxm->full_len = len;
}
extra = (ssize_t)(rxm->accum_len + cand_len) - rxm->full_len;
if (extra < 0) {
/* Message not complete yet. */
if (rxm->full_len - rxm->accum_len >
tcp_inq(psock->sk)) {
/* Don't have the whole messages in the socket
* buffer. Set psock->rx_need_bytes to wait for
* the rest of the message. Also, set "early
* eaten" since we've already buffered the skb
* but don't consume yet per tcp_read_sock.
*/
if (!rxm->accum_len) {
/* Start RX timer for new message */
kcm_start_rx_timer(psock);
}
psock->rx_need_bytes = rxm->full_len -
rxm->accum_len;
rxm->accum_len += cand_len;
rxm->early_eaten = cand_len;
KCM_STATS_ADD(psock->stats.rx_bytes, cand_len);
desc->count = 0; /* Stop reading socket */
break;
}
rxm->accum_len += cand_len;
eaten += cand_len;
WARN_ON(eaten != orig_len);
break;
}
/* Positive extra indicates ore bytes than needed for the read_lock_bh(&sk->sk_callback_lock);
* message
*/
WARN_ON(extra > cand_len); psock = (struct kcm_psock *)sk->sk_user_data;
if (likely(psock))
strp_tcp_data_ready(&psock->strp);
eaten += (cand_len - extra); read_unlock_bh(&sk->sk_callback_lock);
}
/* Hurray, we have a new message! */ /* Called with lower sock held */
del_timer(&psock->rx_msg_timer); static void kcm_rcv_strparser(struct strparser *strp, struct sk_buff *skb)
psock->rx_skb_head = NULL; {
KCM_STATS_INCR(psock->stats.rx_msgs); struct kcm_psock *psock = container_of(strp, struct kcm_psock, strp);
struct kcm_sock *kcm;
try_queue: try_queue:
kcm = reserve_rx_kcm(psock, head); kcm = reserve_rx_kcm(psock, skb);
if (!kcm) { if (!kcm) {
/* Unable to reserve a KCM, message is held in psock. */ /* Unable to reserve a KCM, message is held in psock and strp
break; * is paused.
*/
return;
} }
if (kcm_queue_rcv_skb(&kcm->sk, head)) { if (kcm_queue_rcv_skb(&kcm->sk, skb)) {
/* Should mean socket buffer full */ /* Should mean socket buffer full */
unreserve_rx_kcm(psock, false); unreserve_rx_kcm(psock, false);
goto try_queue; goto try_queue;
} }
}
if (cloned_orig)
kfree_skb(orig_skb);
KCM_STATS_ADD(psock->stats.rx_bytes, eaten);
return eaten;
}
/* Called with lock held on lower socket */
static int psock_tcp_read_sock(struct kcm_psock *psock)
{
read_descriptor_t desc;
desc.arg.data = psock;
desc.error = 0;
desc.count = 1; /* give more than one skb per call */
/* sk should be locked here, so okay to do tcp_read_sock */
tcp_read_sock(psock->sk, &desc, kcm_tcp_recv);
unreserve_rx_kcm(psock, true);
return desc.error;
} }
/* Lower sock lock held */ static int kcm_parse_func_strparser(struct strparser *strp, struct sk_buff *skb)
static void psock_tcp_data_ready(struct sock *sk)
{ {
struct kcm_psock *psock; struct kcm_psock *psock = container_of(strp, struct kcm_psock, strp);
struct bpf_prog *prog = psock->bpf_prog;
read_lock_bh(&sk->sk_callback_lock);
psock = (struct kcm_psock *)sk->sk_user_data;
if (unlikely(!psock || psock->rx_stopped))
goto out;
if (psock->ready_rx_msg)
goto out;
if (psock->rx_need_bytes) {
if (tcp_inq(sk) >= psock->rx_need_bytes)
psock->rx_need_bytes = 0;
else
goto out;
}
if (psock_tcp_read_sock(psock) == -ENOMEM)
queue_delayed_work(kcm_wq, &psock->rx_delayed_work, 0);
out: return (*prog->bpf_func)(skb, prog->insnsi);
read_unlock_bh(&sk->sk_callback_lock);
} }
static void do_psock_rx_work(struct kcm_psock *psock) static int kcm_read_sock_done(struct strparser *strp, int err)
{ {
read_descriptor_t rd_desc; struct kcm_psock *psock = container_of(strp, struct kcm_psock, strp);
struct sock *csk = psock->sk;
/* We need the read lock to synchronize with psock_tcp_data_ready. We
* need the socket lock for calling tcp_read_sock.
*/
lock_sock(csk);
read_lock_bh(&csk->sk_callback_lock);
if (unlikely(csk->sk_user_data != psock))
goto out;
if (unlikely(psock->rx_stopped))
goto out;
if (psock->ready_rx_msg)
goto out;
rd_desc.arg.data = psock;
if (psock_tcp_read_sock(psock) == -ENOMEM) unreserve_rx_kcm(psock, true);
queue_delayed_work(kcm_wq, &psock->rx_delayed_work, 0);
out:
read_unlock_bh(&csk->sk_callback_lock);
release_sock(csk);
}
static void psock_rx_work(struct work_struct *w)
{
do_psock_rx_work(container_of(w, struct kcm_psock, rx_work));
}
static void psock_rx_delayed_work(struct work_struct *w) return err;
{
do_psock_rx_work(container_of(w, struct kcm_psock,
rx_delayed_work.work));
} }
static void psock_tcp_state_change(struct sock *sk) static void psock_tcp_state_change(struct sock *sk)
...@@ -713,14 +413,13 @@ static void psock_tcp_write_space(struct sock *sk) ...@@ -713,14 +413,13 @@ static void psock_tcp_write_space(struct sock *sk)
psock = (struct kcm_psock *)sk->sk_user_data; psock = (struct kcm_psock *)sk->sk_user_data;
if (unlikely(!psock)) if (unlikely(!psock))
goto out; goto out;
mux = psock->mux; mux = psock->mux;
spin_lock_bh(&mux->lock); spin_lock_bh(&mux->lock);
/* Check if the socket is reserved so someone is waiting for sending. */ /* Check if the socket is reserved so someone is waiting for sending. */
kcm = psock->tx_kcm; kcm = psock->tx_kcm;
if (kcm) if (kcm && !unlikely(kcm->tx_stopped))
queue_work(kcm_wq, &kcm->tx_work); queue_work(kcm_wq, &kcm->tx_work);
spin_unlock_bh(&mux->lock); spin_unlock_bh(&mux->lock);
...@@ -1411,7 +1110,7 @@ static int kcm_recvmsg(struct socket *sock, struct msghdr *msg, ...@@ -1411,7 +1110,7 @@ static int kcm_recvmsg(struct socket *sock, struct msghdr *msg,
struct kcm_sock *kcm = kcm_sk(sk); struct kcm_sock *kcm = kcm_sk(sk);
int err = 0; int err = 0;
long timeo; long timeo;
struct kcm_rx_msg *rxm; struct strp_rx_msg *rxm;
int copied = 0; int copied = 0;
struct sk_buff *skb; struct sk_buff *skb;
...@@ -1425,7 +1124,7 @@ static int kcm_recvmsg(struct socket *sock, struct msghdr *msg, ...@@ -1425,7 +1124,7 @@ static int kcm_recvmsg(struct socket *sock, struct msghdr *msg,
/* Okay, have a message on the receive queue */ /* Okay, have a message on the receive queue */
rxm = kcm_rx_msg(skb); rxm = strp_rx_msg(skb);
if (len > rxm->full_len) if (len > rxm->full_len)
len = rxm->full_len; len = rxm->full_len;
...@@ -1481,7 +1180,7 @@ static ssize_t kcm_splice_read(struct socket *sock, loff_t *ppos, ...@@ -1481,7 +1180,7 @@ static ssize_t kcm_splice_read(struct socket *sock, loff_t *ppos,
struct sock *sk = sock->sk; struct sock *sk = sock->sk;
struct kcm_sock *kcm = kcm_sk(sk); struct kcm_sock *kcm = kcm_sk(sk);
long timeo; long timeo;
struct kcm_rx_msg *rxm; struct strp_rx_msg *rxm;
int err = 0; int err = 0;
ssize_t copied; ssize_t copied;
struct sk_buff *skb; struct sk_buff *skb;
...@@ -1498,7 +1197,7 @@ static ssize_t kcm_splice_read(struct socket *sock, loff_t *ppos, ...@@ -1498,7 +1197,7 @@ static ssize_t kcm_splice_read(struct socket *sock, loff_t *ppos,
/* Okay, have a message on the receive queue */ /* Okay, have a message on the receive queue */
rxm = kcm_rx_msg(skb); rxm = strp_rx_msg(skb);
if (len > rxm->full_len) if (len > rxm->full_len)
len = rxm->full_len; len = rxm->full_len;
...@@ -1674,15 +1373,6 @@ static void init_kcm_sock(struct kcm_sock *kcm, struct kcm_mux *mux) ...@@ -1674,15 +1373,6 @@ static void init_kcm_sock(struct kcm_sock *kcm, struct kcm_mux *mux)
spin_unlock_bh(&mux->rx_lock); spin_unlock_bh(&mux->rx_lock);
} }
static void kcm_rx_msg_timeout(unsigned long arg)
{
struct kcm_psock *psock = (struct kcm_psock *)arg;
/* Message assembly timed out */
KCM_STATS_INCR(psock->stats.rx_msg_timeouts);
kcm_abort_rx_psock(psock, ETIMEDOUT, NULL);
}
static int kcm_attach(struct socket *sock, struct socket *csock, static int kcm_attach(struct socket *sock, struct socket *csock,
struct bpf_prog *prog) struct bpf_prog *prog)
{ {
...@@ -1692,6 +1382,7 @@ static int kcm_attach(struct socket *sock, struct socket *csock, ...@@ -1692,6 +1382,7 @@ static int kcm_attach(struct socket *sock, struct socket *csock,
struct kcm_psock *psock = NULL, *tpsock; struct kcm_psock *psock = NULL, *tpsock;
struct list_head *head; struct list_head *head;
int index = 0; int index = 0;
struct strp_callbacks cb;
if (csock->ops->family != PF_INET && if (csock->ops->family != PF_INET &&
csock->ops->family != PF_INET6) csock->ops->family != PF_INET6)
...@@ -1713,11 +1404,12 @@ static int kcm_attach(struct socket *sock, struct socket *csock, ...@@ -1713,11 +1404,12 @@ static int kcm_attach(struct socket *sock, struct socket *csock,
psock->sk = csk; psock->sk = csk;
psock->bpf_prog = prog; psock->bpf_prog = prog;
setup_timer(&psock->rx_msg_timer, kcm_rx_msg_timeout, cb.rcv_msg = kcm_rcv_strparser;
(unsigned long)psock); cb.abort_parser = NULL;
cb.parse_msg = kcm_parse_func_strparser;
cb.read_sock_done = kcm_read_sock_done;
INIT_WORK(&psock->rx_work, psock_rx_work); strp_init(&psock->strp, csk, &cb);
INIT_DELAYED_WORK(&psock->rx_delayed_work, psock_rx_delayed_work);
sock_hold(csk); sock_hold(csk);
...@@ -1750,7 +1442,7 @@ static int kcm_attach(struct socket *sock, struct socket *csock, ...@@ -1750,7 +1442,7 @@ static int kcm_attach(struct socket *sock, struct socket *csock,
spin_unlock_bh(&mux->lock); spin_unlock_bh(&mux->lock);
/* Schedule RX work in case there are already bytes queued */ /* Schedule RX work in case there are already bytes queued */
queue_work(kcm_wq, &psock->rx_work); strp_check_rcv(&psock->strp);
return 0; return 0;
} }
...@@ -1785,6 +1477,7 @@ static int kcm_attach_ioctl(struct socket *sock, struct kcm_attach *info) ...@@ -1785,6 +1477,7 @@ static int kcm_attach_ioctl(struct socket *sock, struct kcm_attach *info)
return err; return err;
} }
/* Lower socket lock held */
static void kcm_unattach(struct kcm_psock *psock) static void kcm_unattach(struct kcm_psock *psock)
{ {
struct sock *csk = psock->sk; struct sock *csk = psock->sk;
...@@ -1798,7 +1491,7 @@ static void kcm_unattach(struct kcm_psock *psock) ...@@ -1798,7 +1491,7 @@ static void kcm_unattach(struct kcm_psock *psock)
csk->sk_data_ready = psock->save_data_ready; csk->sk_data_ready = psock->save_data_ready;
csk->sk_write_space = psock->save_write_space; csk->sk_write_space = psock->save_write_space;
csk->sk_state_change = psock->save_state_change; csk->sk_state_change = psock->save_state_change;
psock->rx_stopped = 1; strp_stop(&psock->strp);
if (WARN_ON(psock->rx_kcm)) { if (WARN_ON(psock->rx_kcm)) {
write_unlock_bh(&csk->sk_callback_lock); write_unlock_bh(&csk->sk_callback_lock);
...@@ -1821,18 +1514,14 @@ static void kcm_unattach(struct kcm_psock *psock) ...@@ -1821,18 +1514,14 @@ static void kcm_unattach(struct kcm_psock *psock)
write_unlock_bh(&csk->sk_callback_lock); write_unlock_bh(&csk->sk_callback_lock);
del_timer_sync(&psock->rx_msg_timer); strp_done(&psock->strp);
cancel_work_sync(&psock->rx_work);
cancel_delayed_work_sync(&psock->rx_delayed_work);
bpf_prog_put(psock->bpf_prog); bpf_prog_put(psock->bpf_prog);
kfree_skb(psock->rx_skb_head);
psock->rx_skb_head = NULL;
spin_lock_bh(&mux->lock); spin_lock_bh(&mux->lock);
aggregate_psock_stats(&psock->stats, &mux->aggregate_psock_stats); aggregate_psock_stats(&psock->stats, &mux->aggregate_psock_stats);
save_strp_stats(&psock->strp, &mux->aggregate_strp_stats);
KCM_STATS_INCR(mux->stats.psock_unattach); KCM_STATS_INCR(mux->stats.psock_unattach);
...@@ -1915,6 +1604,7 @@ static int kcm_unattach_ioctl(struct socket *sock, struct kcm_unattach *info) ...@@ -1915,6 +1604,7 @@ static int kcm_unattach_ioctl(struct socket *sock, struct kcm_unattach *info)
spin_unlock_bh(&mux->lock); spin_unlock_bh(&mux->lock);
/* Lower socket lock should already be held */
kcm_unattach(psock); kcm_unattach(psock);
err = 0; err = 0;
...@@ -2059,8 +1749,11 @@ static void release_mux(struct kcm_mux *mux) ...@@ -2059,8 +1749,11 @@ static void release_mux(struct kcm_mux *mux)
/* Release psocks */ /* Release psocks */
list_for_each_entry_safe(psock, tmp_psock, list_for_each_entry_safe(psock, tmp_psock,
&mux->psocks, psock_list) { &mux->psocks, psock_list) {
if (!WARN_ON(psock->unattaching)) if (!WARN_ON(psock->unattaching)) {
lock_sock(psock->strp.sk);
kcm_unattach(psock); kcm_unattach(psock);
release_sock(psock->strp.sk);
}
} }
if (WARN_ON(mux->psocks_cnt)) if (WARN_ON(mux->psocks_cnt))
...@@ -2072,6 +1765,8 @@ static void release_mux(struct kcm_mux *mux) ...@@ -2072,6 +1765,8 @@ static void release_mux(struct kcm_mux *mux)
aggregate_mux_stats(&mux->stats, &knet->aggregate_mux_stats); aggregate_mux_stats(&mux->stats, &knet->aggregate_mux_stats);
aggregate_psock_stats(&mux->aggregate_psock_stats, aggregate_psock_stats(&mux->aggregate_psock_stats,
&knet->aggregate_psock_stats); &knet->aggregate_psock_stats);
aggregate_strp_stats(&mux->aggregate_strp_stats,
&knet->aggregate_strp_stats);
list_del_rcu(&mux->kcm_mux_list); list_del_rcu(&mux->kcm_mux_list);
knet->count--; knet->count--;
mutex_unlock(&knet->mutex); mutex_unlock(&knet->mutex);
...@@ -2151,6 +1846,13 @@ static int kcm_release(struct socket *sock) ...@@ -2151,6 +1846,13 @@ static int kcm_release(struct socket *sock)
* it will just return. * it will just return.
*/ */
__skb_queue_purge(&sk->sk_write_queue); __skb_queue_purge(&sk->sk_write_queue);
/* Set tx_stopped. This is checked when psock is bound to a kcm and we
* get a writespace callback. This prevents further work being queued
* from the callback (unbinding the psock occurs after canceling work.
*/
kcm->tx_stopped = 1;
release_sock(sk); release_sock(sk);
spin_lock_bh(&mux->lock); spin_lock_bh(&mux->lock);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment