/*
 * Copyright (c) 2009-2016 Solarflare Communications Inc.
 * 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 COPYRIGHT HOLDERS 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 COPYRIGHT OWNER 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.
 *
 * The views and conclusions contained in the software and documentation are
 * those of the authors and should not be interpreted as representing official
 * policies, either expressed or implied, of the FreeBSD Project.
 */

#include <sys/types.h>
#include <sys/kmem.h>
#include "sfxge.h"


static int
sfxge_vpd_get_keyword(sfxge_t *sp, sfxge_vpd_ioc_t *svip)
{
        efx_nic_t *enp = sp->s_enp;
        efx_vpd_value_t vpd;
        size_t size;
        void *buf;
        int rc;

        if ((rc = efx_vpd_size(enp, &size)) != 0)
                goto fail1;

        buf = kmem_zalloc(size, KM_NOSLEEP);
        if (buf == NULL) {
                rc = ENOMEM;
                goto fail1;
        }

        if ((rc = efx_vpd_read(enp, buf, size)) != 0)
                goto fail2;

        if ((rc = efx_vpd_verify(enp, buf, size)) != 0)
                goto fail3;

        vpd.evv_tag = svip->svi_tag;
        vpd.evv_keyword = svip->svi_keyword;

        if ((rc = efx_vpd_get(enp, buf, size, &vpd)) != 0)
                goto fail4;

        svip->svi_len = vpd.evv_length;
        EFX_STATIC_ASSERT(sizeof (svip->svi_payload) == sizeof (vpd.evv_value));
        bcopy(&vpd.evv_value[0], svip->svi_payload, sizeof (svip->svi_payload));

        kmem_free(buf, size);

        return (0);

fail4:
        DTRACE_PROBE(fail4);
fail3:
        DTRACE_PROBE(fail3);
fail2:
        DTRACE_PROBE(fail2);
        kmem_free(buf, size);
fail1:
        DTRACE_PROBE1(fail1, int, rc);

        return (rc);
}


static int
sfxge_vpd_set_keyword(sfxge_t *sp, sfxge_vpd_ioc_t *svip)
{
        efx_nic_t *enp = sp->s_enp;
        efx_vpd_value_t vpd;
        size_t size;
        void *buf;
        int rc;

        /* restriction on writable tags is in efx_vpd_hunk_set() */

        if ((rc = efx_vpd_size(enp, &size)) != 0)
                goto fail1;

        buf = kmem_zalloc(size, KM_NOSLEEP);
        if (buf == NULL) {
                rc = ENOMEM;
                goto fail1;
        }

        if ((rc = efx_vpd_read(enp, buf, size)) != 0)
                goto fail2;

        if ((rc = efx_vpd_verify(enp, buf, size)) != 0) {
                if ((rc = efx_vpd_reinit(enp, buf, size)) != 0)
                        goto fail3;
                if ((rc = efx_vpd_verify(enp, buf, size)) != 0)
                        goto fail4;
        }

        vpd.evv_tag = svip->svi_tag;
        vpd.evv_keyword = svip->svi_keyword;
        vpd.evv_length = svip->svi_len;

        EFX_STATIC_ASSERT(sizeof (svip->svi_payload) == sizeof (vpd.evv_value));
        bcopy(svip->svi_payload, &vpd.evv_value[0], sizeof (svip->svi_payload));

        if ((rc = efx_vpd_set(enp, buf, size, &vpd)) != 0)
                goto fail5;

        if ((rc = efx_vpd_verify(enp, buf, size)) != 0)
                        goto fail6;

        /* And write the VPD back to the hardware */
        if ((rc = efx_vpd_write(enp, buf, size)) != 0)
                goto fail7;

        kmem_free(buf, size);

        return (0);

fail7:
        DTRACE_PROBE(fail7);
fail6:
        DTRACE_PROBE(fail6);
fail5:
        DTRACE_PROBE(fail5);
fail4:
        DTRACE_PROBE(fail4);
fail3:
        DTRACE_PROBE(fail3);
fail2:
        DTRACE_PROBE(fail2);
        kmem_free(buf, size);
fail1:
        DTRACE_PROBE1(fail1, int, rc);

        return (rc);
}


int
sfxge_vpd_ioctl(sfxge_t *sp, sfxge_vpd_ioc_t *svip)
{
        int rc;

        switch (svip->svi_op) {
        case SFXGE_VPD_OP_GET_KEYWORD:
                if ((rc = sfxge_vpd_get_keyword(sp, svip)) != 0)
                        goto fail1;
                break;
        case SFXGE_VPD_OP_SET_KEYWORD:
                if ((rc = sfxge_vpd_set_keyword(sp, svip)) != 0)
                        goto fail1;
                break;
        default:
                rc = EINVAL;
                goto fail2;
        }

        return (0);

fail2:
        DTRACE_PROBE(fail2);
fail1:
        DTRACE_PROBE1(fail1, int, rc);

        return (rc);
}