| /* Copyright (c) 2017-2019, The Linux Foundation. All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 and |
| * only version 2 as published by the Free Software Foundation. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| */ |
| |
| #include <linux/slab.h> |
| #include "cam_cpas_api.h" |
| #include "cam_vfe_soc.h" |
| #include "cam_debug_util.h" |
| |
| static bool cam_vfe_cpas_cb(uint32_t client_handle, void *userdata, |
| struct cam_cpas_irq_data *irq_data) |
| { |
| bool error_handled = false; |
| |
| if (!irq_data) |
| return error_handled; |
| |
| switch (irq_data->irq_type) { |
| case CAM_CAMNOC_IRQ_IFE02_UBWC_ENCODE_ERROR: |
| case CAM_CAMNOC_IRQ_IFE13_UBWC_ENCODE_ERROR: |
| case CAM_CAMNOC_IRQ_IFE0_UBWC_ENCODE_ERROR: |
| case CAM_CAMNOC_IRQ_IFE1_WRITE_UBWC_ENCODE_ERROR: |
| CAM_ERR_RATE_LIMIT(CAM_ISP, |
| "IFE UBWC Encode error type=%d status=%x", |
| irq_data->irq_type, |
| irq_data->u.enc_err.encerr_status.value); |
| error_handled = true; |
| break; |
| default: |
| break; |
| } |
| |
| return error_handled; |
| } |
| |
| static int cam_vfe_get_dt_properties(struct cam_hw_soc_info *soc_info) |
| { |
| int rc = 0; |
| |
| rc = cam_soc_util_get_dt_properties(soc_info); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "Error! get DT properties failed rc=%d", rc); |
| return rc; |
| } |
| |
| return rc; |
| } |
| |
| static int cam_vfe_request_platform_resource( |
| struct cam_hw_soc_info *soc_info, |
| irq_handler_t vfe_irq_handler, void *irq_data) |
| { |
| int rc = 0; |
| |
| rc = cam_soc_util_request_platform_resource(soc_info, vfe_irq_handler, |
| irq_data); |
| if (rc) |
| CAM_ERR(CAM_ISP, |
| "Error! Request platform resource failed rc=%d", rc); |
| |
| return rc; |
| } |
| |
| static int cam_vfe_release_platform_resource(struct cam_hw_soc_info *soc_info) |
| { |
| int rc = 0; |
| |
| rc = cam_soc_util_release_platform_resource(soc_info); |
| if (rc) |
| CAM_ERR(CAM_ISP, |
| "Error! Release platform resource failed rc=%d", rc); |
| |
| return rc; |
| } |
| |
| int cam_vfe_init_soc_resources(struct cam_hw_soc_info *soc_info, |
| irq_handler_t vfe_irq_handler, void *irq_data) |
| { |
| int rc = 0; |
| struct cam_vfe_soc_private *soc_private; |
| struct cam_cpas_register_params cpas_register_param; |
| |
| soc_private = kzalloc(sizeof(struct cam_vfe_soc_private), |
| GFP_KERNEL); |
| if (!soc_private) { |
| CAM_DBG(CAM_ISP, "Error! soc_private Alloc Failed"); |
| return -ENOMEM; |
| } |
| soc_info->soc_private = soc_private; |
| |
| rc = cam_vfe_get_dt_properties(soc_info); |
| if (rc < 0) { |
| CAM_ERR(CAM_ISP, "Error! Get DT properties failed rc=%d", rc); |
| goto free_soc_private; |
| } |
| |
| rc = cam_soc_util_get_option_clk_by_name(soc_info, |
| CAM_VFE_DSP_CLK_NAME, &soc_private->dsp_clk, |
| &soc_private->dsp_clk_index, &soc_private->dsp_clk_rate); |
| if (rc) |
| CAM_WARN(CAM_ISP, "Option clk get failed with rc %d", rc); |
| |
| rc = cam_vfe_request_platform_resource(soc_info, vfe_irq_handler, |
| irq_data); |
| if (rc < 0) { |
| CAM_ERR(CAM_ISP, |
| "Error! Request platform resources failed rc=%d", rc); |
| goto free_soc_private; |
| } |
| |
| memset(&cpas_register_param, 0, sizeof(cpas_register_param)); |
| |
| cpas_register_param.cell_index = soc_info->index; |
| cpas_register_param.dev = soc_info->dev; |
| cpas_register_param.cam_cpas_client_cb = cam_vfe_cpas_cb; |
| cpas_register_param.userdata = soc_info; |
| |
| rc = cam_cpas_get_cpas_hw_version(&soc_private->cpas_version); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "Error! Invalid cpas version rc=%d", rc); |
| goto free_soc_private; |
| } |
| |
| switch (soc_private->cpas_version) { |
| case CAM_CPAS_TITAN_175_V120: |
| strlcpy(cpas_register_param.identifier, "iferdi", |
| CAM_HW_IDENTIFIER_LENGTH); |
| rc = cam_cpas_register_client(&cpas_register_param); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "rdi CPAS registration failed rc=%d", |
| rc); |
| goto release_soc; |
| } else { |
| soc_private->cpas_handle[0] = |
| cpas_register_param.client_handle; |
| } |
| |
| strlcpy(cpas_register_param.identifier, "ifenrdi", |
| CAM_HW_IDENTIFIER_LENGTH); |
| rc = cam_cpas_register_client(&cpas_register_param); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "nrdi CPAS registration failed rc=%d", |
| rc); |
| goto release_soc; |
| } else { |
| soc_private->cpas_handle[1] = |
| cpas_register_param.client_handle; |
| } |
| break; |
| default: |
| strlcpy(cpas_register_param.identifier, "ife", |
| CAM_HW_IDENTIFIER_LENGTH); |
| rc = cam_cpas_register_client(&cpas_register_param); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "CPAS registration failed rc=%d", rc); |
| goto release_soc; |
| } else { |
| soc_private->cpas_handle[0] = |
| cpas_register_param.client_handle; |
| } |
| } |
| return rc; |
| |
| release_soc: |
| cam_soc_util_release_platform_resource(soc_info); |
| free_soc_private: |
| kfree(soc_private); |
| |
| return rc; |
| } |
| |
| int cam_vfe_deinit_soc_resources(struct cam_hw_soc_info *soc_info) |
| { |
| int rc = 0; |
| struct cam_vfe_soc_private *soc_private; |
| |
| if (!soc_info) { |
| CAM_ERR(CAM_ISP, "Error! soc_info NULL"); |
| return -ENODEV; |
| } |
| |
| soc_private = soc_info->soc_private; |
| if (!soc_private) { |
| CAM_ERR(CAM_ISP, "Error! soc_private NULL"); |
| return -ENODEV; |
| } |
| rc = cam_cpas_unregister_client(soc_private->cpas_handle[0]); |
| if (rc) |
| CAM_ERR(CAM_ISP, "CPAS0 unregistration failed rc=%d", rc); |
| |
| if (!rc && soc_private->cpas_version == CAM_CPAS_TITAN_175_V120) |
| rc = cam_cpas_unregister_client(soc_private->cpas_handle[1]); |
| if (rc) |
| CAM_ERR(CAM_ISP, "CPAS1 unregistration failed rc=%d", |
| rc); |
| |
| rc = cam_vfe_release_platform_resource(soc_info); |
| if (rc < 0) |
| CAM_ERR(CAM_ISP, |
| "Error! Release platform resources failed rc=%d", rc); |
| |
| rc = cam_soc_util_clk_put(&soc_private->dsp_clk); |
| if (rc < 0) |
| CAM_ERR(CAM_ISP, |
| "Error Put dsp clk failed rc=%d", rc); |
| |
| kfree(soc_private); |
| |
| return rc; |
| } |
| |
| int cam_vfe_enable_soc_resources(struct cam_hw_soc_info *soc_info) |
| { |
| int rc = 0; |
| struct cam_vfe_soc_private *soc_private; |
| struct cam_ahb_vote ahb_vote; |
| struct cam_axi_vote axi_vote; |
| |
| if (!soc_info) { |
| CAM_ERR(CAM_ISP, "Error! Invalid params"); |
| rc = -EINVAL; |
| goto end; |
| } |
| soc_private = soc_info->soc_private; |
| |
| ahb_vote.type = CAM_VOTE_ABSOLUTE; |
| ahb_vote.vote.level = CAM_SVS_VOTE; |
| |
| axi_vote.compressed_bw = 10640000000L; |
| axi_vote.compressed_bw_ab = 10640000000L; |
| axi_vote.uncompressed_bw = 10640000000L; |
| |
| rc = cam_cpas_start(soc_private->cpas_handle[0], &ahb_vote, &axi_vote); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "Error! CPAS0 start failed rc=%d", rc); |
| rc = -EFAULT; |
| goto end; |
| } |
| |
| if (!rc && soc_private->cpas_version == CAM_CPAS_TITAN_175_V120) |
| rc = cam_cpas_start(soc_private->cpas_handle[1], &ahb_vote, |
| &axi_vote); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "Error! CPAS1 start failed rc=%d", rc); |
| rc = -EFAULT; |
| goto end; |
| } |
| |
| rc = cam_soc_util_enable_platform_resource(soc_info, true, |
| CAM_TURBO_VOTE, true); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "Error! enable platform failed rc=%d", rc); |
| goto stop_cpas; |
| } |
| |
| return rc; |
| |
| stop_cpas: |
| cam_cpas_stop(soc_private->cpas_handle[0]); |
| if (soc_private->cpas_version == CAM_CPAS_TITAN_175_V120) |
| cam_cpas_stop(soc_private->cpas_handle[1]); |
| end: |
| return rc; |
| } |
| |
| int cam_vfe_soc_enable_clk(struct cam_hw_soc_info *soc_info, |
| const char *clk_name) |
| { |
| int rc = 0; |
| struct cam_vfe_soc_private *soc_private; |
| |
| if (!soc_info) { |
| CAM_ERR(CAM_ISP, "Error Invalid params"); |
| rc = -EINVAL; |
| return rc; |
| } |
| soc_private = soc_info->soc_private; |
| |
| if (strcmp(clk_name, CAM_VFE_DSP_CLK_NAME) == 0) { |
| rc = cam_soc_util_clk_enable(soc_private->dsp_clk, |
| CAM_VFE_DSP_CLK_NAME, soc_private->dsp_clk_rate); |
| if (rc) |
| CAM_ERR(CAM_ISP, |
| "Error enable dsp clk failed rc=%d", rc); |
| } |
| |
| return rc; |
| } |
| |
| int cam_vfe_soc_disable_clk(struct cam_hw_soc_info *soc_info, |
| const char *clk_name) |
| { |
| int rc = 0; |
| struct cam_vfe_soc_private *soc_private; |
| |
| if (!soc_info) { |
| CAM_ERR(CAM_ISP, "Error Invalid params"); |
| rc = -EINVAL; |
| return rc; |
| } |
| soc_private = soc_info->soc_private; |
| |
| if (strcmp(clk_name, CAM_VFE_DSP_CLK_NAME) == 0) { |
| rc = cam_soc_util_clk_disable(soc_private->dsp_clk, |
| CAM_VFE_DSP_CLK_NAME); |
| if (rc) |
| CAM_ERR(CAM_ISP, |
| "Error enable dsp clk failed rc=%d", rc); |
| } |
| |
| return rc; |
| } |
| |
| |
| int cam_vfe_disable_soc_resources(struct cam_hw_soc_info *soc_info) |
| { |
| int rc = 0; |
| struct cam_vfe_soc_private *soc_private; |
| |
| if (!soc_info) { |
| CAM_ERR(CAM_ISP, "Error! Invalid params"); |
| rc = -EINVAL; |
| return rc; |
| } |
| soc_private = soc_info->soc_private; |
| |
| rc = cam_soc_util_disable_platform_resource(soc_info, true, true); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "Disable platform failed rc=%d", rc); |
| return rc; |
| } |
| |
| rc = cam_cpas_stop(soc_private->cpas_handle[0]); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "Error! CPAS stop failed rc=%d", rc); |
| return rc; |
| } |
| |
| if (!rc && soc_private->cpas_version == CAM_CPAS_TITAN_175_V120) |
| rc = cam_cpas_stop(soc_private->cpas_handle[1]); |
| if (rc) { |
| CAM_ERR(CAM_ISP, "Error! CPAS stop failed rc=%d", rc); |
| return rc; |
| } |
| |
| return rc; |
| } |