/*
   * net/core/gen_stats.c
   *
   *             This program is free software; you can redistribute it and/or
   *             modify it under the terms of the GNU General Public License
   *             as published by the Free Software Foundation; either version
   *             2 of the License, or (at your option) any later version.
   *
   * Authors:  Thomas Graf <tgraf@suug.ch>
   *           Jamal Hadi Salim
   *           Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
   *
   * See Documentation/networking/gen_stats.txt
   */
  
  #include <linux/types.h>
  #include <linux/kernel.h>
  #include <linux/module.h>
  #include <linux/interrupt.h>
  #include <linux/socket.h>
  #include <linux/rtnetlink.h>
  #include <linux/gen_stats.h>

  #include <net/netlink.h>

  #include <net/gen_stats.h>
  
  
  static inline int

  gnet_stats_copy(struct gnet_dump *d, int type, void *buf, int size, int padattr)

  {

  	if (nla_put_64bit(d->skb, type, size, buf, padattr))

  		goto nla_put_failure;

  	return 0;

  nla_put_failure:

  	if (d->lock)
  		spin_unlock_bh(d->lock);

  	kfree(d->xstats);
  	d->xstats = NULL;
  	d->xstats_len = 0;

  	return -1;
  }
  
  /**
   * gnet_stats_start_copy_compat - start dumping procedure in compatibility mode
   * @skb: socket buffer to put statistics TLVs into
   * @type: TLV type for top level statistic TLV
   * @tc_stats_type: TLV type for backward compatibility struct tc_stats TLV
   * @xstats_type: TLV type for backward compatibility xstats TLV
   * @lock: statistics lock
   * @d: dumping handle

   * @padattr: padding attribute

   *
   * Initializes the dumping handle, grabs the statistic lock and appends
   * an empty TLV header to the socket buffer for use a container for all
   * other statistic TLVS.
   *
   * The dumping handle is marked to be in backward compatibility mode telling
   * all gnet_stats_copy_XXX() functions to fill a local copy of struct tc_stats.
   *
   * Returns 0 on success or -1 if the room in the socket buffer was not sufficient.
   */
  int
  gnet_stats_start_copy_compat(struct sk_buff *skb, int type, int tc_stats_type,

  			     int xstats_type, spinlock_t *lock,
  			     struct gnet_dump *d, int padattr)

  	__acquires(lock)

  {
  	memset(d, 0, sizeof(*d));

  	if (type)

  		d->tail = (struct nlattr *)skb_tail_pointer(skb);

  	d->skb = skb;
  	d->compat_tc_stats = tc_stats_type;
  	d->compat_xstats = xstats_type;

  	d->padattr = padattr;

  	if (lock) {
  		d->lock = lock;
  		spin_lock_bh(lock);
  	}

  	if (d->tail) {
  		int ret = gnet_stats_copy(d, type, NULL, 0, padattr);
  
  		/* The initial attribute added in gnet_stats_copy() may be
  		 * preceded by a padding attribute, in which case d->tail will
  		 * end up pointing at the padding instead of the real attribute.
  		 * Fix this so gnet_stats_finish_copy() adjusts the length of
  		 * the right attribute.
  		 */
  		if (ret == 0 && d->tail->nla_type == padattr)
  			d->tail = (struct nlattr *)((char *)d->tail +
  						    NLA_ALIGN(d->tail->nla_len));
  		return ret;
  	}

  
  	return 0;
  }

  EXPORT_SYMBOL(gnet_stats_start_copy_compat);

  
  /**

   * gnet_stats_start_copy - start dumping procedure in compatibility mode

   * @skb: socket buffer to put statistics TLVs into
   * @type: TLV type for top level statistic TLV
   * @lock: statistics lock
   * @d: dumping handle

   * @padattr: padding attribute

   *
   * Initializes the dumping handle, grabs the statistic lock and appends
   * an empty TLV header to the socket buffer for use a container for all
   * other statistic TLVS.
   *
   * Returns 0 on success or -1 if the room in the socket buffer was not sufficient.
   */
  int
  gnet_stats_start_copy(struct sk_buff *skb, int type, spinlock_t *lock,

  		      struct gnet_dump *d, int padattr)

  {

  	return gnet_stats_start_copy_compat(skb, type, 0, 0, lock, d, padattr);

  }

  EXPORT_SYMBOL(gnet_stats_start_copy);

  static void
  __gnet_stats_copy_basic_cpu(struct gnet_stats_basic_packed *bstats,
  			    struct gnet_stats_basic_cpu __percpu *cpu)
  {
  	int i;
  
  	for_each_possible_cpu(i) {
  		struct gnet_stats_basic_cpu *bcpu = per_cpu_ptr(cpu, i);
  		unsigned int start;

  		u64 bytes;
  		u32 packets;

  
  		do {
  			start = u64_stats_fetch_begin_irq(&bcpu->syncp);
  			bytes = bcpu->bstats.bytes;
  			packets = bcpu->bstats.packets;
  		} while (u64_stats_fetch_retry_irq(&bcpu->syncp, start));

  		bstats->bytes += bytes;
  		bstats->packets += packets;

  	}
  }
  
  void

  __gnet_stats_copy_basic(const seqcount_t *running,
  			struct gnet_stats_basic_packed *bstats,

  			struct gnet_stats_basic_cpu __percpu *cpu,
  			struct gnet_stats_basic_packed *b)
  {

  	unsigned int seq;

  	if (cpu) {
  		__gnet_stats_copy_basic_cpu(bstats, cpu);

  		return;
  	}
  	do {
  		if (running)
  			seq = read_seqcount_begin(running);

  		bstats->bytes = b->bytes;
  		bstats->packets = b->packets;

  	} while (running && read_seqcount_retry(running, seq));

  }
  EXPORT_SYMBOL(__gnet_stats_copy_basic);

  /**
   * gnet_stats_copy_basic - copy basic statistics into statistic TLV

   * @running: seqcount_t pointer

   * @d: dumping handle

   * @cpu: copy statistic per cpu

   * @b: basic statistics
   *
   * Appends the basic statistics to the top level TLV created by
   * gnet_stats_start_copy().
   *
   * Returns 0 on success or -1 with the statistic lock released
   * if the room in the socket buffer was not sufficient.
   */
  int

  gnet_stats_copy_basic(const seqcount_t *running,
  		      struct gnet_dump *d,

  		      struct gnet_stats_basic_cpu __percpu *cpu,
  		      struct gnet_stats_basic_packed *b)

  {

  	struct gnet_stats_basic_packed bstats = {0};

  	__gnet_stats_copy_basic(running, &bstats, cpu, b);

  	if (d->compat_tc_stats) {

  		d->tc_stats.bytes = bstats.bytes;
  		d->tc_stats.packets = bstats.packets;

  	}

  	if (d->tail) {
  		struct gnet_stats_basic sb;

  		memset(&sb, 0, sizeof(sb));

  		sb.bytes = bstats.bytes;
  		sb.packets = bstats.packets;

  		return gnet_stats_copy(d, TCA_STATS_BASIC, &sb, sizeof(sb),
  				       TCA_STATS_PAD);

  	}

  	return 0;
  }

  EXPORT_SYMBOL(gnet_stats_copy_basic);

  
  /**
   * gnet_stats_copy_rate_est - copy rate estimator statistics into statistics TLV
   * @d: dumping handle

   * @rate_est: rate estimator

   *
   * Appends the rate estimator statistics to the top level TLV created by
   * gnet_stats_start_copy().
   *
   * Returns 0 on success or -1 with the statistic lock released
   * if the room in the socket buffer was not sufficient.
   */
  int

  gnet_stats_copy_rate_est(struct gnet_dump *d,

  			 struct net_rate_estimator __rcu **rate_est)

  {

  	struct gnet_stats_rate_est64 sample;

  	struct gnet_stats_rate_est est;
  	int res;

  	if (!gen_estimator_read(rate_est, &sample))

  		return 0;

  	est.bps = min_t(u64, UINT_MAX, sample.bps);

  	/* we have some time before reaching 2^32 packets per second */

  	est.pps = sample.pps;

  	if (d->compat_tc_stats) {

  		d->tc_stats.bps = est.bps;
  		d->tc_stats.pps = est.pps;

  	}

  	if (d->tail) {

  		res = gnet_stats_copy(d, TCA_STATS_RATE_EST, &est, sizeof(est),
  				      TCA_STATS_PAD);

  		if (res < 0 || est.bps == sample.bps)

  			return res;
  		/* emit 64bit stats only if needed */

  		return gnet_stats_copy(d, TCA_STATS_RATE_EST64, &sample,
  				       sizeof(sample), TCA_STATS_PAD);

  	}

  
  	return 0;
  }

  EXPORT_SYMBOL(gnet_stats_copy_rate_est);

  static void
  __gnet_stats_copy_queue_cpu(struct gnet_stats_queue *qstats,
  			    const struct gnet_stats_queue __percpu *q)
  {
  	int i;
  
  	for_each_possible_cpu(i) {
  		const struct gnet_stats_queue *qcpu = per_cpu_ptr(q, i);
  
  		qstats->qlen = 0;
  		qstats->backlog += qcpu->backlog;
  		qstats->drops += qcpu->drops;
  		qstats->requeues += qcpu->requeues;
  		qstats->overlimits += qcpu->overlimits;
  	}
  }
  
  static void __gnet_stats_copy_queue(struct gnet_stats_queue *qstats,
  				    const struct gnet_stats_queue __percpu *cpu,
  				    const struct gnet_stats_queue *q,
  				    __u32 qlen)
  {
  	if (cpu) {
  		__gnet_stats_copy_queue_cpu(qstats, cpu);
  	} else {
  		qstats->qlen = q->qlen;
  		qstats->backlog = q->backlog;
  		qstats->drops = q->drops;
  		qstats->requeues = q->requeues;
  		qstats->overlimits = q->overlimits;
  	}
  
  	qstats->qlen = qlen;
  }

  /**
   * gnet_stats_copy_queue - copy queue statistics into statistics TLV
   * @d: dumping handle

   * @cpu_q: per cpu queue statistics

   * @q: queue statistics

   * @qlen: queue length statistics

   *
   * Appends the queue statistics to the top level TLV created by

   * gnet_stats_start_copy(). Using per cpu queue statistics if
   * they are available.

   *
   * Returns 0 on success or -1 with the statistic lock released
   * if the room in the socket buffer was not sufficient.
   */
  int

  gnet_stats_copy_queue(struct gnet_dump *d,

  		      struct gnet_stats_queue __percpu *cpu_q,

  		      struct gnet_stats_queue *q, __u32 qlen)

  {

  	struct gnet_stats_queue qstats = {0};
  
  	__gnet_stats_copy_queue(&qstats, cpu_q, q, qlen);

  	if (d->compat_tc_stats) {

  		d->tc_stats.drops = qstats.drops;
  		d->tc_stats.qlen = qstats.qlen;
  		d->tc_stats.backlog = qstats.backlog;
  		d->tc_stats.overlimits = qstats.overlimits;

  	}
  
  	if (d->tail)

  		return gnet_stats_copy(d, TCA_STATS_QUEUE,

  				       &qstats, sizeof(qstats),
  				       TCA_STATS_PAD);

  
  	return 0;
  }

  EXPORT_SYMBOL(gnet_stats_copy_queue);

  
  /**
   * gnet_stats_copy_app - copy application specific statistics into statistics TLV
   * @d: dumping handle
   * @st: application specific statistics data
   * @len: length of data
   *

   * Appends the application specific statistics to the top level TLV created by

   * gnet_stats_start_copy() and remembers the data for XSTATS if the dumping
   * handle is in backward compatibility mode.
   *
   * Returns 0 on success or -1 with the statistic lock released
   * if the room in the socket buffer was not sufficient.
   */
  int
  gnet_stats_copy_app(struct gnet_dump *d, void *st, int len)
  {
  	if (d->compat_xstats) {

  		d->xstats = kmemdup(st, len, GFP_ATOMIC);
  		if (!d->xstats)
  			goto err_out;

  		d->xstats_len = len;
  	}
  
  	if (d->tail)

  		return gnet_stats_copy(d, TCA_STATS_APP, st, len,
  				       TCA_STATS_PAD);

  
  	return 0;

  
  err_out:

  	if (d->lock)
  		spin_unlock_bh(d->lock);

  	d->xstats_len = 0;

  	return -1;

  }

  EXPORT_SYMBOL(gnet_stats_copy_app);

  
  /**
   * gnet_stats_finish_copy - finish dumping procedure
   * @d: dumping handle
   *
   * Corrects the length of the top level TLV to include all TLVs added
   * by gnet_stats_copy_XXX() calls. Adds the backward compatibility TLVs
   * if gnet_stats_start_copy_compat() was used and releases the statistics
   * lock.
   *
   * Returns 0 on success or -1 with the statistic lock released
   * if the room in the socket buffer was not sufficient.
   */
  int
  gnet_stats_finish_copy(struct gnet_dump *d)
  {
  	if (d->tail)

  		d->tail->nla_len = skb_tail_pointer(d->skb) - (u8 *)d->tail;

  
  	if (d->compat_tc_stats)
  		if (gnet_stats_copy(d, d->compat_tc_stats, &d->tc_stats,

  				    sizeof(d->tc_stats), d->padattr) < 0)

  			return -1;
  
  	if (d->compat_xstats && d->xstats) {
  		if (gnet_stats_copy(d, d->compat_xstats, d->xstats,

  				    d->xstats_len, d->padattr) < 0)

  			return -1;
  	}

  	if (d->lock)
  		spin_unlock_bh(d->lock);

  	kfree(d->xstats);
  	d->xstats = NULL;
  	d->xstats_len = 0;

  	return 0;
  }

  EXPORT_SYMBOL(gnet_stats_finish_copy);