hc
2024-05-14 bedbef8ad3e75a304af6361af235302bcc61d06b
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
26
27
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
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
/*
 * (C) Copyright 2014
 * Dirk Eibach,  Guntermann & Drunck GmbH, eibach@gdsys.de
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
 
#include <common.h>
#include <command.h>
#include <asm/processor.h>
#include <asm/io.h>
#include <asm/global_data.h>
 
#include "mpc8308.h"
#include <gdsys_fpga.h>
 
#define REFLECTION_TESTPATTERN 0xdede
#define REFLECTION_TESTPATTERN_INV (~REFLECTION_TESTPATTERN & 0xffff)
 
#ifdef CONFIG_SYS_FPGA_NO_RFL_HI
#define REFLECTION_TESTREG reflection_low
#else
#define REFLECTION_TESTREG reflection_high
#endif
 
DECLARE_GLOBAL_DATA_PTR;
 
int get_fpga_state(unsigned dev)
{
   return gd->arch.fpga_state[dev];
}
 
int board_early_init_f(void)
{
   unsigned k;
 
   for (k = 0; k < CONFIG_SYS_FPGA_COUNT; ++k)
       gd->arch.fpga_state[k] = 0;
 
   return 0;
}
 
int board_early_init_r(void)
{
   unsigned k;
   unsigned ctr;
 
   for (k = 0; k < CONFIG_SYS_FPGA_COUNT; ++k)
       gd->arch.fpga_state[k] = 0;
 
   /*
    * reset FPGA
    */
   mpc8308_init();
 
   mpc8308_set_fpga_reset(1);
 
   mpc8308_setup_hw();
 
   for (k = 0; k < CONFIG_SYS_FPGA_COUNT; ++k) {
       ctr = 0;
       while (!mpc8308_get_fpga_done(k)) {
           udelay(100000);
           if (ctr++ > 5) {
               gd->arch.fpga_state[k] |=
                   FPGA_STATE_DONE_FAILED;
               break;
           }
       }
   }
 
   udelay(10);
 
   mpc8308_set_fpga_reset(0);
 
   for (k = 0; k < CONFIG_SYS_FPGA_COUNT; ++k) {
       /*
        * wait for fpga out of reset
        */
       ctr = 0;
       while (1) {
           u16 val;
 
           FPGA_SET_REG(k, reflection_low, REFLECTION_TESTPATTERN);
 
           FPGA_GET_REG(k, REFLECTION_TESTREG, &val);
           if (val == REFLECTION_TESTPATTERN_INV)
               break;
 
           udelay(100000);
           if (ctr++ > 5) {
               gd->arch.fpga_state[k] |=
                   FPGA_STATE_REFLECTION_FAILED;
               break;
           }
       }
   }
 
   return 0;
}