emmc.c 8.29 KB
Newer Older
Haojian Zhuang's avatar
Haojian Zhuang committed
1
/*
2
 * Copyright (c) 2016-2018, ARM Limited and Contributors. All rights reserved.
Haojian Zhuang's avatar
Haojian Zhuang committed
3
 *
dp-arm's avatar
dp-arm committed
4
 * SPDX-License-Identifier: BSD-3-Clause
Haojian Zhuang's avatar
Haojian Zhuang committed
5
6
7
8
9
10
11
12
13
14
 *
 * Defines a simple and generic interface to access eMMC device.
 */

#include <arch_helpers.h>
#include <assert.h>
#include <debug.h>
#include <emmc.h>
#include <errno.h>
#include <string.h>
15
#include <utils.h>
Haojian Zhuang's avatar
Haojian Zhuang committed
16
17
18
19

static const emmc_ops_t *ops;
static unsigned int emmc_ocr_value;
static emmc_csd_t emmc_csd;
Haojian Zhuang's avatar
Haojian Zhuang committed
20
21
22
23
24
25
static unsigned int emmc_flags;

static int is_cmd23_enabled(void)
{
	return (!!(emmc_flags & EMMC_FLAG_CMD23));
}
Haojian Zhuang's avatar
Haojian Zhuang committed
26
27
28
29
30
31
32

static int emmc_device_state(void)
{
	emmc_cmd_t cmd;
	int ret;

	do {
33
		zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
		cmd.cmd_idx = EMMC_CMD13;
		cmd.cmd_arg = EMMC_FIX_RCA << RCA_SHIFT_OFFSET;
		cmd.resp_type = EMMC_RESPONSE_R1;
		ret = ops->send_cmd(&cmd);
		assert(ret == 0);
		assert((cmd.resp_data[0] & STATUS_SWITCH_ERROR) == 0);
		/* Ignore improbable errors in release builds */
		(void)ret;
	} while ((cmd.resp_data[0] & STATUS_READY_FOR_DATA) == 0);
	return EMMC_GET_STATE(cmd.resp_data[0]);
}

static void emmc_set_ext_csd(unsigned int ext_cmd, unsigned int value)
{
	emmc_cmd_t cmd;
	int ret, state;

51
	zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
	cmd.cmd_idx = EMMC_CMD6;
	cmd.cmd_arg = EXTCSD_WRITE_BYTES | EXTCSD_CMD(ext_cmd) |
		      EXTCSD_VALUE(value) | 1;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);

	/* wait to exit PRG state */
	do {
		state = emmc_device_state();
	} while (state == EMMC_STATE_PRG);
	/* Ignore improbable errors in release builds */
	(void)ret;
}

static void emmc_set_ios(int clk, int bus_width)
{
	int ret;

	/* set IO speed & IO bus width */
	if (emmc_csd.spec_vers == 4)
		emmc_set_ext_csd(CMD_EXTCSD_BUS_WIDTH, bus_width);
	ret = ops->set_ios(clk, bus_width);
	assert(ret == 0);
	/* Ignore improbable errors in release builds */
	(void)ret;
}

static int emmc_enumerate(int clk, int bus_width)
{
	emmc_cmd_t cmd;
	int ret, state;

	ops->init();

	/* CMD0: reset to IDLE */
87
	zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
88
89
90
91
92
93
	cmd.cmd_idx = EMMC_CMD0;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);

	while (1) {
		/* CMD1: get OCR register */
94
		zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
95
96
97
98
99
100
101
102
103
104
105
106
		cmd.cmd_idx = EMMC_CMD1;
		cmd.cmd_arg = OCR_SECTOR_MODE | OCR_VDD_MIN_2V7 |
			      OCR_VDD_MIN_1V7;
		cmd.resp_type = EMMC_RESPONSE_R3;
		ret = ops->send_cmd(&cmd);
		assert(ret == 0);
		emmc_ocr_value = cmd.resp_data[0];
		if (emmc_ocr_value & OCR_POWERUP)
			break;
	}

	/* CMD2: Card Identification */
107
	zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
108
109
110
111
112
113
	cmd.cmd_idx = EMMC_CMD2;
	cmd.resp_type = EMMC_RESPONSE_R2;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);

	/* CMD3: Set Relative Address */
114
	zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
115
116
117
118
119
120
121
	cmd.cmd_idx = EMMC_CMD3;
	cmd.cmd_arg = EMMC_FIX_RCA << RCA_SHIFT_OFFSET;
	cmd.resp_type = EMMC_RESPONSE_R1;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);

	/* CMD9: CSD Register */
122
	zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
123
124
125
126
127
128
129
130
	cmd.cmd_idx = EMMC_CMD9;
	cmd.cmd_arg = EMMC_FIX_RCA << RCA_SHIFT_OFFSET;
	cmd.resp_type = EMMC_RESPONSE_R2;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);
	memcpy(&emmc_csd, &cmd.resp_data, sizeof(cmd.resp_data));

	/* CMD7: Select Card */
131
	zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
	cmd.cmd_idx = EMMC_CMD7;
	cmd.cmd_arg = EMMC_FIX_RCA << RCA_SHIFT_OFFSET;
	cmd.resp_type = EMMC_RESPONSE_R1;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);
	/* wait to TRAN state */
	do {
		state = emmc_device_state();
	} while (state != EMMC_STATE_TRAN);

	emmc_set_ios(clk, bus_width);
	return ret;
}

size_t emmc_read_blocks(int lba, uintptr_t buf, size_t size)
{
	emmc_cmd_t cmd;
	int ret;

	assert((ops != 0) &&
	       (ops->read != 0) &&
	       ((buf & EMMC_BLOCK_MASK) == 0) &&
	       ((size & EMMC_BLOCK_MASK) == 0));

	inv_dcache_range(buf, size);
	ret = ops->prepare(lba, buf, size);
	assert(ret == 0);

Haojian Zhuang's avatar
Haojian Zhuang committed
160
	if (is_cmd23_enabled()) {
161
		zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
162
163
164
165
166
167
168
		/* set block count */
		cmd.cmd_idx = EMMC_CMD23;
		cmd.cmd_arg = size / EMMC_BLOCK_SIZE;
		cmd.resp_type = EMMC_RESPONSE_R1;
		ret = ops->send_cmd(&cmd);
		assert(ret == 0);

169
		zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
170
		cmd.cmd_idx = EMMC_CMD18;
Haojian Zhuang's avatar
Haojian Zhuang committed
171
172
173
174
175
176
	} else {
		if (size > EMMC_BLOCK_SIZE)
			cmd.cmd_idx = EMMC_CMD18;
		else
			cmd.cmd_idx = EMMC_CMD17;
	}
Haojian Zhuang's avatar
Haojian Zhuang committed
177
178
179
180
181
182
183
184
185
186
187
188
189
190
	if ((emmc_ocr_value & OCR_ACCESS_MODE_MASK) == OCR_BYTE_MODE)
		cmd.cmd_arg = lba * EMMC_BLOCK_SIZE;
	else
		cmd.cmd_arg = lba;
	cmd.resp_type = EMMC_RESPONSE_R1;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);

	ret = ops->read(lba, buf, size);
	assert(ret == 0);

	/* wait buffer empty */
	emmc_device_state();

Haojian Zhuang's avatar
Haojian Zhuang committed
191
192
	if (is_cmd23_enabled() == 0) {
		if (size > EMMC_BLOCK_SIZE) {
193
			zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
194
195
196
197
			cmd.cmd_idx = EMMC_CMD12;
			ret = ops->send_cmd(&cmd);
			assert(ret == 0);
		}
Haojian Zhuang's avatar
Haojian Zhuang committed
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
	}
	/* Ignore improbable errors in release builds */
	(void)ret;
	return size;
}

size_t emmc_write_blocks(int lba, const uintptr_t buf, size_t size)
{
	emmc_cmd_t cmd;
	int ret;

	assert((ops != 0) &&
	       (ops->write != 0) &&
	       ((buf & EMMC_BLOCK_MASK) == 0) &&
	       ((size & EMMC_BLOCK_MASK) == 0));

	clean_dcache_range(buf, size);
	ret = ops->prepare(lba, buf, size);
	assert(ret == 0);

Haojian Zhuang's avatar
Haojian Zhuang committed
218
219
	if (is_cmd23_enabled()) {
		/* set block count */
220
		zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
221
222
223
224
225
226
		cmd.cmd_idx = EMMC_CMD23;
		cmd.cmd_arg = size / EMMC_BLOCK_SIZE;
		cmd.resp_type = EMMC_RESPONSE_R1;
		ret = ops->send_cmd(&cmd);
		assert(ret == 0);

227
		zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
228
		cmd.cmd_idx = EMMC_CMD25;
Haojian Zhuang's avatar
Haojian Zhuang committed
229
	} else {
230
		zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
231
232
233
234
235
		if (size > EMMC_BLOCK_SIZE)
			cmd.cmd_idx = EMMC_CMD25;
		else
			cmd.cmd_idx = EMMC_CMD24;
	}
Haojian Zhuang's avatar
Haojian Zhuang committed
236
237
238
239
240
241
242
243
244
245
246
247
248
249
	if ((emmc_ocr_value & OCR_ACCESS_MODE_MASK) == OCR_BYTE_MODE)
		cmd.cmd_arg = lba * EMMC_BLOCK_SIZE;
	else
		cmd.cmd_arg = lba;
	cmd.resp_type = EMMC_RESPONSE_R1;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);

	ret = ops->write(lba, buf, size);
	assert(ret == 0);

	/* wait buffer empty */
	emmc_device_state();

Haojian Zhuang's avatar
Haojian Zhuang committed
250
251
	if (is_cmd23_enabled() == 0) {
		if (size > EMMC_BLOCK_SIZE) {
252
			zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
253
254
255
256
			cmd.cmd_idx = EMMC_CMD12;
			ret = ops->send_cmd(&cmd);
			assert(ret == 0);
		}
Haojian Zhuang's avatar
Haojian Zhuang committed
257
258
259
260
261
262
263
264
265
266
267
268
269
270
	}
	/* Ignore improbable errors in release builds */
	(void)ret;
	return size;
}

size_t emmc_erase_blocks(int lba, size_t size)
{
	emmc_cmd_t cmd;
	int ret, state;

	assert(ops != 0);
	assert((size != 0) && ((size % EMMC_BLOCK_SIZE) == 0));

271
	zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
272
273
274
275
276
277
	cmd.cmd_idx = EMMC_CMD35;
	cmd.cmd_arg = lba;
	cmd.resp_type = EMMC_RESPONSE_R1;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);

278
	zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
279
280
281
282
283
284
	cmd.cmd_idx = EMMC_CMD36;
	cmd.cmd_arg = lba + (size / EMMC_BLOCK_SIZE) - 1;
	cmd.resp_type = EMMC_RESPONSE_R1;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);

285
	zeromem(&cmd, sizeof(emmc_cmd_t));
Haojian Zhuang's avatar
Haojian Zhuang committed
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
	cmd.cmd_idx = EMMC_CMD38;
	cmd.resp_type = EMMC_RESPONSE_R1B;
	ret = ops->send_cmd(&cmd);
	assert(ret == 0);

	/* wait to TRAN state */
	do {
		state = emmc_device_state();
	} while (state != EMMC_STATE_TRAN);
	/* Ignore improbable errors in release builds */
	(void)ret;
	return size;
}

static inline void emmc_rpmb_enable(void)
{
	emmc_set_ext_csd(CMD_EXTCSD_PARTITION_CONFIG,
			PART_CFG_BOOT_PARTITION1_ENABLE |
			PART_CFG_PARTITION1_ACCESS);
}

static inline void emmc_rpmb_disable(void)
{
	emmc_set_ext_csd(CMD_EXTCSD_PARTITION_CONFIG,
			PART_CFG_BOOT_PARTITION1_ENABLE);
}

size_t emmc_rpmb_read_blocks(int lba, uintptr_t buf, size_t size)
{
	size_t size_read;

	emmc_rpmb_enable();
	size_read = emmc_read_blocks(lba, buf, size);
	emmc_rpmb_disable();
	return size_read;
}

size_t emmc_rpmb_write_blocks(int lba, const uintptr_t buf, size_t size)
{
	size_t size_written;

	emmc_rpmb_enable();
	size_written = emmc_write_blocks(lba, buf, size);
	emmc_rpmb_disable();
	return size_written;
}

size_t emmc_rpmb_erase_blocks(int lba, size_t size)
{
	size_t size_erased;

	emmc_rpmb_enable();
	size_erased = emmc_erase_blocks(lba, size);
	emmc_rpmb_disable();
	return size_erased;
}

Haojian Zhuang's avatar
Haojian Zhuang committed
343
344
void emmc_init(const emmc_ops_t *ops_ptr, int clk, int width,
	       unsigned int flags)
Haojian Zhuang's avatar
Haojian Zhuang committed
345
346
347
348
349
350
351
352
353
354
355
{
	assert((ops_ptr != 0) &&
	       (ops_ptr->init != 0) &&
	       (ops_ptr->send_cmd != 0) &&
	       (ops_ptr->set_ios != 0) &&
	       (ops_ptr->prepare != 0) &&
	       (ops_ptr->read != 0) &&
	       (ops_ptr->write != 0) &&
	       (clk != 0) &&
	       ((width == EMMC_BUS_WIDTH_1) ||
		(width == EMMC_BUS_WIDTH_4) ||
356
357
358
		(width == EMMC_BUS_WIDTH_8) ||
		(width == EMMC_BUS_WIDTH_DDR_4) ||
		(width == EMMC_BUS_WIDTH_DDR_8)));
Haojian Zhuang's avatar
Haojian Zhuang committed
359
	ops = ops_ptr;
Haojian Zhuang's avatar
Haojian Zhuang committed
360
	emmc_flags = flags;
Haojian Zhuang's avatar
Haojian Zhuang committed
361
362
363

	emmc_enumerate(clk, width);
}