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
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
|
/* $Id$ */
/* BSP-specific bits of flash programmer support */
/*
* Authorship
* ----------
* This software ('mvme3100' RTEMS BSP) was created by
*
* Till Straumann <strauman@slac.stanford.edu>, 2005-2007,
* Stanford Linear Accelerator Center, Stanford University.
*
* Acknowledgement of sponsorship
* ------------------------------
* The 'mvme3100' BSP was produced by
* the Stanford Linear Accelerator Center, Stanford University,
* under Contract DE-AC03-76SFO0515 with the Department of Energy.
*
* Government disclaimer of liability
* ----------------------------------
* Neither the United States nor the United States Department of Energy,
* nor any of their employees, makes any warranty, express or implied, or
* assumes any legal liability or responsibility for the accuracy,
* completeness, or usefulness of any data, apparatus, product, or process
* disclosed, or represents that its use would not infringe privately owned
* rights.
*
* Stanford disclaimer of liability
* --------------------------------
* Stanford University makes no representations or warranties, express or
* implied, nor assumes any liability for the use of this software.
*
* Stanford disclaimer of copyright
* --------------------------------
* Stanford University, owner of the copyright, hereby disclaims its
* copyright and all other rights in this software. Hence, anyone may
* freely use it for any purpose without restriction.
*
* Maintenance of notices
* ----------------------
* In the interest of clarity regarding the origin and status of this
* SLAC software, this and all the preceding Stanford University notices
* are to remain affixed to any copy or derivative of this software made
* or distributed by the recipient and are to be affixed to any copy of
* software made or distributed by the recipient that contains a copy or
* derivative of this software.
*
* ------------------ SLAC Software Notices, Set 4 OTT.002a, 2004 FEB 03
*/
#include <rtems.h>
#include <bsp.h>
#include <libcpu/spr.h>
#include <stdio.h>
#include <bsp/flashPgmPvt.h>
SPR_RO(TBRL)
#define STATIC static
static struct bankdesc mvme3100Flash[] = {
/*
* Bank is populated from the top; make max_size negative to
* indicate this
*/
{ 0xf8000000, 0, - 0x08000000, 2, BSP_flash_vendor_spansion, 0, 0, 0 },
};
STATIC struct bankdesc *
bankcheck(int bank, int quiet)
{
if ( bank ) {
if ( !quiet )
fprintf(stderr,"Invalid flash bank #%i\n",bank);
return 0;
}
return &mvme3100Flash[bank];
}
STATIC int
flash_wp(int bank, int enbl)
{
uint8_t mask = enbl < 0 ? 0 : BSP_MVME3100_FLASH_CSR_F_WP_SW;
uint8_t val;
if ( bank != 0 ) {
fprintf(stderr,"Invalid flash bank #%i\n",bank);
return -1;
}
if ( enbl )
val = BSP_setSysReg( BSP_MVME3100_FLASH_CSR, mask );
else
val = BSP_clrSysReg( BSP_MVME3100_FLASH_CSR, mask );
if ( BSP_MVME3100_FLASH_CSR_F_WP_HW & val ) {
fprintf(stderr,"Flash: hardware write-protection engaged (switch)\n");
return -1;
}
if ( enbl < 0 )
return val & (BSP_MVME3100_FLASH_CSR_F_WP_HW | BSP_MVME3100_FLASH_CSR_F_WP_SW );
return 0;
}
STATIC uint32_t
read_us_timer(void)
{
uint32_t mhz = BSP_bus_frequency/BSP_time_base_divisor/1000;
return _read_TBRL()/mhz;
}
/* BSP ops (detect banks, handle write-protection on board) */
struct flash_bsp_ops BSP_flashBspOps = {
bankcheck: bankcheck,
flash_wp: flash_wp,
read_us_timer: read_us_timer,
};
|