Loading drivers/platform/msm/Kconfig +12 −0 Original line number Diff line number Diff line Loading @@ -223,6 +223,18 @@ config BUS_TOPOLOGY_ADHOC directionality of connections by explicitly listing device connections thus avoiding illegal routes. config DEBUG_BUS_VOTER bool "direct client to vote bus clocks for debugging purposes" depends on BUS_TOPOLOGY_ADHOC default n help This option enables a driver that allows putting in a bus clock vote. This driver allows clients to use the bus scaling driver to put in a floor vote on bus clocks. This feature is meant to be a shortcut to directly put in a vote for bus clocks instead of using the bus scaling APIs which deal with topology end points and not bus clocks directly. config MSM_UIM_HSL tristate "User Indentification Module (UIM) on UART High Speed" help Loading drivers/platform/msm/msm_bus/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -8,6 +8,7 @@ obj-$(CONFIG_MSM_RPM_SMD) += msm_bus_rpm_smd.o ifdef CONFIG_BUS_TOPOLOGY_ADHOC obj-y += msm_bus_fabric_adhoc.o msm_bus_arb_adhoc.o msm_bus_rules.o obj-$(CONFIG_OF) += msm_bus_of_adhoc.o obj-$(CONFIG_DEBUG_BUS_VOTER) += msm_bus_dbg_voter.o obj-$(CONFIG_CORESIGHT) += msm_buspm_coresight_adhoc.o else obj-y += msm_bus_fabric.o msm_bus_config.o msm_bus_arb.o Loading drivers/platform/msm/msm_bus/msm_bus_adhoc.h +8 −0 Original line number Diff line number Diff line Loading @@ -138,4 +138,12 @@ extern int msm_bus_of_get_static_rules(struct platform_device *pdev, extern int msm_rules_update_path(struct list_head *input_list, struct list_head *output_list); extern void print_all_rules(void); #ifdef CONFIG_DEBUG_BUS_VOTER int msm_bus_floor_init(struct device *dev); #else static inline int msm_bus_floor_init(struct device *dev) { return 0; } #endif /* CONFIG_DBG_BUS_VOTER */ #endif /* _ARCH_ARM_MACH_MSM_BUS_ADHOC_H */ drivers/platform/msm/msm_bus/msm_bus_dbg_voter.c 0 → 100644 +589 −0 Original line number Diff line number Diff line /* Copyright (c) 2014, The Linux Foundation. All rights reserved. * * This program is Mree 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/kernel.h> #include <linux/init.h> #include <linux/slab.h> #include <linux/msm-bus.h> #include <linux/msm-bus-board.h> #include "msm_bus_adhoc.h" struct msm_bus_floor_client_type { int mas_id; int slv_id; struct msm_bus_client_handle *vote_handle; struct device *dev; u64 cur_vote_hz; int active_only; }; static struct class *bus_floor_class; #define MAX_VOTER_NAME (50) #define DEFAULT_NODE_WIDTH (8) #define DBG_NAME(s) (strnstr(s, "-", 7) + 1) static int get_id(void) { static int dev_id = MSM_BUS_INT_TEST_ID; int id = dev_id; if (id >= MSM_BUS_INT_TEST_LAST) id = -EINVAL; else dev_id++; return id; } static ssize_t bus_floor_active_only_show(struct device *dev, struct device_attribute *dev_attr, char *buf) { struct msm_bus_floor_client_type *cl; cl = dev_get_drvdata(dev); if (!cl) { pr_err("%s: Can't find cl", __func__); return 0; } return snprintf(buf, sizeof(int), "%d", cl->active_only); } static ssize_t bus_floor_active_only_store(struct device *dev, struct device_attribute *dev_attr, const char *buf, size_t n) { struct msm_bus_floor_client_type *cl; cl = dev_get_drvdata(dev); if (!cl) { pr_err("%s: Can't find cl", __func__); return 0; } if (sscanf(buf, "%d", &cl->active_only) != 1) { pr_err("%s:return error", __func__); return -EINVAL; } return n; } static ssize_t bus_floor_vote_show(struct device *dev, struct device_attribute *dev_attr, char *buf) { struct msm_bus_floor_client_type *cl; cl = dev_get_drvdata(dev); if (!cl) { pr_err("%s: Can't find cl", __func__); return 0; } return snprintf(buf, sizeof(u64), "%llu", cl->cur_vote_hz); } static ssize_t bus_floor_vote_store(struct device *dev, struct device_attribute *dev_attr, const char *buf, size_t n) { struct msm_bus_floor_client_type *cl; int ret = 0; cl = dev_get_drvdata(dev); if (!cl) { pr_err("%s: Can't find cl", __func__); return 0; } if (sscanf(buf, "%llu", &cl->cur_vote_hz) != 1) { pr_err("%s:return error", __func__); return -EINVAL; } ret = msm_bus_floor_vote_context(dev_name(dev), cl->cur_vote_hz, cl->active_only); return n; } static ssize_t bus_floor_vote_store_api(struct device *dev, struct device_attribute *dev_attr, const char *buf, size_t n) { struct msm_bus_floor_client_type *cl; int ret = 0; char name[10]; u64 vote_khz = 0; cl = dev_get_drvdata(dev); if (!cl) { pr_err("%s: Can't find cl", __func__); return 0; } if (sscanf(buf, "%s %llu", name, &vote_khz) != 2) { pr_err("%s:return error", __func__); return -EINVAL; } pr_info("%s: name %s vote %llu\n", __func__, name, vote_khz); ret = msm_bus_floor_vote(name, vote_khz); return n; } static DEVICE_ATTR(floor_vote, S_IRUGO | S_IWUSR, bus_floor_vote_show, bus_floor_vote_store); static DEVICE_ATTR(floor_vote_api, S_IRUGO | S_IWUSR, bus_floor_vote_show, bus_floor_vote_store_api); static DEVICE_ATTR(floor_active_only, S_IRUGO | S_IWUSR, bus_floor_active_only_show, bus_floor_active_only_store); static int msm_bus_floor_init_dev(struct device *fab_dev, struct device *dev, bool is_master) { struct msm_bus_node_device_type *bus_node = NULL; struct msm_bus_node_device_type *fab_node = NULL; struct msm_bus_node_info_type *node_info = NULL; int ret = 0; if (!(fab_dev && dev)) { ret = -ENXIO; goto exit_init_bus_dev; } fab_node = fab_dev->platform_data; if (!fab_node) { pr_info("\n%s: Can't create device", __func__); ret = -ENXIO; goto exit_init_bus_dev; } device_initialize(dev); bus_node = devm_kzalloc(dev, sizeof(struct msm_bus_node_device_type), GFP_KERNEL); if (!bus_node) { pr_err("%s:Bus node alloc failed\n", __func__); ret = -ENOMEM; goto exit_init_bus_dev; } node_info = devm_kzalloc(dev, sizeof(struct msm_bus_node_info_type), GFP_KERNEL); if (!node_info) { pr_err("%s:Bus node info alloc failed\n", __func__); devm_kfree(dev, bus_node); ret = -ENOMEM; goto exit_init_bus_dev; } bus_node->node_info = node_info; bus_node->ap_owned = true; bus_node->node_info->bus_device = fab_dev; bus_node->node_info->buswidth = 8; dev->platform_data = bus_node; dev->bus = &msm_bus_type; bus_node->node_info->id = get_id(); if (bus_node->node_info->id < 0) { pr_err("%s: Failed to get id for dev. Bus:%s is_master:%d", __func__, fab_node->node_info->name, is_master); ret = -ENXIO; goto exit_init_bus_dev; } dev_set_name(dev, "testnode-%s-%s", (is_master ? "mas" : "slv"), fab_node->node_info->name); ret = device_add(dev); if (ret < 0) { pr_err("%s: Failed to add %s", __func__, dev_name(dev)); goto exit_init_bus_dev; } exit_init_bus_dev: return ret; } static int msm_bus_floor_show_info(struct device *dev, void *data) { if (dev) pr_err(" %s\n", dev_name(dev)); return 0; } static void msm_bus_floor_pr_usage(void) { pr_err("msm_bus_floor_vote: Supported buses\n"); class_for_each_device(bus_floor_class, NULL, NULL, msm_bus_floor_show_info); } static int msm_bus_floor_match(struct device *dev, const void *data) { int ret = 0; if (!(dev && data)) return ret; if (strnstr(dev_name(dev), data, MAX_VOTER_NAME)) ret = 1; return ret; } int msm_bus_floor_vote(const char *name, u64 floor_hz) { int ret = -EINVAL; struct msm_bus_floor_client_type *cl; bool found = false; struct device *dbg_voter = NULL; if (!name) { pr_err("%s: NULL name", __func__); return -EINVAL; } dbg_voter = class_find_device(bus_floor_class, NULL, name, msm_bus_floor_match); if (dbg_voter) { found = true; cl = dev_get_drvdata(dbg_voter); if (!cl) { pr_err("%s: Can't find cl", __func__); goto exit_bus_floor_vote; } if (!cl->vote_handle) { char cl_name[MAX_VOTER_NAME]; snprintf(cl_name, MAX_VOTER_NAME, "%s-floor-voter", dev_name(cl->dev)); cl->vote_handle = msm_bus_scale_register(cl->mas_id, cl->slv_id, cl_name, false); if (!cl->vote_handle) { ret = -ENXIO; goto exit_bus_floor_vote; } } cl->cur_vote_hz = floor_hz; ret = msm_bus_scale_update_bw(cl->vote_handle, 0, (floor_hz * DEFAULT_NODE_WIDTH)); if (ret) { pr_err("%s: Failed to update %s", __func__, name); goto exit_bus_floor_vote; } } else { pr_err("\n%s:No matching voting device found for %s", __func__, name); msm_bus_floor_pr_usage(); } exit_bus_floor_vote: if (dbg_voter) put_device(dbg_voter); return ret; } EXPORT_SYMBOL(msm_bus_floor_vote); int msm_bus_floor_vote_context(const char *name, u64 floor_hz, bool active_only) { int ret = -EINVAL; struct msm_bus_floor_client_type *cl; bool found = false; struct device *dbg_voter = NULL; if (!name) { pr_err("%s: NULL name", __func__); return -EINVAL; } dbg_voter = class_find_device(bus_floor_class, NULL, name, msm_bus_floor_match); if (dbg_voter) { found = true; cl = dev_get_drvdata(dbg_voter); if (!cl) { pr_err("%s: Can't find cl", __func__); goto exit_bus_floor_vote_context; } if (!(cl->vote_handle && (cl->vote_handle->active_only == active_only))) { char cl_name[MAX_VOTER_NAME]; if (cl->vote_handle) msm_bus_scale_unregister(cl->vote_handle); snprintf(cl_name, MAX_VOTER_NAME, "%s-floor-voter", dev_name(cl->dev)); cl->vote_handle = msm_bus_scale_register(cl->mas_id, cl->slv_id, (char *)dev_name(cl->dev), active_only); if (!cl->vote_handle) { ret = -ENXIO; goto exit_bus_floor_vote_context; } } cl->cur_vote_hz = floor_hz; ret = msm_bus_scale_update_bw(cl->vote_handle, 0, (floor_hz * DEFAULT_NODE_WIDTH)); if (ret) { pr_err("%s: Failed to update %s", __func__, name); goto exit_bus_floor_vote_context; } } else { pr_err("\n%s:No matching voting device found for %s", __func__, name); msm_bus_floor_pr_usage(); } exit_bus_floor_vote_context: if (dbg_voter) put_device(dbg_voter); return ret; } EXPORT_SYMBOL(msm_bus_floor_vote_context); static int msm_bus_floor_setup_dev_conn(struct device *mas, struct device *slv) { int ret = 0; int slv_id = 0; struct msm_bus_node_device_type *mas_node = NULL; struct msm_bus_node_device_type *slv_node = NULL; if (!(mas && slv)) { pr_err("\n%s: Invalid master/slave device", __func__); ret = -ENXIO; goto exit_setup_dev_conn; } mas_node = mas->platform_data; slv_node = slv->platform_data; if (!(mas_node && slv_node)) { ret = -ENXIO; goto exit_setup_dev_conn; } slv_id = slv_node->node_info->id; mas_node->node_info->num_connections = 1; mas_node->node_info->connections = devm_kzalloc(mas, (sizeof(int) * mas_node->node_info->num_connections), GFP_KERNEL); if (!mas_node->node_info->connections) { pr_err("%s:Bus node connections info alloc failed\n", __func__); ret = -ENOMEM; goto exit_setup_dev_conn; } mas_node->node_info->dev_connections = devm_kzalloc(mas, (sizeof(struct device *) * mas_node->node_info->num_connections), GFP_KERNEL); if (!mas_node->node_info->dev_connections) { pr_err("%s:Bus node dev connections info alloc failed\n", __func__); ret = -ENOMEM; goto exit_setup_dev_conn; } mas_node->node_info->connections[0] = slv_id; mas_node->node_info->dev_connections[0] = slv; exit_setup_dev_conn: return ret; } static int msm_bus_floor_setup_floor_dev( struct msm_bus_node_device_type *mas_node, struct msm_bus_node_device_type *slv_node, struct msm_bus_node_device_type *bus_node) { struct msm_bus_floor_client_type *cl_ptr = NULL; int ret = 0; char *name = NULL; cl_ptr = kzalloc(sizeof(struct msm_bus_floor_client_type), GFP_KERNEL); if (!cl_ptr) { pr_err("\n%s: Err Allocating mem for cl ptr bus %d", __func__, bus_node->node_info->id); ret = -ENOMEM; goto err_setup_floor_dev; } if (!bus_floor_class) { bus_floor_class = class_create(THIS_MODULE, "bus-voter"); if (IS_ERR(bus_floor_class)) { ret = -ENXIO; pr_err("%s: Error creating dev class", __func__); goto err_setup_floor_dev; } } name = DBG_NAME(bus_node->node_info->name); if (!name) { pr_err("%s: Invalid name derived for %s", __func__, bus_node->node_info->name); ret = -EINVAL; goto err_setup_floor_dev; } cl_ptr->dev = kzalloc(sizeof(struct device), GFP_KERNEL); if (!cl_ptr->dev) { pr_err("%s: Failed to create device bus %d", __func__, bus_node->node_info->id); goto err_setup_floor_dev; } device_initialize(cl_ptr->dev); cl_ptr->dev->class = bus_floor_class; dev_set_name(cl_ptr->dev, "%s", name); dev_set_drvdata(cl_ptr->dev, cl_ptr); ret = device_add(cl_ptr->dev); if (ret < 0) { pr_err("%s: Failed to add device bus %d", __func__, bus_node->node_info->id); goto err_setup_floor_dev; } cl_ptr->mas_id = mas_node->node_info->id; cl_ptr->slv_id = slv_node->node_info->id; ret = device_create_file(cl_ptr->dev, &dev_attr_floor_vote); if (ret < 0) goto err_setup_floor_dev; ret = device_create_file(cl_ptr->dev, &dev_attr_floor_vote_api); if (ret < 0) goto err_setup_floor_dev; ret = device_create_file(cl_ptr->dev, &dev_attr_floor_active_only); if (ret < 0) goto err_setup_floor_dev; return ret; err_setup_floor_dev: kfree(cl_ptr); return ret; } int msm_bus_floor_init(struct device *dev) { struct device *m_dev = NULL; struct device *s_dev = NULL; struct msm_bus_node_device_type *mas_node = NULL; struct msm_bus_node_device_type *slv_node = NULL; struct msm_bus_node_device_type *bus_node = NULL; int ret = 0; if (!dev) { pr_info("\n%s: Can't create voting client", __func__); ret = -ENXIO; goto exit_floor_init; } bus_node = dev->platform_data; if (!(bus_node && bus_node->node_info->is_fab_dev)) { pr_info("\n%s: Can't create voting client, not a fab device", __func__); ret = -ENXIO; goto exit_floor_init; } m_dev = kzalloc(sizeof(struct device), GFP_KERNEL); if (!m_dev) { pr_err("%s:Master Device alloc failed\n", __func__); m_dev = NULL; ret = -ENOMEM; goto exit_floor_init; } s_dev = kzalloc(sizeof(struct device), GFP_KERNEL); if (!m_dev) { pr_err("%s:Slave Device alloc failed\n", __func__); s_dev = NULL; kfree(m_dev); ret = -ENOMEM; m_dev = NULL; goto exit_floor_init; } ret = msm_bus_floor_init_dev(dev, m_dev, true); if (ret) { pr_err("\n%s: Error setting up master dev, bus %d", __func__, bus_node->node_info->id); kfree(m_dev); kfree(s_dev); goto exit_floor_init; } ret = msm_bus_floor_init_dev(dev, s_dev, false); if (ret) { pr_err("\n%s: Error setting up slave dev, bus %d", __func__, bus_node->node_info->id); kfree(m_dev); kfree(s_dev); goto exit_floor_init; } ret = msm_bus_floor_setup_dev_conn(m_dev, s_dev); if (ret) { pr_err("\n%s: Error setting up connections bus %d", __func__, bus_node->node_info->id); goto err_floor_init; } mas_node = m_dev->platform_data; slv_node = s_dev->platform_data; if ((!(mas_node && slv_node))) { pr_err("\n%s: Error getting mas/slv nodes bus %d", __func__, bus_node->node_info->id); goto err_floor_init; } ret = msm_bus_floor_setup_floor_dev(mas_node, slv_node, bus_node); if (ret) { pr_err("\n%s: Error getting mas/slv nodes bus %d", __func__, bus_node->node_info->id); goto err_floor_init; } exit_floor_init: return ret; err_floor_init: device_unregister(m_dev); device_unregister(s_dev); kfree(m_dev); kfree(s_dev); return ret; } drivers/platform/msm/msm_bus/msm_bus_fabric_adhoc.c +5 −1 Original line number Diff line number Diff line Loading @@ -1114,6 +1114,9 @@ static int msm_bus_node_debug(struct device *bus_dev, void *data) MSM_BUS_DBG("\n\t Connection[%d] %d", j, bdev->node_info->id); } if (bus_node->node_info->is_fab_dev) msm_bus_floor_init(bus_dev); exit_node_debug: return ret; } Loading Loading @@ -1176,10 +1179,11 @@ static int msm_bus_device_probe(struct platform_device *pdev) goto exit_device_probe; } bus_for_each_dev(&msm_bus_type, NULL, NULL, msm_bus_node_debug); /* Register the arb layer ops */ msm_bus_arb_setops_adhoc(&arb_ops); bus_for_each_dev(&msm_bus_type, NULL, NULL, msm_bus_node_debug); devm_kfree(&pdev->dev, pdata->info); devm_kfree(&pdev->dev, pdata); exit_device_probe: Loading Loading
drivers/platform/msm/Kconfig +12 −0 Original line number Diff line number Diff line Loading @@ -223,6 +223,18 @@ config BUS_TOPOLOGY_ADHOC directionality of connections by explicitly listing device connections thus avoiding illegal routes. config DEBUG_BUS_VOTER bool "direct client to vote bus clocks for debugging purposes" depends on BUS_TOPOLOGY_ADHOC default n help This option enables a driver that allows putting in a bus clock vote. This driver allows clients to use the bus scaling driver to put in a floor vote on bus clocks. This feature is meant to be a shortcut to directly put in a vote for bus clocks instead of using the bus scaling APIs which deal with topology end points and not bus clocks directly. config MSM_UIM_HSL tristate "User Indentification Module (UIM) on UART High Speed" help Loading
drivers/platform/msm/msm_bus/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -8,6 +8,7 @@ obj-$(CONFIG_MSM_RPM_SMD) += msm_bus_rpm_smd.o ifdef CONFIG_BUS_TOPOLOGY_ADHOC obj-y += msm_bus_fabric_adhoc.o msm_bus_arb_adhoc.o msm_bus_rules.o obj-$(CONFIG_OF) += msm_bus_of_adhoc.o obj-$(CONFIG_DEBUG_BUS_VOTER) += msm_bus_dbg_voter.o obj-$(CONFIG_CORESIGHT) += msm_buspm_coresight_adhoc.o else obj-y += msm_bus_fabric.o msm_bus_config.o msm_bus_arb.o Loading
drivers/platform/msm/msm_bus/msm_bus_adhoc.h +8 −0 Original line number Diff line number Diff line Loading @@ -138,4 +138,12 @@ extern int msm_bus_of_get_static_rules(struct platform_device *pdev, extern int msm_rules_update_path(struct list_head *input_list, struct list_head *output_list); extern void print_all_rules(void); #ifdef CONFIG_DEBUG_BUS_VOTER int msm_bus_floor_init(struct device *dev); #else static inline int msm_bus_floor_init(struct device *dev) { return 0; } #endif /* CONFIG_DBG_BUS_VOTER */ #endif /* _ARCH_ARM_MACH_MSM_BUS_ADHOC_H */
drivers/platform/msm/msm_bus/msm_bus_dbg_voter.c 0 → 100644 +589 −0 Original line number Diff line number Diff line /* Copyright (c) 2014, The Linux Foundation. All rights reserved. * * This program is Mree 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/kernel.h> #include <linux/init.h> #include <linux/slab.h> #include <linux/msm-bus.h> #include <linux/msm-bus-board.h> #include "msm_bus_adhoc.h" struct msm_bus_floor_client_type { int mas_id; int slv_id; struct msm_bus_client_handle *vote_handle; struct device *dev; u64 cur_vote_hz; int active_only; }; static struct class *bus_floor_class; #define MAX_VOTER_NAME (50) #define DEFAULT_NODE_WIDTH (8) #define DBG_NAME(s) (strnstr(s, "-", 7) + 1) static int get_id(void) { static int dev_id = MSM_BUS_INT_TEST_ID; int id = dev_id; if (id >= MSM_BUS_INT_TEST_LAST) id = -EINVAL; else dev_id++; return id; } static ssize_t bus_floor_active_only_show(struct device *dev, struct device_attribute *dev_attr, char *buf) { struct msm_bus_floor_client_type *cl; cl = dev_get_drvdata(dev); if (!cl) { pr_err("%s: Can't find cl", __func__); return 0; } return snprintf(buf, sizeof(int), "%d", cl->active_only); } static ssize_t bus_floor_active_only_store(struct device *dev, struct device_attribute *dev_attr, const char *buf, size_t n) { struct msm_bus_floor_client_type *cl; cl = dev_get_drvdata(dev); if (!cl) { pr_err("%s: Can't find cl", __func__); return 0; } if (sscanf(buf, "%d", &cl->active_only) != 1) { pr_err("%s:return error", __func__); return -EINVAL; } return n; } static ssize_t bus_floor_vote_show(struct device *dev, struct device_attribute *dev_attr, char *buf) { struct msm_bus_floor_client_type *cl; cl = dev_get_drvdata(dev); if (!cl) { pr_err("%s: Can't find cl", __func__); return 0; } return snprintf(buf, sizeof(u64), "%llu", cl->cur_vote_hz); } static ssize_t bus_floor_vote_store(struct device *dev, struct device_attribute *dev_attr, const char *buf, size_t n) { struct msm_bus_floor_client_type *cl; int ret = 0; cl = dev_get_drvdata(dev); if (!cl) { pr_err("%s: Can't find cl", __func__); return 0; } if (sscanf(buf, "%llu", &cl->cur_vote_hz) != 1) { pr_err("%s:return error", __func__); return -EINVAL; } ret = msm_bus_floor_vote_context(dev_name(dev), cl->cur_vote_hz, cl->active_only); return n; } static ssize_t bus_floor_vote_store_api(struct device *dev, struct device_attribute *dev_attr, const char *buf, size_t n) { struct msm_bus_floor_client_type *cl; int ret = 0; char name[10]; u64 vote_khz = 0; cl = dev_get_drvdata(dev); if (!cl) { pr_err("%s: Can't find cl", __func__); return 0; } if (sscanf(buf, "%s %llu", name, &vote_khz) != 2) { pr_err("%s:return error", __func__); return -EINVAL; } pr_info("%s: name %s vote %llu\n", __func__, name, vote_khz); ret = msm_bus_floor_vote(name, vote_khz); return n; } static DEVICE_ATTR(floor_vote, S_IRUGO | S_IWUSR, bus_floor_vote_show, bus_floor_vote_store); static DEVICE_ATTR(floor_vote_api, S_IRUGO | S_IWUSR, bus_floor_vote_show, bus_floor_vote_store_api); static DEVICE_ATTR(floor_active_only, S_IRUGO | S_IWUSR, bus_floor_active_only_show, bus_floor_active_only_store); static int msm_bus_floor_init_dev(struct device *fab_dev, struct device *dev, bool is_master) { struct msm_bus_node_device_type *bus_node = NULL; struct msm_bus_node_device_type *fab_node = NULL; struct msm_bus_node_info_type *node_info = NULL; int ret = 0; if (!(fab_dev && dev)) { ret = -ENXIO; goto exit_init_bus_dev; } fab_node = fab_dev->platform_data; if (!fab_node) { pr_info("\n%s: Can't create device", __func__); ret = -ENXIO; goto exit_init_bus_dev; } device_initialize(dev); bus_node = devm_kzalloc(dev, sizeof(struct msm_bus_node_device_type), GFP_KERNEL); if (!bus_node) { pr_err("%s:Bus node alloc failed\n", __func__); ret = -ENOMEM; goto exit_init_bus_dev; } node_info = devm_kzalloc(dev, sizeof(struct msm_bus_node_info_type), GFP_KERNEL); if (!node_info) { pr_err("%s:Bus node info alloc failed\n", __func__); devm_kfree(dev, bus_node); ret = -ENOMEM; goto exit_init_bus_dev; } bus_node->node_info = node_info; bus_node->ap_owned = true; bus_node->node_info->bus_device = fab_dev; bus_node->node_info->buswidth = 8; dev->platform_data = bus_node; dev->bus = &msm_bus_type; bus_node->node_info->id = get_id(); if (bus_node->node_info->id < 0) { pr_err("%s: Failed to get id for dev. Bus:%s is_master:%d", __func__, fab_node->node_info->name, is_master); ret = -ENXIO; goto exit_init_bus_dev; } dev_set_name(dev, "testnode-%s-%s", (is_master ? "mas" : "slv"), fab_node->node_info->name); ret = device_add(dev); if (ret < 0) { pr_err("%s: Failed to add %s", __func__, dev_name(dev)); goto exit_init_bus_dev; } exit_init_bus_dev: return ret; } static int msm_bus_floor_show_info(struct device *dev, void *data) { if (dev) pr_err(" %s\n", dev_name(dev)); return 0; } static void msm_bus_floor_pr_usage(void) { pr_err("msm_bus_floor_vote: Supported buses\n"); class_for_each_device(bus_floor_class, NULL, NULL, msm_bus_floor_show_info); } static int msm_bus_floor_match(struct device *dev, const void *data) { int ret = 0; if (!(dev && data)) return ret; if (strnstr(dev_name(dev), data, MAX_VOTER_NAME)) ret = 1; return ret; } int msm_bus_floor_vote(const char *name, u64 floor_hz) { int ret = -EINVAL; struct msm_bus_floor_client_type *cl; bool found = false; struct device *dbg_voter = NULL; if (!name) { pr_err("%s: NULL name", __func__); return -EINVAL; } dbg_voter = class_find_device(bus_floor_class, NULL, name, msm_bus_floor_match); if (dbg_voter) { found = true; cl = dev_get_drvdata(dbg_voter); if (!cl) { pr_err("%s: Can't find cl", __func__); goto exit_bus_floor_vote; } if (!cl->vote_handle) { char cl_name[MAX_VOTER_NAME]; snprintf(cl_name, MAX_VOTER_NAME, "%s-floor-voter", dev_name(cl->dev)); cl->vote_handle = msm_bus_scale_register(cl->mas_id, cl->slv_id, cl_name, false); if (!cl->vote_handle) { ret = -ENXIO; goto exit_bus_floor_vote; } } cl->cur_vote_hz = floor_hz; ret = msm_bus_scale_update_bw(cl->vote_handle, 0, (floor_hz * DEFAULT_NODE_WIDTH)); if (ret) { pr_err("%s: Failed to update %s", __func__, name); goto exit_bus_floor_vote; } } else { pr_err("\n%s:No matching voting device found for %s", __func__, name); msm_bus_floor_pr_usage(); } exit_bus_floor_vote: if (dbg_voter) put_device(dbg_voter); return ret; } EXPORT_SYMBOL(msm_bus_floor_vote); int msm_bus_floor_vote_context(const char *name, u64 floor_hz, bool active_only) { int ret = -EINVAL; struct msm_bus_floor_client_type *cl; bool found = false; struct device *dbg_voter = NULL; if (!name) { pr_err("%s: NULL name", __func__); return -EINVAL; } dbg_voter = class_find_device(bus_floor_class, NULL, name, msm_bus_floor_match); if (dbg_voter) { found = true; cl = dev_get_drvdata(dbg_voter); if (!cl) { pr_err("%s: Can't find cl", __func__); goto exit_bus_floor_vote_context; } if (!(cl->vote_handle && (cl->vote_handle->active_only == active_only))) { char cl_name[MAX_VOTER_NAME]; if (cl->vote_handle) msm_bus_scale_unregister(cl->vote_handle); snprintf(cl_name, MAX_VOTER_NAME, "%s-floor-voter", dev_name(cl->dev)); cl->vote_handle = msm_bus_scale_register(cl->mas_id, cl->slv_id, (char *)dev_name(cl->dev), active_only); if (!cl->vote_handle) { ret = -ENXIO; goto exit_bus_floor_vote_context; } } cl->cur_vote_hz = floor_hz; ret = msm_bus_scale_update_bw(cl->vote_handle, 0, (floor_hz * DEFAULT_NODE_WIDTH)); if (ret) { pr_err("%s: Failed to update %s", __func__, name); goto exit_bus_floor_vote_context; } } else { pr_err("\n%s:No matching voting device found for %s", __func__, name); msm_bus_floor_pr_usage(); } exit_bus_floor_vote_context: if (dbg_voter) put_device(dbg_voter); return ret; } EXPORT_SYMBOL(msm_bus_floor_vote_context); static int msm_bus_floor_setup_dev_conn(struct device *mas, struct device *slv) { int ret = 0; int slv_id = 0; struct msm_bus_node_device_type *mas_node = NULL; struct msm_bus_node_device_type *slv_node = NULL; if (!(mas && slv)) { pr_err("\n%s: Invalid master/slave device", __func__); ret = -ENXIO; goto exit_setup_dev_conn; } mas_node = mas->platform_data; slv_node = slv->platform_data; if (!(mas_node && slv_node)) { ret = -ENXIO; goto exit_setup_dev_conn; } slv_id = slv_node->node_info->id; mas_node->node_info->num_connections = 1; mas_node->node_info->connections = devm_kzalloc(mas, (sizeof(int) * mas_node->node_info->num_connections), GFP_KERNEL); if (!mas_node->node_info->connections) { pr_err("%s:Bus node connections info alloc failed\n", __func__); ret = -ENOMEM; goto exit_setup_dev_conn; } mas_node->node_info->dev_connections = devm_kzalloc(mas, (sizeof(struct device *) * mas_node->node_info->num_connections), GFP_KERNEL); if (!mas_node->node_info->dev_connections) { pr_err("%s:Bus node dev connections info alloc failed\n", __func__); ret = -ENOMEM; goto exit_setup_dev_conn; } mas_node->node_info->connections[0] = slv_id; mas_node->node_info->dev_connections[0] = slv; exit_setup_dev_conn: return ret; } static int msm_bus_floor_setup_floor_dev( struct msm_bus_node_device_type *mas_node, struct msm_bus_node_device_type *slv_node, struct msm_bus_node_device_type *bus_node) { struct msm_bus_floor_client_type *cl_ptr = NULL; int ret = 0; char *name = NULL; cl_ptr = kzalloc(sizeof(struct msm_bus_floor_client_type), GFP_KERNEL); if (!cl_ptr) { pr_err("\n%s: Err Allocating mem for cl ptr bus %d", __func__, bus_node->node_info->id); ret = -ENOMEM; goto err_setup_floor_dev; } if (!bus_floor_class) { bus_floor_class = class_create(THIS_MODULE, "bus-voter"); if (IS_ERR(bus_floor_class)) { ret = -ENXIO; pr_err("%s: Error creating dev class", __func__); goto err_setup_floor_dev; } } name = DBG_NAME(bus_node->node_info->name); if (!name) { pr_err("%s: Invalid name derived for %s", __func__, bus_node->node_info->name); ret = -EINVAL; goto err_setup_floor_dev; } cl_ptr->dev = kzalloc(sizeof(struct device), GFP_KERNEL); if (!cl_ptr->dev) { pr_err("%s: Failed to create device bus %d", __func__, bus_node->node_info->id); goto err_setup_floor_dev; } device_initialize(cl_ptr->dev); cl_ptr->dev->class = bus_floor_class; dev_set_name(cl_ptr->dev, "%s", name); dev_set_drvdata(cl_ptr->dev, cl_ptr); ret = device_add(cl_ptr->dev); if (ret < 0) { pr_err("%s: Failed to add device bus %d", __func__, bus_node->node_info->id); goto err_setup_floor_dev; } cl_ptr->mas_id = mas_node->node_info->id; cl_ptr->slv_id = slv_node->node_info->id; ret = device_create_file(cl_ptr->dev, &dev_attr_floor_vote); if (ret < 0) goto err_setup_floor_dev; ret = device_create_file(cl_ptr->dev, &dev_attr_floor_vote_api); if (ret < 0) goto err_setup_floor_dev; ret = device_create_file(cl_ptr->dev, &dev_attr_floor_active_only); if (ret < 0) goto err_setup_floor_dev; return ret; err_setup_floor_dev: kfree(cl_ptr); return ret; } int msm_bus_floor_init(struct device *dev) { struct device *m_dev = NULL; struct device *s_dev = NULL; struct msm_bus_node_device_type *mas_node = NULL; struct msm_bus_node_device_type *slv_node = NULL; struct msm_bus_node_device_type *bus_node = NULL; int ret = 0; if (!dev) { pr_info("\n%s: Can't create voting client", __func__); ret = -ENXIO; goto exit_floor_init; } bus_node = dev->platform_data; if (!(bus_node && bus_node->node_info->is_fab_dev)) { pr_info("\n%s: Can't create voting client, not a fab device", __func__); ret = -ENXIO; goto exit_floor_init; } m_dev = kzalloc(sizeof(struct device), GFP_KERNEL); if (!m_dev) { pr_err("%s:Master Device alloc failed\n", __func__); m_dev = NULL; ret = -ENOMEM; goto exit_floor_init; } s_dev = kzalloc(sizeof(struct device), GFP_KERNEL); if (!m_dev) { pr_err("%s:Slave Device alloc failed\n", __func__); s_dev = NULL; kfree(m_dev); ret = -ENOMEM; m_dev = NULL; goto exit_floor_init; } ret = msm_bus_floor_init_dev(dev, m_dev, true); if (ret) { pr_err("\n%s: Error setting up master dev, bus %d", __func__, bus_node->node_info->id); kfree(m_dev); kfree(s_dev); goto exit_floor_init; } ret = msm_bus_floor_init_dev(dev, s_dev, false); if (ret) { pr_err("\n%s: Error setting up slave dev, bus %d", __func__, bus_node->node_info->id); kfree(m_dev); kfree(s_dev); goto exit_floor_init; } ret = msm_bus_floor_setup_dev_conn(m_dev, s_dev); if (ret) { pr_err("\n%s: Error setting up connections bus %d", __func__, bus_node->node_info->id); goto err_floor_init; } mas_node = m_dev->platform_data; slv_node = s_dev->platform_data; if ((!(mas_node && slv_node))) { pr_err("\n%s: Error getting mas/slv nodes bus %d", __func__, bus_node->node_info->id); goto err_floor_init; } ret = msm_bus_floor_setup_floor_dev(mas_node, slv_node, bus_node); if (ret) { pr_err("\n%s: Error getting mas/slv nodes bus %d", __func__, bus_node->node_info->id); goto err_floor_init; } exit_floor_init: return ret; err_floor_init: device_unregister(m_dev); device_unregister(s_dev); kfree(m_dev); kfree(s_dev); return ret; }
drivers/platform/msm/msm_bus/msm_bus_fabric_adhoc.c +5 −1 Original line number Diff line number Diff line Loading @@ -1114,6 +1114,9 @@ static int msm_bus_node_debug(struct device *bus_dev, void *data) MSM_BUS_DBG("\n\t Connection[%d] %d", j, bdev->node_info->id); } if (bus_node->node_info->is_fab_dev) msm_bus_floor_init(bus_dev); exit_node_debug: return ret; } Loading Loading @@ -1176,10 +1179,11 @@ static int msm_bus_device_probe(struct platform_device *pdev) goto exit_device_probe; } bus_for_each_dev(&msm_bus_type, NULL, NULL, msm_bus_node_debug); /* Register the arb layer ops */ msm_bus_arb_setops_adhoc(&arb_ops); bus_for_each_dev(&msm_bus_type, NULL, NULL, msm_bus_node_debug); devm_kfree(&pdev->dev, pdata->info); devm_kfree(&pdev->dev, pdata); exit_device_probe: Loading
