| /* Copyright (c) 2017, 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/io.h> |
| #include <linux/of.h> |
| #include <linux/platform_device.h> |
| #include <linux/dma-buf.h> |
| #include <media/cam_defs.h> |
| #include <media/cam_icp.h> |
| #include "bps_soc.h" |
| #include "cam_soc_util.h" |
| #include "cam_debug_util.h" |
| |
| static int cam_bps_get_dt_properties(struct cam_hw_soc_info *soc_info) |
| { |
| int rc = 0; |
| |
| rc = cam_soc_util_get_dt_properties(soc_info); |
| if (rc < 0) |
| CAM_ERR(CAM_ICP, "get bps dt prop is failed"); |
| |
| return rc; |
| } |
| |
| static int cam_bps_request_platform_resource( |
| struct cam_hw_soc_info *soc_info, |
| irq_handler_t bps_irq_handler, void *irq_data) |
| { |
| int rc = 0; |
| |
| rc = cam_soc_util_request_platform_resource(soc_info, bps_irq_handler, |
| irq_data); |
| |
| return rc; |
| } |
| |
| int cam_bps_init_soc_resources(struct cam_hw_soc_info *soc_info, |
| irq_handler_t bps_irq_handler, void *irq_data) |
| { |
| int rc = 0; |
| |
| rc = cam_bps_get_dt_properties(soc_info); |
| if (rc < 0) |
| return rc; |
| |
| rc = cam_bps_request_platform_resource(soc_info, bps_irq_handler, |
| irq_data); |
| if (rc < 0) |
| return rc; |
| |
| return rc; |
| } |
| |
| int cam_bps_enable_soc_resources(struct cam_hw_soc_info *soc_info) |
| { |
| int rc = 0; |
| |
| rc = cam_soc_util_enable_platform_resource(soc_info, true, |
| CAM_SVS_VOTE, false); |
| if (rc) |
| CAM_ERR(CAM_ICP, "enable platform failed"); |
| |
| return rc; |
| } |
| |
| int cam_bps_disable_soc_resources(struct cam_hw_soc_info *soc_info) |
| { |
| int rc = 0; |
| |
| rc = cam_soc_util_disable_platform_resource(soc_info, true, false); |
| if (rc) |
| CAM_ERR(CAM_ICP, "disable platform failed"); |
| |
| return rc; |
| } |
| |
| int cam_bps_transfer_gdsc_control(struct cam_hw_soc_info *soc_info) |
| { |
| int i; |
| int rc; |
| |
| for (i = 0; i < soc_info->num_rgltr; i++) { |
| rc = regulator_set_mode(soc_info->rgltr[i], |
| REGULATOR_MODE_FAST); |
| if (rc) { |
| CAM_ERR(CAM_ICP, "Regulator set mode %s failed", |
| soc_info->rgltr_name[i]); |
| goto rgltr_set_mode_failed; |
| } |
| } |
| return 0; |
| |
| rgltr_set_mode_failed: |
| for (i = i - 1; i >= 0; i--) |
| if (soc_info->rgltr[i]) |
| regulator_set_mode(soc_info->rgltr[i], |
| REGULATOR_MODE_NORMAL); |
| |
| return rc; |
| } |
| |
| int cam_bps_get_gdsc_control(struct cam_hw_soc_info *soc_info) |
| { |
| int i; |
| int rc; |
| |
| for (i = 0; i < soc_info->num_rgltr; i++) { |
| rc = regulator_set_mode(soc_info->rgltr[i], |
| REGULATOR_MODE_NORMAL); |
| if (rc) { |
| CAM_ERR(CAM_ICP, "Regulator set mode %s failed", |
| soc_info->rgltr_name[i]); |
| goto rgltr_set_mode_failed; |
| } |
| } |
| return 0; |
| |
| rgltr_set_mode_failed: |
| for (i = i - 1; i >= 0; i--) |
| if (soc_info->rgltr[i]) |
| regulator_set_mode(soc_info->rgltr[i], |
| REGULATOR_MODE_FAST); |
| |
| return rc; |
| } |
| |
| int cam_bps_update_clk_rate(struct cam_hw_soc_info *soc_info, |
| uint32_t clk_rate) |
| { |
| if (!soc_info) |
| return -EINVAL; |
| |
| return cam_soc_util_set_clk_rate(soc_info->clk[soc_info->src_clk_idx], |
| soc_info->clk_name[soc_info->src_clk_idx], clk_rate); |
| } |