144d362409d5469aed47d19e7908d19bd194493aThomas Graf/* 244d362409d5469aed47d19e7908d19bd194493aThomas Graf * lib/route/sch/fifo.c (p|b)fifo 344d362409d5469aed47d19e7908d19bd194493aThomas Graf * 444d362409d5469aed47d19e7908d19bd194493aThomas Graf * This library is free software; you can redistribute it and/or 544d362409d5469aed47d19e7908d19bd194493aThomas Graf * modify it under the terms of the GNU Lesser General Public 644d362409d5469aed47d19e7908d19bd194493aThomas Graf * License as published by the Free Software Foundation version 2.1 744d362409d5469aed47d19e7908d19bd194493aThomas Graf * of the License. 844d362409d5469aed47d19e7908d19bd194493aThomas Graf * 98a3efffa5b3fde252675239914118664d36a2c24Thomas Graf * Copyright (c) 2003-2008 Thomas Graf <tgraf@suug.ch> 1044d362409d5469aed47d19e7908d19bd194493aThomas Graf */ 1144d362409d5469aed47d19e7908d19bd194493aThomas Graf 1244d362409d5469aed47d19e7908d19bd194493aThomas Graf/** 1344d362409d5469aed47d19e7908d19bd194493aThomas Graf * @ingroup qdisc_api 1444d362409d5469aed47d19e7908d19bd194493aThomas Graf * @defgroup fifo Packet/Bytes FIFO (pfifo/bfifo) 1544d362409d5469aed47d19e7908d19bd194493aThomas Graf * @brief 1644d362409d5469aed47d19e7908d19bd194493aThomas Graf * 1744d362409d5469aed47d19e7908d19bd194493aThomas Graf * The FIFO qdisc comes in two flavours: 1844d362409d5469aed47d19e7908d19bd194493aThomas Graf * @par bfifo (Byte FIFO) 1944d362409d5469aed47d19e7908d19bd194493aThomas Graf * Allows enqueuing until the currently queued volume in bytes exceeds 2044d362409d5469aed47d19e7908d19bd194493aThomas Graf * the configured limit.backlog contains currently enqueued volume in bytes. 2144d362409d5469aed47d19e7908d19bd194493aThomas Graf * 2244d362409d5469aed47d19e7908d19bd194493aThomas Graf * @par pfifo (Packet FIFO) 2344d362409d5469aed47d19e7908d19bd194493aThomas Graf * Allows enquueing until the currently queued number of packets 2444d362409d5469aed47d19e7908d19bd194493aThomas Graf * exceeds the configured limit. 2544d362409d5469aed47d19e7908d19bd194493aThomas Graf * 2644d362409d5469aed47d19e7908d19bd194493aThomas Graf * The configuration is exactly the same, the decision which of 2744d362409d5469aed47d19e7908d19bd194493aThomas Graf * the two variations is going to be used is made based on the 2844d362409d5469aed47d19e7908d19bd194493aThomas Graf * kind of the qdisc (rtnl_qdisc_set_kind()). 2944d362409d5469aed47d19e7908d19bd194493aThomas Graf * @{ 3044d362409d5469aed47d19e7908d19bd194493aThomas Graf */ 3144d362409d5469aed47d19e7908d19bd194493aThomas Graf 3244d362409d5469aed47d19e7908d19bd194493aThomas Graf#include <netlink-local.h> 3344d362409d5469aed47d19e7908d19bd194493aThomas Graf#include <netlink-tc.h> 3444d362409d5469aed47d19e7908d19bd194493aThomas Graf#include <netlink/netlink.h> 3544d362409d5469aed47d19e7908d19bd194493aThomas Graf#include <netlink/route/qdisc.h> 3644d362409d5469aed47d19e7908d19bd194493aThomas Graf#include <netlink/route/qdisc-modules.h> 3744d362409d5469aed47d19e7908d19bd194493aThomas Graf#include <netlink/route/sch/fifo.h> 3844d362409d5469aed47d19e7908d19bd194493aThomas Graf#include <netlink/utils.h> 3944d362409d5469aed47d19e7908d19bd194493aThomas Graf 4044d362409d5469aed47d19e7908d19bd194493aThomas Graf/** @cond SKIP */ 4144d362409d5469aed47d19e7908d19bd194493aThomas Graf#define SCH_FIFO_ATTR_LIMIT 1 4244d362409d5469aed47d19e7908d19bd194493aThomas Graf/** @endcond */ 4344d362409d5469aed47d19e7908d19bd194493aThomas Graf 4444d362409d5469aed47d19e7908d19bd194493aThomas Grafstatic inline struct rtnl_fifo *fifo_qdisc(struct rtnl_qdisc *qdisc) 4544d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 4644d362409d5469aed47d19e7908d19bd194493aThomas Graf return (struct rtnl_fifo *) qdisc->q_subdata; 4744d362409d5469aed47d19e7908d19bd194493aThomas Graf} 4844d362409d5469aed47d19e7908d19bd194493aThomas Graf 4944d362409d5469aed47d19e7908d19bd194493aThomas Grafstatic inline struct rtnl_fifo *fifo_alloc(struct rtnl_qdisc *qdisc) 5044d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 5144d362409d5469aed47d19e7908d19bd194493aThomas Graf if (!qdisc->q_subdata) 5244d362409d5469aed47d19e7908d19bd194493aThomas Graf qdisc->q_subdata = calloc(1, sizeof(struct rtnl_fifo)); 5344d362409d5469aed47d19e7908d19bd194493aThomas Graf 5444d362409d5469aed47d19e7908d19bd194493aThomas Graf return fifo_qdisc(qdisc); 5544d362409d5469aed47d19e7908d19bd194493aThomas Graf} 5644d362409d5469aed47d19e7908d19bd194493aThomas Graf 5744d362409d5469aed47d19e7908d19bd194493aThomas Grafstatic int fifo_msg_parser(struct rtnl_qdisc *qdisc) 5844d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 5944d362409d5469aed47d19e7908d19bd194493aThomas Graf struct rtnl_fifo *fifo; 6044d362409d5469aed47d19e7908d19bd194493aThomas Graf struct tc_fifo_qopt *opt; 6144d362409d5469aed47d19e7908d19bd194493aThomas Graf 6244d362409d5469aed47d19e7908d19bd194493aThomas Graf if (qdisc->q_opts->d_size < sizeof(struct tc_fifo_qopt)) 638a3efffa5b3fde252675239914118664d36a2c24Thomas Graf return -NLE_INVAL; 6444d362409d5469aed47d19e7908d19bd194493aThomas Graf 6544d362409d5469aed47d19e7908d19bd194493aThomas Graf fifo = fifo_alloc(qdisc); 6644d362409d5469aed47d19e7908d19bd194493aThomas Graf if (!fifo) 678a3efffa5b3fde252675239914118664d36a2c24Thomas Graf return -NLE_NOMEM; 6844d362409d5469aed47d19e7908d19bd194493aThomas Graf 6944d362409d5469aed47d19e7908d19bd194493aThomas Graf opt = (struct tc_fifo_qopt *) qdisc->q_opts->d_data; 7044d362409d5469aed47d19e7908d19bd194493aThomas Graf fifo->qf_limit = opt->limit; 7144d362409d5469aed47d19e7908d19bd194493aThomas Graf fifo->qf_mask = SCH_FIFO_ATTR_LIMIT; 7244d362409d5469aed47d19e7908d19bd194493aThomas Graf 7344d362409d5469aed47d19e7908d19bd194493aThomas Graf return 0; 7444d362409d5469aed47d19e7908d19bd194493aThomas Graf} 7544d362409d5469aed47d19e7908d19bd194493aThomas Graf 7644d362409d5469aed47d19e7908d19bd194493aThomas Grafstatic void fifo_free_data(struct rtnl_qdisc *qdisc) 7744d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 7844d362409d5469aed47d19e7908d19bd194493aThomas Graf free(qdisc->q_subdata); 7944d362409d5469aed47d19e7908d19bd194493aThomas Graf} 8044d362409d5469aed47d19e7908d19bd194493aThomas Graf 81d84430702496f617c01c5e2d27d0e82e02390bb7Thomas Grafstatic void pfifo_dump_line(struct rtnl_qdisc *qdisc, struct nl_dump_params *p) 8244d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 8344d362409d5469aed47d19e7908d19bd194493aThomas Graf struct rtnl_fifo *fifo = fifo_qdisc(qdisc); 8444d362409d5469aed47d19e7908d19bd194493aThomas Graf 8544d362409d5469aed47d19e7908d19bd194493aThomas Graf if (fifo) 86d84430702496f617c01c5e2d27d0e82e02390bb7Thomas Graf nl_dump(p, " limit %u packets", fifo->qf_limit); 8744d362409d5469aed47d19e7908d19bd194493aThomas Graf} 8844d362409d5469aed47d19e7908d19bd194493aThomas Graf 89d84430702496f617c01c5e2d27d0e82e02390bb7Thomas Grafstatic void bfifo_dump_line(struct rtnl_qdisc *qdisc, struct nl_dump_params *p) 9044d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 9144d362409d5469aed47d19e7908d19bd194493aThomas Graf struct rtnl_fifo *fifo = fifo_qdisc(qdisc); 9244d362409d5469aed47d19e7908d19bd194493aThomas Graf 9344d362409d5469aed47d19e7908d19bd194493aThomas Graf if (fifo) { 9444d362409d5469aed47d19e7908d19bd194493aThomas Graf char *unit; 9544d362409d5469aed47d19e7908d19bd194493aThomas Graf double r; 9644d362409d5469aed47d19e7908d19bd194493aThomas Graf 9744d362409d5469aed47d19e7908d19bd194493aThomas Graf r = nl_cancel_down_bytes(fifo->qf_limit, &unit); 98d84430702496f617c01c5e2d27d0e82e02390bb7Thomas Graf nl_dump(p, " limit %.1f%s", r, unit); 9944d362409d5469aed47d19e7908d19bd194493aThomas Graf } 10044d362409d5469aed47d19e7908d19bd194493aThomas Graf} 10144d362409d5469aed47d19e7908d19bd194493aThomas Graf 10244d362409d5469aed47d19e7908d19bd194493aThomas Grafstatic struct nl_msg *fifo_get_opts(struct rtnl_qdisc *qdisc) 10344d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 10444d362409d5469aed47d19e7908d19bd194493aThomas Graf struct rtnl_fifo *fifo; 10544d362409d5469aed47d19e7908d19bd194493aThomas Graf struct tc_fifo_qopt opts; 10644d362409d5469aed47d19e7908d19bd194493aThomas Graf struct nl_msg *msg; 10744d362409d5469aed47d19e7908d19bd194493aThomas Graf 10844d362409d5469aed47d19e7908d19bd194493aThomas Graf fifo = fifo_qdisc(qdisc); 10944d362409d5469aed47d19e7908d19bd194493aThomas Graf if (!fifo || !(fifo->qf_mask & SCH_FIFO_ATTR_LIMIT)) 11044d362409d5469aed47d19e7908d19bd194493aThomas Graf return NULL; 11144d362409d5469aed47d19e7908d19bd194493aThomas Graf 11244d362409d5469aed47d19e7908d19bd194493aThomas Graf msg = nlmsg_alloc(); 11344d362409d5469aed47d19e7908d19bd194493aThomas Graf if (!msg) 11444d362409d5469aed47d19e7908d19bd194493aThomas Graf goto errout; 11544d362409d5469aed47d19e7908d19bd194493aThomas Graf 11644d362409d5469aed47d19e7908d19bd194493aThomas Graf memset(&opts, 0, sizeof(opts)); 11744d362409d5469aed47d19e7908d19bd194493aThomas Graf opts.limit = fifo->qf_limit; 11844d362409d5469aed47d19e7908d19bd194493aThomas Graf 11944d362409d5469aed47d19e7908d19bd194493aThomas Graf if (nlmsg_append(msg, &opts, sizeof(opts), NL_DONTPAD) < 0) 12044d362409d5469aed47d19e7908d19bd194493aThomas Graf goto errout; 12144d362409d5469aed47d19e7908d19bd194493aThomas Graf 12244d362409d5469aed47d19e7908d19bd194493aThomas Graf return msg; 12344d362409d5469aed47d19e7908d19bd194493aThomas Graferrout: 12444d362409d5469aed47d19e7908d19bd194493aThomas Graf nlmsg_free(msg); 12544d362409d5469aed47d19e7908d19bd194493aThomas Graf return NULL; 12644d362409d5469aed47d19e7908d19bd194493aThomas Graf} 12744d362409d5469aed47d19e7908d19bd194493aThomas Graf 12844d362409d5469aed47d19e7908d19bd194493aThomas Graf/** 12944d362409d5469aed47d19e7908d19bd194493aThomas Graf * @name Attribute Modification 13044d362409d5469aed47d19e7908d19bd194493aThomas Graf * @{ 13144d362409d5469aed47d19e7908d19bd194493aThomas Graf */ 13244d362409d5469aed47d19e7908d19bd194493aThomas Graf 13344d362409d5469aed47d19e7908d19bd194493aThomas Graf/** 13444d362409d5469aed47d19e7908d19bd194493aThomas Graf * Set limit of FIFO qdisc. 13544d362409d5469aed47d19e7908d19bd194493aThomas Graf * @arg qdisc FIFO qdisc to be modified. 13644d362409d5469aed47d19e7908d19bd194493aThomas Graf * @arg limit New limit. 13744d362409d5469aed47d19e7908d19bd194493aThomas Graf * @return 0 on success or a negative error code. 13844d362409d5469aed47d19e7908d19bd194493aThomas Graf */ 13944d362409d5469aed47d19e7908d19bd194493aThomas Grafint rtnl_qdisc_fifo_set_limit(struct rtnl_qdisc *qdisc, int limit) 14044d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 14144d362409d5469aed47d19e7908d19bd194493aThomas Graf struct rtnl_fifo *fifo; 14244d362409d5469aed47d19e7908d19bd194493aThomas Graf 14344d362409d5469aed47d19e7908d19bd194493aThomas Graf fifo = fifo_alloc(qdisc); 14444d362409d5469aed47d19e7908d19bd194493aThomas Graf if (!fifo) 1458a3efffa5b3fde252675239914118664d36a2c24Thomas Graf return -NLE_NOMEM; 14644d362409d5469aed47d19e7908d19bd194493aThomas Graf 14744d362409d5469aed47d19e7908d19bd194493aThomas Graf fifo->qf_limit = limit; 14844d362409d5469aed47d19e7908d19bd194493aThomas Graf fifo->qf_mask |= SCH_FIFO_ATTR_LIMIT; 14944d362409d5469aed47d19e7908d19bd194493aThomas Graf 15044d362409d5469aed47d19e7908d19bd194493aThomas Graf return 0; 15144d362409d5469aed47d19e7908d19bd194493aThomas Graf} 15244d362409d5469aed47d19e7908d19bd194493aThomas Graf 15344d362409d5469aed47d19e7908d19bd194493aThomas Graf/** 15444d362409d5469aed47d19e7908d19bd194493aThomas Graf * Get limit of a FIFO qdisc. 15544d362409d5469aed47d19e7908d19bd194493aThomas Graf * @arg qdisc FIFO qdisc. 15644d362409d5469aed47d19e7908d19bd194493aThomas Graf * @return Numeric limit or a negative error code. 15744d362409d5469aed47d19e7908d19bd194493aThomas Graf */ 15844d362409d5469aed47d19e7908d19bd194493aThomas Grafint rtnl_qdisc_fifo_get_limit(struct rtnl_qdisc *qdisc) 15944d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 16044d362409d5469aed47d19e7908d19bd194493aThomas Graf struct rtnl_fifo *fifo; 16144d362409d5469aed47d19e7908d19bd194493aThomas Graf 16244d362409d5469aed47d19e7908d19bd194493aThomas Graf fifo = fifo_qdisc(qdisc); 16344d362409d5469aed47d19e7908d19bd194493aThomas Graf if (fifo && fifo->qf_mask & SCH_FIFO_ATTR_LIMIT) 16444d362409d5469aed47d19e7908d19bd194493aThomas Graf return fifo->qf_limit; 16544d362409d5469aed47d19e7908d19bd194493aThomas Graf else 1668a3efffa5b3fde252675239914118664d36a2c24Thomas Graf return -NLE_NOATTR; 16744d362409d5469aed47d19e7908d19bd194493aThomas Graf} 16844d362409d5469aed47d19e7908d19bd194493aThomas Graf 16944d362409d5469aed47d19e7908d19bd194493aThomas Graf/** @} */ 17044d362409d5469aed47d19e7908d19bd194493aThomas Graf 17144d362409d5469aed47d19e7908d19bd194493aThomas Grafstatic struct rtnl_qdisc_ops pfifo_ops = { 17244d362409d5469aed47d19e7908d19bd194493aThomas Graf .qo_kind = "pfifo", 17344d362409d5469aed47d19e7908d19bd194493aThomas Graf .qo_msg_parser = fifo_msg_parser, 17444d362409d5469aed47d19e7908d19bd194493aThomas Graf .qo_free_data = fifo_free_data, 175d84430702496f617c01c5e2d27d0e82e02390bb7Thomas Graf .qo_dump[NL_DUMP_LINE] = pfifo_dump_line, 17644d362409d5469aed47d19e7908d19bd194493aThomas Graf .qo_get_opts = fifo_get_opts, 17744d362409d5469aed47d19e7908d19bd194493aThomas Graf}; 17844d362409d5469aed47d19e7908d19bd194493aThomas Graf 17944d362409d5469aed47d19e7908d19bd194493aThomas Grafstatic struct rtnl_qdisc_ops bfifo_ops = { 18044d362409d5469aed47d19e7908d19bd194493aThomas Graf .qo_kind = "bfifo", 18144d362409d5469aed47d19e7908d19bd194493aThomas Graf .qo_msg_parser = fifo_msg_parser, 18244d362409d5469aed47d19e7908d19bd194493aThomas Graf .qo_free_data = fifo_free_data, 183d84430702496f617c01c5e2d27d0e82e02390bb7Thomas Graf .qo_dump[NL_DUMP_LINE] = bfifo_dump_line, 18444d362409d5469aed47d19e7908d19bd194493aThomas Graf .qo_get_opts = fifo_get_opts, 18544d362409d5469aed47d19e7908d19bd194493aThomas Graf}; 18644d362409d5469aed47d19e7908d19bd194493aThomas Graf 18744d362409d5469aed47d19e7908d19bd194493aThomas Grafstatic void __init fifo_init(void) 18844d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 18944d362409d5469aed47d19e7908d19bd194493aThomas Graf rtnl_qdisc_register(&pfifo_ops); 19044d362409d5469aed47d19e7908d19bd194493aThomas Graf rtnl_qdisc_register(&bfifo_ops); 19144d362409d5469aed47d19e7908d19bd194493aThomas Graf} 19244d362409d5469aed47d19e7908d19bd194493aThomas Graf 19344d362409d5469aed47d19e7908d19bd194493aThomas Grafstatic void __exit fifo_exit(void) 19444d362409d5469aed47d19e7908d19bd194493aThomas Graf{ 19544d362409d5469aed47d19e7908d19bd194493aThomas Graf rtnl_qdisc_unregister(&pfifo_ops); 19644d362409d5469aed47d19e7908d19bd194493aThomas Graf rtnl_qdisc_unregister(&bfifo_ops); 19744d362409d5469aed47d19e7908d19bd194493aThomas Graf} 19844d362409d5469aed47d19e7908d19bd194493aThomas Graf 19944d362409d5469aed47d19e7908d19bd194493aThomas Graf/** @} */ 200