Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
torvalds
GitHub Repository: torvalds/linux
 Path: blob/master/drivers/firmware/imx/imx-scu-soc.c
26428 views
1
// SPDX-License-Identifier: GPL-2.0

2
/*

3
 * Copyright 2019 NXP.

4
 */

5


6
#include <dt-bindings/firmware/imx/rsrc.h>

7
#include <linux/firmware/imx/sci.h>

8
#include <linux/slab.h>

9
#include <linux/sys_soc.h>

10
#include <linux/platform_device.h>

11
#include <linux/of.h>

12


13
static struct imx_sc_ipc *imx_sc_soc_ipc_handle;

14


15
struct imx_sc_msg_misc_get_soc_id {

16
	struct imx_sc_rpc_msg hdr;

17
	union {

18
		struct {

19
			u32 control;

20
			u16 resource;

21
		} __packed req;

22
		struct {

23
			u32 id;

24
		} resp;

25
	} data;

26
} __packed __aligned(4);

27


28
struct imx_sc_msg_misc_get_soc_uid {

29
	struct imx_sc_rpc_msg hdr;

30
	u32 uid_low;

31
	u32 uid_high;

32
} __packed;

33


34
static int imx_scu_soc_uid(u64 *soc_uid)

35
{

36
	struct imx_sc_msg_misc_get_soc_uid msg;

37
	struct imx_sc_rpc_msg *hdr = &msg.hdr;

38
	int ret;

39


40
	hdr->ver = IMX_SC_RPC_VERSION;

41
	hdr->svc = IMX_SC_RPC_SVC_MISC;

42
	hdr->func = IMX_SC_MISC_FUNC_UNIQUE_ID;

43
	hdr->size = 1;

44


45
	ret = imx_scu_call_rpc(imx_sc_soc_ipc_handle, &msg, true);

46
	if (ret) {

47
		pr_err("%s: get soc uid failed, ret %d\n", __func__, ret);

48
		return ret;

49
	}

50


51
	*soc_uid = msg.uid_high;

52
	*soc_uid <<= 32;

53
	*soc_uid |= msg.uid_low;

54


55
	return 0;

56
}

57


58
static int imx_scu_soc_id(void)

59
{

60
	struct imx_sc_msg_misc_get_soc_id msg;

61
	struct imx_sc_rpc_msg *hdr = &msg.hdr;

62
	int ret;

63


64
	hdr->ver = IMX_SC_RPC_VERSION;

65
	hdr->svc = IMX_SC_RPC_SVC_MISC;

66
	hdr->func = IMX_SC_MISC_FUNC_GET_CONTROL;

67
	hdr->size = 3;

68


69
	msg.data.req.control = IMX_SC_C_ID;

70
	msg.data.req.resource = IMX_SC_R_SYSTEM;

71


72
	ret = imx_scu_call_rpc(imx_sc_soc_ipc_handle, &msg, true);

73
	if (ret) {

74
		pr_err("%s: get soc info failed, ret %d\n", __func__, ret);

75
		return ret;

76
	}

77


78
	return msg.data.resp.id;

79
}

80


81
static const char *imx_scu_soc_name(u32 id)

82
{

83
	switch (id) {

84
	case 0x1:

85
		return "i.MX8QM";

86
	case 0x2:

87
		return "i.MX8QXP";

88
	case 0xe:

89
		return "i.MX8DXL";

90
	default:

91
		break;

92
	}

93


94
	return "NULL";

95
}

96


97
int imx_scu_soc_init(struct device *dev)

98
{

99
	struct soc_device_attribute *soc_dev_attr;

100
	struct soc_device *soc_dev;

101
	int id, ret;

102
	u64 uid = 0;

103
	u32 val;

104


105
	ret = imx_scu_get_handle(&imx_sc_soc_ipc_handle);

106
	if (ret)

107
		return ret;

108


109
	soc_dev_attr = devm_kzalloc(dev, sizeof(*soc_dev_attr),

110
				    GFP_KERNEL);

111
	if (!soc_dev_attr)

112
		return -ENOMEM;

113


114
	soc_dev_attr->family = "Freescale i.MX";

115


116
	ret = of_property_read_string(of_root,

117
				      "model",

118
				      &soc_dev_attr->machine);

119
	if (ret)

120
		return ret;

121


122
	id = imx_scu_soc_id();

123
	if (id < 0)

124
		return -EINVAL;

125


126
	ret = imx_scu_soc_uid(&uid);

127
	if (ret < 0)

128
		return -EINVAL;

129


130
	/* format soc_id value passed from SCU firmware */

131
	val = id & 0x1f;

132
	soc_dev_attr->soc_id = imx_scu_soc_name(val);

133


134
	/* format revision value passed from SCU firmware */

135
	val = (id >> 5) & 0xf;

136
	val = (((val >> 2) + 1) << 4) | (val & 0x3);

137
	soc_dev_attr->revision = devm_kasprintf(dev, GFP_KERNEL, "%d.%d",

138
						(val >> 4) & 0xf, val & 0xf);

139
	if (!soc_dev_attr->revision)

140
		return -ENOMEM;

141


142
	soc_dev_attr->serial_number = devm_kasprintf(dev, GFP_KERNEL,

143
						     "%016llX", uid);

144
	if (!soc_dev_attr->serial_number)

145
		return -ENOMEM;

146


147
	soc_dev = soc_device_register(soc_dev_attr);

148
	if (IS_ERR(soc_dev))

149
		return PTR_ERR(soc_dev);

150


151
	return 0;

152
}

153


154