106 строки
2.6 KiB
C
106 строки
2.6 KiB
C
/*
|
|
* spi_eeprom.c
|
|
* Copyright (C) 2000-2001 Toshiba Corporation
|
|
*
|
|
* 2003-2005 (c) MontaVista Software, Inc. This file is licensed under the
|
|
* terms of the GNU General Public License version 2. This program is
|
|
* licensed "as is" without any warranty of any kind, whether express
|
|
* or implied.
|
|
*
|
|
* Support for TX4938 in 2.6 - Manish Lachwani (mlachwani@mvista.com)
|
|
*/
|
|
#include <linux/init.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/export.h>
|
|
#include <linux/device.h>
|
|
#include <linux/spi/spi.h>
|
|
#include <linux/spi/eeprom.h>
|
|
#include <asm/txx9/spi.h>
|
|
|
|
#define AT250X0_PAGE_SIZE 8
|
|
|
|
/* register board information for at25 driver */
|
|
int __init spi_eeprom_register(int busid, int chipid, int size)
|
|
{
|
|
struct spi_board_info info = {
|
|
.modalias = "at25",
|
|
.max_speed_hz = 1500000, /* 1.5Mbps */
|
|
.bus_num = busid,
|
|
.chip_select = chipid,
|
|
/* Mode 0: High-Active, Sample-Then-Shift */
|
|
};
|
|
struct spi_eeprom *eeprom;
|
|
eeprom = kzalloc(sizeof(*eeprom), GFP_KERNEL);
|
|
if (!eeprom)
|
|
return -ENOMEM;
|
|
strcpy(eeprom->name, "at250x0");
|
|
eeprom->byte_len = size;
|
|
eeprom->page_size = AT250X0_PAGE_SIZE;
|
|
eeprom->flags = EE_ADDR1;
|
|
info.platform_data = eeprom;
|
|
return spi_register_board_info(&info, 1);
|
|
}
|
|
|
|
/* simple temporary spi driver to provide early access to seeprom. */
|
|
|
|
static struct read_param {
|
|
int busid;
|
|
int chipid;
|
|
int address;
|
|
unsigned char *buf;
|
|
int len;
|
|
} *read_param;
|
|
|
|
static int __init early_seeprom_probe(struct spi_device *spi)
|
|
{
|
|
int stat = 0;
|
|
u8 cmd[2];
|
|
int len = read_param->len;
|
|
char *buf = read_param->buf;
|
|
int address = read_param->address;
|
|
|
|
dev_info(&spi->dev, "spiclk %u KHz.\n",
|
|
(spi->max_speed_hz + 500) / 1000);
|
|
if (read_param->busid != spi->master->bus_num ||
|
|
read_param->chipid != spi->chip_select)
|
|
return -ENODEV;
|
|
while (len > 0) {
|
|
/* spi_write_then_read can only work with small chunk */
|
|
int c = len < AT250X0_PAGE_SIZE ? len : AT250X0_PAGE_SIZE;
|
|
cmd[0] = 0x03; /* AT25_READ */
|
|
cmd[1] = address;
|
|
stat = spi_write_then_read(spi, cmd, sizeof(cmd), buf, c);
|
|
buf += c;
|
|
len -= c;
|
|
address += c;
|
|
}
|
|
return stat;
|
|
}
|
|
|
|
static struct spi_driver early_seeprom_driver __initdata = {
|
|
.driver = {
|
|
.name = "at25",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.probe = early_seeprom_probe,
|
|
};
|
|
|
|
int __init spi_eeprom_read(int busid, int chipid, int address,
|
|
unsigned char *buf, int len)
|
|
{
|
|
int ret;
|
|
struct read_param param = {
|
|
.busid = busid,
|
|
.chipid = chipid,
|
|
.address = address,
|
|
.buf = buf,
|
|
.len = len
|
|
};
|
|
|
|
read_param = ¶m;
|
|
ret = spi_register_driver(&early_seeprom_driver);
|
|
if (!ret)
|
|
spi_unregister_driver(&early_seeprom_driver);
|
|
return ret;
|
|
}
|