Loading Documentation/devicetree/bindings/media/video/msm-cam-soc.txt 0 → 100644 +41 −0 Original line number Diff line number Diff line * Qualcomm MSM Camera SOC The below set of properties need to be defined by all the camera modules in their respective dtsi to adapt to SOC layer Required properties: - clock-names: name of the clocks required for the device - qcom,clock-rates: clock rate in Hz - 0 if appropriate clock is required but doesn't have to apply the rate - qcom,vdd-names: names of all the regulators for the device - Refer to "Documentation/devicetree/bindings/arm/msm/msm_bus.txt" for below optional properties: - qcom,msm-bus,name - qcom,msm-bus,num-cases - qcom,msm-bus,num-paths - qcom,msm-bus,vectors-KBps - qcom,msm-bus-vector-dyn-vote: indicated dynamic or static voting - qcom,clock-cntl-support: indicates if further control supported for clocks - Refer to "Documentation/devicetree/bindings/media/video/msm-ispif.txt" for below optional property: - qcom,clock-control Example: cpp: qcom,cpp@a04000 { mmagic-vdd-supply = <&gdsc_mmagic_camss>; camss-vdd-supply = <&gdsc_camss_top>; vdd-supply = <&gdsc_cpp>; qcom,vdd-names = "mmagic-vdd", "camss-vdd", "vdd"; clock-names = "camss_top_ahb_clk", "ispif_ahb_clk", "csiphy_timer_src_clk", "csiphy_timer_clk"; qcom,clock-rates = <0 0 200000000 0>; qcom,msm-bus,name = "msm_camera_cpp"; qcom,msm-bus,num-cases = <2>; qcom,msm-bus,num-paths = <1>; qcom,msm-bus,vectors-KBps = <106 512 0 0>, <106 512 0 0>; qcom,msm-bus-vector-dyn-vote; }; drivers/media/platform/msm/camera_v2/common/Makefile +1 −1 Original line number Diff line number Diff line ccflags-y += -Idrivers/media/platform/msm/camera_v2/ obj-$(CONFIG_MSMB_CAMERA) += msm_camera_io_util.o cam_smmu_api.o cam_hw_ops.o obj-$(CONFIG_MSMB_CAMERA) += msm_camera_io_util.o cam_smmu_api.o cam_hw_ops.o cam_soc_api.o drivers/media/platform/msm/camera_v2/common/cam_soc_api.c 0 → 100644 +724 −0 Original line number Diff line number Diff line /* Copyright (c) 2015 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. */ #define pr_fmt(fmt) "CAM-SOC %s:%d " fmt, __func__, __LINE__ #define NO_SET_RATE -1 #define INIT_RATE -2 #ifdef CONFIG_CAM_SOC_API_DBG #define CDBG(fmt, args...) pr_err(fmt, ##args) #else #define CDBG(fmt, args...) pr_debug(fmt, ##args) #endif #include <linux/delay.h> #include <linux/module.h> #include <linux/of_platform.h> #include <linux/msm-bus.h> #include "cam_soc_api.h" struct msm_cam_bus_pscale_data { struct msm_bus_scale_pdata *pdata; uint32_t bus_client; uint32_t num_usecases; uint32_t num_paths; unsigned int vector_index; bool dyn_vote; }; struct msm_cam_bus_pscale_data g_cv[CAM_AHB_CLIENT_MAX]; /* Get all clocks from DT */ int msm_camera_get_clk_info(struct platform_device *pdev, struct msm_cam_clk_info **clk_info, struct clk ***clk_ptr, size_t *num_clk) { int rc = 0; size_t cnt, tmp; uint32_t *rates, i = 0; const char *clk_ctl = NULL; bool clock_cntl_support = false; struct device_node *of_node; if (!pdev || !clk_info || !num_clk) return -EINVAL; of_node = pdev->dev.of_node; cnt = of_property_count_strings(of_node, "clock-names"); if (cnt <= 0) { pr_err("err: No clocks found in DT=%zu\n", cnt); return -EINVAL; } tmp = of_property_count_u32_elems(of_node, "qcom,clock-rates"); if (tmp <= 0) { pr_err("err: No clk rates device tree, count=%zu", tmp); return -EINVAL; } if (cnt != tmp) { pr_err("err: clk name/rates mismatch, strings=%zu, rates=%zu\n", cnt, tmp); return -EINVAL; } if (of_property_read_bool(of_node, "qcom,clock-cntl-support")) { tmp = of_property_count_strings(of_node, "qcom,clock-control"); if (tmp <= 0) { pr_err("err: control strings not found in DT count=%zu", tmp); return -EINVAL; } if (cnt != tmp) { pr_err("err: controls mismatch, strings=%zu, ctl=%zu\n", cnt, tmp); return -EINVAL; } clock_cntl_support = true; } *num_clk = cnt; *clk_info = devm_kcalloc(&pdev->dev, cnt, sizeof(struct msm_cam_clk_info), GFP_KERNEL); if (!*clk_info) return -ENOMEM; *clk_ptr = devm_kcalloc(&pdev->dev, cnt, sizeof(struct clk *), GFP_KERNEL); if (!*clk_ptr) { rc = -ENOMEM; goto err1; } rates = devm_kcalloc(&pdev->dev, cnt, sizeof(long), GFP_KERNEL); if (!rates) { rc = -ENOMEM; goto err2; } rc = of_property_read_u32_array(of_node, "qcom,clock-rates", rates, cnt); if (rc < 0) { pr_err("err: failed reading clock rates\n"); rc = -EINVAL; goto err3; } for (i = 0; i < cnt; i++) { rc = of_property_read_string_index(of_node, "clock-names", i, &((*clk_info)[i].clk_name)); if (rc < 0) { pr_err("%s reading clock-name failed index %d\n", __func__, i); rc = -EINVAL; goto err3; } CDBG("dbg: clk-name[%d] = %s\n", i, (*clk_info)[i].clk_name); if (clock_cntl_support) { rc = of_property_read_string_index(of_node, "qcom,clock-control", i, &clk_ctl); if (rc < 0) { pr_err("%s reading clock-control failed index %d\n", __func__, i); rc = -EINVAL; goto err3; } if (!strcmp(clk_ctl, "NO_SET_RATE")) (*clk_info)[i].clk_rate = NO_SET_RATE; else if (!strcmp(clk_ctl, "INIT_RATE")) (*clk_info)[i].clk_rate = INIT_RATE; else if (!strcmp(clk_ctl, "SET_RATE")) (*clk_info)[i].clk_rate = rates[i]; else { pr_err("%s: error: clock control has invalid value\n", __func__); rc = -EBUSY; goto err3; } } else (*clk_info)[i].clk_rate = (rates[i] == 0) ? (long)-1 : rates[i]; CDBG("dbg: clk-rate[%d] = rate: %ld\n", i, (*clk_info)[i].clk_rate); (*clk_ptr)[i] = devm_clk_get(&pdev->dev, (*clk_info)[i].clk_name); if (IS_ERR((*clk_ptr)[i])) { rc = PTR_ERR((*clk_ptr)[i]); goto err4; } CDBG("clk ptr[%d] :%p\n", i, (*clk_ptr)[i]); } devm_kfree(&pdev->dev, rates); return rc; err4: for (--i; i >= 0; i--) devm_clk_put(&pdev->dev, (*clk_ptr)[i]); err3: devm_kfree(&pdev->dev, rates); err2: devm_kfree(&pdev->dev, *clk_ptr); err1: devm_kfree(&pdev->dev, *clk_info); return rc; } EXPORT_SYMBOL(msm_camera_get_clk_info); /* Enable/Disable all clocks */ int msm_camera_clk_enable(struct device *dev, struct msm_cam_clk_info *clk_info, struct clk **clk_ptr, int num_clk, int enable) { int i; int rc = 0; long clk_rate; if (enable) { for (i = 0; i < num_clk; i++) { CDBG("enable %s\n", clk_info[i].clk_name); if (clk_info[i].clk_rate > 0) { clk_rate = clk_round_rate(clk_ptr[i], clk_info[i].clk_rate); if (clk_rate < 0) { pr_err("%s round failed\n", clk_info[i].clk_name); goto cam_clk_set_err; } rc = clk_set_rate(clk_ptr[i], clk_rate); if (rc < 0) { pr_err("%s set failed\n", clk_info[i].clk_name); goto cam_clk_set_err; } } else if (clk_info[i].clk_rate == INIT_RATE) { clk_rate = clk_get_rate(clk_ptr[i]); if (clk_rate == 0) { clk_rate = clk_round_rate(clk_ptr[i], 0); if (clk_rate < 0) { pr_err("%s round rate failed\n", clk_info[i].clk_name); goto cam_clk_set_err; } rc = clk_set_rate(clk_ptr[i], clk_rate); if (rc < 0) { pr_err("%s set rate failed\n", clk_info[i].clk_name); goto cam_clk_set_err; } } } rc = clk_prepare_enable(clk_ptr[i]); if (rc < 0) { pr_err("%s enable failed\n", clk_info[i].clk_name); goto cam_clk_enable_err; } if (clk_info[i].delay > 20) { msleep(clk_info[i].delay); } else if (clk_info[i].delay) { usleep_range(clk_info[i].delay * 1000, (clk_info[i].delay * 1000) + 1000); } } } else { for (i = num_clk - 1; i >= 0; i--) { if (clk_ptr[i] != NULL) { CDBG("%s disable %s\n", __func__, clk_info[i].clk_name); clk_disable_unprepare(clk_ptr[i]); } } } return rc; cam_clk_enable_err: cam_clk_set_err: for (i--; i >= 0; i--) { if (clk_ptr[i] != NULL) clk_disable_unprepare(clk_ptr[i]); } return rc; } EXPORT_SYMBOL(msm_camera_clk_enable); /* Set rate on a specific clock */ int msm_camera_clk_set_rate(struct device *dev, struct clk *clk, long clk_rate) { int rc = 0; if (!dev || !clk) return -EINVAL; clk_rate = clk_round_rate(clk, clk_rate); if (clk_rate < 0) { pr_err("round rate failed:\n"); return -EINVAL; } rc = clk_set_rate(clk, clk_rate); if (rc < 0) { pr_err("set rate failed:\n"); return -EINVAL; } return 0; } EXPORT_SYMBOL(msm_camera_clk_set_rate); /* release memory allocated for clocks */ int msm_camera_put_clk_info(struct platform_device *pdev, struct msm_cam_clk_info **clk_info, struct clk ***clk_ptr, int cnt) { int i; for (i = cnt - 1; i >= 0; i--) { if (clk_ptr[i] != NULL) devm_clk_put(&pdev->dev, (*clk_ptr)[i]); CDBG("clk ptr[%d] :%p\n", i, (*clk_ptr)[i]); } devm_kfree(&pdev->dev, *clk_info); devm_kfree(&pdev->dev, *clk_ptr); *clk_info = NULL; *clk_ptr = NULL; return 0; } EXPORT_SYMBOL(msm_camera_put_clk_info); /* Get regulators from DT */ int msm_camera_get_regulator_info(struct platform_device *pdev, struct regulator ***vdd, int *num_reg) { uint32_t cnt; int i, rc; struct device_node *of_node; const char *name; char prop_name[32]; if (!pdev || !vdd || !num_reg) return -EINVAL; of_node = pdev->dev.of_node; if (!of_get_property(of_node, "qcom,vdd-names", NULL)) { pr_err("err: Regulators property not found\n"); return -EINVAL; } cnt = of_property_count_strings(of_node, "qcom,vdd-names"); if (cnt <= 0) { pr_err("err: no regulators found in device tree, count=%d", cnt); return -EINVAL; } *num_reg = cnt; (*vdd) = devm_kcalloc(&pdev->dev, cnt, sizeof(struct regulator *), GFP_KERNEL); if (!*vdd) return -ENOMEM; for (i = 0; i < cnt; i++) { rc = of_property_read_string_index(of_node, "qcom,vdd-names", i, &name); if (rc < 0) { pr_err("Fail to fetch regulators: %d\n", i); rc = -EINVAL; goto err1; } CDBG("regulator-names[%d] = %s\n", i, name); snprintf(prop_name, 32, "%s-supply", name); if (of_get_property(of_node, prop_name, NULL)) { (*vdd)[i] = devm_regulator_get(&pdev->dev, name); if (IS_ERR((*vdd)[i])) { rc = -EINVAL; pr_err("Fail to get regulator :%d\n", i); goto err1; } } else { pr_err("Regulator phandle not found :%s\n", name); goto err1; } CDBG("vdd ptr[%d] :%p\n", i, (*vdd)[i]); } return 0; err1: for (--i; i >= 0; i--) devm_regulator_put((*vdd)[i]); devm_kfree(&pdev->dev, *vdd); return rc; } EXPORT_SYMBOL(msm_camera_get_regulator_info); /* Enable/Disable regulators */ int msm_camera_regulator_enable(struct regulator **vdd, int cnt, int enable) { int i; int rc; CDBG("cnt : %d, enable : %d\n", cnt, enable); if (!vdd) { pr_err("Invalid Params"); return -EINVAL; } for (i = 0; i < cnt; i++) { if (enable) { rc = regulator_enable(vdd[i]); if (rc < 0) { pr_err("regulator enable failed %d\n", i); goto error; } } else { rc = regulator_disable(vdd[i]); if (rc < 0) pr_err("regulator disable failed %d\n", i); } } return 0; error: for (--i; i > 0; i--) { if (!IS_ERR_OR_NULL(vdd[i])) regulator_disable(vdd[i]); } return rc; } EXPORT_SYMBOL(msm_camera_regulator_enable); /* Put regulators regulators */ void msm_camera_put_regulators(struct platform_device *pdev, struct regulator ***vdd, int cnt) { int i; if (!*vdd) { pr_err("Invalid params\n"); return; } for (i = cnt - 1; i >= 0; i--) { if (!IS_ERR_OR_NULL((*vdd)[i])) devm_regulator_put((*vdd)[i]); CDBG("vdd ptr[%d] :%p\n", i, (*vdd)[i]); } devm_kfree(&pdev->dev, *vdd); *vdd = NULL; } EXPORT_SYMBOL(msm_camera_put_regulators); struct resource *msm_camera_get_irq(struct platform_device *pdev, char *irq_name) { if (!pdev || !irq_name) { pr_err("Invalid Params\n"); return NULL; } CDBG("Get irq for %s\n", irq_name); return platform_get_resource_byname(pdev, IORESOURCE_IRQ, irq_name); } EXPORT_SYMBOL(msm_camera_get_irq); int msm_camera_register_irq(struct platform_device *pdev, struct resource *irq, irq_handler_t handler, char *irq_name, void *dev_id) { int rc = 0; if (!pdev || !irq || !handler || !irq_name || !dev_id) { pr_err("Invalid Params\n"); return -EINVAL; } rc = devm_request_irq(&pdev->dev, irq->start, handler, IRQF_TRIGGER_RISING, irq_name, dev_id); if (rc < 0) { pr_err("irq request fail\n"); rc = -EINVAL; } CDBG("Registered irq for %s[resource - %p]\n", irq_name, irq); return rc; } EXPORT_SYMBOL(msm_camera_register_irq); int msm_camera_enable_irq(struct resource *irq, int enable) { if (!irq) { pr_err("Invalid Params\n"); return -EINVAL; } CDBG("irq Enable %d\n", enable); if (enable) enable_irq(irq->start); else disable_irq(irq->start); return 0; } EXPORT_SYMBOL(msm_camera_enable_irq); int msm_camera_unregister_irq(struct platform_device *pdev, struct resource *irq, void *dev_id) { if (!pdev || !irq || !dev_id) { pr_err("Invalid Params\n"); return -EINVAL; } CDBG("Un Registering irq for [resource - %p]\n", irq); devm_free_irq(&pdev->dev, irq->start, dev_id); return 0; } EXPORT_SYMBOL(msm_camera_unregister_irq); void __iomem *msm_camera_get_reg_base(struct platform_device *pdev, char *device_name) { struct resource *mem; void *base; if (!pdev || !device_name) { pr_err("Invalid Params\n"); return NULL; } CDBG("device name :%s\n", device_name); mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, device_name); if (!mem) { pr_err("err: mem resource %s not found\n", device_name); return NULL; } if (!devm_request_mem_region(&pdev->dev, mem->start, resource_size(mem), device_name)) { pr_err("err: no valid mem region for device:%s\n", device_name); return NULL; } base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem)); if (!base) { devm_release_mem_region(&pdev->dev, mem->start, resource_size(mem)); pr_err("err: ioremap failed: %s\n", device_name); return NULL; } CDBG("base : %p\n", base); return base; } EXPORT_SYMBOL(msm_camera_get_reg_base); int msm_camera_put_reg_base(struct platform_device *pdev, void __iomem *base, char *device_name) { struct resource *mem; if (!pdev || !base || !device_name) { pr_err("Invalid Params\n"); return -EINVAL; } CDBG("device name :%s\n", device_name); mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, device_name); if (!mem) { pr_err("err: mem resource %s not found\n", device_name); return -EINVAL; } devm_iounmap(&pdev->dev, base); devm_release_mem_region(&pdev->dev, mem->start, resource_size(mem)); return 0; } EXPORT_SYMBOL(msm_camera_put_reg_base); /* Register the bus client */ uint32_t msm_camera_register_bus_client(struct platform_device *pdev, enum cam_ahb_clk_client id) { int rc = 0; uint32_t bus_client, num_usecases, num_paths; struct msm_bus_scale_pdata *pdata; struct device_node *of_node; CDBG("Register client ID: %d\n", id); if (id >= CAM_AHB_CLIENT_MAX || !pdev) { pr_err("Invalid Params"); return -EINVAL; } of_node = pdev->dev.of_node; if (!g_cv[id].pdata) { rc = of_property_read_u32(of_node, "qcom,msm-bus,num-cases", &num_usecases); if (rc) { pr_err("num-usecases not found\n"); return -EINVAL; } rc = of_property_read_u32(of_node, "qcom,msm-bus,num-paths", &num_paths); if (rc) { pr_err("num-usecases not found\n"); return -EINVAL; } if (num_paths != 1) { pr_err("Exceeds number of paths\n"); return -EINVAL; } if (of_property_read_bool(of_node, "qcom,msm-bus-vector-dyn-vote")) { if (num_usecases != 2) { pr_err("Excess or less vectors\n"); return -EINVAL; } g_cv[id].dyn_vote = true; } pdata = msm_bus_cl_get_pdata(pdev); if (!pdata) { pr_err("failed get_pdata client_id :%d\n", id); return -EINVAL; } bus_client = msm_bus_scale_register_client(pdata); if (!bus_client) { pr_err("Unable to register bus client :%d\n", id); return -EINVAL; } } else { pr_err("vector already setup client_id : %d\n", id); return -EINVAL; } g_cv[id].pdata = pdata; g_cv[id].bus_client = bus_client; g_cv[id].vector_index = 0; g_cv[id].num_usecases = num_usecases; g_cv[id].num_paths = num_paths; CDBG("Exit Client ID: %d\n", id); return 0; } EXPORT_SYMBOL(msm_camera_register_bus_client); /* Update the bus bandwidth */ uint32_t msm_camera_update_bus_bw(int id, uint64_t ab, uint64_t ib) { struct msm_bus_paths *path; struct msm_bus_scale_pdata *pdata; int idx = 0; if (id >= CAM_AHB_CLIENT_MAX) { pr_err("Invalid Params"); return -EINVAL; } if (g_cv[id].num_usecases != 2 || g_cv[id].num_paths != 1 || g_cv[id].dyn_vote != true) { pr_err("dynamic update not allowed\n"); return -EINVAL; } idx = g_cv[id].vector_index; pdata = g_cv[id].pdata; idx = 1 - idx; path = &(pdata->usecase[idx]); path->vectors[0].ab = ab; path->vectors[0].ib = ib; CDBG("Register client ID : %d [ab : %llx, ib : %llx], update :%d\n", id, ab, ib, idx); msm_bus_scale_client_update_request(g_cv[id].bus_client, idx); g_cv[id].vector_index = idx; return 0; } EXPORT_SYMBOL(msm_camera_update_bus_bw); /* Update the bus vector */ uint32_t msm_camera_update_bus_vector(enum cam_ahb_clk_client id, int vector_index) { if (id >= CAM_AHB_CLIENT_MAX || g_cv[id].dyn_vote == true) { pr_err("Invalid Params"); return -EINVAL; } if (vector_index < 0 || vector_index > g_cv[id].num_usecases) { pr_err("Invalid Params"); return -EINVAL; } msm_bus_scale_client_update_request(g_cv[id].bus_client, vector_index); return 0; } EXPORT_SYMBOL(msm_camera_update_bus_vector); /* Unregister the bus client */ uint32_t msm_camera_unregister_bus_client(enum cam_ahb_clk_client id) { if (id >= CAM_AHB_CLIENT_MAX) { pr_err("Invalid Params"); return -EINVAL; } CDBG("UnRegister client ID: %d\n", id); msm_bus_scale_unregister_client(g_cv[id].bus_client); msm_bus_cl_clear_pdata(g_cv[id].pdata); memset(&g_cv[id], 0, sizeof(struct msm_cam_bus_pscale_data)); return 0; } EXPORT_SYMBOL(msm_camera_unregister_bus_client); drivers/media/platform/msm/camera_v2/common/cam_soc_api.h 0 → 100644 +289 −0 File added.Preview size limit exceeded, changes collapsed. Show changes Loading
Documentation/devicetree/bindings/media/video/msm-cam-soc.txt 0 → 100644 +41 −0 Original line number Diff line number Diff line * Qualcomm MSM Camera SOC The below set of properties need to be defined by all the camera modules in their respective dtsi to adapt to SOC layer Required properties: - clock-names: name of the clocks required for the device - qcom,clock-rates: clock rate in Hz - 0 if appropriate clock is required but doesn't have to apply the rate - qcom,vdd-names: names of all the regulators for the device - Refer to "Documentation/devicetree/bindings/arm/msm/msm_bus.txt" for below optional properties: - qcom,msm-bus,name - qcom,msm-bus,num-cases - qcom,msm-bus,num-paths - qcom,msm-bus,vectors-KBps - qcom,msm-bus-vector-dyn-vote: indicated dynamic or static voting - qcom,clock-cntl-support: indicates if further control supported for clocks - Refer to "Documentation/devicetree/bindings/media/video/msm-ispif.txt" for below optional property: - qcom,clock-control Example: cpp: qcom,cpp@a04000 { mmagic-vdd-supply = <&gdsc_mmagic_camss>; camss-vdd-supply = <&gdsc_camss_top>; vdd-supply = <&gdsc_cpp>; qcom,vdd-names = "mmagic-vdd", "camss-vdd", "vdd"; clock-names = "camss_top_ahb_clk", "ispif_ahb_clk", "csiphy_timer_src_clk", "csiphy_timer_clk"; qcom,clock-rates = <0 0 200000000 0>; qcom,msm-bus,name = "msm_camera_cpp"; qcom,msm-bus,num-cases = <2>; qcom,msm-bus,num-paths = <1>; qcom,msm-bus,vectors-KBps = <106 512 0 0>, <106 512 0 0>; qcom,msm-bus-vector-dyn-vote; };
drivers/media/platform/msm/camera_v2/common/Makefile +1 −1 Original line number Diff line number Diff line ccflags-y += -Idrivers/media/platform/msm/camera_v2/ obj-$(CONFIG_MSMB_CAMERA) += msm_camera_io_util.o cam_smmu_api.o cam_hw_ops.o obj-$(CONFIG_MSMB_CAMERA) += msm_camera_io_util.o cam_smmu_api.o cam_hw_ops.o cam_soc_api.o
drivers/media/platform/msm/camera_v2/common/cam_soc_api.c 0 → 100644 +724 −0 Original line number Diff line number Diff line /* Copyright (c) 2015 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. */ #define pr_fmt(fmt) "CAM-SOC %s:%d " fmt, __func__, __LINE__ #define NO_SET_RATE -1 #define INIT_RATE -2 #ifdef CONFIG_CAM_SOC_API_DBG #define CDBG(fmt, args...) pr_err(fmt, ##args) #else #define CDBG(fmt, args...) pr_debug(fmt, ##args) #endif #include <linux/delay.h> #include <linux/module.h> #include <linux/of_platform.h> #include <linux/msm-bus.h> #include "cam_soc_api.h" struct msm_cam_bus_pscale_data { struct msm_bus_scale_pdata *pdata; uint32_t bus_client; uint32_t num_usecases; uint32_t num_paths; unsigned int vector_index; bool dyn_vote; }; struct msm_cam_bus_pscale_data g_cv[CAM_AHB_CLIENT_MAX]; /* Get all clocks from DT */ int msm_camera_get_clk_info(struct platform_device *pdev, struct msm_cam_clk_info **clk_info, struct clk ***clk_ptr, size_t *num_clk) { int rc = 0; size_t cnt, tmp; uint32_t *rates, i = 0; const char *clk_ctl = NULL; bool clock_cntl_support = false; struct device_node *of_node; if (!pdev || !clk_info || !num_clk) return -EINVAL; of_node = pdev->dev.of_node; cnt = of_property_count_strings(of_node, "clock-names"); if (cnt <= 0) { pr_err("err: No clocks found in DT=%zu\n", cnt); return -EINVAL; } tmp = of_property_count_u32_elems(of_node, "qcom,clock-rates"); if (tmp <= 0) { pr_err("err: No clk rates device tree, count=%zu", tmp); return -EINVAL; } if (cnt != tmp) { pr_err("err: clk name/rates mismatch, strings=%zu, rates=%zu\n", cnt, tmp); return -EINVAL; } if (of_property_read_bool(of_node, "qcom,clock-cntl-support")) { tmp = of_property_count_strings(of_node, "qcom,clock-control"); if (tmp <= 0) { pr_err("err: control strings not found in DT count=%zu", tmp); return -EINVAL; } if (cnt != tmp) { pr_err("err: controls mismatch, strings=%zu, ctl=%zu\n", cnt, tmp); return -EINVAL; } clock_cntl_support = true; } *num_clk = cnt; *clk_info = devm_kcalloc(&pdev->dev, cnt, sizeof(struct msm_cam_clk_info), GFP_KERNEL); if (!*clk_info) return -ENOMEM; *clk_ptr = devm_kcalloc(&pdev->dev, cnt, sizeof(struct clk *), GFP_KERNEL); if (!*clk_ptr) { rc = -ENOMEM; goto err1; } rates = devm_kcalloc(&pdev->dev, cnt, sizeof(long), GFP_KERNEL); if (!rates) { rc = -ENOMEM; goto err2; } rc = of_property_read_u32_array(of_node, "qcom,clock-rates", rates, cnt); if (rc < 0) { pr_err("err: failed reading clock rates\n"); rc = -EINVAL; goto err3; } for (i = 0; i < cnt; i++) { rc = of_property_read_string_index(of_node, "clock-names", i, &((*clk_info)[i].clk_name)); if (rc < 0) { pr_err("%s reading clock-name failed index %d\n", __func__, i); rc = -EINVAL; goto err3; } CDBG("dbg: clk-name[%d] = %s\n", i, (*clk_info)[i].clk_name); if (clock_cntl_support) { rc = of_property_read_string_index(of_node, "qcom,clock-control", i, &clk_ctl); if (rc < 0) { pr_err("%s reading clock-control failed index %d\n", __func__, i); rc = -EINVAL; goto err3; } if (!strcmp(clk_ctl, "NO_SET_RATE")) (*clk_info)[i].clk_rate = NO_SET_RATE; else if (!strcmp(clk_ctl, "INIT_RATE")) (*clk_info)[i].clk_rate = INIT_RATE; else if (!strcmp(clk_ctl, "SET_RATE")) (*clk_info)[i].clk_rate = rates[i]; else { pr_err("%s: error: clock control has invalid value\n", __func__); rc = -EBUSY; goto err3; } } else (*clk_info)[i].clk_rate = (rates[i] == 0) ? (long)-1 : rates[i]; CDBG("dbg: clk-rate[%d] = rate: %ld\n", i, (*clk_info)[i].clk_rate); (*clk_ptr)[i] = devm_clk_get(&pdev->dev, (*clk_info)[i].clk_name); if (IS_ERR((*clk_ptr)[i])) { rc = PTR_ERR((*clk_ptr)[i]); goto err4; } CDBG("clk ptr[%d] :%p\n", i, (*clk_ptr)[i]); } devm_kfree(&pdev->dev, rates); return rc; err4: for (--i; i >= 0; i--) devm_clk_put(&pdev->dev, (*clk_ptr)[i]); err3: devm_kfree(&pdev->dev, rates); err2: devm_kfree(&pdev->dev, *clk_ptr); err1: devm_kfree(&pdev->dev, *clk_info); return rc; } EXPORT_SYMBOL(msm_camera_get_clk_info); /* Enable/Disable all clocks */ int msm_camera_clk_enable(struct device *dev, struct msm_cam_clk_info *clk_info, struct clk **clk_ptr, int num_clk, int enable) { int i; int rc = 0; long clk_rate; if (enable) { for (i = 0; i < num_clk; i++) { CDBG("enable %s\n", clk_info[i].clk_name); if (clk_info[i].clk_rate > 0) { clk_rate = clk_round_rate(clk_ptr[i], clk_info[i].clk_rate); if (clk_rate < 0) { pr_err("%s round failed\n", clk_info[i].clk_name); goto cam_clk_set_err; } rc = clk_set_rate(clk_ptr[i], clk_rate); if (rc < 0) { pr_err("%s set failed\n", clk_info[i].clk_name); goto cam_clk_set_err; } } else if (clk_info[i].clk_rate == INIT_RATE) { clk_rate = clk_get_rate(clk_ptr[i]); if (clk_rate == 0) { clk_rate = clk_round_rate(clk_ptr[i], 0); if (clk_rate < 0) { pr_err("%s round rate failed\n", clk_info[i].clk_name); goto cam_clk_set_err; } rc = clk_set_rate(clk_ptr[i], clk_rate); if (rc < 0) { pr_err("%s set rate failed\n", clk_info[i].clk_name); goto cam_clk_set_err; } } } rc = clk_prepare_enable(clk_ptr[i]); if (rc < 0) { pr_err("%s enable failed\n", clk_info[i].clk_name); goto cam_clk_enable_err; } if (clk_info[i].delay > 20) { msleep(clk_info[i].delay); } else if (clk_info[i].delay) { usleep_range(clk_info[i].delay * 1000, (clk_info[i].delay * 1000) + 1000); } } } else { for (i = num_clk - 1; i >= 0; i--) { if (clk_ptr[i] != NULL) { CDBG("%s disable %s\n", __func__, clk_info[i].clk_name); clk_disable_unprepare(clk_ptr[i]); } } } return rc; cam_clk_enable_err: cam_clk_set_err: for (i--; i >= 0; i--) { if (clk_ptr[i] != NULL) clk_disable_unprepare(clk_ptr[i]); } return rc; } EXPORT_SYMBOL(msm_camera_clk_enable); /* Set rate on a specific clock */ int msm_camera_clk_set_rate(struct device *dev, struct clk *clk, long clk_rate) { int rc = 0; if (!dev || !clk) return -EINVAL; clk_rate = clk_round_rate(clk, clk_rate); if (clk_rate < 0) { pr_err("round rate failed:\n"); return -EINVAL; } rc = clk_set_rate(clk, clk_rate); if (rc < 0) { pr_err("set rate failed:\n"); return -EINVAL; } return 0; } EXPORT_SYMBOL(msm_camera_clk_set_rate); /* release memory allocated for clocks */ int msm_camera_put_clk_info(struct platform_device *pdev, struct msm_cam_clk_info **clk_info, struct clk ***clk_ptr, int cnt) { int i; for (i = cnt - 1; i >= 0; i--) { if (clk_ptr[i] != NULL) devm_clk_put(&pdev->dev, (*clk_ptr)[i]); CDBG("clk ptr[%d] :%p\n", i, (*clk_ptr)[i]); } devm_kfree(&pdev->dev, *clk_info); devm_kfree(&pdev->dev, *clk_ptr); *clk_info = NULL; *clk_ptr = NULL; return 0; } EXPORT_SYMBOL(msm_camera_put_clk_info); /* Get regulators from DT */ int msm_camera_get_regulator_info(struct platform_device *pdev, struct regulator ***vdd, int *num_reg) { uint32_t cnt; int i, rc; struct device_node *of_node; const char *name; char prop_name[32]; if (!pdev || !vdd || !num_reg) return -EINVAL; of_node = pdev->dev.of_node; if (!of_get_property(of_node, "qcom,vdd-names", NULL)) { pr_err("err: Regulators property not found\n"); return -EINVAL; } cnt = of_property_count_strings(of_node, "qcom,vdd-names"); if (cnt <= 0) { pr_err("err: no regulators found in device tree, count=%d", cnt); return -EINVAL; } *num_reg = cnt; (*vdd) = devm_kcalloc(&pdev->dev, cnt, sizeof(struct regulator *), GFP_KERNEL); if (!*vdd) return -ENOMEM; for (i = 0; i < cnt; i++) { rc = of_property_read_string_index(of_node, "qcom,vdd-names", i, &name); if (rc < 0) { pr_err("Fail to fetch regulators: %d\n", i); rc = -EINVAL; goto err1; } CDBG("regulator-names[%d] = %s\n", i, name); snprintf(prop_name, 32, "%s-supply", name); if (of_get_property(of_node, prop_name, NULL)) { (*vdd)[i] = devm_regulator_get(&pdev->dev, name); if (IS_ERR((*vdd)[i])) { rc = -EINVAL; pr_err("Fail to get regulator :%d\n", i); goto err1; } } else { pr_err("Regulator phandle not found :%s\n", name); goto err1; } CDBG("vdd ptr[%d] :%p\n", i, (*vdd)[i]); } return 0; err1: for (--i; i >= 0; i--) devm_regulator_put((*vdd)[i]); devm_kfree(&pdev->dev, *vdd); return rc; } EXPORT_SYMBOL(msm_camera_get_regulator_info); /* Enable/Disable regulators */ int msm_camera_regulator_enable(struct regulator **vdd, int cnt, int enable) { int i; int rc; CDBG("cnt : %d, enable : %d\n", cnt, enable); if (!vdd) { pr_err("Invalid Params"); return -EINVAL; } for (i = 0; i < cnt; i++) { if (enable) { rc = regulator_enable(vdd[i]); if (rc < 0) { pr_err("regulator enable failed %d\n", i); goto error; } } else { rc = regulator_disable(vdd[i]); if (rc < 0) pr_err("regulator disable failed %d\n", i); } } return 0; error: for (--i; i > 0; i--) { if (!IS_ERR_OR_NULL(vdd[i])) regulator_disable(vdd[i]); } return rc; } EXPORT_SYMBOL(msm_camera_regulator_enable); /* Put regulators regulators */ void msm_camera_put_regulators(struct platform_device *pdev, struct regulator ***vdd, int cnt) { int i; if (!*vdd) { pr_err("Invalid params\n"); return; } for (i = cnt - 1; i >= 0; i--) { if (!IS_ERR_OR_NULL((*vdd)[i])) devm_regulator_put((*vdd)[i]); CDBG("vdd ptr[%d] :%p\n", i, (*vdd)[i]); } devm_kfree(&pdev->dev, *vdd); *vdd = NULL; } EXPORT_SYMBOL(msm_camera_put_regulators); struct resource *msm_camera_get_irq(struct platform_device *pdev, char *irq_name) { if (!pdev || !irq_name) { pr_err("Invalid Params\n"); return NULL; } CDBG("Get irq for %s\n", irq_name); return platform_get_resource_byname(pdev, IORESOURCE_IRQ, irq_name); } EXPORT_SYMBOL(msm_camera_get_irq); int msm_camera_register_irq(struct platform_device *pdev, struct resource *irq, irq_handler_t handler, char *irq_name, void *dev_id) { int rc = 0; if (!pdev || !irq || !handler || !irq_name || !dev_id) { pr_err("Invalid Params\n"); return -EINVAL; } rc = devm_request_irq(&pdev->dev, irq->start, handler, IRQF_TRIGGER_RISING, irq_name, dev_id); if (rc < 0) { pr_err("irq request fail\n"); rc = -EINVAL; } CDBG("Registered irq for %s[resource - %p]\n", irq_name, irq); return rc; } EXPORT_SYMBOL(msm_camera_register_irq); int msm_camera_enable_irq(struct resource *irq, int enable) { if (!irq) { pr_err("Invalid Params\n"); return -EINVAL; } CDBG("irq Enable %d\n", enable); if (enable) enable_irq(irq->start); else disable_irq(irq->start); return 0; } EXPORT_SYMBOL(msm_camera_enable_irq); int msm_camera_unregister_irq(struct platform_device *pdev, struct resource *irq, void *dev_id) { if (!pdev || !irq || !dev_id) { pr_err("Invalid Params\n"); return -EINVAL; } CDBG("Un Registering irq for [resource - %p]\n", irq); devm_free_irq(&pdev->dev, irq->start, dev_id); return 0; } EXPORT_SYMBOL(msm_camera_unregister_irq); void __iomem *msm_camera_get_reg_base(struct platform_device *pdev, char *device_name) { struct resource *mem; void *base; if (!pdev || !device_name) { pr_err("Invalid Params\n"); return NULL; } CDBG("device name :%s\n", device_name); mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, device_name); if (!mem) { pr_err("err: mem resource %s not found\n", device_name); return NULL; } if (!devm_request_mem_region(&pdev->dev, mem->start, resource_size(mem), device_name)) { pr_err("err: no valid mem region for device:%s\n", device_name); return NULL; } base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem)); if (!base) { devm_release_mem_region(&pdev->dev, mem->start, resource_size(mem)); pr_err("err: ioremap failed: %s\n", device_name); return NULL; } CDBG("base : %p\n", base); return base; } EXPORT_SYMBOL(msm_camera_get_reg_base); int msm_camera_put_reg_base(struct platform_device *pdev, void __iomem *base, char *device_name) { struct resource *mem; if (!pdev || !base || !device_name) { pr_err("Invalid Params\n"); return -EINVAL; } CDBG("device name :%s\n", device_name); mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, device_name); if (!mem) { pr_err("err: mem resource %s not found\n", device_name); return -EINVAL; } devm_iounmap(&pdev->dev, base); devm_release_mem_region(&pdev->dev, mem->start, resource_size(mem)); return 0; } EXPORT_SYMBOL(msm_camera_put_reg_base); /* Register the bus client */ uint32_t msm_camera_register_bus_client(struct platform_device *pdev, enum cam_ahb_clk_client id) { int rc = 0; uint32_t bus_client, num_usecases, num_paths; struct msm_bus_scale_pdata *pdata; struct device_node *of_node; CDBG("Register client ID: %d\n", id); if (id >= CAM_AHB_CLIENT_MAX || !pdev) { pr_err("Invalid Params"); return -EINVAL; } of_node = pdev->dev.of_node; if (!g_cv[id].pdata) { rc = of_property_read_u32(of_node, "qcom,msm-bus,num-cases", &num_usecases); if (rc) { pr_err("num-usecases not found\n"); return -EINVAL; } rc = of_property_read_u32(of_node, "qcom,msm-bus,num-paths", &num_paths); if (rc) { pr_err("num-usecases not found\n"); return -EINVAL; } if (num_paths != 1) { pr_err("Exceeds number of paths\n"); return -EINVAL; } if (of_property_read_bool(of_node, "qcom,msm-bus-vector-dyn-vote")) { if (num_usecases != 2) { pr_err("Excess or less vectors\n"); return -EINVAL; } g_cv[id].dyn_vote = true; } pdata = msm_bus_cl_get_pdata(pdev); if (!pdata) { pr_err("failed get_pdata client_id :%d\n", id); return -EINVAL; } bus_client = msm_bus_scale_register_client(pdata); if (!bus_client) { pr_err("Unable to register bus client :%d\n", id); return -EINVAL; } } else { pr_err("vector already setup client_id : %d\n", id); return -EINVAL; } g_cv[id].pdata = pdata; g_cv[id].bus_client = bus_client; g_cv[id].vector_index = 0; g_cv[id].num_usecases = num_usecases; g_cv[id].num_paths = num_paths; CDBG("Exit Client ID: %d\n", id); return 0; } EXPORT_SYMBOL(msm_camera_register_bus_client); /* Update the bus bandwidth */ uint32_t msm_camera_update_bus_bw(int id, uint64_t ab, uint64_t ib) { struct msm_bus_paths *path; struct msm_bus_scale_pdata *pdata; int idx = 0; if (id >= CAM_AHB_CLIENT_MAX) { pr_err("Invalid Params"); return -EINVAL; } if (g_cv[id].num_usecases != 2 || g_cv[id].num_paths != 1 || g_cv[id].dyn_vote != true) { pr_err("dynamic update not allowed\n"); return -EINVAL; } idx = g_cv[id].vector_index; pdata = g_cv[id].pdata; idx = 1 - idx; path = &(pdata->usecase[idx]); path->vectors[0].ab = ab; path->vectors[0].ib = ib; CDBG("Register client ID : %d [ab : %llx, ib : %llx], update :%d\n", id, ab, ib, idx); msm_bus_scale_client_update_request(g_cv[id].bus_client, idx); g_cv[id].vector_index = idx; return 0; } EXPORT_SYMBOL(msm_camera_update_bus_bw); /* Update the bus vector */ uint32_t msm_camera_update_bus_vector(enum cam_ahb_clk_client id, int vector_index) { if (id >= CAM_AHB_CLIENT_MAX || g_cv[id].dyn_vote == true) { pr_err("Invalid Params"); return -EINVAL; } if (vector_index < 0 || vector_index > g_cv[id].num_usecases) { pr_err("Invalid Params"); return -EINVAL; } msm_bus_scale_client_update_request(g_cv[id].bus_client, vector_index); return 0; } EXPORT_SYMBOL(msm_camera_update_bus_vector); /* Unregister the bus client */ uint32_t msm_camera_unregister_bus_client(enum cam_ahb_clk_client id) { if (id >= CAM_AHB_CLIENT_MAX) { pr_err("Invalid Params"); return -EINVAL; } CDBG("UnRegister client ID: %d\n", id); msm_bus_scale_unregister_client(g_cv[id].bus_client); msm_bus_cl_clear_pdata(g_cv[id].pdata); memset(&g_cv[id], 0, sizeof(struct msm_cam_bus_pscale_data)); return 0; } EXPORT_SYMBOL(msm_camera_unregister_bus_client);
drivers/media/platform/msm/camera_v2/common/cam_soc_api.h 0 → 100644 +289 −0 File added.Preview size limit exceeded, changes collapsed. Show changes
