mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-16 08:44:21 +08:00
orinoco: Move firmware download functionality into new module
Move the functionality from spectrum_cs to hermes_dld in preparation for making it more generic and usable by other orinoco drivers. Signed-off-by: David Kilroy <kilroyd@gmail.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>
This commit is contained in:
parent
fc5a62d8b7
commit
f482eb797a
@ -16,7 +16,7 @@ obj-$(CONFIG_WAVELAN) += wavelan.o
|
||||
obj-$(CONFIG_PCMCIA_NETWAVE) += netwave_cs.o
|
||||
obj-$(CONFIG_PCMCIA_WAVELAN) += wavelan_cs.o
|
||||
|
||||
obj-$(CONFIG_HERMES) += orinoco.o hermes.o
|
||||
obj-$(CONFIG_HERMES) += orinoco.o hermes.o hermes_dld.o
|
||||
obj-$(CONFIG_PCMCIA_HERMES) += orinoco_cs.o
|
||||
obj-$(CONFIG_APPLE_AIRPORT) += airport.o
|
||||
obj-$(CONFIG_PLX_HERMES) += orinoco_plx.o
|
||||
|
338
drivers/net/wireless/hermes_dld.c
Normal file
338
drivers/net/wireless/hermes_dld.c
Normal file
@ -0,0 +1,338 @@
|
||||
/*
|
||||
* Hermes download helper driver.
|
||||
*
|
||||
* This could be entirely merged into hermes.c.
|
||||
*
|
||||
* I'm keeping it separate to minimise the amount of merging between
|
||||
* kernel upgrades. It also means the memory overhead for drivers that
|
||||
* don't need firmware download low.
|
||||
*
|
||||
* This driver:
|
||||
* - is capable of writing to the volatile area of the hermes device
|
||||
* - is currently not capable of writing to non-volatile areas
|
||||
* - provide helpers to identify and update plugin data
|
||||
* - is not capable of interpreting a fw image directly. That is up to
|
||||
* the main card driver.
|
||||
* - deals with Hermes I devices. It can probably be modified to deal
|
||||
* with Hermes II devices
|
||||
*
|
||||
* Copyright (C) 2007, David Kilroy
|
||||
*
|
||||
* Plug data code slightly modified from spectrum_cs driver
|
||||
* Copyright (C) 2002-2005 Pavel Roskin <proski@gnu.org>
|
||||
* Portions based on information in wl_lkm_718 Agere driver
|
||||
* COPYRIGHT (C) 2001-2004 by Agere Systems Inc. All Rights Reserved
|
||||
*
|
||||
* The contents of this file are subject to the Mozilla Public License
|
||||
* Version 1.1 (the "License"); you may not use this file except in
|
||||
* compliance with the License. You may obtain a copy of the License
|
||||
* at http://www.mozilla.org/MPL/
|
||||
*
|
||||
* Software distributed under the License is distributed on an "AS IS"
|
||||
* basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See
|
||||
* the License for the specific language governing rights and
|
||||
* limitations under the License.
|
||||
*
|
||||
* Alternatively, the contents of this file may be used under the
|
||||
* terms of the GNU General Public License version 2 (the "GPL"), in
|
||||
* which case the provisions of the GPL are applicable instead of the
|
||||
* above. If you wish to allow the use of your version of this file
|
||||
* only under the terms of the GPL and not to allow others to use your
|
||||
* version of this file under the MPL, indicate your decision by
|
||||
* deleting the provisions above and replace them with the notice and
|
||||
* other provisions required by the GPL. If you do not delete the
|
||||
* provisions above, a recipient may use your version of this file
|
||||
* under either the MPL or the GPL.
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/delay.h>
|
||||
#include "hermes.h"
|
||||
#include "hermes_dld.h"
|
||||
|
||||
MODULE_DESCRIPTION("Download helper for Lucent Hermes chipset");
|
||||
MODULE_AUTHOR("David Kilroy <kilroyd@gmail.com>");
|
||||
MODULE_LICENSE("Dual MPL/GPL");
|
||||
|
||||
#define PFX "hermes_dld: "
|
||||
|
||||
/*
|
||||
* AUX port access. To unlock the AUX port write the access keys to the
|
||||
* PARAM0-2 registers, then write HERMES_AUX_ENABLE to the HERMES_CONTROL
|
||||
* register. Then read it and make sure it's HERMES_AUX_ENABLED.
|
||||
*/
|
||||
#define HERMES_AUX_ENABLE 0x8000 /* Enable auxiliary port access */
|
||||
#define HERMES_AUX_DISABLE 0x4000 /* Disable to auxiliary port access */
|
||||
#define HERMES_AUX_ENABLED 0xC000 /* Auxiliary port is open */
|
||||
|
||||
#define HERMES_AUX_PW0 0xFE01
|
||||
#define HERMES_AUX_PW1 0xDC23
|
||||
#define HERMES_AUX_PW2 0xBA45
|
||||
|
||||
/* End markers */
|
||||
#define PDI_END 0x00000000 /* End of PDA */
|
||||
#define BLOCK_END 0xFFFFFFFF /* Last image block */
|
||||
|
||||
/*
|
||||
* The following structures have little-endian fields denoted by
|
||||
* the leading underscore. Don't access them directly - use inline
|
||||
* functions defined below.
|
||||
*/
|
||||
|
||||
/*
|
||||
* The binary image to be downloaded consists of series of data blocks.
|
||||
* Each block has the following structure.
|
||||
*/
|
||||
struct dblock {
|
||||
__le32 addr; /* adapter address where to write the block */
|
||||
__le16 len; /* length of the data only, in bytes */
|
||||
char data[0]; /* data to be written */
|
||||
} __attribute__ ((packed));
|
||||
|
||||
/*
|
||||
* Plug Data References are located in in the image after the last data
|
||||
* block. They refer to areas in the adapter memory where the plug data
|
||||
* items with matching ID should be written.
|
||||
*/
|
||||
struct pdr {
|
||||
__le32 id; /* record ID */
|
||||
__le32 addr; /* adapter address where to write the data */
|
||||
__le32 len; /* expected length of the data, in bytes */
|
||||
char next[0]; /* next PDR starts here */
|
||||
} __attribute__ ((packed));
|
||||
|
||||
/*
|
||||
* Plug Data Items are located in the EEPROM read from the adapter by
|
||||
* primary firmware. They refer to the device-specific data that should
|
||||
* be plugged into the secondary firmware.
|
||||
*/
|
||||
struct pdi {
|
||||
__le16 len; /* length of ID and data, in words */
|
||||
__le16 id; /* record ID */
|
||||
char data[0]; /* plug data */
|
||||
} __attribute__ ((packed));
|
||||
|
||||
/* Functions for access to little-endian data */
|
||||
static inline u32
|
||||
dblock_addr(const struct dblock *blk)
|
||||
{
|
||||
return le32_to_cpu(blk->addr);
|
||||
}
|
||||
|
||||
static inline u32
|
||||
dblock_len(const struct dblock *blk)
|
||||
{
|
||||
return le16_to_cpu(blk->len);
|
||||
}
|
||||
|
||||
static inline u32
|
||||
pdr_id(const struct pdr *pdr)
|
||||
{
|
||||
return le32_to_cpu(pdr->id);
|
||||
}
|
||||
|
||||
static inline u32
|
||||
pdr_addr(const struct pdr *pdr)
|
||||
{
|
||||
return le32_to_cpu(pdr->addr);
|
||||
}
|
||||
|
||||
static inline u32
|
||||
pdr_len(const struct pdr *pdr)
|
||||
{
|
||||
return le32_to_cpu(pdr->len);
|
||||
}
|
||||
|
||||
static inline u32
|
||||
pdi_id(const struct pdi *pdi)
|
||||
{
|
||||
return le16_to_cpu(pdi->id);
|
||||
}
|
||||
|
||||
/* Return length of the data only, in bytes */
|
||||
static inline u32
|
||||
pdi_len(const struct pdi *pdi)
|
||||
{
|
||||
return 2 * (le16_to_cpu(pdi->len) - 1);
|
||||
}
|
||||
|
||||
/* Set address of the auxiliary port */
|
||||
static inline void
|
||||
spectrum_aux_setaddr(hermes_t *hw, u32 addr)
|
||||
{
|
||||
hermes_write_reg(hw, HERMES_AUXPAGE, (u16) (addr >> 7));
|
||||
hermes_write_reg(hw, HERMES_AUXOFFSET, (u16) (addr & 0x7F));
|
||||
}
|
||||
|
||||
/* Open access to the auxiliary port */
|
||||
static int
|
||||
spectrum_aux_open(hermes_t *hw)
|
||||
{
|
||||
int i;
|
||||
|
||||
/* Already open? */
|
||||
if (hermes_read_reg(hw, HERMES_CONTROL) == HERMES_AUX_ENABLED)
|
||||
return 0;
|
||||
|
||||
hermes_write_reg(hw, HERMES_PARAM0, HERMES_AUX_PW0);
|
||||
hermes_write_reg(hw, HERMES_PARAM1, HERMES_AUX_PW1);
|
||||
hermes_write_reg(hw, HERMES_PARAM2, HERMES_AUX_PW2);
|
||||
hermes_write_reg(hw, HERMES_CONTROL, HERMES_AUX_ENABLE);
|
||||
|
||||
for (i = 0; i < 20; i++) {
|
||||
udelay(10);
|
||||
if (hermes_read_reg(hw, HERMES_CONTROL) ==
|
||||
HERMES_AUX_ENABLED)
|
||||
return 0;
|
||||
}
|
||||
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
/*
|
||||
* Scan PDR for the record with the specified RECORD_ID.
|
||||
* If it's not found, return NULL.
|
||||
*/
|
||||
static struct pdr *
|
||||
spectrum_find_pdr(struct pdr *first_pdr, u32 record_id)
|
||||
{
|
||||
struct pdr *pdr = first_pdr;
|
||||
|
||||
while (pdr_id(pdr) != PDI_END) {
|
||||
/*
|
||||
* PDR area is currently not terminated by PDI_END.
|
||||
* It's followed by CRC records, which have the type
|
||||
* field where PDR has length. The type can be 0 or 1.
|
||||
*/
|
||||
if (pdr_len(pdr) < 2)
|
||||
return NULL;
|
||||
|
||||
/* If the record ID matches, we are done */
|
||||
if (pdr_id(pdr) == record_id)
|
||||
return pdr;
|
||||
|
||||
pdr = (struct pdr *) pdr->next;
|
||||
}
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* Process one Plug Data Item - find corresponding PDR and plug it */
|
||||
static int
|
||||
spectrum_plug_pdi(hermes_t *hw, struct pdr *first_pdr, struct pdi *pdi)
|
||||
{
|
||||
struct pdr *pdr;
|
||||
|
||||
/* Find the PDI corresponding to this PDR */
|
||||
pdr = spectrum_find_pdr(first_pdr, pdi_id(pdi));
|
||||
|
||||
/* No match is found, safe to ignore */
|
||||
if (!pdr)
|
||||
return 0;
|
||||
|
||||
/* Lengths of the data in PDI and PDR must match */
|
||||
if (pdi_len(pdi) != pdr_len(pdr))
|
||||
return -EINVAL;
|
||||
|
||||
/* do the actual plugging */
|
||||
spectrum_aux_setaddr(hw, pdr_addr(pdr));
|
||||
hermes_write_bytes(hw, HERMES_AUXDATA, pdi->data, pdi_len(pdi));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Read PDA from the adapter */
|
||||
int
|
||||
spectrum_read_pda(hermes_t *hw, __le16 *pda, int pda_len)
|
||||
{
|
||||
int ret;
|
||||
int pda_size;
|
||||
|
||||
/* Issue command to read EEPROM */
|
||||
ret = hermes_docmd_wait(hw, HERMES_CMD_READMIF, 0, NULL);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* Open auxiliary port */
|
||||
ret = spectrum_aux_open(hw);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* read PDA from EEPROM */
|
||||
spectrum_aux_setaddr(hw, PDA_ADDR);
|
||||
hermes_read_words(hw, HERMES_AUXDATA, pda, pda_len / 2);
|
||||
|
||||
/* Check PDA length */
|
||||
pda_size = le16_to_cpu(pda[0]);
|
||||
if (pda_size > pda_len)
|
||||
return -EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(spectrum_read_pda);
|
||||
|
||||
/* Parse PDA and write the records into the adapter */
|
||||
int
|
||||
spectrum_apply_pda(hermes_t *hw, const struct dblock *first_block,
|
||||
__le16 *pda)
|
||||
{
|
||||
int ret;
|
||||
struct pdi *pdi;
|
||||
struct pdr *first_pdr;
|
||||
const struct dblock *blk = first_block;
|
||||
|
||||
/* Skip all blocks to locate Plug Data References */
|
||||
while (dblock_addr(blk) != BLOCK_END)
|
||||
blk = (struct dblock *) &blk->data[dblock_len(blk)];
|
||||
|
||||
first_pdr = (struct pdr *) blk;
|
||||
|
||||
/* Go through every PDI and plug them into the adapter */
|
||||
pdi = (struct pdi *) (pda + 2);
|
||||
while (pdi_id(pdi) != PDI_END) {
|
||||
ret = spectrum_plug_pdi(hw, first_pdr, pdi);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* Increment to the next PDI */
|
||||
pdi = (struct pdi *) &pdi->data[pdi_len(pdi)];
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(spectrum_apply_pda);
|
||||
|
||||
/* Load firmware blocks into the adapter */
|
||||
int
|
||||
spectrum_load_blocks(hermes_t *hw, const struct dblock *first_block)
|
||||
{
|
||||
const struct dblock *blk;
|
||||
u32 blkaddr;
|
||||
u32 blklen;
|
||||
|
||||
blk = first_block;
|
||||
blkaddr = dblock_addr(blk);
|
||||
blklen = dblock_len(blk);
|
||||
|
||||
while (dblock_addr(blk) != BLOCK_END) {
|
||||
spectrum_aux_setaddr(hw, blkaddr);
|
||||
hermes_write_bytes(hw, HERMES_AUXDATA, blk->data,
|
||||
blklen);
|
||||
|
||||
blk = (struct dblock *) &blk->data[blklen];
|
||||
blkaddr = dblock_addr(blk);
|
||||
blklen = dblock_len(blk);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(spectrum_load_blocks);
|
||||
|
||||
static int __init init_hermes_dld(void)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit exit_hermes_dld(void)
|
||||
{
|
||||
}
|
||||
|
||||
module_init(init_hermes_dld);
|
||||
module_exit(exit_hermes_dld);
|
45
drivers/net/wireless/hermes_dld.h
Normal file
45
drivers/net/wireless/hermes_dld.h
Normal file
@ -0,0 +1,45 @@
|
||||
/*
|
||||
* Copyright (C) 2007, David Kilroy
|
||||
*
|
||||
* The contents of this file are subject to the Mozilla Public License
|
||||
* Version 1.1 (the "License"); you may not use this file except in
|
||||
* compliance with the License. You may obtain a copy of the License
|
||||
* at http://www.mozilla.org/MPL/
|
||||
*
|
||||
* Software distributed under the License is distributed on an "AS IS"
|
||||
* basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See
|
||||
* the License for the specific language governing rights and
|
||||
* limitations under the License.
|
||||
*
|
||||
* Alternatively, the contents of this file may be used under the
|
||||
* terms of the GNU General Public License version 2 (the "GPL"), in
|
||||
* which case the provisions of the GPL are applicable instead of the
|
||||
* above. If you wish to allow the use of your version of this file
|
||||
* only under the terms of the GPL and not to allow others to use your
|
||||
* version of this file under the MPL, indicate your decision by
|
||||
* deleting the provisions above and replace them with the notice and
|
||||
* other provisions required by the GPL. If you do not delete the
|
||||
* provisions above, a recipient may use your version of this file
|
||||
* under either the MPL or the GPL.
|
||||
*/
|
||||
#ifndef _HERMES_DLD_H
|
||||
#define _HERMES_DLD_H
|
||||
|
||||
#include "hermes.h"
|
||||
|
||||
/* Position of PDA in the adapter memory */
|
||||
#define EEPROM_ADDR 0x3000
|
||||
#define EEPROM_LEN 0x200
|
||||
#define PDA_OFFSET 0x100
|
||||
|
||||
#define PDA_ADDR (EEPROM_ADDR + PDA_OFFSET)
|
||||
#define PDA_WORDS ((EEPROM_LEN - PDA_OFFSET) / 2)
|
||||
|
||||
struct dblock;
|
||||
|
||||
int spectrum_read_pda(hermes_t *hw, __le16 *pda, int pda_len);
|
||||
int spectrum_apply_pda(hermes_t *hw, const struct dblock *first_block,
|
||||
__le16 *pda);
|
||||
int spectrum_load_blocks(hermes_t *hw, const struct dblock *first_block);
|
||||
|
||||
#endif /* _HERMES_DLD_H */
|
@ -33,6 +33,7 @@
|
||||
#include <pcmcia/ds.h>
|
||||
|
||||
#include "orinoco.h"
|
||||
#include "hermes_dld.h"
|
||||
|
||||
static const char primary_fw_name[] = "symbol_sp24t_prim_fw";
|
||||
static const char secondary_fw_name[] = "symbol_sp24t_sec_fw";
|
||||
@ -88,144 +89,9 @@ static void spectrum_cs_release(struct pcmcia_device *link);
|
||||
#define HCR_IDLE 0x0E /* don't run firmware after reset */
|
||||
#define HCR_MEM16 0x10 /* memory width bit, should be preserved */
|
||||
|
||||
/*
|
||||
* AUX port access. To unlock the AUX port write the access keys to the
|
||||
* PARAM0-2 registers, then write HERMES_AUX_ENABLE to the HERMES_CONTROL
|
||||
* register. Then read it and make sure it's HERMES_AUX_ENABLED.
|
||||
*/
|
||||
#define HERMES_AUX_ENABLE 0x8000 /* Enable auxiliary port access */
|
||||
#define HERMES_AUX_DISABLE 0x4000 /* Disable to auxiliary port access */
|
||||
#define HERMES_AUX_ENABLED 0xC000 /* Auxiliary port is open */
|
||||
|
||||
#define HERMES_AUX_PW0 0xFE01
|
||||
#define HERMES_AUX_PW1 0xDC23
|
||||
#define HERMES_AUX_PW2 0xBA45
|
||||
|
||||
/* End markers */
|
||||
#define PDI_END 0x00000000 /* End of PDA */
|
||||
#define BLOCK_END 0xFFFFFFFF /* Last image block */
|
||||
#define TEXT_END 0x1A /* End of text header */
|
||||
|
||||
/*
|
||||
* The following structures have little-endian fields denoted by
|
||||
* the leading underscore. Don't access them directly - use inline
|
||||
* functions defined below.
|
||||
*/
|
||||
|
||||
/*
|
||||
* The binary image to be downloaded consists of series of data blocks.
|
||||
* Each block has the following structure.
|
||||
*/
|
||||
struct dblock {
|
||||
__le32 addr; /* adapter address where to write the block */
|
||||
__le16 len; /* length of the data only, in bytes */
|
||||
char data[0]; /* data to be written */
|
||||
} __attribute__ ((packed));
|
||||
|
||||
/*
|
||||
* Plug Data References are located in in the image after the last data
|
||||
* block. They refer to areas in the adapter memory where the plug data
|
||||
* items with matching ID should be written.
|
||||
*/
|
||||
struct pdr {
|
||||
__le32 id; /* record ID */
|
||||
__le32 addr; /* adapter address where to write the data */
|
||||
__le32 len; /* expected length of the data, in bytes */
|
||||
char next[0]; /* next PDR starts here */
|
||||
} __attribute__ ((packed));
|
||||
|
||||
|
||||
/*
|
||||
* Plug Data Items are located in the EEPROM read from the adapter by
|
||||
* primary firmware. They refer to the device-specific data that should
|
||||
* be plugged into the secondary firmware.
|
||||
*/
|
||||
struct pdi {
|
||||
__le16 len; /* length of ID and data, in words */
|
||||
__le16 id; /* record ID */
|
||||
char data[0]; /* plug data */
|
||||
} __attribute__ ((packed));
|
||||
|
||||
|
||||
/* Functions for access to little-endian data */
|
||||
static inline u32
|
||||
dblock_addr(const struct dblock *blk)
|
||||
{
|
||||
return le32_to_cpu(blk->addr);
|
||||
}
|
||||
|
||||
static inline u32
|
||||
dblock_len(const struct dblock *blk)
|
||||
{
|
||||
return le16_to_cpu(blk->len);
|
||||
}
|
||||
|
||||
static inline u32
|
||||
pdr_id(const struct pdr *pdr)
|
||||
{
|
||||
return le32_to_cpu(pdr->id);
|
||||
}
|
||||
|
||||
static inline u32
|
||||
pdr_addr(const struct pdr *pdr)
|
||||
{
|
||||
return le32_to_cpu(pdr->addr);
|
||||
}
|
||||
|
||||
static inline u32
|
||||
pdr_len(const struct pdr *pdr)
|
||||
{
|
||||
return le32_to_cpu(pdr->len);
|
||||
}
|
||||
|
||||
static inline u32
|
||||
pdi_id(const struct pdi *pdi)
|
||||
{
|
||||
return le16_to_cpu(pdi->id);
|
||||
}
|
||||
|
||||
/* Return length of the data only, in bytes */
|
||||
static inline u32
|
||||
pdi_len(const struct pdi *pdi)
|
||||
{
|
||||
return 2 * (le16_to_cpu(pdi->len) - 1);
|
||||
}
|
||||
|
||||
|
||||
/* Set address of the auxiliary port */
|
||||
static inline void
|
||||
spectrum_aux_setaddr(hermes_t *hw, u32 addr)
|
||||
{
|
||||
hermes_write_reg(hw, HERMES_AUXPAGE, (u16) (addr >> 7));
|
||||
hermes_write_reg(hw, HERMES_AUXOFFSET, (u16) (addr & 0x7F));
|
||||
}
|
||||
|
||||
|
||||
/* Open access to the auxiliary port */
|
||||
static int
|
||||
spectrum_aux_open(hermes_t *hw)
|
||||
{
|
||||
int i;
|
||||
|
||||
/* Already open? */
|
||||
if (hermes_read_reg(hw, HERMES_CONTROL) == HERMES_AUX_ENABLED)
|
||||
return 0;
|
||||
|
||||
hermes_write_reg(hw, HERMES_PARAM0, HERMES_AUX_PW0);
|
||||
hermes_write_reg(hw, HERMES_PARAM1, HERMES_AUX_PW1);
|
||||
hermes_write_reg(hw, HERMES_PARAM2, HERMES_AUX_PW2);
|
||||
hermes_write_reg(hw, HERMES_CONTROL, HERMES_AUX_ENABLE);
|
||||
|
||||
for (i = 0; i < 20; i++) {
|
||||
udelay(10);
|
||||
if (hermes_read_reg(hw, HERMES_CONTROL) ==
|
||||
HERMES_AUX_ENABLED)
|
||||
return 0;
|
||||
}
|
||||
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
|
||||
#define CS_CHECK(fn, ret) \
|
||||
do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
|
||||
@ -293,144 +159,6 @@ spectrum_reset(struct pcmcia_device *link, int idle)
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Scan PDR for the record with the specified RECORD_ID.
|
||||
* If it's not found, return NULL.
|
||||
*/
|
||||
static struct pdr *
|
||||
spectrum_find_pdr(struct pdr *first_pdr, u32 record_id)
|
||||
{
|
||||
struct pdr *pdr = first_pdr;
|
||||
|
||||
while (pdr_id(pdr) != PDI_END) {
|
||||
/*
|
||||
* PDR area is currently not terminated by PDI_END.
|
||||
* It's followed by CRC records, which have the type
|
||||
* field where PDR has length. The type can be 0 or 1.
|
||||
*/
|
||||
if (pdr_len(pdr) < 2)
|
||||
return NULL;
|
||||
|
||||
/* If the record ID matches, we are done */
|
||||
if (pdr_id(pdr) == record_id)
|
||||
return pdr;
|
||||
|
||||
pdr = (struct pdr *) pdr->next;
|
||||
}
|
||||
return NULL;
|
||||
}
|
||||
|
||||
|
||||
/* Process one Plug Data Item - find corresponding PDR and plug it */
|
||||
static int
|
||||
spectrum_plug_pdi(hermes_t *hw, struct pdr *first_pdr, struct pdi *pdi)
|
||||
{
|
||||
struct pdr *pdr;
|
||||
|
||||
/* Find the PDI corresponding to this PDR */
|
||||
pdr = spectrum_find_pdr(first_pdr, pdi_id(pdi));
|
||||
|
||||
/* No match is found, safe to ignore */
|
||||
if (!pdr)
|
||||
return 0;
|
||||
|
||||
/* Lengths of the data in PDI and PDR must match */
|
||||
if (pdi_len(pdi) != pdr_len(pdr))
|
||||
return -EINVAL;
|
||||
|
||||
/* do the actual plugging */
|
||||
spectrum_aux_setaddr(hw, pdr_addr(pdr));
|
||||
hermes_write_bytes(hw, HERMES_AUXDATA, pdi->data, pdi_len(pdi));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* Read PDA from the adapter */
|
||||
static int
|
||||
spectrum_read_pda(hermes_t *hw, __le16 *pda, int pda_len)
|
||||
{
|
||||
int ret;
|
||||
int pda_size;
|
||||
|
||||
/* Issue command to read EEPROM */
|
||||
ret = hermes_docmd_wait(hw, HERMES_CMD_READMIF, 0, NULL);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* Open auxiliary port */
|
||||
ret = spectrum_aux_open(hw);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* read PDA from EEPROM */
|
||||
spectrum_aux_setaddr(hw, PDA_ADDR);
|
||||
hermes_read_words(hw, HERMES_AUXDATA, pda, pda_len / 2);
|
||||
|
||||
/* Check PDA length */
|
||||
pda_size = le16_to_cpu(pda[0]);
|
||||
if (pda_size > pda_len)
|
||||
return -EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* Parse PDA and write the records into the adapter */
|
||||
static int
|
||||
spectrum_apply_pda(hermes_t *hw, const struct dblock *first_block,
|
||||
__le16 *pda)
|
||||
{
|
||||
int ret;
|
||||
struct pdi *pdi;
|
||||
struct pdr *first_pdr;
|
||||
const struct dblock *blk = first_block;
|
||||
|
||||
/* Skip all blocks to locate Plug Data References */
|
||||
while (dblock_addr(blk) != BLOCK_END)
|
||||
blk = (struct dblock *) &blk->data[dblock_len(blk)];
|
||||
|
||||
first_pdr = (struct pdr *) blk;
|
||||
|
||||
/* Go through every PDI and plug them into the adapter */
|
||||
pdi = (struct pdi *) (pda + 2);
|
||||
while (pdi_id(pdi) != PDI_END) {
|
||||
ret = spectrum_plug_pdi(hw, first_pdr, pdi);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* Increment to the next PDI */
|
||||
pdi = (struct pdi *) &pdi->data[pdi_len(pdi)];
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* Load firmware blocks into the adapter */
|
||||
static int
|
||||
spectrum_load_blocks(hermes_t *hw, const struct dblock *first_block)
|
||||
{
|
||||
const struct dblock *blk;
|
||||
u32 blkaddr;
|
||||
u32 blklen;
|
||||
|
||||
blk = first_block;
|
||||
blkaddr = dblock_addr(blk);
|
||||
blklen = dblock_len(blk);
|
||||
|
||||
while (dblock_addr(blk) != BLOCK_END) {
|
||||
spectrum_aux_setaddr(hw, blkaddr);
|
||||
hermes_write_bytes(hw, HERMES_AUXDATA, blk->data,
|
||||
blklen);
|
||||
|
||||
blk = (struct dblock *) &blk->data[blklen];
|
||||
blkaddr = dblock_addr(blk);
|
||||
blklen = dblock_len(blk);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Process a firmware image - stop the card, load the firmware, reset
|
||||
* the card and make sure it responds. For the secondary firmware take
|
||||
|
Loading…
Reference in New Issue
Block a user