static void get_qos_params(
struct device_node * const dev_node,
struct platform_device * const pdev,
struct msm_bus_node_info_type *node_info)
{
const char *qos_mode = NULL;
unsigned int ret;
unsigned int temp;
ret = of_property_read_string(dev_node, "qcom,qos-mode", &qos_mode);
if (ret)
node_info->qos_params.mode = -1;
else
node_info->qos_params.mode = get_qos_mode(pdev, dev_node,
qos_mode);
of_property_read_u32(dev_node, "qcom,prio-lvl",
&node_info->qos_params.prio_lvl);
of_property_read_u32(dev_node, "qcom,prio1",
&node_info->qos_params.prio1);
of_property_read_u32(dev_node, "qcom,prio0",
&node_info->qos_params.prio0);
of_property_read_u32(dev_node, "qcom,reg-prio1",
&node_info->qos_params.reg_prio1);
of_property_read_u32(dev_node, "qcom,reg-prio0",
&node_info->qos_params.reg_prio0);
of_property_read_u32(dev_node, "qcom,prio-rd",
&node_info->qos_params.prio_rd);
of_property_read_u32(dev_node, "qcom,prio-wr",
&node_info->qos_params.prio_wr);
of_property_read_u32(dev_node, "qcom,gp",
&node_info->qos_params.gp);
of_property_read_u32(dev_node, "qcom,thmp",
&node_info->qos_params.thmp);
of_property_read_u32(dev_node, "qcom,ws",
&node_info->qos_params.ws);
ret = of_property_read_u32(dev_node, "qcom,bw_buffer", &temp);
if (ret)
node_info->qos_params.bw_buffer = 0;
else
node_info->qos_params.bw_buffer = KBTOB(temp);
}
static struct msm_bus_node_info_type *get_node_info_data(
struct device_node * const dev_node,
struct platform_device * const pdev)
{
struct msm_bus_node_info_type *node_info;
unsigned int ret;
int size;
int i;
struct device_node *con_node;
struct device_node *bus_dev;
const char *qos_mode = NULL;
node_info = devm_kzalloc(&pdev->dev,
sizeof(struct msm_bus_node_info_type),
GFP_KERNEL);
if (!node_info) {
dev_err(&pdev->dev,
"Error: Unable to allocate memory for node_info\n");
return NULL;
}
ret = of_property_read_u32(dev_node, "cell-id", &node_info->id);
if (ret) {
dev_warn(&pdev->dev, "Bus node is missing cell-id\n");
goto node_info_err;
}
ret = of_property_read_string(dev_node, "label", &node_info->name);
if (ret) {
dev_warn(&pdev->dev, "Bus node is missing name\n");
goto node_info_err;
}
node_info->qport = get_arr(pdev, dev_node, "qcom,qport",
&node_info->num_qports);
if (of_get_property(dev_node, "qcom,connections", &size)) {
node_info->num_connections = size / sizeof(int);
node_info->connections = devm_kzalloc(&pdev->dev, size,
GFP_KERNEL);
} else {
node_info->num_connections = 0;
node_info->connections = 0;
}
for (i = 0; i < node_info->num_connections; i++) {
con_node = of_parse_phandle(dev_node, "qcom,connections", i);
if (IS_ERR_OR_NULL(con_node))
goto node_info_err;
if (of_property_read_u32(con_node, "cell-id",
&node_info->connections[i]))
goto node_info_err;
of_node_put(con_node);
}
bus_dev = of_parse_phandle(dev_node, "qcom,bus-dev", 0);
if (!IS_ERR_OR_NULL(bus_dev)) {
if (of_property_read_u32(bus_dev, "cell-id",
&node_info->bus_device_id)) {
dev_err(&pdev->dev, "Can't find bus device. Node %d",
node_info->id);
goto node_info_err;
}
of_node_put(bus_dev);
} else
dev_dbg(&pdev->dev, "Can't find bdev phandle for %d",
node_info->id);
node_info->is_fab_dev = of_property_read_bool(dev_node, "qcom,fab-dev");
node_info->virt_dev = of_property_read_bool(dev_node, "qcom,virt-dev");
ret = of_property_read_u32(dev_node, "qcom,buswidth",
&node_info->buswidth);
if (ret) {
dev_dbg(&pdev->dev, "Using default 8 bytes %d", node_info->id);
node_info->buswidth = 8;
}
ret = of_property_read_u32(dev_node, "qcom,mas-rpm-id",
&node_info->mas_rpm_id);
if (ret) {
dev_dbg(&pdev->dev, "mas rpm id is missing\n");
node_info->mas_rpm_id = -1;
}
ret = of_property_read_u32(dev_node, "qcom,slv-rpm-id",
&node_info->slv_rpm_id);
if (ret) {
dev_dbg(&pdev->dev, "slv rpm id is missing\n");
node_info->slv_rpm_id = -1;
}
ret = of_property_read_string(dev_node, "qcom,qos-mode", &qos_mode);
if (ret)
node_info->mode = -1;
else
node_info->mode = get_qos_mode(pdev, dev_node, qos_mode);
ret = of_property_read_u32(dev_node, "qcom,prio-lvl",
&node_info->prio_lvl);
ret = of_property_read_u32(dev_node, "qcom,prio1", &node_info->prio1);
ret = of_property_read_u32(dev_node, "qcom,prio0", &node_info->prio0);
ret = of_property_read_u32(dev_node, "qcom,prio-rd",
&node_info->prio_rd);
ret = of_property_read_u32(dev_node, "qcom,prio-wr",
&node_info->prio_wr);
return node_info;
node_info_err:
devm_kfree(&pdev->dev, node_info);
node_info = 0;
return NULL;
}
