32616b2121
This patch fixes typos in the llcc-slice driver.
Fixes: 72d1cd0331
("qcom: soc: llcc-slice: Clear the global drv_data pointer on error")
Signed-off-by: Andy Gross <andy.gross@linaro.org>
413 lines
10 KiB
C
413 lines
10 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
|
|
*
|
|
*/
|
|
|
|
#include <linux/bitmap.h>
|
|
#include <linux/bitops.h>
|
|
#include <linux/device.h>
|
|
#include <linux/io.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/sizes.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/soc/qcom/llcc-qcom.h>
|
|
|
|
#define ACTIVATE BIT(0)
|
|
#define DEACTIVATE BIT(1)
|
|
#define ACT_CTRL_OPCODE_ACTIVATE BIT(0)
|
|
#define ACT_CTRL_OPCODE_DEACTIVATE BIT(1)
|
|
#define ACT_CTRL_ACT_TRIG BIT(0)
|
|
#define ACT_CTRL_OPCODE_SHIFT 0x01
|
|
#define ATTR1_PROBE_TARGET_WAYS_SHIFT 0x02
|
|
#define ATTR1_FIXED_SIZE_SHIFT 0x03
|
|
#define ATTR1_PRIORITY_SHIFT 0x04
|
|
#define ATTR1_MAX_CAP_SHIFT 0x10
|
|
#define ATTR0_RES_WAYS_MASK GENMASK(11, 0)
|
|
#define ATTR0_BONUS_WAYS_MASK GENMASK(27, 16)
|
|
#define ATTR0_BONUS_WAYS_SHIFT 0x10
|
|
#define LLCC_STATUS_READ_DELAY 100
|
|
|
|
#define CACHE_LINE_SIZE_SHIFT 6
|
|
|
|
#define LLCC_COMMON_STATUS0 0x0003000c
|
|
#define LLCC_LB_CNT_MASK GENMASK(31, 28)
|
|
#define LLCC_LB_CNT_SHIFT 28
|
|
|
|
#define MAX_CAP_TO_BYTES(n) (n * SZ_1K)
|
|
#define LLCC_TRP_ACT_CTRLn(n) (n * SZ_4K)
|
|
#define LLCC_TRP_STATUSn(n) (4 + n * SZ_4K)
|
|
#define LLCC_TRP_ATTR0_CFGn(n) (0x21000 + SZ_8 * n)
|
|
#define LLCC_TRP_ATTR1_CFGn(n) (0x21004 + SZ_8 * n)
|
|
|
|
#define BANK_OFFSET_STRIDE 0x80000
|
|
|
|
static struct llcc_drv_data *drv_data = (void *) -EPROBE_DEFER;
|
|
|
|
static const struct regmap_config llcc_regmap_config = {
|
|
.reg_bits = 32,
|
|
.reg_stride = 4,
|
|
.val_bits = 32,
|
|
.fast_io = true,
|
|
};
|
|
|
|
/**
|
|
* llcc_slice_getd - get llcc slice descriptor
|
|
* @uid: usecase_id for the client
|
|
*
|
|
* A pointer to llcc slice descriptor will be returned on success and
|
|
* and error pointer is returned on failure
|
|
*/
|
|
struct llcc_slice_desc *llcc_slice_getd(u32 uid)
|
|
{
|
|
const struct llcc_slice_config *cfg;
|
|
struct llcc_slice_desc *desc;
|
|
u32 sz, count;
|
|
|
|
if (IS_ERR(drv_data))
|
|
return ERR_CAST(drv_data);
|
|
|
|
cfg = drv_data->cfg;
|
|
sz = drv_data->cfg_size;
|
|
|
|
for (count = 0; cfg && count < sz; count++, cfg++)
|
|
if (cfg->usecase_id == uid)
|
|
break;
|
|
|
|
if (count == sz || !cfg)
|
|
return ERR_PTR(-ENODEV);
|
|
|
|
desc = kzalloc(sizeof(*desc), GFP_KERNEL);
|
|
if (!desc)
|
|
return ERR_PTR(-ENOMEM);
|
|
|
|
desc->slice_id = cfg->slice_id;
|
|
desc->slice_size = cfg->max_cap;
|
|
|
|
return desc;
|
|
}
|
|
EXPORT_SYMBOL_GPL(llcc_slice_getd);
|
|
|
|
/**
|
|
* llcc_slice_putd - llcc slice descritpor
|
|
* @desc: Pointer to llcc slice descriptor
|
|
*/
|
|
void llcc_slice_putd(struct llcc_slice_desc *desc)
|
|
{
|
|
if (!IS_ERR_OR_NULL(desc))
|
|
kfree(desc);
|
|
}
|
|
EXPORT_SYMBOL_GPL(llcc_slice_putd);
|
|
|
|
static int llcc_update_act_ctrl(u32 sid,
|
|
u32 act_ctrl_reg_val, u32 status)
|
|
{
|
|
u32 act_ctrl_reg;
|
|
u32 status_reg;
|
|
u32 slice_status;
|
|
int ret;
|
|
|
|
if (IS_ERR(drv_data))
|
|
return PTR_ERR(drv_data);
|
|
|
|
act_ctrl_reg = LLCC_TRP_ACT_CTRLn(sid);
|
|
status_reg = LLCC_TRP_STATUSn(sid);
|
|
|
|
/* Set the ACTIVE trigger */
|
|
act_ctrl_reg_val |= ACT_CTRL_ACT_TRIG;
|
|
ret = regmap_write(drv_data->bcast_regmap, act_ctrl_reg,
|
|
act_ctrl_reg_val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* Clear the ACTIVE trigger */
|
|
act_ctrl_reg_val &= ~ACT_CTRL_ACT_TRIG;
|
|
ret = regmap_write(drv_data->bcast_regmap, act_ctrl_reg,
|
|
act_ctrl_reg_val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = regmap_read_poll_timeout(drv_data->bcast_regmap, status_reg,
|
|
slice_status, !(slice_status & status),
|
|
0, LLCC_STATUS_READ_DELAY);
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* llcc_slice_activate - Activate the llcc slice
|
|
* @desc: Pointer to llcc slice descriptor
|
|
*
|
|
* A value of zero will be returned on success and a negative errno will
|
|
* be returned in error cases
|
|
*/
|
|
int llcc_slice_activate(struct llcc_slice_desc *desc)
|
|
{
|
|
int ret;
|
|
u32 act_ctrl_val;
|
|
|
|
if (IS_ERR(drv_data))
|
|
return PTR_ERR(drv_data);
|
|
|
|
if (IS_ERR_OR_NULL(desc))
|
|
return -EINVAL;
|
|
|
|
mutex_lock(&drv_data->lock);
|
|
if (test_bit(desc->slice_id, drv_data->bitmap)) {
|
|
mutex_unlock(&drv_data->lock);
|
|
return 0;
|
|
}
|
|
|
|
act_ctrl_val = ACT_CTRL_OPCODE_ACTIVATE << ACT_CTRL_OPCODE_SHIFT;
|
|
|
|
ret = llcc_update_act_ctrl(desc->slice_id, act_ctrl_val,
|
|
DEACTIVATE);
|
|
if (ret) {
|
|
mutex_unlock(&drv_data->lock);
|
|
return ret;
|
|
}
|
|
|
|
__set_bit(desc->slice_id, drv_data->bitmap);
|
|
mutex_unlock(&drv_data->lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(llcc_slice_activate);
|
|
|
|
/**
|
|
* llcc_slice_deactivate - Deactivate the llcc slice
|
|
* @desc: Pointer to llcc slice descriptor
|
|
*
|
|
* A value of zero will be returned on success and a negative errno will
|
|
* be returned in error cases
|
|
*/
|
|
int llcc_slice_deactivate(struct llcc_slice_desc *desc)
|
|
{
|
|
u32 act_ctrl_val;
|
|
int ret;
|
|
|
|
if (IS_ERR(drv_data))
|
|
return PTR_ERR(drv_data);
|
|
|
|
if (IS_ERR_OR_NULL(desc))
|
|
return -EINVAL;
|
|
|
|
mutex_lock(&drv_data->lock);
|
|
if (!test_bit(desc->slice_id, drv_data->bitmap)) {
|
|
mutex_unlock(&drv_data->lock);
|
|
return 0;
|
|
}
|
|
act_ctrl_val = ACT_CTRL_OPCODE_DEACTIVATE << ACT_CTRL_OPCODE_SHIFT;
|
|
|
|
ret = llcc_update_act_ctrl(desc->slice_id, act_ctrl_val,
|
|
ACTIVATE);
|
|
if (ret) {
|
|
mutex_unlock(&drv_data->lock);
|
|
return ret;
|
|
}
|
|
|
|
__clear_bit(desc->slice_id, drv_data->bitmap);
|
|
mutex_unlock(&drv_data->lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(llcc_slice_deactivate);
|
|
|
|
/**
|
|
* llcc_get_slice_id - return the slice id
|
|
* @desc: Pointer to llcc slice descriptor
|
|
*/
|
|
int llcc_get_slice_id(struct llcc_slice_desc *desc)
|
|
{
|
|
if (IS_ERR_OR_NULL(desc))
|
|
return -EINVAL;
|
|
|
|
return desc->slice_id;
|
|
}
|
|
EXPORT_SYMBOL_GPL(llcc_get_slice_id);
|
|
|
|
/**
|
|
* llcc_get_slice_size - return the slice id
|
|
* @desc: Pointer to llcc slice descriptor
|
|
*/
|
|
size_t llcc_get_slice_size(struct llcc_slice_desc *desc)
|
|
{
|
|
if (IS_ERR_OR_NULL(desc))
|
|
return 0;
|
|
|
|
return desc->slice_size;
|
|
}
|
|
EXPORT_SYMBOL_GPL(llcc_get_slice_size);
|
|
|
|
static int qcom_llcc_cfg_program(struct platform_device *pdev)
|
|
{
|
|
int i;
|
|
u32 attr1_cfg;
|
|
u32 attr0_cfg;
|
|
u32 attr1_val;
|
|
u32 attr0_val;
|
|
u32 max_cap_cacheline;
|
|
u32 sz;
|
|
int ret = 0;
|
|
const struct llcc_slice_config *llcc_table;
|
|
struct llcc_slice_desc desc;
|
|
|
|
sz = drv_data->cfg_size;
|
|
llcc_table = drv_data->cfg;
|
|
|
|
for (i = 0; i < sz; i++) {
|
|
attr1_cfg = LLCC_TRP_ATTR1_CFGn(llcc_table[i].slice_id);
|
|
attr0_cfg = LLCC_TRP_ATTR0_CFGn(llcc_table[i].slice_id);
|
|
|
|
attr1_val = llcc_table[i].cache_mode;
|
|
attr1_val |= llcc_table[i].probe_target_ways <<
|
|
ATTR1_PROBE_TARGET_WAYS_SHIFT;
|
|
attr1_val |= llcc_table[i].fixed_size <<
|
|
ATTR1_FIXED_SIZE_SHIFT;
|
|
attr1_val |= llcc_table[i].priority <<
|
|
ATTR1_PRIORITY_SHIFT;
|
|
|
|
max_cap_cacheline = MAX_CAP_TO_BYTES(llcc_table[i].max_cap);
|
|
|
|
/* LLCC instances can vary for each target.
|
|
* The SW writes to broadcast register which gets propagated
|
|
* to each llcc instace (llcc0,.. llccN).
|
|
* Since the size of the memory is divided equally amongst the
|
|
* llcc instances, we need to configure the max cap accordingly.
|
|
*/
|
|
max_cap_cacheline = max_cap_cacheline / drv_data->num_banks;
|
|
max_cap_cacheline >>= CACHE_LINE_SIZE_SHIFT;
|
|
attr1_val |= max_cap_cacheline << ATTR1_MAX_CAP_SHIFT;
|
|
|
|
attr0_val = llcc_table[i].res_ways & ATTR0_RES_WAYS_MASK;
|
|
attr0_val |= llcc_table[i].bonus_ways << ATTR0_BONUS_WAYS_SHIFT;
|
|
|
|
ret = regmap_write(drv_data->bcast_regmap, attr1_cfg,
|
|
attr1_val);
|
|
if (ret)
|
|
return ret;
|
|
ret = regmap_write(drv_data->bcast_regmap, attr0_cfg,
|
|
attr0_val);
|
|
if (ret)
|
|
return ret;
|
|
if (llcc_table[i].activate_on_init) {
|
|
desc.slice_id = llcc_table[i].slice_id;
|
|
ret = llcc_slice_activate(&desc);
|
|
}
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
int qcom_llcc_remove(struct platform_device *pdev)
|
|
{
|
|
/* Set the global pointer to a error code to avoid referencing it */
|
|
drv_data = ERR_PTR(-ENODEV);
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(qcom_llcc_remove);
|
|
|
|
static struct regmap *qcom_llcc_init_mmio(struct platform_device *pdev,
|
|
const char *name)
|
|
{
|
|
struct resource *res;
|
|
void __iomem *base;
|
|
|
|
res = platform_get_resource_byname(pdev, IORESOURCE_MEM, name);
|
|
if (!res)
|
|
return ERR_PTR(-ENODEV);
|
|
|
|
base = devm_ioremap_resource(&pdev->dev, res);
|
|
if (IS_ERR(base))
|
|
return ERR_CAST(base);
|
|
|
|
return devm_regmap_init_mmio(&pdev->dev, base, &llcc_regmap_config);
|
|
}
|
|
|
|
int qcom_llcc_probe(struct platform_device *pdev,
|
|
const struct llcc_slice_config *llcc_cfg, u32 sz)
|
|
{
|
|
u32 num_banks;
|
|
struct device *dev = &pdev->dev;
|
|
int ret, i;
|
|
struct platform_device *llcc_edac;
|
|
|
|
drv_data = devm_kzalloc(dev, sizeof(*drv_data), GFP_KERNEL);
|
|
if (!drv_data) {
|
|
ret = -ENOMEM;
|
|
goto err;
|
|
}
|
|
|
|
drv_data->regmap = qcom_llcc_init_mmio(pdev, "llcc_base");
|
|
if (IS_ERR(drv_data->regmap)) {
|
|
ret = PTR_ERR(drv_data->regmap);
|
|
goto err;
|
|
}
|
|
|
|
drv_data->bcast_regmap =
|
|
qcom_llcc_init_mmio(pdev, "llcc_broadcast_base");
|
|
if (IS_ERR(drv_data->bcast_regmap)) {
|
|
ret = PTR_ERR(drv_data->bcast_regmap);
|
|
goto err;
|
|
}
|
|
|
|
ret = regmap_read(drv_data->regmap, LLCC_COMMON_STATUS0,
|
|
&num_banks);
|
|
if (ret)
|
|
goto err;
|
|
|
|
num_banks &= LLCC_LB_CNT_MASK;
|
|
num_banks >>= LLCC_LB_CNT_SHIFT;
|
|
drv_data->num_banks = num_banks;
|
|
|
|
for (i = 0; i < sz; i++)
|
|
if (llcc_cfg[i].slice_id > drv_data->max_slices)
|
|
drv_data->max_slices = llcc_cfg[i].slice_id;
|
|
|
|
drv_data->offsets = devm_kcalloc(dev, num_banks, sizeof(u32),
|
|
GFP_KERNEL);
|
|
if (!drv_data->offsets) {
|
|
ret = -ENOMEM;
|
|
goto err;
|
|
}
|
|
|
|
for (i = 0; i < num_banks; i++)
|
|
drv_data->offsets[i] = i * BANK_OFFSET_STRIDE;
|
|
|
|
drv_data->bitmap = devm_kcalloc(dev,
|
|
BITS_TO_LONGS(drv_data->max_slices), sizeof(unsigned long),
|
|
GFP_KERNEL);
|
|
if (!drv_data->bitmap) {
|
|
ret = -ENOMEM;
|
|
goto err;
|
|
}
|
|
|
|
drv_data->cfg = llcc_cfg;
|
|
drv_data->cfg_size = sz;
|
|
mutex_init(&drv_data->lock);
|
|
platform_set_drvdata(pdev, drv_data);
|
|
|
|
ret = qcom_llcc_cfg_program(pdev);
|
|
if (ret)
|
|
goto err;
|
|
|
|
drv_data->ecc_irq = platform_get_irq(pdev, 0);
|
|
if (drv_data->ecc_irq >= 0) {
|
|
llcc_edac = platform_device_register_data(&pdev->dev,
|
|
"qcom_llcc_edac", -1, drv_data,
|
|
sizeof(*drv_data));
|
|
if (IS_ERR(llcc_edac))
|
|
dev_err(dev, "Failed to register llcc edac driver\n");
|
|
}
|
|
|
|
return 0;
|
|
err:
|
|
drv_data = ERR_PTR(-ENODEV);
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(qcom_llcc_probe);
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_DESCRIPTION("Qualcomm Last Level Cache Controller");
|