1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (C) 2018 Marek Behun <marek.behun@nic.cz>
4  */
5 
6 #include <common.h>
7 #include <asm/io.h>
8 
9 #define RWTM_CMD_PARAM(i)	(size_t)(0xd00b0000 + (i) * 4)
10 #define RWTM_CMD		0xd00b0040
11 #define RWTM_CMD_RETSTATUS	0xd00b0080
12 #define RWTM_CMD_STATUS(i)	(size_t)(0xd00b0084 + (i) * 4)
13 
14 #define RWTM_HOST_INT_RESET	0xd00b00c8
15 #define RWTM_HOST_INT_MASK	0xd00b00cc
16 #define SP_CMD_COMPLETE		BIT(0)
17 
18 #define MBOX_STS_SUCCESS		(0x0 << 30)
19 #define MBOX_STS_FAIL			(0x1 << 30)
20 #define MBOX_STS_BADCMD			(0x2 << 30)
21 #define MBOX_STS_LATER			(0x3 << 30)
22 #define MBOX_STS_ERROR(s)		((s) & (3 << 30))
23 #define MBOX_STS_VALUE(s)		(((s) >> 10) & 0xfffff)
24 #define MBOX_STS_CMD(s)			((s) & 0x3ff)
25 
26 enum mbox_cmd {
27 	MBOX_CMD_GET_RANDOM	= 1,
28 	MBOX_CMD_BOARD_INFO,
29 	MBOX_CMD_ECDSA_PUB_KEY,
30 	MBOX_CMD_HASH,
31 	MBOX_CMD_SIGN,
32 	MBOX_CMD_VERIFY,
33 
34 	MBOX_CMD_OTP_READ,
35 	MBOX_CMD_OTP_WRITE
36 };
37 
mbox_do_cmd(enum mbox_cmd cmd,u32 * out,int nout)38 static int mbox_do_cmd(enum mbox_cmd cmd, u32 *out, int nout)
39 {
40 	const int tries = 50;
41 	int i;
42 	u32 status;
43 
44 	clrbits_le32(RWTM_HOST_INT_MASK, SP_CMD_COMPLETE);
45 
46 	writel(cmd, RWTM_CMD);
47 
48 	for (i = 0; i < tries; ++i) {
49 		mdelay(10);
50 		if (readl(RWTM_HOST_INT_RESET) & SP_CMD_COMPLETE)
51 			break;
52 	}
53 
54 	if (i == tries) {
55 		/* if timed out, don't read status */
56 		setbits_le32(RWTM_HOST_INT_RESET, SP_CMD_COMPLETE);
57 		return -ETIMEDOUT;
58 	}
59 
60 	for (i = 0; i < nout; ++i)
61 		out[i] = readl(RWTM_CMD_STATUS(i));
62 	status = readl(RWTM_CMD_RETSTATUS);
63 
64 	setbits_le32(RWTM_HOST_INT_RESET, SP_CMD_COMPLETE);
65 
66 	if (MBOX_STS_CMD(status) != cmd)
67 		return -EIO;
68 	else if (MBOX_STS_ERROR(status) == MBOX_STS_FAIL)
69 		return -(int)MBOX_STS_VALUE(status);
70 	else if (MBOX_STS_ERROR(status) != MBOX_STS_SUCCESS)
71 		return -EIO;
72 	else
73 		return MBOX_STS_VALUE(status);
74 }
75 
mox_sp_get_ecdsa_public_key(void)76 const char *mox_sp_get_ecdsa_public_key(void)
77 {
78 	static char public_key[135];
79 	u32 out[16];
80 	int res;
81 
82 	if (public_key[0])
83 		return public_key;
84 
85 	res = mbox_do_cmd(MBOX_CMD_ECDSA_PUB_KEY, out, 16);
86 	if (res < 0)
87 		return NULL;
88 
89 	sprintf(public_key,
90 		"%06x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x",
91 		(u32)res, out[0], out[1], out[2], out[3], out[4], out[5],
92 		out[6], out[7], out[8], out[9], out[10], out[11], out[12],
93 		out[13], out[14], out[15]);
94 
95 	return public_key;
96 }
97 
res_to_mac(u8 * mac,u32 t1,u32 t2)98 static inline void res_to_mac(u8 *mac, u32 t1, u32 t2)
99 {
100 	mac[0] = t1 >> 8;
101 	mac[1] = t1;
102 	mac[2] = t2 >> 24;
103 	mac[3] = t2 >> 16;
104 	mac[4] = t2 >> 8;
105 	mac[5] = t2;
106 }
107 
mbox_sp_get_board_info(u64 * sn,u8 * mac1,u8 * mac2,int * bv,int * ram)108 int mbox_sp_get_board_info(u64 *sn, u8 *mac1, u8 *mac2, int *bv, int *ram)
109 {
110 	u32 out[8];
111 	int res;
112 
113 	res = mbox_do_cmd(MBOX_CMD_BOARD_INFO, out, 8);
114 	if (res < 0)
115 		return res;
116 
117 	if (sn) {
118 		*sn = out[1];
119 		*sn <<= 32;
120 		*sn |= out[0];
121 	}
122 
123 	if (bv)
124 		*bv = out[2];
125 
126 	if (ram)
127 		*ram = out[3];
128 
129 	if (mac1)
130 		res_to_mac(mac1, out[4], out[5]);
131 
132 	if (mac2)
133 		res_to_mac(mac2, out[6], out[7]);
134 
135 	return 0;
136 }
137