Blame view

board/ti/am43xx/board.c 12.5 KB
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
1
2
3
4
5
6
7
8
9
10
11
  /*
   * board.c
   *
   * Board functions for TI AM43XX based boards
   *
   * Copyright (C) 2013, Texas Instruments, Incorporated - http://www.ti.com/
   *
   * SPDX-License-Identifier:	GPL-2.0+
   */
  
  #include <common.h>
9f1a8cd33   Sekhar Nori   ARM: AM43XX: boar...
12
13
  #include <i2c.h>
  #include <asm/errno.h>
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
14
  #include <spl.h>
3b34ac13f   Lokesh Vutla   ARM: AM43xx: cloc...
15
  #include <asm/arch/clock.h>
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
16
17
  #include <asm/arch/sys_proto.h>
  #include <asm/arch/mux.h>
d3daba10f   Lokesh Vutla   ARM: AM43xx: EPOS...
18
  #include <asm/arch/ddr_defs.h>
b5e01eecc   Lokesh Vutla   ARM: AM43xx: GP_E...
19
  #include <asm/arch/gpio.h>
d3daba10f   Lokesh Vutla   ARM: AM43xx: EPOS...
20
  #include <asm/emif.h>
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
21
  #include "board.h"
4cdd7fda9   Mugunthan V N   ARM: AM43xx: Add ...
22
23
  #include <miiphy.h>
  #include <cpsw.h>
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
24
25
  
  DECLARE_GLOBAL_DATA_PTR;
4cdd7fda9   Mugunthan V N   ARM: AM43xx: Add ...
26
  static struct ctrl_dev *cdev = (struct ctrl_dev *)CTRL_DEVICE_BASE;
4cdd7fda9   Mugunthan V N   ARM: AM43xx: Add ...
27

9f1a8cd33   Sekhar Nori   ARM: AM43XX: boar...
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
  /*
   * Read header information from EEPROM into global structure.
   */
  static int read_eeprom(struct am43xx_board_id *header)
  {
  	/* Check if baseboard eeprom is available */
  	if (i2c_probe(CONFIG_SYS_I2C_EEPROM_ADDR)) {
  		printf("Could not probe the EEPROM at 0x%x
  ",
  		       CONFIG_SYS_I2C_EEPROM_ADDR);
  		return -ENODEV;
  	}
  
  	/* read the eeprom using i2c */
  	if (i2c_read(CONFIG_SYS_I2C_EEPROM_ADDR, 0, 2, (uchar *)header,
  		     sizeof(struct am43xx_board_id))) {
  		printf("Could not read the EEPROM
  ");
  		return -EIO;
  	}
  
  	if (header->magic != 0xEE3355AA) {
  		/*
  		 * read the eeprom using i2c again,
  		 * but use only a 1 byte address
  		 */
  		if (i2c_read(CONFIG_SYS_I2C_EEPROM_ADDR, 0, 1, (uchar *)header,
  			     sizeof(struct am43xx_board_id))) {
  			printf("Could not read the EEPROM at 0x%x
  ",
  			       CONFIG_SYS_I2C_EEPROM_ADDR);
  			return -EIO;
  		}
  
  		if (header->magic != 0xEE3355AA) {
  			printf("Incorrect magic number (0x%x) in EEPROM
  ",
  			       header->magic);
  			return -EINVAL;
  		}
  	}
  
  	strncpy(am43xx_board_name, (char *)header->name, sizeof(header->name));
  	am43xx_board_name[sizeof(header->name)] = 0;
  
  	return 0;
  }
7a5f71bc4   Sourav Poddar   am43xx_evm: Add q...
75
  #ifndef CONFIG_SKIP_LOWLEVEL_INIT
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
76

cf04d0326   Lokesh Vutla   ARM: AM43xx: cloc...
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
  #define NUM_OPPS	6
  
  const struct dpll_params dpll_mpu[NUM_CRYSTAL_FREQ][NUM_OPPS] = {
  	{	/* 19.2 MHz */
  		{-1, -1, -1, -1, -1, -1, -1},	/* OPP 50 */
  		{-1, -1, -1, -1, -1, -1, -1},	/* OPP RESERVED	*/
  		{-1, -1, -1, -1, -1, -1, -1},	/* OPP 100 */
  		{-1, -1, -1, -1, -1, -1, -1},	/* OPP 120 */
  		{-1, -1, -1, -1, -1, -1, -1},	/* OPP TB */
  		{-1, -1, -1, -1, -1, -1, -1}	/* OPP NT */
  	},
  	{	/* 24 MHz */
  		{300, 23, 1, -1, -1, -1, -1},	/* OPP 50 */
  		{-1, -1, -1, -1, -1, -1, -1},	/* OPP RESERVED	*/
  		{600, 23, 1, -1, -1, -1, -1},	/* OPP 100 */
  		{720, 23, 1, -1, -1, -1, -1},	/* OPP 120 */
  		{800, 23, 1, -1, -1, -1, -1},	/* OPP TB */
  		{1000, 23, 1, -1, -1, -1, -1}	/* OPP NT */
  	},
  	{	/* 25 MHz */
  		{300, 24, 1, -1, -1, -1, -1},	/* OPP 50 */
  		{-1, -1, -1, -1, -1, -1, -1},	/* OPP RESERVED	*/
  		{600, 24, 1, -1, -1, -1, -1},	/* OPP 100 */
  		{720, 24, 1, -1, -1, -1, -1},	/* OPP 120 */
  		{800, 24, 1, -1, -1, -1, -1},	/* OPP TB */
  		{1000, 24, 1, -1, -1, -1, -1}	/* OPP NT */
  	},
  	{	/* 26 MHz */
  		{300, 25, 1, -1, -1, -1, -1},	/* OPP 50 */
  		{-1, -1, -1, -1, -1, -1, -1},	/* OPP RESERVED	*/
  		{600, 25, 1, -1, -1, -1, -1},	/* OPP 100 */
  		{720, 25, 1, -1, -1, -1, -1},	/* OPP 120 */
  		{800, 25, 1, -1, -1, -1, -1},	/* OPP TB */
  		{1000, 25, 1, -1, -1, -1, -1}	/* OPP NT */
  	},
  };
  
  const struct dpll_params dpll_core[NUM_CRYSTAL_FREQ] = {
  		{-1, -1, -1, -1, -1, -1, -1},	/* 19.2 MHz */
  		{1000, 23, -1, -1, 10, 8, 4},	/* 24 MHz */
  		{1000, 24, -1, -1, 10, 8, 4},	/* 25 MHz */
  		{1000, 25, -1, -1, 10, 8, 4}	/* 26 MHz */
  };
  
  const struct dpll_params dpll_per[NUM_CRYSTAL_FREQ] = {
  		{-1, -1, -1, -1, -1, -1, -1},	/* 19.2 MHz */
  		{960, 23, 5, -1, -1, -1, -1},	/* 24 MHz */
  		{960, 24, 5, -1, -1, -1, -1},	/* 25 MHz */
  		{960, 25, 5, -1, -1, -1, -1}	/* 26 MHz */
  };
  
  const struct dpll_params epos_evm_dpll_ddr = {
  		266, 24, 1, -1, 1, -1, -1};
  
  const struct dpll_params gp_evm_dpll_ddr = {
  		400, 23, 1, -1, 1, -1, -1};
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
133

d3daba10f   Lokesh Vutla   ARM: AM43xx: EPOS...
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
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
  const struct ctrl_ioregs ioregs_lpddr2 = {
  	.cm0ioctl		= LPDDR2_ADDRCTRL_IOCTRL_VALUE,
  	.cm1ioctl		= LPDDR2_ADDRCTRL_WD0_IOCTRL_VALUE,
  	.cm2ioctl		= LPDDR2_ADDRCTRL_WD1_IOCTRL_VALUE,
  	.dt0ioctl		= LPDDR2_DATA0_IOCTRL_VALUE,
  	.dt1ioctl		= LPDDR2_DATA0_IOCTRL_VALUE,
  	.dt2ioctrl		= LPDDR2_DATA0_IOCTRL_VALUE,
  	.dt3ioctrl		= LPDDR2_DATA0_IOCTRL_VALUE,
  	.emif_sdram_config_ext	= 0x1,
  };
  
  const struct emif_regs emif_regs_lpddr2 = {
  	.sdram_config			= 0x808012BA,
  	.ref_ctrl			= 0x0000040D,
  	.sdram_tim1			= 0xEA86B411,
  	.sdram_tim2			= 0x103A094A,
  	.sdram_tim3			= 0x0F6BA37F,
  	.read_idle_ctrl			= 0x00050000,
  	.zq_config			= 0x50074BE4,
  	.temp_alert_config		= 0x0,
  	.emif_rd_wr_lvl_rmp_win		= 0x0,
  	.emif_rd_wr_lvl_rmp_ctl		= 0x0,
  	.emif_rd_wr_lvl_ctl		= 0x0,
  	.emif_ddr_phy_ctlr_1		= 0x0E084006,
  	.emif_rd_wr_exec_thresh		= 0x00000405,
  	.emif_ddr_ext_phy_ctrl_1	= 0x04010040,
  	.emif_ddr_ext_phy_ctrl_2	= 0x00500050,
  	.emif_ddr_ext_phy_ctrl_3	= 0x00500050,
  	.emif_ddr_ext_phy_ctrl_4	= 0x00500050,
  	.emif_ddr_ext_phy_ctrl_5	= 0x00500050
  };
  
  const u32 ext_phy_ctrl_const_base_lpddr2[] = {
  	0x00500050,
  	0x00350035,
  	0x00350035,
  	0x00350035,
  	0x00350035,
  	0x00350035,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x40001000,
  	0x08102040
  };
b5e01eecc   Lokesh Vutla   ARM: AM43xx: GP_E...
188
189
190
191
192
193
194
195
  const struct ctrl_ioregs ioregs_ddr3 = {
  	.cm0ioctl		= DDR3_ADDRCTRL_IOCTRL_VALUE,
  	.cm1ioctl		= DDR3_ADDRCTRL_WD0_IOCTRL_VALUE,
  	.cm2ioctl		= DDR3_ADDRCTRL_WD1_IOCTRL_VALUE,
  	.dt0ioctl		= DDR3_DATA0_IOCTRL_VALUE,
  	.dt1ioctl		= DDR3_DATA0_IOCTRL_VALUE,
  	.dt2ioctrl		= DDR3_DATA0_IOCTRL_VALUE,
  	.dt3ioctrl		= DDR3_DATA0_IOCTRL_VALUE,
0df8afdf1   Lokesh Vutla   ARM: AM43xx: Enab...
196
  	.emif_sdram_config_ext	= 0x0143,
b5e01eecc   Lokesh Vutla   ARM: AM43xx: GP_E...
197
198
199
200
201
202
203
204
205
206
207
  };
  
  const struct emif_regs ddr3_emif_regs_400Mhz = {
  	.sdram_config			= 0x638413B2,
  	.ref_ctrl			= 0x00000C30,
  	.sdram_tim1			= 0xEAAAD4DB,
  	.sdram_tim2			= 0x266B7FDA,
  	.sdram_tim3			= 0x107F8678,
  	.read_idle_ctrl			= 0x00050000,
  	.zq_config			= 0x50074BE4,
  	.temp_alert_config		= 0x0,
e27f2dd72   Lokesh Vutla   ARM: AM4372: Upda...
208
  	.emif_ddr_phy_ctlr_1		= 0x0E004008,
b5e01eecc   Lokesh Vutla   ARM: AM43xx: GP_E...
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
  	.emif_ddr_ext_phy_ctrl_1	= 0x08020080,
  	.emif_ddr_ext_phy_ctrl_2	= 0x00400040,
  	.emif_ddr_ext_phy_ctrl_3	= 0x00400040,
  	.emif_ddr_ext_phy_ctrl_4	= 0x00400040,
  	.emif_ddr_ext_phy_ctrl_5	= 0x00400040,
  	.emif_rd_wr_lvl_rmp_win		= 0x0,
  	.emif_rd_wr_lvl_rmp_ctl		= 0x0,
  	.emif_rd_wr_lvl_ctl		= 0x0,
  	.emif_rd_wr_exec_thresh		= 0x00000405
  };
  
  const u32 ext_phy_ctrl_const_base_ddr3[] = {
  	0x00400040,
  	0x00350035,
  	0x00350035,
  	0x00350035,
  	0x00350035,
  	0x00350035,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00000000,
  	0x00340034,
  	0x00340034,
  	0x00340034,
  	0x00340034,
  	0x00340034,
  	0x0,
  	0x0,
  	0x40000000,
  	0x08102040
  };
d3daba10f   Lokesh Vutla   ARM: AM43xx: EPOS...
242
243
  void emif_get_ext_phy_ctrl_const_regs(const u32 **regs, u32 *size)
  {
b5e01eecc   Lokesh Vutla   ARM: AM43xx: GP_E...
244
245
246
247
248
249
250
  	if (board_is_eposevm()) {
  		*regs = ext_phy_ctrl_const_base_lpddr2;
  		*size = ARRAY_SIZE(ext_phy_ctrl_const_base_lpddr2);
  	} else if (board_is_gpevm()) {
  		*regs = ext_phy_ctrl_const_base_ddr3;
  		*size = ARRAY_SIZE(ext_phy_ctrl_const_base_ddr3);
  	}
d3daba10f   Lokesh Vutla   ARM: AM43xx: EPOS...
251
252
253
  
  	return;
  }
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
254
255
  const struct dpll_params *get_dpll_ddr_params(void)
  {
cf04d0326   Lokesh Vutla   ARM: AM43xx: cloc...
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
  	struct am43xx_board_id header;
  
  	enable_i2c0_pin_mux();
  	i2c_init(CONFIG_SYS_OMAP24_I2C_SPEED, CONFIG_SYS_OMAP24_I2C_SLAVE);
  	if (read_eeprom(&header) < 0)
  		puts("Could not get board ID.
  ");
  
  	if (board_is_eposevm())
  		return &epos_evm_dpll_ddr;
  	else if (board_is_gpevm())
  		return &gp_evm_dpll_ddr;
  
  	puts(" Board not supported
  ");
  	return NULL;
  }
  
  /*
   * get_sys_clk_index : returns the index of the sys_clk read from
   *			ctrl status register. This value is either
   *			read from efuse or sysboot pins.
   */
  static u32 get_sys_clk_index(void)
  {
  	struct ctrl_stat *ctrl = (struct ctrl_stat *)CTRL_BASE;
  	u32 ind = readl(&ctrl->statusreg), src;
  
  	src = (ind & CTRL_CRYSTAL_FREQ_SRC_MASK) >> CTRL_CRYSTAL_FREQ_SRC_SHIFT;
  	if (src == CTRL_CRYSTAL_FREQ_SRC_EFUSE) /* Value read from EFUSE */
  		return ((ind & CTRL_CRYSTAL_FREQ_SELECTION_MASK) >>
  			CTRL_CRYSTAL_FREQ_SELECTION_SHIFT);
  	else /* Value read from SYS BOOT pins */
  		return ((ind & CTRL_SYSBOOT_15_14_MASK) >>
  			CTRL_SYSBOOT_15_14_SHIFT);
  }
  
  /*
   * get_opp_offset:
   * Returns the index for safest OPP of the device to boot.
   * max_off:	Index of the MAX OPP in DEV ATTRIBUTE register.
   * min_off:	Index of the MIN OPP in DEV ATTRIBUTE register.
   * This data is read from dev_attribute register which is e-fused.
   * A'1' in bit indicates OPP disabled and not available, a '0' indicates
   * OPP available. Lowest OPP starts with min_off. So returning the
   * bit with rightmost '0'.
   */
  static int get_opp_offset(int max_off, int min_off)
  {
  	struct ctrl_stat *ctrl = (struct ctrl_stat *)CTRL_BASE;
feca6e676   Tom Rini   am43xx: Only read...
306
307
308
309
  	int opp, offset, i;
  
  	/* Bits 0:11 are defined to be the MPU_MAX_FREQ */
  	opp = readl(&ctrl->dev_attr) & ~0xFFFFF000;
cf04d0326   Lokesh Vutla   ARM: AM43xx: cloc...
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
  
  	for (i = max_off; i >= min_off; i--) {
  		offset = opp & (1 << i);
  		if (!offset)
  			return i;
  	}
  
  	return min_off;
  }
  
  const struct dpll_params *get_dpll_mpu_params(void)
  {
  	int opp = get_opp_offset(DEV_ATTR_MAX_OFFSET, DEV_ATTR_MIN_OFFSET);
  	u32 ind = get_sys_clk_index();
  
  	return &dpll_mpu[ind][opp];
  }
  
  const struct dpll_params *get_dpll_core_params(void)
  {
  	int ind = get_sys_clk_index();
  
  	return &dpll_core[ind];
  }
  
  const struct dpll_params *get_dpll_per_params(void)
  {
  	int ind = get_sys_clk_index();
  
  	return &dpll_per[ind];
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
340
341
342
343
344
345
346
347
348
349
350
  }
  
  void set_uart_mux_conf(void)
  {
  	enable_uart0_pin_mux();
  }
  
  void set_mux_conf_regs(void)
  {
  	enable_board_pin_mux();
  }
b5e01eecc   Lokesh Vutla   ARM: AM43xx: GP_E...
351
352
353
354
355
  static void enable_vtt_regulator(void)
  {
  	u32 temp;
  
  	/* enable module */
cd8341b7e   Dave Gerlach   ARM: AM43xx: GP-E...
356
357
358
359
360
361
362
363
  	writel(GPIO_CTRL_ENABLEMODULE, AM33XX_GPIO5_BASE + OMAP_GPIO_CTRL);
  
  	/* enable output for GPIO5_7 */
  	writel(GPIO_SETDATAOUT(7),
  	       AM33XX_GPIO5_BASE + OMAP_GPIO_SETDATAOUT);
  	temp = readl(AM33XX_GPIO5_BASE + OMAP_GPIO_OE);
  	temp = temp & ~(GPIO_OE_ENABLE(7));
  	writel(temp, AM33XX_GPIO5_BASE + OMAP_GPIO_OE);
b5e01eecc   Lokesh Vutla   ARM: AM43xx: GP_E...
364
  }
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
365
366
  void sdram_init(void)
  {
b5e01eecc   Lokesh Vutla   ARM: AM43xx: GP_E...
367
368
369
370
371
372
373
374
375
376
377
378
  	/*
  	 * EPOS EVM has 1GB LPDDR2 connected to EMIF.
  	 * GP EMV has 1GB DDR3 connected to EMIF
  	 * along with VTT regulator.
  	 */
  	if (board_is_eposevm()) {
  		config_ddr(0, &ioregs_lpddr2, NULL, NULL, &emif_regs_lpddr2, 0);
  	} else if (board_is_gpevm()) {
  		enable_vtt_regulator();
  		config_ddr(0, &ioregs_ddr3, NULL, NULL,
  			   &ddr3_emif_regs_400Mhz, 0);
  	}
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
379
380
381
382
383
  }
  #endif
  
  int board_init(void)
  {
369cbe1e1   Lokesh Vutla   ARM: AM43xx: Adap...
384
  	gd->bd->bi_boot_params = CONFIG_SYS_SDRAM_BASE + 0x100;
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
385
386
387
388
389
390
391
  
  	return 0;
  }
  
  #ifdef CONFIG_BOARD_LATE_INIT
  int board_late_init(void)
  {
f4af163e6   Sekhar Nori   ARM: AM43XX: Add ...
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
  #ifdef CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG
  	char safe_string[HDR_NAME_LEN + 1];
  	struct am43xx_board_id header;
  
  	if (read_eeprom(&header) < 0)
  		puts("Could not get board ID.
  ");
  
  	/* Now set variables based on the header. */
  	strncpy(safe_string, (char *)header.name, sizeof(header.name));
  	safe_string[sizeof(header.name)] = 0;
  	setenv("board_name", safe_string);
  
  	strncpy(safe_string, (char *)header.version, sizeof(header.version));
  	safe_string[sizeof(header.version)] = 0;
  	setenv("board_rev", safe_string);
  #endif
fbf2728da   Lokesh Vutla   ARM: AM43xx: Add ...
409
410
411
  	return 0;
  }
  #endif
4cdd7fda9   Mugunthan V N   ARM: AM43xx: Add ...
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
  
  #ifdef CONFIG_DRIVER_TI_CPSW
  
  static void cpsw_control(int enabled)
  {
  	/* Additional controls can be added here */
  	return;
  }
  
  static struct cpsw_slave_data cpsw_slaves[] = {
  	{
  		.slave_reg_ofs	= 0x208,
  		.sliver_reg_ofs	= 0xd80,
  		.phy_addr	= 16,
  	},
  	{
  		.slave_reg_ofs	= 0x308,
  		.sliver_reg_ofs	= 0xdc0,
  		.phy_addr	= 1,
  	},
  };
  
  static struct cpsw_platform_data cpsw_data = {
  	.mdio_base		= CPSW_MDIO_BASE,
  	.cpsw_base		= CPSW_BASE,
  	.mdio_div		= 0xff,
  	.channels		= 8,
  	.cpdma_reg_ofs		= 0x800,
  	.slaves			= 1,
  	.slave_data		= cpsw_slaves,
  	.ale_reg_ofs		= 0xd00,
  	.ale_entries		= 1024,
  	.host_port_reg_ofs	= 0x108,
  	.hw_stats_reg_ofs	= 0x900,
  	.bd_ram_ofs		= 0x2000,
  	.mac_control		= (1 << 5),
  	.control		= cpsw_control,
  	.host_port_num		= 0,
  	.version		= CPSW_CTRL_VERSION_2,
  };
  
  int board_eth_init(bd_t *bis)
  {
  	int rv;
  	uint8_t mac_addr[6];
  	uint32_t mac_hi, mac_lo;
  
  	/* try reading mac address from efuse */
  	mac_lo = readl(&cdev->macid0l);
  	mac_hi = readl(&cdev->macid0h);
  	mac_addr[0] = mac_hi & 0xFF;
  	mac_addr[1] = (mac_hi & 0xFF00) >> 8;
  	mac_addr[2] = (mac_hi & 0xFF0000) >> 16;
  	mac_addr[3] = (mac_hi & 0xFF000000) >> 24;
  	mac_addr[4] = mac_lo & 0xFF;
  	mac_addr[5] = (mac_lo & 0xFF00) >> 8;
  
  	if (!getenv("ethaddr")) {
  		puts("<ethaddr> not set. Validating first E-fuse MAC
  ");
  		if (is_valid_ether_addr(mac_addr))
  			eth_setenv_enetaddr("ethaddr", mac_addr);
  	}
  
  	mac_lo = readl(&cdev->macid1l);
  	mac_hi = readl(&cdev->macid1h);
  	mac_addr[0] = mac_hi & 0xFF;
  	mac_addr[1] = (mac_hi & 0xFF00) >> 8;
  	mac_addr[2] = (mac_hi & 0xFF0000) >> 16;
  	mac_addr[3] = (mac_hi & 0xFF000000) >> 24;
  	mac_addr[4] = mac_lo & 0xFF;
  	mac_addr[5] = (mac_lo & 0xFF00) >> 8;
  
  	if (!getenv("eth1addr")) {
  		if (is_valid_ether_addr(mac_addr))
  			eth_setenv_enetaddr("eth1addr", mac_addr);
  	}
  
  	if (board_is_eposevm()) {
  		writel(RMII_MODE_ENABLE | RMII_CHIPCKL_ENABLE, &cdev->miisel);
  		cpsw_slaves[0].phy_if = PHY_INTERFACE_MODE_RMII;
  		cpsw_slaves[0].phy_addr = 16;
  	} else {
  		writel(RGMII_MODE_ENABLE, &cdev->miisel);
  		cpsw_slaves[0].phy_if = PHY_INTERFACE_MODE_RGMII;
  		cpsw_slaves[0].phy_addr = 0;
  	}
  
  	rv = cpsw_register(&cpsw_data);
  	if (rv < 0)
  		printf("Error %d registering CPSW switch
  ", rv);
  
  	return rv;
  }
  #endif