RTOS/rtems
1
0
Fork 0
forked from Imagelibrary/rtems
Code Pull Requests Activity

2007-12-10 Till Straumann <strauman@slac.stanford.edu>

Browse Source 
* shared/motorola/vpd.c, shared/motorola/vpd.h:
	added code (originally developed for 'beatnik')
	to read MotLoad VPD data from i2c eeprom.
This commit is contained in:
Till Straumann
2007-12-11 06:20:53 +00:00
parent 3aff05fbd3
commit a50260e8b0
4 changed files with 474 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
c/src/lib/libbsp/powerpc/ChangeLog
View File

@@ -1,3 +1,9 @@
2007-12-10 Till Straumann <strauman@slac.stanford.edu>
* shared/motorola/vpd.c, shared/motorola/vpd.h:
added code (originally developed for 'beatnik')
to read MotLoad VPD data from i2c eeprom.
2007-12-10 Till Straumann <strauman@slac.stanford.edu>
* shared/vectors/README.deprecated, shared/irq/README.deprecated:

2
c/src/lib/libbsp/powerpc/Makefile.am
View File

@@ -37,6 +37,8 @@ EXTRA_DIST += shared/flash/flash.c shared/flash/flashPgm.h shared/flash/flashPgm
## shared/motorola
EXTRA_DIST += shared/motorola/motorola.c
EXTRA_DIST += shared/motorola/vpd.c
EXTRA_DIST += shared/motorola/vpd.h
## shared/pci
EXTRA_DIST += shared/pci/pci.c shared/pci/detect_raven_bridge.c shared/pci/pcifinddevice.c \

322
c/src/lib/libbsp/powerpc/shared/motorola/vpd.c Normal file
View File

@@ -0,0 +1,322 @@
/* $Id$ */
/* MotLoad VPD format */
/*
VPD = "MOTOROLA" , { field }
field = type, length, { data }
*/
/*
* Authorship
* ----------
* This software ('beatnik' RTEMS BSP for MVME6100 and MVME5500) was
* created by Till Straumann <strauman@slac.stanford.edu>, 2005-2007,
* Stanford Linear Accelerator Center, Stanford University.
*
* Acknowledgement of sponsorship
* ------------------------------
* The 'beatnik' 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 <string.h>
#include <sys/fcntl.h>
#include <bsp.h>
#include "vpd.h"
/* FIXME XXX: all of the early i2c reading stuff should
* be moved elsewhere. This file should only deal with
* VPD.
*/
#include <rtems/libi2c.h>
#define dev BSP_I2C_BUS_DESCRIPTOR
extern rtems_libi2c_bus_t *dev;
#define init dev->ops->init
#define start dev->ops->send_start
#define addr dev->ops->send_addr
#define write_bytes dev->ops->write_bytes
#define I2C_READ 1
#define I2C_WRITE 0
static ssize_t (*read_bytes)(int fd, void *buf, size_t len) = 0;
static ssize_t early_fp = 0;
static ssize_t early_read(int fd, void *buf, size_t len)
{
ssize_t rval;
rtems_libi2c_bus_t *d = (rtems_libi2c_bus_t*)fd;
uint8_t fp[2];
/* Always send the file-pointer. Some i2c controllers
* (mpc8540) have 'pipelined' operation and do extra
* read cycles so that a sequence of
* 'read_bytes', 'read_bytes' does NOT return the true
* sequence of bytes :-(
*/
start(d);
addr(d, BSP_VPD_I2C_ADDR, I2C_WRITE);
fp[0] = early_fp>>8;
fp[1] = early_fp;
write_bytes(dev,fp,2);
start(d);
addr(d, BSP_VPD_I2C_ADDR, I2C_READ);
rval = d->ops->read_bytes(d, buf, len);
if ( rval > 0 )
early_fp += rval;
return rval;
}
static int early_close(int fd)
{
rtems_libi2c_bus_t *d = (rtems_libi2c_bus_t*)fd;
return d->ops->send_stop(d);
}
static int read_buf(int fd, void *buf, size_t len)
{
int got, rval = 0;
while ( len > 0 ) {
if ( (got = read_bytes(fd, buf+rval, len)) <= 0 )
return -1;
len -= got;
rval+= got;
}
return rval;
}
/* Not Efficient but simple */
int
BSP_vpdRetrieveFields(VpdBuf data)
{
VpdBuf b, b1;
VpdKey k;
int l,fd = -1, put, got;
int rval = -1;
unsigned char mot[9];
static int (*stop)(int fd);
memset(mot,0,sizeof(mot));
if ( 0 && _System_state_Is_up(_System_state_Get()) ) {
read_bytes = read;
stop = close;
fd = open(BSP_I2C_VPD_EEPROM_DEV_NAME, 0);
if ( fd < 0 )
return -1;
} else {
fd = (int)dev;
/*
init(dev);
*
* Hangs - probably would need a delay here - just leave motload settings
*/
read_bytes = early_read;
stop = early_close;
}
if ( read_bytes(fd, mot, 8) < 8 ) {
goto bail;
}
if ( strcmp((char*)mot,"MOTOROLA") )
goto bail;
l = 0;
do {
/* skip field -- this is not done the first time since l=0 */
while ( l > sizeof(mot) ) {
got = read_buf(fd, mot, sizeof(mot));
if ( got < 1 )
goto bail;
l -= got;
}
if ( read_buf(fd, mot, l) < 0 )
goto bail;
/* now get a new header */
if ( read_buf(fd, mot, 2) < 2 )
goto bail;
k = mot[0];
l = mot[1];
for ( b = data; b->key != End; b++ ) {
if ( b->key == k && (signed char)b->instance >= 0 ) {
if ( 0 == b->instance-- ) {
/* found 'instance' of field 'type' */
/* limit to buffer size */
put = b->buflen > l ? l : b->buflen;
if ( read_buf(fd, b->buf, put) < put )
goto bail;
/* if this instance is multiply requested, copy the data */
for ( b1 = b + 1; b1->key != End; b1++ ) {
if ( b1->key == k && 0 == b1->instance ) {
b1->instance--;
/* we dont' handle the case where
* the first buffer couldn't hold the entire
* item but this one could...
*/
memcpy(b1->buf, b->buf, put);
b1->found = mot[1];
}
}
l -= put;
b->found = mot[1];
}
}
}
} while ( k != End );
rval = 0;
bail:
stop(fd);
return rval;
}
int
BSP_vpdRetrieveKey(VpdKey k, void *buf, int len, int inst)
{
VpdBufRec d[] = {
{ key: k, buf: buf, buflen: len, instance: inst },
VPD_END
};
return BSP_vpdRetrieveFields(d) ? -1 : d[0].found;
}
/*
005C3000 4D4F544F 524F4C41 0200010D 4D564D45 MOTOROLA....MVME
005C3010 35353030 2D303136 31020C30 312D5733 5500-0161..01-W3
005C3020 38323946 30324803 07373237 39303630 829F02H..7279060
005C3030 05053B9A CA000106 0507F281 55010807 ..;.........U...
005C3040 0001AF12 CA780008 070001AF 12CA7901 .....x........y.
005C3050 09043734 35350A04 D3223DD0 0B0C0089 ..7455..."=.....
005C3060 00181002 02101000 78070B0C FFFFFFFF ........x.......
005C3070 10020210 10017805 0E0FFFFF FFFFFFFF ......x.........
005C3080 FFFFFF01 FF01FFFF FF0F0400 03000019 ................
005C3090 0A010107 02030000 000100FF FFFFFFFF ................
005C30A0 FFFFFFFF FFFFFFFF FFFFFFFF FFFFFFFF ................
005C30B0 FFFFFFFF FFFFFFFF FFFFFFFF FFFFFFFF ................
005C30C0 00000000 00000000 00000000 00000000 ................
005C30D0 00000000 00000000 00000000 00000000 ................
005C30E0 00000000 00000000 00000000 00000000 ................
005C30F0 00000000 00000000 00000000 00000000 ................
Product Identifier : MVME5500-0161
Manufacturing Assembly Number : 01-W3829F02H
Serial Number : 7279060
Internal Clock Speed (Hertz) : 3B9ACA00 (&1000000000)
External Clock Speed (Hertz) : 07F28155 (&133333333)
Ethernet Address : 00 01 AF 12 CA 78 00
Ethernet Address : 00 01 AF 12 CA 79 01
Microprocessor Type : 7455
SROM/EEPROM CRC : D3223DD0 (&-752730672)
Flash Memory Configuration : 00 89 00 18 10 02 02 10
: 10 00 78 07
Flash Memory Configuration : FF FF FF FF 10 02 02 10
: 10 01 78 05
L2 Cache Configuration : FF FF FF FF FF FF FF FF
: FF 01 FF 01 FF FF FF
VPD Revision : 00 03 00 00
L3 Cache Configuration : 01 01 07 02 03 00 00 00
: 01 00
0x01889128: 4d4f544f 524f4c41 02000f04 00030000 MOTOROLA........
0x01889138: 060507f2 81550101 0d4d564d 45363130 .....U...MVME610
0x01889148: 302d3031 3631020c 30312d57 33383738 0-0161..01-W3878
0x01889158: 46303144 03073732 33313137 300e0fff F01D..7231170...
0x01889168: ffffffff ffffffff 01ff01ff ffff190a ................
0x01889178: 01000002 03000000 01000904 37343537 ............7457
0x01889188: 0a047277 144d0807 0001af13 b53c0008 ..rw.M.......<..
0x01889198: 070001af 13b53d01 0b0c0089 00031002 ......=.........
0x018891a8: 02101000 78080b0c 00890003 10020210 ....x...........
0x018891b8: 10017808 ffffffff ffffffff ffffffff ..x.............
0x018891c8: ffffffff ffffffff ffffffff ffffffff ................
0x018891d8: ffffffff ffffffff ffffffff ffffffff ................
0x018891e8: ffffffff ffffffff ........
0x00000000 (0)
0x003895c0: 4d4f544f 524f4c41 02000f04 00030000 MOTOROLA........
0x003895d0: 060503f9 40aa0101 0d4d564d 45333130 ....@....MVME310
0x003895e0: 302d3132 3633020c 30312d57 33383933 0-1263..01-W3893
0x003895f0: 46303143 03073734 35383831 340e0fff F01C..7458814...
0x00389600: ffffffff ffffffff 01ff01ff ffff0904 ................
0x00389610: 38353430 0a047129 d2d60807 0001af16 8540..q)........
0x00389620: e5c50008 070001af 16e5c601 08070001 ................
0x00389630: af16e5c7 020b0c00 017e2310 02021010 .........~#.....
0x00389640: 006409ff ffffffff ffffffff ffffffff .d..............
0x00389650: ffffffff ffffffff ffffffff ffffffff ................
0x00389660: ffffffff ffffffff ffffffff ffffffff ................
0x00389670: ffffffff ffffffff ffffffff ffffffff ................
0x00389680: ffffffff ffffffff ffffffff ffffffff ................
0x00389690: ffffffff ffffffff ffffffff ffffffff ................
0x003896a0: ffffffff ffffffff ffffffff ffffffff ................
0x003896b0: ffffffff ffffffff ffffffff ffffffff ................
MVME3100> vpdDisplay
VPD Revision : 00 03 00 00
External Clock Speed (Hertz) : 03F940AA (&66666666)
Product Identifier : MVME3100-1263
Manufacturing Assembly Number : 01-W3893F01C
Serial Number : 7458814
L2 Cache Configuration : FF FF FF FF FF FF FF FF
: FF 01 FF 01 FF FF FF
Microprocessor Type : 8540
SROM/EEPROM CRC : 7129D2D6 (&1898566358)
Ethernet Address : 00 01 AF 16 E5 C5 00
Ethernet Address : 00 01 AF 16 E5 C6 01
Ethernet Address : 00 01 AF 16 E5 C7 02
Flash Memory Configuration : 00 01 7E 23 10 02 02 10
: 10 00 64 09
*/

144
c/src/lib/libbsp/powerpc/shared/motorola/vpd.h Normal file
View File

@@ -0,0 +1,144 @@
#ifndef PPC_MOTLOAD_VPD_H
#define PPC_MOTLOAD_VPD_H
/* $Id$ */
/* MotLoad VPD format */
/* Till Straumann, 2005; see copyright notice at the end of this file */
#ifdef __cplusplus
extern "C" {
#endif
/*
VPD = "MOTOROLA" , { field }
field = type_byte, length_byte, { data }
*/
/* Known fields so far */
typedef enum {
ProductIdent = 0x01, /* String */
AssemblyNumber = 0x02, /* String */
SerialNumber = 0x03, /* String */
CpuClockHz = 0x05, /* binary (5bytes), 0x01 byte appended to unsigned int */
BusClockHz = 0x06, /* binary (5bytes), 0x01 byte appended to unsigned int */
EthernetAddr = 0x08, /* binary (7bytes), 0x00 byte appended, 2nd has 0x01 appended */
CpuType = 0x09, /* String */
EEpromCrc = 0x0a, /* binary (4bytes) */
FlashConfig = 0x0b, /* binary */
L2CacheConfig = 0x0e, /* binary */
VPDRevision = 0x0f, /* binary (4bytes) */
L3CacheConfig = 0x19, /* binary */
End = 0xff
} VpdKey;
typedef struct {
VpdKey key; /* key for the data item to be read into 'buf' */
char instance; /* instance # (starting with 0) - some keys are present more than one time */
void *buf; /* pointer to area where the data item is to be stored */
int buflen; /* available space in the buffer */
char found; /* set by BSP_vpdRetrieveFields() to the original length as found in the PROM */
} VpdBufRec, *VpdBuf;
#define VPD_END { key:End, }
/* Scan the VPD EEPROM for a number of fields
*
* Pass an array of VpdBufRec items. The routine
* fills the 'buf'fers for all keys that are found
* and sets the 'found' field to the original length
* of the data (i.e., as found in the PROM) so that
* the routine could be called again with a larger
* buffer.
*
* NOTE: - the array must be terminated by a VPD_END record!
* - no CRC check is performed.
* - INTERRUPT MANAGEMENT MUST BE FUNCTIONAL
*
* RETURNS: 0 on success, -1 if any read errors were
* encountered or if the "MOTOROLA" header
* was not found.
*/
int
BSP_vpdRetrieveFields(VpdBuf data);
/* Example:
* Read 2nd ethernet address:
*
* char enet_addr_2[6];
*
* VpdBufRec enetVpd [] = {
* { key: EthernetAddr, instance: 1, buf: enet_addr_2, buflen: 2},
* VPD_END
* };
*
* if ( BSP_vpdRetrieveFields(enetVpd) ) {
* error("ethernet address couldn't be read\n");
* } else if ( enetVpd[0].found < 6 ) {
* error("2nd ethernet address not found in VPD\n");
* } else {
* use_it(enet_addr_2);
* }
*/
/* Simple wrapper if only one field is needed
*
* RETURNS: original length if key is found, -1 on error or if key is not found
*/
int
BSP_vpdRetrieveKey(VpdKey k, void *buf, int buflen, int instance);
#ifdef __cplusplus
}
#endif
/*
* Authorship
* ----------
* This software ('beatnik' RTEMS BSP for MVME6100 and MVME5500) was
* created by Till Straumann <strauman@slac.stanford.edu>, 2005-2007,
* Stanford Linear Accelerator Center, Stanford University.
*
* Acknowledgement of sponsorship
* ------------------------------
* The 'beatnik' 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
*/
#endif