PSP can support both SEV and TEE interface. Therefore, move
SEV specific registers to a dedicated data structure.
TEE interface specific registers will be added in a later
patch.

Signed-off-by: Rijo Thomas <rijo-john.tho...@amd.com>
Signed-off-by: Devaraj Rangasamy <devaraj.rangas...@amd.com>
---
 drivers/crypto/ccp/sev-dev.c | 17 ++++++++++++-----
 drivers/crypto/ccp/sev-dev.h |  2 ++
 drivers/crypto/ccp/sp-dev.h  |  6 +++++-
 drivers/crypto/ccp/sp-pci.c  | 16 ++++++++++++----
 4 files changed, 31 insertions(+), 10 deletions(-)

diff --git a/drivers/crypto/ccp/sev-dev.c b/drivers/crypto/ccp/sev-dev.c
index 7e5e7b2..f546f8d 100644
--- a/drivers/crypto/ccp/sev-dev.c
+++ b/drivers/crypto/ccp/sev-dev.c
@@ -65,7 +65,7 @@ static void sev_irq_handler(int irq, void *data, unsigned int 
status)
                return;

        /* Check if it is SEV command completion: */
-       reg = ioread32(sev->io_regs + sev->psp->vdata->cmdresp_reg);
+       reg = ioread32(sev->io_regs + sev->vdata->cmdresp_reg);
        if (reg & PSP_CMDRESP_RESP) {
                sev->int_rcvd = 1;
                wake_up(&sev->int_queue);
@@ -82,7 +82,7 @@ static int sev_wait_cmd_ioc(struct sev_device *sev,
        if (!ret)
                return -ETIMEDOUT;

-       *reg = ioread32(sev->io_regs + sev->psp->vdata->cmdresp_reg);
+       *reg = ioread32(sev->io_regs + sev->vdata->cmdresp_reg);

        return 0;
 }
@@ -148,15 +148,15 @@ static int __sev_do_cmd_locked(int cmd, void *data, int 
*psp_ret)
        print_hex_dump_debug("(in):  ", DUMP_PREFIX_OFFSET, 16, 2, data,
                             sev_cmd_buffer_len(cmd), false);

-       iowrite32(phys_lsb, sev->io_regs + psp->vdata->cmdbuff_addr_lo_reg);
-       iowrite32(phys_msb, sev->io_regs + psp->vdata->cmdbuff_addr_hi_reg);
+       iowrite32(phys_lsb, sev->io_regs + sev->vdata->cmdbuff_addr_lo_reg);
+       iowrite32(phys_msb, sev->io_regs + sev->vdata->cmdbuff_addr_hi_reg);

        sev->int_rcvd = 0;

        reg = cmd;
        reg <<= SEV_CMDRESP_CMD_SHIFT;
        reg |= SEV_CMDRESP_IOC;
-       iowrite32(reg, sev->io_regs + psp->vdata->cmdresp_reg);
+       iowrite32(reg, sev->io_regs + sev->vdata->cmdresp_reg);

        /* wait for command completion */
        ret = sev_wait_cmd_ioc(sev, &reg, psp_timeout);
@@ -934,6 +934,13 @@ int sev_dev_init(struct psp_device *psp)

        sev->io_regs = psp->io_regs;

+       sev->vdata = (struct sev_vdata *)psp->vdata->sev;
+       if (!sev->vdata) {
+               ret = -ENODEV;
+               dev_err(dev, "sev: missing driver data\n");
+               goto e_err;
+       }
+
        psp_set_sev_irq_handler(psp, sev_irq_handler, sev);

        ret = sev_misc_init(sev);
diff --git a/drivers/crypto/ccp/sev-dev.h b/drivers/crypto/ccp/sev-dev.h
index 20d51c9..55cae86 100644
--- a/drivers/crypto/ccp/sev-dev.h
+++ b/drivers/crypto/ccp/sev-dev.h
@@ -39,6 +39,8 @@ struct sev_device {

        void __iomem *io_regs;

+       struct sev_vdata *vdata;
+
        int state;
        unsigned int int_rcvd;
        wait_queue_head_t int_queue;
diff --git a/drivers/crypto/ccp/sp-dev.h b/drivers/crypto/ccp/sp-dev.h
index 53c1256..0394c75 100644
--- a/drivers/crypto/ccp/sp-dev.h
+++ b/drivers/crypto/ccp/sp-dev.h
@@ -39,10 +39,14 @@ struct ccp_vdata {
        const unsigned int rsamax;
 };

-struct psp_vdata {
+struct sev_vdata {
        const unsigned int cmdresp_reg;
        const unsigned int cmdbuff_addr_lo_reg;
        const unsigned int cmdbuff_addr_hi_reg;
+};
+
+struct psp_vdata {
+       const struct sev_vdata *sev;
        const unsigned int feature_reg;
        const unsigned int inten_reg;
        const unsigned int intsts_reg;
diff --git a/drivers/crypto/ccp/sp-pci.c b/drivers/crypto/ccp/sp-pci.c
index b29d2e6..733693d 100644
--- a/drivers/crypto/ccp/sp-pci.c
+++ b/drivers/crypto/ccp/sp-pci.c
@@ -262,19 +262,27 @@ static int sp_pci_resume(struct pci_dev *pdev)
 #endif

 #ifdef CONFIG_CRYPTO_DEV_SP_PSP
-static const struct psp_vdata pspv1 = {
+static const struct sev_vdata sevv1 = {
        .cmdresp_reg            = 0x10580,
        .cmdbuff_addr_lo_reg    = 0x105e0,
        .cmdbuff_addr_hi_reg    = 0x105e4,
+};
+
+static const struct sev_vdata sevv2 = {
+       .cmdresp_reg            = 0x10980,
+       .cmdbuff_addr_lo_reg    = 0x109e0,
+       .cmdbuff_addr_hi_reg    = 0x109e4,
+};
+
+static const struct psp_vdata pspv1 = {
+       .sev                    = &sevv1,
        .feature_reg            = 0x105fc,
        .inten_reg              = 0x10610,
        .intsts_reg             = 0x10614,
 };

 static const struct psp_vdata pspv2 = {
-       .cmdresp_reg            = 0x10980,
-       .cmdbuff_addr_lo_reg    = 0x109e0,
-       .cmdbuff_addr_hi_reg    = 0x109e4,
+       .sev                    = &sevv2,
        .feature_reg            = 0x109fc,
        .inten_reg              = 0x10690,
        .intsts_reg             = 0x10694,
--
1.9.1

Reply via email to