/*      $NetBSD: ieee8023ad_lacp_debug.c,v 1.7 2021/11/30 01:17:02 yamaguchi Exp $      */

/*-
 * Copyright (c)2005 YAMAMOTO Takashi,
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ieee8023ad_lacp_debug.c,v 1.7 2021/11/30 01:17:02 yamaguchi Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/callout.h>

#include <net/if.h>
#include <net/if_ether.h>
#include <net/ether_slowprotocols.h>

#include <net/agr/ieee8023_tlv.h>
#include <net/agr/ieee8023ad_lacp.h>
#include <net/agr/ieee8023ad_lacp_impl.h>
#include <net/agr/ieee8023ad_lacp_debug.h>

#if defined(LACP_DEBUG)
int lacpdebug = 0;
#endif /* defined(LACP_DEBUG) */

const char *
lacp_format_mac(const uint8_t *mac, char *buf, size_t buflen)
{

        snprintf(buf, buflen, "%02X-%02X-%02X-%02X-%02X-%02X",
            (int)mac[0],
            (int)mac[1],
            (int)mac[2],
            (int)mac[3],
            (int)mac[4],
            (int)mac[5]);

        return buf;
}

const char *
lacp_format_systemid(const struct lacp_systemid *sysid,
    char *buf, size_t buflen)
{
        char macbuf[LACP_MACSTR_MAX+1];

        snprintf(buf, buflen, "%04X,%s",
            be16toh(sysid->lsi_prio),
            lacp_format_mac(sysid->lsi_mac, macbuf, sizeof(macbuf)));

        return buf;
}

const char *
lacp_format_portid(const struct lacp_portid *portid, char *buf, size_t buflen)
{

        snprintf(buf, buflen, "%04X,%04X",
            be16toh(portid->lpi_prio),
            be16toh(portid->lpi_portno));

        return buf;
}

const char *
lacp_format_partner(const struct lacp_peerinfo *peer, char *buf, size_t buflen)
{
        char sysid[LACP_SYSTEMIDSTR_MAX+1];
        char portid[LACP_PORTIDSTR_MAX+1];

        snprintf(buf, buflen, "(%s,%04X,%s)",
            lacp_format_systemid(&peer->lip_systemid, sysid, sizeof(sysid)),
            be16toh(peer->lip_key),
            lacp_format_portid(&peer->lip_portid, portid, sizeof(portid)));

        return buf;
}

const char *
lacp_format_lagid(const struct lacp_peerinfo *a,
    const struct lacp_peerinfo *b, char *buf, size_t buflen)
{
        char astr[LACP_PARTNERSTR_MAX+1];
        char bstr[LACP_PARTNERSTR_MAX+1];

#if 0
        /*
         * there's a convention to display small numbered peer
         * in the left.
         */

        if (lacp_compare_peerinfo(a, b) > 0) {
                const struct lacp_peerinfo *t;

                t = a;
                a = b;
                b = t;
        }
#endif

        snprintf(buf, buflen, "[%s,%s]",
            lacp_format_partner(a, astr, sizeof(astr)),
            lacp_format_partner(b, bstr, sizeof(bstr)));

        return buf;
}

const char *
lacp_format_lagid_aggregator(const struct lacp_aggregator *la,
    char *buf, size_t buflen)
{

        if (la == NULL) {
                return "(none)";
        }

        return lacp_format_lagid(&la->la_actor, &la->la_partner, buf, buflen);
}

const char *
lacp_format_state(uint8_t state, char *buf, size_t buflen)
{
        static const char lacp_state_bits[] = LACP_STATE_BITS;

        snprintb(buf, buflen, lacp_state_bits, state);

        return buf;
}

void
lacp_dump_lacpdu(const struct lacpdu *du)
{
        char buf[LACP_PARTNERSTR_MAX+1];
        char buf2[LACP_STATESTR_MAX+1];

        printf("actor=%s\n",
            lacp_format_partner(&du->ldu_actor, buf, sizeof(buf)));
        printf("actor.state=%s\n", 
            lacp_format_state(du->ldu_actor.lip_state, buf2, sizeof(buf2)));
        printf("partner=%s\n",
            lacp_format_partner(&du->ldu_partner, buf, sizeof(buf)));
        printf("partner.state=%s\n", 
            lacp_format_state(du->ldu_partner.lip_state, buf2, sizeof(buf2)));

        printf("maxdelay=%d\n", be16toh(du->ldu_collector.lci_maxdelay));
}

#if defined(LACP_DEBUG)
#include <net/agr/if_agrvar_impl.h>

void
lacp_dprintf(const struct lacp_port *lp, const char *fmt, ...)
{
        va_list va;

        if (lacpdebug == 0) {
                return;
        }

        if (lp) {
                printf("%s: ", lp->lp_agrport->port_ifp->if_xname);
        }

        va_start(va, fmt);
        vprintf(fmt, va);
        va_end(va);
}
#endif