1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * (C) Copyright 2010-2016 Freescale Semiconductor, Inc.
3*4882a593Smuzhiyun *
4*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun /* #define DEBUG */
8*4882a593Smuzhiyun
9*4882a593Smuzhiyun #include <common.h>
10*4882a593Smuzhiyun
11*4882a593Smuzhiyun #include <command.h>
12*4882a593Smuzhiyun #include <environment.h>
13*4882a593Smuzhiyun #include <linux/stddef.h>
14*4882a593Smuzhiyun #include <errno.h>
15*4882a593Smuzhiyun #include <memalign.h>
16*4882a593Smuzhiyun #include <sata.h>
17*4882a593Smuzhiyun #include <search.h>
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun #if defined(CONFIG_ENV_SIZE_REDUND) || defined(CONFIG_ENV_OFFSET_REDUND)
20*4882a593Smuzhiyun #error ENV REDUND not supported
21*4882a593Smuzhiyun #endif
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun #if !defined(CONFIG_ENV_OFFSET) || !defined(CONFIG_ENV_SIZE)
24*4882a593Smuzhiyun #error CONFIG_ENV_OFFSET or CONFIG_ENV_SIZE not defined
25*4882a593Smuzhiyun #endif
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun DECLARE_GLOBAL_DATA_PTR;
28*4882a593Smuzhiyun
sata_get_env_dev(void)29*4882a593Smuzhiyun __weak int sata_get_env_dev(void)
30*4882a593Smuzhiyun {
31*4882a593Smuzhiyun return CONFIG_SYS_SATA_ENV_DEV;
32*4882a593Smuzhiyun }
33*4882a593Smuzhiyun
34*4882a593Smuzhiyun #ifdef CONFIG_CMD_SAVEENV
write_env(struct blk_desc * sata,unsigned long size,unsigned long offset,void * buffer)35*4882a593Smuzhiyun static inline int write_env(struct blk_desc *sata, unsigned long size,
36*4882a593Smuzhiyun unsigned long offset, void *buffer)
37*4882a593Smuzhiyun {
38*4882a593Smuzhiyun uint blk_start, blk_cnt, n;
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun blk_start = ALIGN(offset, sata->blksz) / sata->blksz;
41*4882a593Smuzhiyun blk_cnt = ALIGN(size, sata->blksz) / sata->blksz;
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun n = blk_dwrite(sata, blk_start, blk_cnt, buffer);
44*4882a593Smuzhiyun
45*4882a593Smuzhiyun return (n == blk_cnt) ? 0 : -1;
46*4882a593Smuzhiyun }
47*4882a593Smuzhiyun
env_sata_save(void)48*4882a593Smuzhiyun static int env_sata_save(void)
49*4882a593Smuzhiyun {
50*4882a593Smuzhiyun ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1);
51*4882a593Smuzhiyun struct blk_desc *sata = NULL;
52*4882a593Smuzhiyun int env_sata, ret;
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun if (sata_initialize())
55*4882a593Smuzhiyun return 1;
56*4882a593Smuzhiyun
57*4882a593Smuzhiyun env_sata = sata_get_env_dev();
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun sata = sata_get_dev(env_sata);
60*4882a593Smuzhiyun if (sata == NULL) {
61*4882a593Smuzhiyun printf("Unknown SATA(%d) device for environment!\n",
62*4882a593Smuzhiyun env_sata);
63*4882a593Smuzhiyun return 1;
64*4882a593Smuzhiyun }
65*4882a593Smuzhiyun
66*4882a593Smuzhiyun ret = env_export(env_new);
67*4882a593Smuzhiyun if (ret)
68*4882a593Smuzhiyun return 1;
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun printf("Writing to SATA(%d)...", env_sata);
71*4882a593Smuzhiyun if (write_env(sata, CONFIG_ENV_SIZE, CONFIG_ENV_OFFSET, &env_new)) {
72*4882a593Smuzhiyun puts("failed\n");
73*4882a593Smuzhiyun return 1;
74*4882a593Smuzhiyun }
75*4882a593Smuzhiyun
76*4882a593Smuzhiyun puts("done\n");
77*4882a593Smuzhiyun return 0;
78*4882a593Smuzhiyun }
79*4882a593Smuzhiyun #endif /* CONFIG_CMD_SAVEENV */
80*4882a593Smuzhiyun
read_env(struct blk_desc * sata,unsigned long size,unsigned long offset,void * buffer)81*4882a593Smuzhiyun static inline int read_env(struct blk_desc *sata, unsigned long size,
82*4882a593Smuzhiyun unsigned long offset, void *buffer)
83*4882a593Smuzhiyun {
84*4882a593Smuzhiyun uint blk_start, blk_cnt, n;
85*4882a593Smuzhiyun
86*4882a593Smuzhiyun blk_start = ALIGN(offset, sata->blksz) / sata->blksz;
87*4882a593Smuzhiyun blk_cnt = ALIGN(size, sata->blksz) / sata->blksz;
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun n = blk_dread(sata, blk_start, blk_cnt, buffer);
90*4882a593Smuzhiyun
91*4882a593Smuzhiyun return (n == blk_cnt) ? 0 : -1;
92*4882a593Smuzhiyun }
93*4882a593Smuzhiyun
env_sata_load(void)94*4882a593Smuzhiyun static void env_sata_load(void)
95*4882a593Smuzhiyun {
96*4882a593Smuzhiyun ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE);
97*4882a593Smuzhiyun struct blk_desc *sata = NULL;
98*4882a593Smuzhiyun int env_sata;
99*4882a593Smuzhiyun
100*4882a593Smuzhiyun if (sata_initialize())
101*4882a593Smuzhiyun return -EIO;
102*4882a593Smuzhiyun
103*4882a593Smuzhiyun env_sata = sata_get_env_dev();
104*4882a593Smuzhiyun
105*4882a593Smuzhiyun sata = sata_get_dev(env_sata);
106*4882a593Smuzhiyun if (sata == NULL) {
107*4882a593Smuzhiyun printf("Unknown SATA(%d) device for environment!\n", env_sata);
108*4882a593Smuzhiyun return -EIO;
109*4882a593Smuzhiyun }
110*4882a593Smuzhiyun
111*4882a593Smuzhiyun if (read_env(sata, CONFIG_ENV_SIZE, CONFIG_ENV_OFFSET, buf)) {
112*4882a593Smuzhiyun set_default_env(NULL);
113*4882a593Smuzhiyun return -EIO;
114*4882a593Smuzhiyun }
115*4882a593Smuzhiyun
116*4882a593Smuzhiyun env_import(buf, 1);
117*4882a593Smuzhiyun
118*4882a593Smuzhiyun return 0;
119*4882a593Smuzhiyun }
120*4882a593Smuzhiyun
121*4882a593Smuzhiyun U_BOOT_ENV_LOCATION(sata) = {
122*4882a593Smuzhiyun .location = ENVL_ESATA,
123*4882a593Smuzhiyun ENV_NAME("SATA")
124*4882a593Smuzhiyun .load = env_sata_load,
125*4882a593Smuzhiyun .save = env_save_ptr(env_sata_save),
126*4882a593Smuzhiyun };
127