Add the isp driver in amdgpu to support ISP device on the APUs that
supports ISP IP block. ISP hw block is used for camera front-end, pre
and post processing operations.

Signed-off-by: Pratap Nirujogi <pratap.niruj...@amd.com>
---
 drivers/gpu/drm/amd/amdgpu/Makefile       |   3 +
 drivers/gpu/drm/amd/amdgpu/amdgpu.h       |   4 +
 drivers/gpu/drm/amd/amdgpu/amdgpu_isp.c   | 298 ++++++++++++++++++++++
 drivers/gpu/drm/amd/amdgpu/amdgpu_isp.h   |  54 ++++
 drivers/gpu/drm/amd/amdgpu/amdgpu_psp.c   |   3 +
 drivers/gpu/drm/amd/amdgpu/amdgpu_ucode.c |   5 +
 drivers/gpu/drm/amd/amdgpu/amdgpu_ucode.h |   1 +
 7 files changed, 368 insertions(+)
 create mode 100644 drivers/gpu/drm/amd/amdgpu/amdgpu_isp.c
 create mode 100644 drivers/gpu/drm/amd/amdgpu/amdgpu_isp.h

diff --git a/drivers/gpu/drm/amd/amdgpu/Makefile 
b/drivers/gpu/drm/amd/amdgpu/Makefile
index de7b76327f5b..12ba76025cb7 100644
--- a/drivers/gpu/drm/amd/amdgpu/Makefile
+++ b/drivers/gpu/drm/amd/amdgpu/Makefile
@@ -324,4 +324,7 @@ amdgpu-y += $(AMD_DISPLAY_FILES)
 
 endif
 
+# add isp block
+amdgpu-y += amdgpu_isp.o
+
 obj-$(CONFIG_DRM_AMDGPU)+= amdgpu.o
diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu.h 
b/drivers/gpu/drm/amd/amdgpu/amdgpu.h
index eb60d28a3a13..6d7f9ef53269 100644
--- a/drivers/gpu/drm/amd/amdgpu/amdgpu.h
+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu.h
@@ -112,6 +112,7 @@
 #include "amdgpu_xcp.h"
 #include "amdgpu_seq64.h"
 #include "amdgpu_reg_state.h"
+#include "amdgpu_isp.h"
 
 #define MAX_GPU_INSTANCE               64
 
@@ -1045,6 +1046,9 @@ struct amdgpu_device {
        /* display related functionality */
        struct amdgpu_display_manager dm;
 
+       /* isp */
+       struct amdgpu_isp               isp;
+
        /* mes */
        bool                            enable_mes;
        bool                            enable_mes_kiq;
diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_isp.c 
b/drivers/gpu/drm/amd/amdgpu/amdgpu_isp.c
new file mode 100644
index 000000000000..dcc01a339a43
--- /dev/null
+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_isp.c
@@ -0,0 +1,298 @@
+/* SPDX-License-Identifier: MIT */
+/*
+ * Copyright (C) 2024 Advanced Micro Devices, Inc. All rights reserved.
+ * All Rights Reserved.
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a
+ * copy of this software and associated documentation files (the
+ * "Software"), to deal in the Software without restriction, including
+ * without limitation the rights to use, copy, modify, merge, publish,
+ * distribute, sub license, and/or sell copies of the Software, and to
+ * permit persons to whom the Software is furnished to do so, subject to
+ * the following conditions:
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
+ * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
+ * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
+ * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
+ * USE OR OTHER DEALINGS IN THE SOFTWARE.
+ *
+ * The above copyright notice and this permission notice (including the
+ * next paragraph) shall be included in all copies or substantial portions
+ * of the Software.
+ *
+ */
+
+#include <linux/irqdomain.h>
+#include <linux/pm_domain.h>
+#include <linux/platform_device.h>
+#include <sound/designware_i2s.h>
+#include <sound/pcm.h>
+#include <linux/acpi.h>
+#include <linux/firmware.h>
+
+#include "amdgpu_smu.h"
+#include "atom.h"
+#include "amdgpu_isp.h"
+#include "smu_internal.h"
+#include "smu_v11_5_ppsmc.h"
+#include "smu_v11_5_pmfw.h"
+
+#define mmDAGB0_WRCLI5_V4_1    0x6811C
+#define mmDAGB0_WRCLI9_V4_1    0x6812C
+#define mmDAGB0_WRCLI10_V4_1   0x68130
+#define mmDAGB0_WRCLI14_V4_1   0x68140
+#define mmDAGB0_WRCLI19_V4_1   0x68154
+#define mmDAGB0_WRCLI20_V4_1   0x68158
+
+static int isp_sw_init(void *handle)
+{
+       struct amdgpu_device *adev = (struct amdgpu_device *)handle;
+
+       pr_info("%s called adev %p\n", __func__, adev);
+
+       adev->isp.parent = adev->dev;
+
+       adev->isp.cgs_device = amdgpu_cgs_create_device(adev);
+       if (!adev->isp.cgs_device)
+               return -EINVAL;
+
+       return 0;
+}
+
+static int isp_sw_fini(void *handle)
+{
+       struct amdgpu_device *adev = (struct amdgpu_device *)handle;
+
+       pr_info("%s called adev %p\n", __func__, adev);
+
+       if (adev->isp.cgs_device)
+               amdgpu_cgs_destroy_device(adev->isp.cgs_device);
+
+       return 0;
+}
+
+/**
+ * isp_hw_init - start and test isp block
+ *
+ * @adev: amdgpu_device pointer
+ *
+ */
+static int isp_hw_init(void *handle)
+{
+       int r;
+       u64 isp_base;
+       struct amdgpu_device *adev = (struct amdgpu_device *)handle;
+
+       const struct amdgpu_ip_block *ip_block =
+               amdgpu_device_ip_get_ip_block(adev, AMD_IP_BLOCK_TYPE_ISP);
+
+       if (!ip_block)
+               return -EINVAL;
+
+       if (adev->rmmio_size == 0 || adev->rmmio_size < 0x5289)
+               return -EINVAL;
+
+       isp_base = adev->rmmio_base;
+
+       adev->isp.isp_cell = kcalloc(1, sizeof(struct mfd_cell), GFP_KERNEL);
+       if (!adev->isp.isp_cell) {
+               r = -ENOMEM;
+               DRM_ERROR("%s: isp mfd cell alloc failed\n", __func__);
+               goto failure;
+       }
+
+       adev->isp.isp_res = kcalloc(2, sizeof(struct resource), GFP_KERNEL);
+       if (!adev->isp.isp_res) {
+               r = -ENOMEM;
+               DRM_ERROR("%s: isp mfd res alloc failed\n", __func__);
+               goto failure;
+       }
+
+       adev->isp.isp_pdata = kzalloc(sizeof(*adev->isp.isp_pdata), GFP_KERNEL);
+       if (!adev->isp.isp_pdata) {
+               r = -ENOMEM;
+               DRM_ERROR("%s: isp platform data alloc failed\n", __func__);
+               goto failure;
+       }
+
+       // initialize isp platform data
+       adev->isp.isp_pdata->adev = (void *)adev;
+       adev->isp.isp_pdata->asic_type = adev->asic_type;
+       adev->isp.isp_pdata->base_rmmio_size = adev->rmmio_size;
+
+       adev->isp.isp_res[0].name = "isp41_reg";
+       adev->isp.isp_res[0].flags = IORESOURCE_MEM;
+       adev->isp.isp_res[0].start = isp_base;
+       adev->isp.isp_res[0].end = isp_base + ISP_REGS_OFFSET_END;
+
+       adev->isp.isp_res[1].name = "isp41_irq";
+       adev->isp.isp_res[1].flags = IORESOURCE_IRQ;
+       adev->isp.isp_res[1].start = amdgpu_irq_create_mapping(adev, 162);
+       adev->isp.isp_res[1].end = adev->isp.isp_res[1].start;
+
+       adev->isp.isp_cell[0].name = "amd_isp41_capture";
+       adev->isp.isp_cell[0].num_resources = 2;
+       adev->isp.isp_cell[0].resources = &adev->isp.isp_res[0];
+       adev->isp.isp_cell[0].platform_data = adev->isp.isp_pdata;
+       adev->isp.isp_cell[0].pdata_size = sizeof(struct isp_platform_data);
+
+       r = mfd_add_hotplug_devices(adev->isp.parent, adev->isp.isp_cell, 1);
+       if (r) {
+               DRM_ERROR("%s: add mfd hotplug device failed\n", __func__);
+               goto failure;
+       }
+
+       // Temporary WA added to disable MMHUB TLSi until the GART 
initialization
+       // is ready to support MMHUB TLSi and SAW for ISP HW to access GART 
memory
+       // using the TLSi path
+       cgs_write_register(adev->isp.cgs_device, mmDAGB0_WRCLI5_V4_1 >> 2, 
0xFE5FEAA8);
+       cgs_write_register(adev->isp.cgs_device, mmDAGB0_WRCLI9_V4_1 >> 2, 
0xFE5FEAA8);
+       cgs_write_register(adev->isp.cgs_device, mmDAGB0_WRCLI10_V4_1 >> 2, 
0xFE5FEAA8);
+       cgs_write_register(adev->isp.cgs_device, mmDAGB0_WRCLI14_V4_1 >> 2, 
0xFE5FEAA8);
+       cgs_write_register(adev->isp.cgs_device, mmDAGB0_WRCLI19_V4_1 >> 2, 
0xFE5FEAA8);
+       cgs_write_register(adev->isp.cgs_device, mmDAGB0_WRCLI20_V4_1 >> 2, 
0xFE5FEAA8);
+
+       return 0;
+
+failure:
+
+       kfree(adev->isp.isp_pdata);
+       kfree(adev->isp.isp_res);
+       kfree(adev->isp.isp_cell);
+
+       return r;
+}
+
+/**
+ * isp_hw_fini - stop the hardware block
+ *
+ * @adev: amdgpu_device pointer
+ *
+ */
+static int isp_hw_fini(void *handle)
+{
+       struct amdgpu_device *adev = (struct amdgpu_device *)handle;
+
+       // remove isp mfd device
+       mfd_remove_devices(adev->isp.parent);
+
+       kfree(adev->isp.isp_res);
+       kfree(adev->isp.isp_cell);
+       kfree(adev->isp.isp_pdata);
+
+       return 0;
+}
+
+static int isp_suspend(void *handle)
+{
+       return 0;
+}
+
+static int isp_resume(void *handle)
+{
+       return 0;
+}
+
+static int isp_load_fw_by_psp(struct amdgpu_device *adev)
+{
+       const struct common_firmware_header *hdr;
+       char ucode_prefix[30];
+       char fw_name[40];
+       int r = 0;
+
+       // get isp fw binary name and path
+       amdgpu_ucode_ip_version_decode(adev, ISP_HWIP, ucode_prefix,
+                                      sizeof(ucode_prefix));
+       snprintf(fw_name, sizeof(fw_name), "amdgpu/%s.bin", ucode_prefix);
+
+       // read isp fw
+       r = amdgpu_ucode_request(adev, &adev->isp.fw, fw_name);
+       if (r) {
+               DRM_ERROR("%s: failed to read isp fw %s\n", __func__, fw_name);
+               amdgpu_ucode_release(&adev->isp.fw);
+               return r;
+       }
+
+       hdr = (const struct common_firmware_header *)adev->isp.fw->data;
+
+       adev->firmware.ucode[AMDGPU_UCODE_ID_ISP].ucode_id =
+               AMDGPU_UCODE_ID_ISP;
+       adev->firmware.ucode[AMDGPU_UCODE_ID_ISP].fw = adev->isp.fw;
+
+       adev->firmware.fw_size +=
+               ALIGN(le32_to_cpu(hdr->ucode_size_bytes), PAGE_SIZE);
+
+       DRM_INFO("isp fw <%s> load success, (base_addr, size)=(%p,%d)\n", 
fw_name,
+                adev->isp.fw->data, (int)adev->isp.fw->size);
+
+       return r;
+}
+
+static int isp_early_init(void *handle)
+{
+       int ret = 0;
+       struct amdgpu_device *adev = (struct amdgpu_device *)handle;
+
+       ret = isp_load_fw_by_psp(adev);
+       if (ret) {
+               DRM_WARN("%s: isp fw load failed\n", __func__);
+               ret = 0;
+       }
+
+       return ret;
+}
+
+static bool isp_is_idle(void *handle)
+{
+       return true;
+}
+
+static int isp_wait_for_idle(void *handle)
+{
+       return 0;
+}
+
+static int isp_soft_reset(void *handle)
+{
+       return 0;
+}
+
+static int isp_set_clockgating_state(void *handle,
+                                    enum amd_clockgating_state state)
+{
+       return 0;
+}
+
+static int isp_set_powergating_state(void *handle,
+                                    enum amd_powergating_state state)
+{
+       return 0;
+}
+
+static const struct amd_ip_funcs isp_ip_funcs = {
+       .name = "isp_ip",
+       .early_init = isp_early_init,
+       .late_init = NULL,
+       .sw_init = isp_sw_init,
+       .sw_fini = isp_sw_fini,
+       .hw_init = isp_hw_init,
+       .hw_fini = isp_hw_fini,
+       .suspend = isp_suspend,
+       .resume = isp_resume,
+       .is_idle = isp_is_idle,
+       .wait_for_idle = isp_wait_for_idle,
+       .soft_reset = isp_soft_reset,
+       .set_clockgating_state = isp_set_clockgating_state,
+       .set_powergating_state = isp_set_powergating_state,
+};
+
+const struct amdgpu_ip_block_version isp_ip_block = {
+       .type = AMD_IP_BLOCK_TYPE_ISP,
+       .major = 4,
+       .minor = 1,
+       .rev = 0,
+       .funcs = &isp_ip_funcs,
+};
diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_isp.h 
b/drivers/gpu/drm/amd/amdgpu/amdgpu_isp.h
new file mode 100644
index 000000000000..2adcb4b4dc6e
--- /dev/null
+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_isp.h
@@ -0,0 +1,54 @@
+/* SPDX-License-Identifier: MIT */
+/*
+ * Copyright (C) 2024 Advanced Micro Devices, Inc. All rights reserved.
+ * All Rights Reserved.
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a
+ * copy of this software and associated documentation files (the
+ * "Software"), to deal in the Software without restriction, including
+ * without limitation the rights to use, copy, modify, merge, publish,
+ * distribute, sub license, and/or sell copies of the Software, and to
+ * permit persons to whom the Software is furnished to do so, subject to
+ * the following conditions:
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
+ * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
+ * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
+ * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
+ * USE OR OTHER DEALINGS IN THE SOFTWARE.
+ *
+ * The above copyright notice and this permission notice (including the
+ * next paragraph) shall be included in all copies or substantial portions
+ * of the Software.
+ *
+ */
+
+#ifndef __AMDGPU_ISP_H__
+#define __AMDGPU_ISP_H__
+
+#include <linux/mfd/core.h>
+#include <linux/mfd/core.h>
+
+#define ISP_REGS_OFFSET_END 0x629A4
+
+struct isp_platform_data {
+       void *adev;
+       u32 asic_type;
+       resource_size_t base_rmmio_size;
+};
+
+struct amdgpu_isp {
+       struct device *parent;
+       struct cgs_device *cgs_device;
+       struct mfd_cell *isp_cell;
+       struct resource *isp_res;
+       struct isp_platform_data *isp_pdata;
+       unsigned int harvest_config;
+       const struct firmware   *fw;
+};
+
+extern const struct amdgpu_ip_block_version isp_ip_block;
+
+#endif /* __AMDGPU_ISP_H__ */
diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_psp.c 
b/drivers/gpu/drm/amd/amdgpu/amdgpu_psp.c
index 37820dd03cab..b4bd943a7cc8 100644
--- a/drivers/gpu/drm/amd/amdgpu/amdgpu_psp.c
+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_psp.c
@@ -2539,6 +2539,9 @@ static int psp_get_fw_type(struct amdgpu_firmware_info 
*ucode,
        case AMDGPU_UCODE_ID_JPEG_RAM:
                *type = GFX_FW_TYPE_JPEG_RAM;
                break;
+       case AMDGPU_UCODE_ID_ISP:
+               *type = GFX_FW_TYPE_ISP;
+               break;
        case AMDGPU_UCODE_ID_MAXIMUM:
        default:
                return -EINVAL;
diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_ucode.c 
b/drivers/gpu/drm/amd/amdgpu/amdgpu_ucode.c
index 75ece8a2f96b..a9de78bb96e2 100644
--- a/drivers/gpu/drm/amd/amdgpu/amdgpu_ucode.c
+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_ucode.c
@@ -712,6 +712,8 @@ const char *amdgpu_ucode_name(enum AMDGPU_UCODE_ID ucode_id)
                return "RS64_MEC_P2_STACK";
        case AMDGPU_UCODE_ID_CP_RS64_MEC_P3_STACK:
                return "RS64_MEC_P3_STACK";
+       case AMDGPU_UCODE_ID_ISP:
+               return "ISP";
        default:
                return "UNKNOWN UCODE";
        }
@@ -1411,6 +1413,9 @@ void amdgpu_ucode_ip_version_decode(struct amdgpu_device 
*adev, int block_type,
        case VPE_HWIP:
                ip_name = "vpe";
                break;
+       case ISP_HWIP:
+               ip_name = "isp";
+               break;
        default:
                BUG();
        }
diff --git a/drivers/gpu/drm/amd/amdgpu/amdgpu_ucode.h 
b/drivers/gpu/drm/amd/amdgpu/amdgpu_ucode.h
index a3c04f711099..db745ab7b0c8 100644
--- a/drivers/gpu/drm/amd/amdgpu/amdgpu_ucode.h
+++ b/drivers/gpu/drm/amd/amdgpu/amdgpu_ucode.h
@@ -523,6 +523,7 @@ enum AMDGPU_UCODE_ID {
        AMDGPU_UCODE_ID_UMSCH_MM_CMD_BUFFER,
        AMDGPU_UCODE_ID_P2S_TABLE,
        AMDGPU_UCODE_ID_JPEG_RAM,
+       AMDGPU_UCODE_ID_ISP,
        AMDGPU_UCODE_ID_MAXIMUM,
 };
 
-- 
2.34.1

Reply via email to