18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * sch_plug.c Queue traffic until an explicit release command 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * There are two ways to use this qdisc: 68c2ecf20Sopenharmony_ci * 1. A simple "instantaneous" plug/unplug operation, by issuing an alternating 78c2ecf20Sopenharmony_ci * sequence of TCQ_PLUG_BUFFER & TCQ_PLUG_RELEASE_INDEFINITE commands. 88c2ecf20Sopenharmony_ci * 98c2ecf20Sopenharmony_ci * 2. For network output buffering (a.k.a output commit) functionality. 108c2ecf20Sopenharmony_ci * Output commit property is commonly used by applications using checkpoint 118c2ecf20Sopenharmony_ci * based fault-tolerance to ensure that the checkpoint from which a system 128c2ecf20Sopenharmony_ci * is being restored is consistent w.r.t outside world. 138c2ecf20Sopenharmony_ci * 148c2ecf20Sopenharmony_ci * Consider for e.g. Remus - a Virtual Machine checkpointing system, 158c2ecf20Sopenharmony_ci * wherein a VM is checkpointed, say every 50ms. The checkpoint is replicated 168c2ecf20Sopenharmony_ci * asynchronously to the backup host, while the VM continues executing the 178c2ecf20Sopenharmony_ci * next epoch speculatively. 188c2ecf20Sopenharmony_ci * 198c2ecf20Sopenharmony_ci * The following is a typical sequence of output buffer operations: 208c2ecf20Sopenharmony_ci * 1.At epoch i, start_buffer(i) 218c2ecf20Sopenharmony_ci * 2. At end of epoch i (i.e. after 50ms): 228c2ecf20Sopenharmony_ci * 2.1 Stop VM and take checkpoint(i). 238c2ecf20Sopenharmony_ci * 2.2 start_buffer(i+1) and Resume VM 248c2ecf20Sopenharmony_ci * 3. While speculatively executing epoch(i+1), asynchronously replicate 258c2ecf20Sopenharmony_ci * checkpoint(i) to backup host. 268c2ecf20Sopenharmony_ci * 4. When checkpoint_ack(i) is received from backup, release_buffer(i) 278c2ecf20Sopenharmony_ci * Thus, this Qdisc would receive the following sequence of commands: 288c2ecf20Sopenharmony_ci * TCQ_PLUG_BUFFER (epoch i) 298c2ecf20Sopenharmony_ci * .. TCQ_PLUG_BUFFER (epoch i+1) 308c2ecf20Sopenharmony_ci * ....TCQ_PLUG_RELEASE_ONE (epoch i) 318c2ecf20Sopenharmony_ci * ......TCQ_PLUG_BUFFER (epoch i+2) 328c2ecf20Sopenharmony_ci * ........ 338c2ecf20Sopenharmony_ci */ 348c2ecf20Sopenharmony_ci 358c2ecf20Sopenharmony_ci#include <linux/module.h> 368c2ecf20Sopenharmony_ci#include <linux/types.h> 378c2ecf20Sopenharmony_ci#include <linux/kernel.h> 388c2ecf20Sopenharmony_ci#include <linux/errno.h> 398c2ecf20Sopenharmony_ci#include <linux/netdevice.h> 408c2ecf20Sopenharmony_ci#include <linux/skbuff.h> 418c2ecf20Sopenharmony_ci#include <net/pkt_sched.h> 428c2ecf20Sopenharmony_ci 438c2ecf20Sopenharmony_ci/* 448c2ecf20Sopenharmony_ci * State of the queue, when used for network output buffering: 458c2ecf20Sopenharmony_ci * 468c2ecf20Sopenharmony_ci * plug(i+1) plug(i) head 478c2ecf20Sopenharmony_ci * ------------------+--------------------+----------------> 488c2ecf20Sopenharmony_ci * | | 498c2ecf20Sopenharmony_ci * | | 508c2ecf20Sopenharmony_ci * pkts_current_epoch| pkts_last_epoch |pkts_to_release 518c2ecf20Sopenharmony_ci * ----------------->|<--------+--------->|+---------------> 528c2ecf20Sopenharmony_ci * v v 538c2ecf20Sopenharmony_ci * 548c2ecf20Sopenharmony_ci */ 558c2ecf20Sopenharmony_ci 568c2ecf20Sopenharmony_cistruct plug_sched_data { 578c2ecf20Sopenharmony_ci /* If true, the dequeue function releases all packets 588c2ecf20Sopenharmony_ci * from head to end of the queue. The queue turns into 598c2ecf20Sopenharmony_ci * a pass-through queue for newly arriving packets. 608c2ecf20Sopenharmony_ci */ 618c2ecf20Sopenharmony_ci bool unplug_indefinite; 628c2ecf20Sopenharmony_ci 638c2ecf20Sopenharmony_ci bool throttled; 648c2ecf20Sopenharmony_ci 658c2ecf20Sopenharmony_ci /* Queue Limit in bytes */ 668c2ecf20Sopenharmony_ci u32 limit; 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci /* Number of packets (output) from the current speculatively 698c2ecf20Sopenharmony_ci * executing epoch. 708c2ecf20Sopenharmony_ci */ 718c2ecf20Sopenharmony_ci u32 pkts_current_epoch; 728c2ecf20Sopenharmony_ci 738c2ecf20Sopenharmony_ci /* Number of packets corresponding to the recently finished 748c2ecf20Sopenharmony_ci * epoch. These will be released when we receive a 758c2ecf20Sopenharmony_ci * TCQ_PLUG_RELEASE_ONE command. This command is typically 768c2ecf20Sopenharmony_ci * issued after committing a checkpoint at the target. 778c2ecf20Sopenharmony_ci */ 788c2ecf20Sopenharmony_ci u32 pkts_last_epoch; 798c2ecf20Sopenharmony_ci 808c2ecf20Sopenharmony_ci /* 818c2ecf20Sopenharmony_ci * Number of packets from the head of the queue, that can 828c2ecf20Sopenharmony_ci * be released (committed checkpoint). 838c2ecf20Sopenharmony_ci */ 848c2ecf20Sopenharmony_ci u32 pkts_to_release; 858c2ecf20Sopenharmony_ci}; 868c2ecf20Sopenharmony_ci 878c2ecf20Sopenharmony_cistatic int plug_enqueue(struct sk_buff *skb, struct Qdisc *sch, 888c2ecf20Sopenharmony_ci struct sk_buff **to_free) 898c2ecf20Sopenharmony_ci{ 908c2ecf20Sopenharmony_ci struct plug_sched_data *q = qdisc_priv(sch); 918c2ecf20Sopenharmony_ci 928c2ecf20Sopenharmony_ci if (likely(sch->qstats.backlog + skb->len <= q->limit)) { 938c2ecf20Sopenharmony_ci if (!q->unplug_indefinite) 948c2ecf20Sopenharmony_ci q->pkts_current_epoch++; 958c2ecf20Sopenharmony_ci return qdisc_enqueue_tail(skb, sch); 968c2ecf20Sopenharmony_ci } 978c2ecf20Sopenharmony_ci 988c2ecf20Sopenharmony_ci return qdisc_drop(skb, sch, to_free); 998c2ecf20Sopenharmony_ci} 1008c2ecf20Sopenharmony_ci 1018c2ecf20Sopenharmony_cistatic struct sk_buff *plug_dequeue(struct Qdisc *sch) 1028c2ecf20Sopenharmony_ci{ 1038c2ecf20Sopenharmony_ci struct plug_sched_data *q = qdisc_priv(sch); 1048c2ecf20Sopenharmony_ci 1058c2ecf20Sopenharmony_ci if (q->throttled) 1068c2ecf20Sopenharmony_ci return NULL; 1078c2ecf20Sopenharmony_ci 1088c2ecf20Sopenharmony_ci if (!q->unplug_indefinite) { 1098c2ecf20Sopenharmony_ci if (!q->pkts_to_release) { 1108c2ecf20Sopenharmony_ci /* No more packets to dequeue. Block the queue 1118c2ecf20Sopenharmony_ci * and wait for the next release command. 1128c2ecf20Sopenharmony_ci */ 1138c2ecf20Sopenharmony_ci q->throttled = true; 1148c2ecf20Sopenharmony_ci return NULL; 1158c2ecf20Sopenharmony_ci } 1168c2ecf20Sopenharmony_ci q->pkts_to_release--; 1178c2ecf20Sopenharmony_ci } 1188c2ecf20Sopenharmony_ci 1198c2ecf20Sopenharmony_ci return qdisc_dequeue_head(sch); 1208c2ecf20Sopenharmony_ci} 1218c2ecf20Sopenharmony_ci 1228c2ecf20Sopenharmony_cistatic int plug_init(struct Qdisc *sch, struct nlattr *opt, 1238c2ecf20Sopenharmony_ci struct netlink_ext_ack *extack) 1248c2ecf20Sopenharmony_ci{ 1258c2ecf20Sopenharmony_ci struct plug_sched_data *q = qdisc_priv(sch); 1268c2ecf20Sopenharmony_ci 1278c2ecf20Sopenharmony_ci q->pkts_current_epoch = 0; 1288c2ecf20Sopenharmony_ci q->pkts_last_epoch = 0; 1298c2ecf20Sopenharmony_ci q->pkts_to_release = 0; 1308c2ecf20Sopenharmony_ci q->unplug_indefinite = false; 1318c2ecf20Sopenharmony_ci 1328c2ecf20Sopenharmony_ci if (opt == NULL) { 1338c2ecf20Sopenharmony_ci q->limit = qdisc_dev(sch)->tx_queue_len 1348c2ecf20Sopenharmony_ci * psched_mtu(qdisc_dev(sch)); 1358c2ecf20Sopenharmony_ci } else { 1368c2ecf20Sopenharmony_ci struct tc_plug_qopt *ctl = nla_data(opt); 1378c2ecf20Sopenharmony_ci 1388c2ecf20Sopenharmony_ci if (nla_len(opt) < sizeof(*ctl)) 1398c2ecf20Sopenharmony_ci return -EINVAL; 1408c2ecf20Sopenharmony_ci 1418c2ecf20Sopenharmony_ci q->limit = ctl->limit; 1428c2ecf20Sopenharmony_ci } 1438c2ecf20Sopenharmony_ci 1448c2ecf20Sopenharmony_ci q->throttled = true; 1458c2ecf20Sopenharmony_ci return 0; 1468c2ecf20Sopenharmony_ci} 1478c2ecf20Sopenharmony_ci 1488c2ecf20Sopenharmony_ci/* Receives 4 types of messages: 1498c2ecf20Sopenharmony_ci * TCQ_PLUG_BUFFER: Inset a plug into the queue and 1508c2ecf20Sopenharmony_ci * buffer any incoming packets 1518c2ecf20Sopenharmony_ci * TCQ_PLUG_RELEASE_ONE: Dequeue packets from queue head 1528c2ecf20Sopenharmony_ci * to beginning of the next plug. 1538c2ecf20Sopenharmony_ci * TCQ_PLUG_RELEASE_INDEFINITE: Dequeue all packets from queue. 1548c2ecf20Sopenharmony_ci * Stop buffering packets until the next TCQ_PLUG_BUFFER 1558c2ecf20Sopenharmony_ci * command is received (just act as a pass-thru queue). 1568c2ecf20Sopenharmony_ci * TCQ_PLUG_LIMIT: Increase/decrease queue size 1578c2ecf20Sopenharmony_ci */ 1588c2ecf20Sopenharmony_cistatic int plug_change(struct Qdisc *sch, struct nlattr *opt, 1598c2ecf20Sopenharmony_ci struct netlink_ext_ack *extack) 1608c2ecf20Sopenharmony_ci{ 1618c2ecf20Sopenharmony_ci struct plug_sched_data *q = qdisc_priv(sch); 1628c2ecf20Sopenharmony_ci struct tc_plug_qopt *msg; 1638c2ecf20Sopenharmony_ci 1648c2ecf20Sopenharmony_ci if (opt == NULL) 1658c2ecf20Sopenharmony_ci return -EINVAL; 1668c2ecf20Sopenharmony_ci 1678c2ecf20Sopenharmony_ci msg = nla_data(opt); 1688c2ecf20Sopenharmony_ci if (nla_len(opt) < sizeof(*msg)) 1698c2ecf20Sopenharmony_ci return -EINVAL; 1708c2ecf20Sopenharmony_ci 1718c2ecf20Sopenharmony_ci switch (msg->action) { 1728c2ecf20Sopenharmony_ci case TCQ_PLUG_BUFFER: 1738c2ecf20Sopenharmony_ci /* Save size of the current buffer */ 1748c2ecf20Sopenharmony_ci q->pkts_last_epoch = q->pkts_current_epoch; 1758c2ecf20Sopenharmony_ci q->pkts_current_epoch = 0; 1768c2ecf20Sopenharmony_ci if (q->unplug_indefinite) 1778c2ecf20Sopenharmony_ci q->throttled = true; 1788c2ecf20Sopenharmony_ci q->unplug_indefinite = false; 1798c2ecf20Sopenharmony_ci break; 1808c2ecf20Sopenharmony_ci case TCQ_PLUG_RELEASE_ONE: 1818c2ecf20Sopenharmony_ci /* Add packets from the last complete buffer to the 1828c2ecf20Sopenharmony_ci * packets to be released set. 1838c2ecf20Sopenharmony_ci */ 1848c2ecf20Sopenharmony_ci q->pkts_to_release += q->pkts_last_epoch; 1858c2ecf20Sopenharmony_ci q->pkts_last_epoch = 0; 1868c2ecf20Sopenharmony_ci q->throttled = false; 1878c2ecf20Sopenharmony_ci netif_schedule_queue(sch->dev_queue); 1888c2ecf20Sopenharmony_ci break; 1898c2ecf20Sopenharmony_ci case TCQ_PLUG_RELEASE_INDEFINITE: 1908c2ecf20Sopenharmony_ci q->unplug_indefinite = true; 1918c2ecf20Sopenharmony_ci q->pkts_to_release = 0; 1928c2ecf20Sopenharmony_ci q->pkts_last_epoch = 0; 1938c2ecf20Sopenharmony_ci q->pkts_current_epoch = 0; 1948c2ecf20Sopenharmony_ci q->throttled = false; 1958c2ecf20Sopenharmony_ci netif_schedule_queue(sch->dev_queue); 1968c2ecf20Sopenharmony_ci break; 1978c2ecf20Sopenharmony_ci case TCQ_PLUG_LIMIT: 1988c2ecf20Sopenharmony_ci /* Limit is supplied in bytes */ 1998c2ecf20Sopenharmony_ci q->limit = msg->limit; 2008c2ecf20Sopenharmony_ci break; 2018c2ecf20Sopenharmony_ci default: 2028c2ecf20Sopenharmony_ci return -EINVAL; 2038c2ecf20Sopenharmony_ci } 2048c2ecf20Sopenharmony_ci 2058c2ecf20Sopenharmony_ci return 0; 2068c2ecf20Sopenharmony_ci} 2078c2ecf20Sopenharmony_ci 2088c2ecf20Sopenharmony_cistatic struct Qdisc_ops plug_qdisc_ops __read_mostly = { 2098c2ecf20Sopenharmony_ci .id = "plug", 2108c2ecf20Sopenharmony_ci .priv_size = sizeof(struct plug_sched_data), 2118c2ecf20Sopenharmony_ci .enqueue = plug_enqueue, 2128c2ecf20Sopenharmony_ci .dequeue = plug_dequeue, 2138c2ecf20Sopenharmony_ci .peek = qdisc_peek_dequeued, 2148c2ecf20Sopenharmony_ci .init = plug_init, 2158c2ecf20Sopenharmony_ci .change = plug_change, 2168c2ecf20Sopenharmony_ci .reset = qdisc_reset_queue, 2178c2ecf20Sopenharmony_ci .owner = THIS_MODULE, 2188c2ecf20Sopenharmony_ci}; 2198c2ecf20Sopenharmony_ci 2208c2ecf20Sopenharmony_cistatic int __init plug_module_init(void) 2218c2ecf20Sopenharmony_ci{ 2228c2ecf20Sopenharmony_ci return register_qdisc(&plug_qdisc_ops); 2238c2ecf20Sopenharmony_ci} 2248c2ecf20Sopenharmony_ci 2258c2ecf20Sopenharmony_cistatic void __exit plug_module_exit(void) 2268c2ecf20Sopenharmony_ci{ 2278c2ecf20Sopenharmony_ci unregister_qdisc(&plug_qdisc_ops); 2288c2ecf20Sopenharmony_ci} 2298c2ecf20Sopenharmony_cimodule_init(plug_module_init) 2308c2ecf20Sopenharmony_cimodule_exit(plug_module_exit) 2318c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 232