msm: camera: icp: Trigger FW load/unload via debugfs

Based on compilation flag CONFIG_CAM_TEST_ICP_FW_DOWNLOAD, ICP
FW load/unload sequence can be verified. This change initializes
memory manager for load and de-initializes memmgr during unload.

To trigger FW download-
adb shell "echo "load" > /sys/kernel/debug/camera_icp/icp_fw_load_unload"

FW unload -
adb shell "echo "unload" > /sys/kernel/debug/camera_icp/icp_fw_load_unload"

CONFIG_CAM_TEST_FW_DOWNLOAD needs to be set only for testing
FW loading when camera server is not enabled.

The change also adds protection for repeated memmgr init/deinit calls.

CRs-Fixed: 3097781
Change-Id: Iceb5089793313b086b9d4fc3770a87860237e741
Signed-off-by: Karthik Anantha Ram <[email protected]>

drivers/cam_icp/icp_hw/icp_hw_mgr/cam_icp_hw_mgr.c

@@ -1920,6 +1920,42 @@ static int cam_icp_get_icp_fw_dump_lvl(void *data, u64 *val)
 DEFINE_SIMPLE_ATTRIBUTE(cam_icp_debug_fw_dump, cam_icp_get_icp_fw_dump_lvl,
 	cam_icp_set_icp_fw_dump_lvl, "%08llu");
 
+#ifdef CONFIG_CAM_TEST_ICP_FW_DOWNLOAD
+static ssize_t cam_icp_hw_mgr_fw_load_unload(
+	struct file *file, const char __user *ubuf,
+	size_t size, loff_t *loff_t)
+{
+	int rc = 0;
+	char input_buf[16];
+
+	if (copy_from_user(input_buf, ubuf, sizeof(input_buf)))
+		return -EFAULT;
+
+	if (strcmp(input_buf, "load\n") == 0) {
+		rc = cam_mem_mgr_init();
+		if (rc) {
+			CAM_ERR(CAM_ICP, "memmgr init failed rc: %d", rc);
+			goto end;
+		}
+		cam_icp_mgr_hw_open(&icp_hw_mgr, NULL);
+	} else if (strcmp(input_buf, "unload\n") == 0) {
+		cam_icp_mgr_hw_close(&icp_hw_mgr, NULL);
+		cam_mem_mgr_deinit();
+	} else {
+		CAM_WARN(CAM_ICP, "Invalid input: %s", input_buf);
+	}
+
+end:
+	return size;
+}
+
+static const struct file_operations cam_icp_hw_mgr_fw_load_options = {
+	.owner = THIS_MODULE,
+	.open  = simple_open,
+	.write = cam_icp_hw_mgr_fw_load_unload,
+};
+#endif
+
 static int cam_icp_hw_mgr_create_debugfs_entry(void)
 {
 	int rc = 0;
@@ -1957,6 +1993,12 @@ static int cam_icp_hw_mgr_create_debugfs_entry(void)
 
 	debugfs_create_bool("disable_ubwc_comp", 0644,
 		icp_hw_mgr.dentry, &icp_hw_mgr.disable_ubwc_comp);
+
+	#ifdef CONFIG_CAM_TEST_ICP_FW_DOWNLOAD
+		debugfs_create_file("icp_fw_load_unload", 0644,
+			icp_hw_mgr.dentry, NULL, &cam_icp_hw_mgr_fw_load_options);
+	#endif
+
 end:
 	/* Set default hang dump lvl */
 	icp_hw_mgr.icp_fw_dump_lvl = HFI_FW_DUMP_ON_FAILURE;

drivers/cam_req_mgr/cam_mem_mgr.c

@@ -191,6 +191,9 @@ int cam_mem_mgr_init(void)
 	int bitmap_size;
 	int rc = 0;
 
+	if (atomic_read(&cam_mem_mgr_state))
+		return 0;
+
 	memset(tbl.bufq, 0, sizeof(tbl.bufq));
 
 	if (cam_smmu_need_force_alloc_cached(&tbl.force_cache_allocs)) {
@@ -1316,6 +1319,9 @@ static int cam_mem_mgr_cleanup_table(void)
 
 void cam_mem_mgr_deinit(void)
 {
+	if (!atomic_read(&cam_mem_mgr_state))
+		return;
+
 	atomic_set(&cam_mem_mgr_state, CAM_MEM_MGR_UNINITIALIZED);
 	cam_mem_mgr_cleanup_table();
 	debugfs_remove_recursive(tbl.dentry);