1 /* SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0)
2 *
3 * Copyright 2008-2016 Freescale Semiconductor Inc.
4 * Copyright 2016,2019 NXP
5 */
6
7 #ifndef __RTA_STORE_CMD_H__
8 #define __RTA_STORE_CMD_H__
9
10 extern enum rta_sec_era rta_sec_era;
11
12 static const uint32_t store_src_table[][2] = {
13 /*1*/ { KEY1SZ, LDST_CLASS_1_CCB | LDST_SRCDST_WORD_KEYSZ_REG },
14 { KEY2SZ, LDST_CLASS_2_CCB | LDST_SRCDST_WORD_KEYSZ_REG },
15 { DJQDA, LDST_CLASS_DECO | LDST_SRCDST_WORD_DECO_JQDAR },
16 { MODE1, LDST_CLASS_1_CCB | LDST_SRCDST_WORD_MODE_REG },
17 { MODE2, LDST_CLASS_2_CCB | LDST_SRCDST_WORD_MODE_REG },
18 { DJQCTRL, LDST_CLASS_DECO | LDST_SRCDST_WORD_DECO_JQCTRL },
19 { DATA1SZ, LDST_CLASS_1_CCB | LDST_SRCDST_WORD_DATASZ_REG },
20 { DATA2SZ, LDST_CLASS_2_CCB | LDST_SRCDST_WORD_DATASZ_REG },
21 { DSTAT, LDST_CLASS_DECO | LDST_SRCDST_WORD_DECO_STAT },
22 { ICV1SZ, LDST_CLASS_1_CCB | LDST_SRCDST_WORD_ICVSZ_REG },
23 { ICV2SZ, LDST_CLASS_2_CCB | LDST_SRCDST_WORD_ICVSZ_REG },
24 { DPID, LDST_CLASS_DECO | LDST_SRCDST_WORD_PID },
25 { CCTRL, LDST_SRCDST_WORD_CHACTRL },
26 { ICTRL, LDST_SRCDST_WORD_IRQCTRL },
27 { CLRW, LDST_SRCDST_WORD_CLRW },
28 { MATH0, LDST_CLASS_DECO | LDST_SRCDST_WORD_DECO_MATH0 },
29 { CSTAT, LDST_SRCDST_WORD_STAT },
30 { MATH1, LDST_CLASS_DECO | LDST_SRCDST_WORD_DECO_MATH1 },
31 { MATH2, LDST_CLASS_DECO | LDST_SRCDST_WORD_DECO_MATH2 },
32 { AAD1SZ, LDST_CLASS_1_CCB | LDST_SRCDST_WORD_DECO_AAD_SZ },
33 { MATH3, LDST_CLASS_DECO | LDST_SRCDST_WORD_DECO_MATH3 },
34 { IV1SZ, LDST_CLASS_1_CCB | LDST_SRCDST_WORD_CLASS1_IV_SZ },
35 { PKASZ, LDST_CLASS_1_CCB | LDST_SRCDST_WORD_PKHA_A_SZ },
36 { PKBSZ, LDST_CLASS_1_CCB | LDST_SRCDST_WORD_PKHA_B_SZ },
37 { PKESZ, LDST_CLASS_1_CCB | LDST_SRCDST_WORD_PKHA_E_SZ },
38 { PKNSZ, LDST_CLASS_1_CCB | LDST_SRCDST_WORD_PKHA_N_SZ },
39 { CONTEXT1, LDST_CLASS_1_CCB | LDST_SRCDST_BYTE_CONTEXT },
40 { CONTEXT2, LDST_CLASS_2_CCB | LDST_SRCDST_BYTE_CONTEXT },
41 { DESCBUF, LDST_CLASS_DECO | LDST_SRCDST_WORD_DESCBUF },
42 /*30*/ { JOBDESCBUF, LDST_CLASS_DECO | LDST_SRCDST_WORD_DESCBUF_JOB },
43 { SHAREDESCBUF, LDST_CLASS_DECO | LDST_SRCDST_WORD_DESCBUF_SHARED },
44 /*32*/ { JOBDESCBUF_EFF, LDST_CLASS_DECO |
45 LDST_SRCDST_WORD_DESCBUF_JOB_WE },
46 { SHAREDESCBUF_EFF, LDST_CLASS_DECO |
47 LDST_SRCDST_WORD_DESCBUF_SHARED_WE },
48 /*34*/ { GTR, LDST_CLASS_DECO | LDST_SRCDST_WORD_GTR },
49 { STR, LDST_CLASS_DECO | LDST_SRCDST_WORD_STR }
50 };
51
52 /*
53 * Allowed STORE sources for each SEC ERA.
54 * Values represent the number of entries from source_src_table[] that are
55 * supported.
56 */
57 static const unsigned int store_src_table_sz[] = {29, 31, 33, 33,
58 33, 33, 35, 35,
59 35, 35};
60
61 static inline int
rta_store(struct program * program,uint64_t src,uint16_t offset,uint64_t dst,uint32_t length,uint32_t flags)62 rta_store(struct program *program, uint64_t src,
63 uint16_t offset, uint64_t dst, uint32_t length,
64 uint32_t flags)
65 {
66 uint32_t opcode = 0, val;
67 int ret = -EINVAL;
68 unsigned int start_pc = program->current_pc;
69
70 if (flags & SEQ)
71 opcode = CMD_SEQ_STORE;
72 else
73 opcode = CMD_STORE;
74
75 /* parameters check */
76 if ((flags & IMMED) && (flags & SGF)) {
77 pr_err("STORE: Invalid flag. SEC PC: %d; Instr: %d\n",
78 program->current_pc, program->current_instruction);
79 goto err;
80 }
81 if ((flags & IMMED) && (offset != 0)) {
82 pr_err("STORE: Invalid flag. SEC PC: %d; Instr: %d\n",
83 program->current_pc, program->current_instruction);
84 goto err;
85 }
86
87 if ((flags & SEQ) && ((src == JOBDESCBUF) || (src == SHAREDESCBUF) ||
88 (src == JOBDESCBUF_EFF) ||
89 (src == SHAREDESCBUF_EFF))) {
90 pr_err("STORE: Invalid SRC type. SEC PC: %d; Instr: %d\n",
91 program->current_pc, program->current_instruction);
92 goto err;
93 }
94
95 if (flags & IMMED)
96 opcode |= LDST_IMM;
97
98 if ((flags & SGF) || (flags & VLF))
99 opcode |= LDST_VLF;
100
101 /*
102 * source for data to be stored can be specified as:
103 * - register location; set in src field[9-15];
104 * - if IMMED flag is set, data is set in value field [0-31];
105 * user can give this value as actual value or pointer to data
106 */
107 if (!(flags & IMMED)) {
108 ret = __rta_map_opcode((uint32_t)src, store_src_table,
109 store_src_table_sz[rta_sec_era], &val);
110 if (ret < 0) {
111 pr_err("STORE: Invalid source. SEC PC: %d; Instr: %d\n",
112 program->current_pc,
113 program->current_instruction);
114 goto err;
115 }
116 opcode |= val;
117 }
118
119 /* DESC BUFFER: length / offset values are specified in 4-byte words */
120 if ((src == DESCBUF) || (src == JOBDESCBUF) || (src == SHAREDESCBUF) ||
121 (src == JOBDESCBUF_EFF) || (src == SHAREDESCBUF_EFF)) {
122 opcode |= (length >> 2);
123 opcode |= (uint32_t)((offset >> 2) << LDST_OFFSET_SHIFT);
124 } else {
125 opcode |= length;
126 opcode |= (uint32_t)(offset << LDST_OFFSET_SHIFT);
127 }
128
129 __rta_out32(program, opcode);
130 program->current_instruction++;
131
132 if ((src == JOBDESCBUF) || (src == SHAREDESCBUF) ||
133 (src == JOBDESCBUF_EFF) || (src == SHAREDESCBUF_EFF))
134 return (int)start_pc;
135
136 /* for STORE, a pointer to where the data will be stored if needed */
137 if (!(flags & SEQ))
138 __rta_out64(program, program->ps, dst);
139
140 /* for IMMED data, place the data here */
141 if (flags & IMMED)
142 __rta_inline_data(program, src, flags & __COPY_MASK, length);
143
144 return (int)start_pc;
145
146 err:
147 program->first_error_pc = start_pc;
148 program->current_instruction++;
149 return ret;
150 }
151
152 #endif /* __RTA_STORE_CMD_H__ */
153