// SPDX-License-Identifier: GPL-2.0-or-later

  /*
   * sch_plug.c Queue traffic until an explicit release command
   *

   * There are two ways to use this qdisc:
   * 1. A simple "instantaneous" plug/unplug operation, by issuing an alternating
   *    sequence of TCQ_PLUG_BUFFER & TCQ_PLUG_RELEASE_INDEFINITE commands.
   *
   * 2. For network output buffering (a.k.a output commit) functionality.
   *    Output commit property is commonly used by applications using checkpoint
   *    based fault-tolerance to ensure that the checkpoint from which a system
   *    is being restored is consistent w.r.t outside world.
   *
   *    Consider for e.g. Remus - a Virtual Machine checkpointing system,
   *    wherein a VM is checkpointed, say every 50ms. The checkpoint is replicated
   *    asynchronously to the backup host, while the VM continues executing the
   *    next epoch speculatively.
   *
   *    The following is a typical sequence of output buffer operations:
   *       1.At epoch i, start_buffer(i)
   *       2. At end of epoch i (i.e. after 50ms):
   *          2.1 Stop VM and take checkpoint(i).
   *          2.2 start_buffer(i+1) and Resume VM
   *       3. While speculatively executing epoch(i+1), asynchronously replicate
   *          checkpoint(i) to backup host.
   *       4. When checkpoint_ack(i) is received from backup, release_buffer(i)
   *    Thus, this Qdisc would receive the following sequence of commands:
   *       TCQ_PLUG_BUFFER (epoch i)
   *       .. TCQ_PLUG_BUFFER (epoch i+1)
   *       ....TCQ_PLUG_RELEASE_ONE (epoch i)
   *       ......TCQ_PLUG_BUFFER (epoch i+2)
   *       ........
   */
  
  #include <linux/module.h>
  #include <linux/types.h>
  #include <linux/kernel.h>
  #include <linux/errno.h>
  #include <linux/netdevice.h>
  #include <linux/skbuff.h>
  #include <net/pkt_sched.h>
  
  /*
   * State of the queue, when used for network output buffering:
   *
   *                 plug(i+1)            plug(i)          head
   * ------------------+--------------------+---------------->
   *                   |                    |
   *                   |                    |
   * pkts_current_epoch| pkts_last_epoch    |pkts_to_release
   * ----------------->|<--------+--------->|+--------------->
   *                   v                    v
   *
   */
  
  struct plug_sched_data {
  	/* If true, the dequeue function releases all packets
  	 * from head to end of the queue. The queue turns into
  	 * a pass-through queue for newly arriving packets.
  	 */
  	bool unplug_indefinite;

  	bool throttled;

  	/* Queue Limit in bytes */
  	u32 limit;
  
  	/* Number of packets (output) from the current speculatively
  	 * executing epoch.
  	 */
  	u32 pkts_current_epoch;
  
  	/* Number of packets corresponding to the recently finished
  	 * epoch. These will be released when we receive a
  	 * TCQ_PLUG_RELEASE_ONE command. This command is typically
  	 * issued after committing a checkpoint at the target.
  	 */
  	u32 pkts_last_epoch;
  
  	/*
  	 * Number of packets from the head of the queue, that can
  	 * be released (committed checkpoint).
  	 */
  	u32 pkts_to_release;
  };

  static int plug_enqueue(struct sk_buff *skb, struct Qdisc *sch,
  			struct sk_buff **to_free)

  {
  	struct plug_sched_data *q = qdisc_priv(sch);
  
  	if (likely(sch->qstats.backlog + skb->len <= q->limit)) {
  		if (!q->unplug_indefinite)
  			q->pkts_current_epoch++;
  		return qdisc_enqueue_tail(skb, sch);
  	}

  	return qdisc_drop(skb, sch, to_free);

  }
  
  static struct sk_buff *plug_dequeue(struct Qdisc *sch)
  {
  	struct plug_sched_data *q = qdisc_priv(sch);

  	if (q->throttled)

  		return NULL;
  
  	if (!q->unplug_indefinite) {
  		if (!q->pkts_to_release) {
  			/* No more packets to dequeue. Block the queue
  			 * and wait for the next release command.
  			 */

  			q->throttled = true;

  			return NULL;
  		}
  		q->pkts_to_release--;
  	}
  
  	return qdisc_dequeue_head(sch);
  }

  static int plug_init(struct Qdisc *sch, struct nlattr *opt,
  		     struct netlink_ext_ack *extack)

  {
  	struct plug_sched_data *q = qdisc_priv(sch);
  
  	q->pkts_current_epoch = 0;
  	q->pkts_last_epoch = 0;
  	q->pkts_to_release = 0;
  	q->unplug_indefinite = false;
  
  	if (opt == NULL) {

  		q->limit = qdisc_dev(sch)->tx_queue_len
  		           * psched_mtu(qdisc_dev(sch));

  	} else {
  		struct tc_plug_qopt *ctl = nla_data(opt);
  
  		if (nla_len(opt) < sizeof(*ctl))
  			return -EINVAL;
  
  		q->limit = ctl->limit;
  	}

  	q->throttled = true;

  	return 0;
  }
  
  /* Receives 4 types of messages:
   * TCQ_PLUG_BUFFER: Inset a plug into the queue and
   *  buffer any incoming packets
   * TCQ_PLUG_RELEASE_ONE: Dequeue packets from queue head
   *   to beginning of the next plug.
   * TCQ_PLUG_RELEASE_INDEFINITE: Dequeue all packets from queue.
   *   Stop buffering packets until the next TCQ_PLUG_BUFFER
   *   command is received (just act as a pass-thru queue).
   * TCQ_PLUG_LIMIT: Increase/decrease queue size
   */

  static int plug_change(struct Qdisc *sch, struct nlattr *opt,
  		       struct netlink_ext_ack *extack)

  {
  	struct plug_sched_data *q = qdisc_priv(sch);
  	struct tc_plug_qopt *msg;
  
  	if (opt == NULL)
  		return -EINVAL;
  
  	msg = nla_data(opt);
  	if (nla_len(opt) < sizeof(*msg))
  		return -EINVAL;
  
  	switch (msg->action) {
  	case TCQ_PLUG_BUFFER:
  		/* Save size of the current buffer */
  		q->pkts_last_epoch = q->pkts_current_epoch;
  		q->pkts_current_epoch = 0;
  		if (q->unplug_indefinite)

  			q->throttled = true;

  		q->unplug_indefinite = false;
  		break;
  	case TCQ_PLUG_RELEASE_ONE:
  		/* Add packets from the last complete buffer to the
  		 * packets to be released set.
  		 */
  		q->pkts_to_release += q->pkts_last_epoch;
  		q->pkts_last_epoch = 0;

  		q->throttled = false;

  		netif_schedule_queue(sch->dev_queue);
  		break;
  	case TCQ_PLUG_RELEASE_INDEFINITE:
  		q->unplug_indefinite = true;
  		q->pkts_to_release = 0;
  		q->pkts_last_epoch = 0;
  		q->pkts_current_epoch = 0;

  		q->throttled = false;

  		netif_schedule_queue(sch->dev_queue);
  		break;
  	case TCQ_PLUG_LIMIT:
  		/* Limit is supplied in bytes */
  		q->limit = msg->limit;
  		break;
  	default:
  		return -EINVAL;
  	}
  
  	return 0;
  }

  static struct Qdisc_ops plug_qdisc_ops __read_mostly = {

  	.id          =       "plug",
  	.priv_size   =       sizeof(struct plug_sched_data),
  	.enqueue     =       plug_enqueue,
  	.dequeue     =       plug_dequeue,
  	.peek        =       qdisc_peek_head,
  	.init        =       plug_init,
  	.change      =       plug_change,

  	.reset       =	     qdisc_reset_queue,

  	.owner       =       THIS_MODULE,
  };
  
  static int __init plug_module_init(void)
  {
  	return register_qdisc(&plug_qdisc_ops);
  }
  
  static void __exit plug_module_exit(void)
  {
  	unregister_qdisc(&plug_qdisc_ops);
  }
  module_init(plug_module_init)
  module_exit(plug_module_exit)
  MODULE_LICENSE("GPL");