#include <linux/clk.h>
#include <linux/interconnect.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/platform_device.h>
#include <linux/regmap.h>
#include <linux/reset.h>
#include "ppe.h"
#include "ppe_config.h"
#include "ppe_debugfs.h"
#define IPQ9574_PPE_CLK_RATE 353000000
#define IPQ5424_PPE_CLK_RATE 375000000
#define IPQ9574_PPE_PORT_MAX 8
#define IPQ5424_PPE_PORT_MAX 4
struct ppe_of_data {
enum ppe_type type;
unsigned long ppe_rate;
int num_ports;
const struct regmap_config *regmap_config;
const struct icc_bulk_data *icc_paths;
int num_icc_paths;
};
static const struct icc_bulk_data ipq9574_ppe_icc_data[] = {
{
.name = "ppe",
.avg_bw = 0,
.peak_bw = 0,
},
{
.name = "ppe_cfg",
.avg_bw = 0,
.peak_bw = 0,
},
{
.name = "qos_gen",
.avg_bw = 6000,
.peak_bw = 6000,
},
{
.name = "timeout_ref",
.avg_bw = 6000,
.peak_bw = 6000,
},
{
.name = "nssnoc_memnoc",
.avg_bw = 533333,
.peak_bw = 533333,
},
{
.name = "memnoc_nssnoc",
.avg_bw = 533333,
.peak_bw = 533333,
},
{
.name = "memnoc_nssnoc_1",
.avg_bw = 533333,
.peak_bw = 533333,
},
};
static const struct icc_bulk_data ipq5424_ppe_icc_data[] = {
{
.name = "ppe",
.avg_bw = 0,
.peak_bw = 0,
},
{
.name = "ppe_cfg",
.avg_bw = 0,
.peak_bw = 0,
},
{
.name = "nssnoc_ce_axi",
.avg_bw = 0,
.peak_bw = 0,
},
{
.name = "nssnoc_ce_apb",
.avg_bw = 0,
.peak_bw = 0,
},
{
.name = "nssnoc_nss_csr",
.avg_bw = 100000,
.peak_bw = 100000,
},
};
static const struct regmap_range ppe_readable_ranges[] = {
regmap_reg_range(0x0, 0x1ff),
regmap_reg_range(0x400, 0x5ff),
regmap_reg_range(0x1000, 0x11ff),
regmap_reg_range(0x1200, 0x13ff),
regmap_reg_range(0x1400, 0x15ff),
regmap_reg_range(0x1600, 0x17ff),
regmap_reg_range(0x1800, 0x19ff),
regmap_reg_range(0x1a00, 0x1bff),
regmap_reg_range(0xb000, 0xefff),
regmap_reg_range(0xf000, 0x1efff),
regmap_reg_range(0x20000, 0x5ffff),
regmap_reg_range(0x60000, 0x9ffff),
regmap_reg_range(0xb0000, 0xeffff),
regmap_reg_range(0x100000, 0x17ffff),
regmap_reg_range(0x180000, 0x1bffff),
regmap_reg_range(0x1d0000, 0x1dffff),
regmap_reg_range(0x1e0000, 0x1effff),
regmap_reg_range(0x200000, 0x2fffff),
regmap_reg_range(0x300000, 0x3fffff),
regmap_reg_range(0x400000, 0x4fffff),
regmap_reg_range(0x500000, 0x503fff),
regmap_reg_range(0x504000, 0x507fff),
regmap_reg_range(0x508000, 0x50bfff),
regmap_reg_range(0x50c000, 0x50ffff),
regmap_reg_range(0x510000, 0x513fff),
regmap_reg_range(0x514000, 0x517fff),
regmap_reg_range(0x600000, 0x6fffff),
regmap_reg_range(0x800000, 0x9fffff),
regmap_reg_range(0xb00000, 0xbef800),
};
static const struct regmap_access_table ppe_reg_table = {
.yes_ranges = ppe_readable_ranges,
.n_yes_ranges = ARRAY_SIZE(ppe_readable_ranges),
};
static const struct regmap_config regmap_config_ipq9574 = {
.reg_bits = 32,
.reg_stride = 4,
.val_bits = 32,
.rd_table = &ppe_reg_table,
.wr_table = &ppe_reg_table,
.max_register = 0xbef800,
};
static const struct regmap_range ppe_reserved_ranges_ipq5424[] = {
regmap_reg_range(0x1600, 0x17ff),
regmap_reg_range(0x1800, 0x19ff),
regmap_reg_range(0x1a00, 0x1bff),
regmap_reg_range(0x50c000, 0x50ffff),
regmap_reg_range(0x510000, 0x513fff),
regmap_reg_range(0x514000, 0x517fff),
};
static const struct regmap_access_table ppe_reg_table_ipq5424 = {
.yes_ranges = ppe_readable_ranges,
.n_yes_ranges = ARRAY_SIZE(ppe_readable_ranges),
.no_ranges = ppe_reserved_ranges_ipq5424,
.n_no_ranges = ARRAY_SIZE(ppe_reserved_ranges_ipq5424),
};
static const struct regmap_config regmap_config_ipq5424 = {
.reg_bits = 32,
.reg_stride = 4,
.val_bits = 32,
.rd_table = &ppe_reg_table_ipq5424,
.wr_table = &ppe_reg_table_ipq5424,
.max_register = 0xbef800,
};
static int ppe_clock_init_and_reset(struct ppe_device *ppe_dev,
const struct ppe_of_data *data)
{
unsigned long ppe_rate = ppe_dev->clk_rate;
struct device *dev = ppe_dev->dev;
struct reset_control *rstc;
struct clk_bulk_data *clks;
struct clk *clk;
int ret, i;
for (i = 0; i < ppe_dev->num_icc_paths; i++) {
ppe_dev->icc_paths[i].name = data->icc_paths[i].name;
ppe_dev->icc_paths[i].avg_bw = data->icc_paths[i].avg_bw ? :
Bps_to_icc(ppe_rate);
ppe_dev->icc_paths[i].peak_bw = data->icc_paths[i].peak_bw ? :
Bps_to_icc(ppe_rate);
}
ret = devm_of_icc_bulk_get(dev, ppe_dev->num_icc_paths,
ppe_dev->icc_paths);
if (ret)
return ret;
ret = icc_bulk_set_bw(ppe_dev->num_icc_paths, ppe_dev->icc_paths);
if (ret)
return ret;
clk = devm_clk_get(dev, "ppe");
if (IS_ERR(clk))
return PTR_ERR(clk);
ret = clk_set_rate(clk, ppe_rate);
if (ret)
return ret;
ret = devm_clk_bulk_get_all_enabled(dev, &clks);
if (ret < 0)
return ret;
rstc = devm_reset_control_get_exclusive(dev, NULL);
if (IS_ERR(rstc))
return PTR_ERR(rstc);
ret = reset_control_assert(rstc);
if (ret)
return ret;
usleep_range(10000, 11000);
return reset_control_deassert(rstc);
}
static int qcom_ppe_probe(struct platform_device *pdev)
{
struct device *dev = &pdev->dev;
const struct ppe_of_data *data;
struct ppe_device *ppe_dev;
void __iomem *base;
int ret;
data = of_device_get_match_data(dev);
if (!data)
return dev_err_probe(dev, -EINVAL, "PPE no match data provided\n");
ppe_dev = devm_kzalloc_flex(dev, *ppe_dev, icc_paths,
data->num_icc_paths);
if (!ppe_dev)
return -ENOMEM;
base = devm_platform_ioremap_resource(pdev, 0);
if (IS_ERR(base))
return dev_err_probe(dev, PTR_ERR(base), "PPE ioremap failed\n");
ppe_dev->regmap = devm_regmap_init_mmio(dev, base, data->regmap_config);
if (IS_ERR(ppe_dev->regmap))
return dev_err_probe(dev, PTR_ERR(ppe_dev->regmap),
"PPE initialize regmap failed\n");
ppe_dev->dev = dev;
ppe_dev->type = data->type;
ppe_dev->clk_rate = data->ppe_rate;
ppe_dev->num_ports = data->num_ports;
ppe_dev->num_icc_paths = data->num_icc_paths;
ret = ppe_clock_init_and_reset(ppe_dev, data);
if (ret)
return dev_err_probe(dev, ret, "PPE clock config failed\n");
ret = ppe_hw_config(ppe_dev);
if (ret)
return dev_err_probe(dev, ret, "PPE HW config failed\n");
ppe_debugfs_setup(ppe_dev);
platform_set_drvdata(pdev, ppe_dev);
return 0;
}
static void qcom_ppe_remove(struct platform_device *pdev)
{
struct ppe_device *ppe_dev;
ppe_dev = platform_get_drvdata(pdev);
ppe_debugfs_teardown(ppe_dev);
}
static const struct ppe_of_data ipq9574_data = {
.type = IPQ9574_PPE,
.ppe_rate = IPQ9574_PPE_CLK_RATE,
.num_ports = IPQ9574_PPE_PORT_MAX,
.regmap_config = ®map_config_ipq9574,
.icc_paths = ipq9574_ppe_icc_data,
.num_icc_paths = ARRAY_SIZE(ipq9574_ppe_icc_data),
};
static const struct ppe_of_data ipq5424_data = {
.type = IPQ5424_PPE,
.ppe_rate = IPQ5424_PPE_CLK_RATE,
.num_ports = IPQ5424_PPE_PORT_MAX,
.regmap_config = ®map_config_ipq5424,
.icc_paths = ipq5424_ppe_icc_data,
.num_icc_paths = ARRAY_SIZE(ipq5424_ppe_icc_data),
};
static const struct of_device_id qcom_ppe_of_match[] = {
{ .compatible = "qcom,ipq9574-ppe", .data = &ipq9574_data },
{ .compatible = "qcom,ipq5424-ppe", .data = &ipq5424_data },
{}
};
MODULE_DEVICE_TABLE(of, qcom_ppe_of_match);
static struct platform_driver qcom_ppe_driver = {
.driver = {
.name = "qcom_ppe",
.of_match_table = qcom_ppe_of_match,
},
.probe = qcom_ppe_probe,
.remove = qcom_ppe_remove,
};
module_platform_driver(qcom_ppe_driver);
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("Qualcomm Technologies, Inc. IPQ PPE driver"