162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * sch_plug.c Queue traffic until an explicit release command 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * There are two ways to use this qdisc: 662306a36Sopenharmony_ci * 1. A simple "instantaneous" plug/unplug operation, by issuing an alternating 762306a36Sopenharmony_ci * sequence of TCQ_PLUG_BUFFER & TCQ_PLUG_RELEASE_INDEFINITE commands. 862306a36Sopenharmony_ci * 962306a36Sopenharmony_ci * 2. For network output buffering (a.k.a output commit) functionality. 1062306a36Sopenharmony_ci * Output commit property is commonly used by applications using checkpoint 1162306a36Sopenharmony_ci * based fault-tolerance to ensure that the checkpoint from which a system 1262306a36Sopenharmony_ci * is being restored is consistent w.r.t outside world. 1362306a36Sopenharmony_ci * 1462306a36Sopenharmony_ci * Consider for e.g. Remus - a Virtual Machine checkpointing system, 1562306a36Sopenharmony_ci * wherein a VM is checkpointed, say every 50ms. The checkpoint is replicated 1662306a36Sopenharmony_ci * asynchronously to the backup host, while the VM continues executing the 1762306a36Sopenharmony_ci * next epoch speculatively. 1862306a36Sopenharmony_ci * 1962306a36Sopenharmony_ci * The following is a typical sequence of output buffer operations: 2062306a36Sopenharmony_ci * 1.At epoch i, start_buffer(i) 2162306a36Sopenharmony_ci * 2. At end of epoch i (i.e. after 50ms): 2262306a36Sopenharmony_ci * 2.1 Stop VM and take checkpoint(i). 2362306a36Sopenharmony_ci * 2.2 start_buffer(i+1) and Resume VM 2462306a36Sopenharmony_ci * 3. While speculatively executing epoch(i+1), asynchronously replicate 2562306a36Sopenharmony_ci * checkpoint(i) to backup host. 2662306a36Sopenharmony_ci * 4. When checkpoint_ack(i) is received from backup, release_buffer(i) 2762306a36Sopenharmony_ci * Thus, this Qdisc would receive the following sequence of commands: 2862306a36Sopenharmony_ci * TCQ_PLUG_BUFFER (epoch i) 2962306a36Sopenharmony_ci * .. TCQ_PLUG_BUFFER (epoch i+1) 3062306a36Sopenharmony_ci * ....TCQ_PLUG_RELEASE_ONE (epoch i) 3162306a36Sopenharmony_ci * ......TCQ_PLUG_BUFFER (epoch i+2) 3262306a36Sopenharmony_ci * ........ 3362306a36Sopenharmony_ci */ 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_ci#include <linux/module.h> 3662306a36Sopenharmony_ci#include <linux/types.h> 3762306a36Sopenharmony_ci#include <linux/kernel.h> 3862306a36Sopenharmony_ci#include <linux/errno.h> 3962306a36Sopenharmony_ci#include <linux/netdevice.h> 4062306a36Sopenharmony_ci#include <linux/skbuff.h> 4162306a36Sopenharmony_ci#include <net/pkt_sched.h> 4262306a36Sopenharmony_ci 4362306a36Sopenharmony_ci/* 4462306a36Sopenharmony_ci * State of the queue, when used for network output buffering: 4562306a36Sopenharmony_ci * 4662306a36Sopenharmony_ci * plug(i+1) plug(i) head 4762306a36Sopenharmony_ci * ------------------+--------------------+----------------> 4862306a36Sopenharmony_ci * | | 4962306a36Sopenharmony_ci * | | 5062306a36Sopenharmony_ci * pkts_current_epoch| pkts_last_epoch |pkts_to_release 5162306a36Sopenharmony_ci * ----------------->|<--------+--------->|+---------------> 5262306a36Sopenharmony_ci * v v 5362306a36Sopenharmony_ci * 5462306a36Sopenharmony_ci */ 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_cistruct plug_sched_data { 5762306a36Sopenharmony_ci /* If true, the dequeue function releases all packets 5862306a36Sopenharmony_ci * from head to end of the queue. The queue turns into 5962306a36Sopenharmony_ci * a pass-through queue for newly arriving packets. 6062306a36Sopenharmony_ci */ 6162306a36Sopenharmony_ci bool unplug_indefinite; 6262306a36Sopenharmony_ci 6362306a36Sopenharmony_ci bool throttled; 6462306a36Sopenharmony_ci 6562306a36Sopenharmony_ci /* Queue Limit in bytes */ 6662306a36Sopenharmony_ci u32 limit; 6762306a36Sopenharmony_ci 6862306a36Sopenharmony_ci /* Number of packets (output) from the current speculatively 6962306a36Sopenharmony_ci * executing epoch. 7062306a36Sopenharmony_ci */ 7162306a36Sopenharmony_ci u32 pkts_current_epoch; 7262306a36Sopenharmony_ci 7362306a36Sopenharmony_ci /* Number of packets corresponding to the recently finished 7462306a36Sopenharmony_ci * epoch. These will be released when we receive a 7562306a36Sopenharmony_ci * TCQ_PLUG_RELEASE_ONE command. This command is typically 7662306a36Sopenharmony_ci * issued after committing a checkpoint at the target. 7762306a36Sopenharmony_ci */ 7862306a36Sopenharmony_ci u32 pkts_last_epoch; 7962306a36Sopenharmony_ci 8062306a36Sopenharmony_ci /* 8162306a36Sopenharmony_ci * Number of packets from the head of the queue, that can 8262306a36Sopenharmony_ci * be released (committed checkpoint). 8362306a36Sopenharmony_ci */ 8462306a36Sopenharmony_ci u32 pkts_to_release; 8562306a36Sopenharmony_ci}; 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_cistatic int plug_enqueue(struct sk_buff *skb, struct Qdisc *sch, 8862306a36Sopenharmony_ci struct sk_buff **to_free) 8962306a36Sopenharmony_ci{ 9062306a36Sopenharmony_ci struct plug_sched_data *q = qdisc_priv(sch); 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci if (likely(sch->qstats.backlog + skb->len <= q->limit)) { 9362306a36Sopenharmony_ci if (!q->unplug_indefinite) 9462306a36Sopenharmony_ci q->pkts_current_epoch++; 9562306a36Sopenharmony_ci return qdisc_enqueue_tail(skb, sch); 9662306a36Sopenharmony_ci } 9762306a36Sopenharmony_ci 9862306a36Sopenharmony_ci return qdisc_drop(skb, sch, to_free); 9962306a36Sopenharmony_ci} 10062306a36Sopenharmony_ci 10162306a36Sopenharmony_cistatic struct sk_buff *plug_dequeue(struct Qdisc *sch) 10262306a36Sopenharmony_ci{ 10362306a36Sopenharmony_ci struct plug_sched_data *q = qdisc_priv(sch); 10462306a36Sopenharmony_ci 10562306a36Sopenharmony_ci if (q->throttled) 10662306a36Sopenharmony_ci return NULL; 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_ci if (!q->unplug_indefinite) { 10962306a36Sopenharmony_ci if (!q->pkts_to_release) { 11062306a36Sopenharmony_ci /* No more packets to dequeue. Block the queue 11162306a36Sopenharmony_ci * and wait for the next release command. 11262306a36Sopenharmony_ci */ 11362306a36Sopenharmony_ci q->throttled = true; 11462306a36Sopenharmony_ci return NULL; 11562306a36Sopenharmony_ci } 11662306a36Sopenharmony_ci q->pkts_to_release--; 11762306a36Sopenharmony_ci } 11862306a36Sopenharmony_ci 11962306a36Sopenharmony_ci return qdisc_dequeue_head(sch); 12062306a36Sopenharmony_ci} 12162306a36Sopenharmony_ci 12262306a36Sopenharmony_cistatic int plug_init(struct Qdisc *sch, struct nlattr *opt, 12362306a36Sopenharmony_ci struct netlink_ext_ack *extack) 12462306a36Sopenharmony_ci{ 12562306a36Sopenharmony_ci struct plug_sched_data *q = qdisc_priv(sch); 12662306a36Sopenharmony_ci 12762306a36Sopenharmony_ci q->pkts_current_epoch = 0; 12862306a36Sopenharmony_ci q->pkts_last_epoch = 0; 12962306a36Sopenharmony_ci q->pkts_to_release = 0; 13062306a36Sopenharmony_ci q->unplug_indefinite = false; 13162306a36Sopenharmony_ci 13262306a36Sopenharmony_ci if (opt == NULL) { 13362306a36Sopenharmony_ci q->limit = qdisc_dev(sch)->tx_queue_len 13462306a36Sopenharmony_ci * psched_mtu(qdisc_dev(sch)); 13562306a36Sopenharmony_ci } else { 13662306a36Sopenharmony_ci struct tc_plug_qopt *ctl = nla_data(opt); 13762306a36Sopenharmony_ci 13862306a36Sopenharmony_ci if (nla_len(opt) < sizeof(*ctl)) 13962306a36Sopenharmony_ci return -EINVAL; 14062306a36Sopenharmony_ci 14162306a36Sopenharmony_ci q->limit = ctl->limit; 14262306a36Sopenharmony_ci } 14362306a36Sopenharmony_ci 14462306a36Sopenharmony_ci q->throttled = true; 14562306a36Sopenharmony_ci return 0; 14662306a36Sopenharmony_ci} 14762306a36Sopenharmony_ci 14862306a36Sopenharmony_ci/* Receives 4 types of messages: 14962306a36Sopenharmony_ci * TCQ_PLUG_BUFFER: Inset a plug into the queue and 15062306a36Sopenharmony_ci * buffer any incoming packets 15162306a36Sopenharmony_ci * TCQ_PLUG_RELEASE_ONE: Dequeue packets from queue head 15262306a36Sopenharmony_ci * to beginning of the next plug. 15362306a36Sopenharmony_ci * TCQ_PLUG_RELEASE_INDEFINITE: Dequeue all packets from queue. 15462306a36Sopenharmony_ci * Stop buffering packets until the next TCQ_PLUG_BUFFER 15562306a36Sopenharmony_ci * command is received (just act as a pass-thru queue). 15662306a36Sopenharmony_ci * TCQ_PLUG_LIMIT: Increase/decrease queue size 15762306a36Sopenharmony_ci */ 15862306a36Sopenharmony_cistatic int plug_change(struct Qdisc *sch, struct nlattr *opt, 15962306a36Sopenharmony_ci struct netlink_ext_ack *extack) 16062306a36Sopenharmony_ci{ 16162306a36Sopenharmony_ci struct plug_sched_data *q = qdisc_priv(sch); 16262306a36Sopenharmony_ci struct tc_plug_qopt *msg; 16362306a36Sopenharmony_ci 16462306a36Sopenharmony_ci msg = nla_data(opt); 16562306a36Sopenharmony_ci if (nla_len(opt) < sizeof(*msg)) 16662306a36Sopenharmony_ci return -EINVAL; 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ci switch (msg->action) { 16962306a36Sopenharmony_ci case TCQ_PLUG_BUFFER: 17062306a36Sopenharmony_ci /* Save size of the current buffer */ 17162306a36Sopenharmony_ci q->pkts_last_epoch = q->pkts_current_epoch; 17262306a36Sopenharmony_ci q->pkts_current_epoch = 0; 17362306a36Sopenharmony_ci if (q->unplug_indefinite) 17462306a36Sopenharmony_ci q->throttled = true; 17562306a36Sopenharmony_ci q->unplug_indefinite = false; 17662306a36Sopenharmony_ci break; 17762306a36Sopenharmony_ci case TCQ_PLUG_RELEASE_ONE: 17862306a36Sopenharmony_ci /* Add packets from the last complete buffer to the 17962306a36Sopenharmony_ci * packets to be released set. 18062306a36Sopenharmony_ci */ 18162306a36Sopenharmony_ci q->pkts_to_release += q->pkts_last_epoch; 18262306a36Sopenharmony_ci q->pkts_last_epoch = 0; 18362306a36Sopenharmony_ci q->throttled = false; 18462306a36Sopenharmony_ci netif_schedule_queue(sch->dev_queue); 18562306a36Sopenharmony_ci break; 18662306a36Sopenharmony_ci case TCQ_PLUG_RELEASE_INDEFINITE: 18762306a36Sopenharmony_ci q->unplug_indefinite = true; 18862306a36Sopenharmony_ci q->pkts_to_release = 0; 18962306a36Sopenharmony_ci q->pkts_last_epoch = 0; 19062306a36Sopenharmony_ci q->pkts_current_epoch = 0; 19162306a36Sopenharmony_ci q->throttled = false; 19262306a36Sopenharmony_ci netif_schedule_queue(sch->dev_queue); 19362306a36Sopenharmony_ci break; 19462306a36Sopenharmony_ci case TCQ_PLUG_LIMIT: 19562306a36Sopenharmony_ci /* Limit is supplied in bytes */ 19662306a36Sopenharmony_ci q->limit = msg->limit; 19762306a36Sopenharmony_ci break; 19862306a36Sopenharmony_ci default: 19962306a36Sopenharmony_ci return -EINVAL; 20062306a36Sopenharmony_ci } 20162306a36Sopenharmony_ci 20262306a36Sopenharmony_ci return 0; 20362306a36Sopenharmony_ci} 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_cistatic struct Qdisc_ops plug_qdisc_ops __read_mostly = { 20662306a36Sopenharmony_ci .id = "plug", 20762306a36Sopenharmony_ci .priv_size = sizeof(struct plug_sched_data), 20862306a36Sopenharmony_ci .enqueue = plug_enqueue, 20962306a36Sopenharmony_ci .dequeue = plug_dequeue, 21062306a36Sopenharmony_ci .peek = qdisc_peek_dequeued, 21162306a36Sopenharmony_ci .init = plug_init, 21262306a36Sopenharmony_ci .change = plug_change, 21362306a36Sopenharmony_ci .reset = qdisc_reset_queue, 21462306a36Sopenharmony_ci .owner = THIS_MODULE, 21562306a36Sopenharmony_ci}; 21662306a36Sopenharmony_ci 21762306a36Sopenharmony_cistatic int __init plug_module_init(void) 21862306a36Sopenharmony_ci{ 21962306a36Sopenharmony_ci return register_qdisc(&plug_qdisc_ops); 22062306a36Sopenharmony_ci} 22162306a36Sopenharmony_ci 22262306a36Sopenharmony_cistatic void __exit plug_module_exit(void) 22362306a36Sopenharmony_ci{ 22462306a36Sopenharmony_ci unregister_qdisc(&plug_qdisc_ops); 22562306a36Sopenharmony_ci} 22662306a36Sopenharmony_cimodule_init(plug_module_init) 22762306a36Sopenharmony_cimodule_exit(plug_module_exit) 22862306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 229