Quelle  adf_gen4_pfvf.c   Sprache: C

// SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0-only)
/* Copyright(c) 2021 Intel Corporation */
#include <linux/iopoll.h>
#include <linux/mutex.h>
#include <linux/types.h>
#include "adf_accel_devices.h"
#include "adf_common_drv.h"
#include "adf_gen4_pfvf.h"
#include "adf_gen4_hw_data.h"
#include "adf_pfvf_pf_proto.h"
#include "adf_pfvf_utils.h"

/* VF2PF interrupt source registers */
#define ADF_4XXX_VM2PF_SOU  0x41A180
#define ADF_4XXX_VM2PF_MSK  0x41A1C0
#define ADF_GEN4_VF_MSK   0xFFFF

#define ADF_PFVF_GEN4_MSGTYPE_SHIFT 2
#define ADF_PFVF_GEN4_MSGTYPE_MASK 0x3F
#define ADF_PFVF_GEN4_MSGDATA_SHIFT 8
#define ADF_PFVF_GEN4_MSGDATA_MASK 0xFFFFFF

static const struct pfvf_csr_format csr_gen4_fmt = {
 { ADF_PFVF_GEN4_MSGTYPE_SHIFT, ADF_PFVF_GEN4_MSGTYPE_MASK },
 { ADF_PFVF_GEN4_MSGDATA_SHIFT, ADF_PFVF_GEN4_MSGDATA_MASK },
};

static u32 adf_gen4_pf_get_pf2vf_offset(u32 i)
{
 return ADF_GEN4_PF2VM_OFFSET(i);
}

static u32 adf_gen4_pf_get_vf2pf_offset(u32 i)
{
 return ADF_GEN4_VM2PF_OFFSET(i);
}

static void adf_gen4_enable_vf2pf_interrupts(void __iomem *pmisc_addr, u32 vf_mask)
{
 u32 val;

 val = ADF_CSR_RD(pmisc_addr, ADF_4XXX_VM2PF_MSK) & ~vf_mask;
 ADF_CSR_WR(pmisc_addr, ADF_4XXX_VM2PF_MSK, val);
}

static void adf_gen4_disable_all_vf2pf_interrupts(void __iomem *pmisc_addr)
{
 ADF_CSR_WR(pmisc_addr, ADF_4XXX_VM2PF_MSK, ADF_GEN4_VF_MSK);
}

static u32 adf_gen4_disable_pending_vf2pf_interrupts(void __iomem *pmisc_addr)
{
 u32 sources, disabled, pending;

 /* Get the interrupt sources triggered by VFs */
 sources = ADF_CSR_RD(pmisc_addr, ADF_4XXX_VM2PF_SOU);
 if (!sources)
  return 0;

 /* Get the already disabled interrupts */
 disabled = ADF_CSR_RD(pmisc_addr, ADF_4XXX_VM2PF_MSK);

 pending = sources & ~disabled;
 if (!pending)
  return 0;

 /* Due to HW limitations, when disabling the interrupts, we can't
 * just disable the requested sources, as this would lead to missed
 * interrupts if VM2PF_SOU changes just before writing to VM2PF_MSK.
 * To work around it, disable all and re-enable only the sources that
 * are not in vf_mask and were not already disabled. Re-enabling will
 * trigger a new interrupt for the sources that have changed in the
 * meantime, if any.
 */
 ADF_CSR_WR(pmisc_addr, ADF_4XXX_VM2PF_MSK, ADF_GEN4_VF_MSK);
 ADF_CSR_WR(pmisc_addr, ADF_4XXX_VM2PF_MSK, disabled | sources);

 /* Return the sources of the (new) interrupt(s) */
 return pending;
}

static int adf_gen4_pfvf_send(struct adf_accel_dev *accel_dev,
         struct pfvf_message msg, u32 pfvf_offset,
         struct mutex *csr_lock)
{
 void __iomem *pmisc_addr = adf_get_pmisc_base(accel_dev);
 u32 csr_val;
 int ret;

 csr_val = adf_pfvf_csr_msg_of(accel_dev, msg, &csr_gen4_fmt);
 if (unlikely(!csr_val))
  return -EINVAL;

 mutex_lock(csr_lock);

 ADF_CSR_WR(pmisc_addr, pfvf_offset, csr_val | ADF_PFVF_INT);

 /* Wait for confirmation from remote that it received the message */
 ret = read_poll_timeout(ADF_CSR_RD, csr_val, !(csr_val & ADF_PFVF_INT),
    ADF_PFVF_MSG_ACK_DELAY_US,
    ADF_PFVF_MSG_ACK_MAX_DELAY_US,
    true, pmisc_addr, pfvf_offset);
 if (ret < 0)
  dev_dbg(&GET_DEV(accel_dev), "ACK not received from remote\n");

 mutex_unlock(csr_lock);
 return ret;
}

static struct pfvf_message adf_gen4_pfvf_recv(struct adf_accel_dev *accel_dev,
           u32 pfvf_offset, u8 compat_ver)
{
 void __iomem *pmisc_addr = adf_get_pmisc_base(accel_dev);
 struct pfvf_message msg = { 0 };
 u32 csr_val;

 /* Read message from the CSR */
 csr_val = ADF_CSR_RD(pmisc_addr, pfvf_offset);
 if (!(csr_val & ADF_PFVF_INT)) {
  dev_info(&GET_DEV(accel_dev),
    "Spurious PFVF interrupt, msg 0x%.8x. Ignored\n", csr_val);
  return msg;
 }

 /* We can now acknowledge the message reception by clearing the
 * interrupt bit
 */
 ADF_CSR_WR(pmisc_addr, pfvf_offset, csr_val & ~ADF_PFVF_INT);

 /* Return the pfvf_message format */
 return adf_pfvf_message_of(accel_dev, csr_val, &csr_gen4_fmt);
}

void adf_gen4_init_pf_pfvf_ops(struct adf_pfvf_ops *pfvf_ops)
{
 pfvf_ops->enable_comms = adf_enable_pf2vf_comms;
 pfvf_ops->get_pf2vf_offset = adf_gen4_pf_get_pf2vf_offset;
 pfvf_ops->get_vf2pf_offset = adf_gen4_pf_get_vf2pf_offset;
 pfvf_ops->enable_vf2pf_interrupts = adf_gen4_enable_vf2pf_interrupts;
 pfvf_ops->disable_all_vf2pf_interrupts = adf_gen4_disable_all_vf2pf_interrupts;
 pfvf_ops->disable_pending_vf2pf_interrupts = adf_gen4_disable_pending_vf2pf_interrupts;
 pfvf_ops->send_msg = adf_gen4_pfvf_send;
 pfvf_ops->recv_msg = adf_gen4_pfvf_recv;
}
EXPORT_SYMBOL_GPL(adf_gen4_init_pf_pfvf_ops);