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