1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
|
// SPDX-License-Identifier: GPL-2.0
/*
* GXP SSMT driver.
*
* Copyright (C) 2022 Google LLC
*/
#include <linux/platform_device.h>
#include "gxp-config.h"
#include "gxp-internal.h"
#include "gxp-ssmt.h"
static inline void ssmt_set_vid_for_sid(void __iomem *ssmt, uint vid, uint sid)
{
/* NS_READ_STREAM_VID_<sid> */
writel(vid, ssmt + 0x1000u + 0x4u * sid);
/* NS_WRITE_STREAM_VID_<sid> */
writel(vid, ssmt + 0x1200u + 0x4u * sid);
}
int gxp_ssmt_init(struct gxp_dev *gxp, struct gxp_ssmt *ssmt)
{
struct platform_device *pdev =
container_of(gxp->dev, struct platform_device, dev);
struct resource *r;
ssmt->gxp = gxp;
r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "ssmt_idma");
if (!r) {
dev_err(gxp->dev, "Failed to find IDMA SSMT register base\n");
return -EINVAL;
}
ssmt->idma_ssmt_base = devm_ioremap_resource(gxp->dev, r);
if (IS_ERR(ssmt->idma_ssmt_base)) {
dev_err(gxp->dev,
"Failed to map IDMA SSMT register base (%ld)\n",
PTR_ERR(ssmt->idma_ssmt_base));
return PTR_ERR(ssmt->idma_ssmt_base);
}
r = platform_get_resource_byname(pdev, IORESOURCE_MEM,
"ssmt_inst_data");
if (!r) {
dev_err(gxp->dev,
"Failed to find instruction/data SSMT register base\n");
return -EINVAL;
}
ssmt->inst_data_ssmt_base = devm_ioremap_resource(gxp->dev, r);
if (IS_ERR(ssmt->inst_data_ssmt_base)) {
dev_err(gxp->dev,
"Failed to map instruction/data SSMT register base (%ld)\n",
PTR_ERR(ssmt->inst_data_ssmt_base));
return PTR_ERR(ssmt->inst_data_ssmt_base);
}
return 0;
}
void gxp_ssmt_set_core_vid(struct gxp_ssmt *ssmt, uint core, uint vid)
{
const u8 sids[] = {
INST_SID_FOR_CORE(core),
DATA_SID_FOR_CORE(core),
IDMA_SID_FOR_CORE(core),
};
int i;
for (i = 0; i < ARRAY_SIZE(sids); i++) {
ssmt_set_vid_for_sid(ssmt->idma_ssmt_base, vid, sids[i]);
ssmt_set_vid_for_sid(ssmt->inst_data_ssmt_base, vid, sids[i]);
}
}
|