Blame view

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

2166ebf78   Simon Goldschmidt   env: make env dri...
115
  	return env_import(buf, 1);
125d193c4   Peng Fan   common: env: supp...
116
  }
4415f1d1f   Simon Glass   env: Create a loc...
117
118
119
  
  U_BOOT_ENV_LOCATION(sata) = {
  	.location	= ENVL_ESATA,
ac358beb8   Simon Glass   env: Drop the env...
120
  	ENV_NAME("SATA")
e5bce247b   Simon Glass   env: Switch over ...
121
122
  	.load		= env_sata_load,
  	.save		= env_save_ptr(env_sata_save),
4415f1d1f   Simon Glass   env: Create a loc...
123
  };