--- /dev/null
+/*
+ * Copyright (c) 2013 Qualcomm Atheros, Inc.
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted (subject to the limitations in the
+ * disclaimer below) provided that the following conditions are met:
+ *
+ * * Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ *
+ * * Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the
+ * distribution.
+ *
+ * * Neither the name of Qualcomm Atheros nor the names of its
+ * contributors may be used to endorse or promote products derived
+ * from this software without specific prior written permission.
+ *
+ * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
+ * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT
+ * HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
+ * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
+ * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
+ * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+/*************************************************************************/
+/* Copyright (c) 2008 Atheros Communications, Inc., All Rights Reserved */
+/* */
+/* Module Name : cmnos_rompatch.c */
+/* */
+/* Abstract */
+/* This file contains rom code patch mechanism, patch code is */
+/* offline generated, and replace the indirect table function as we */
+/* need to patch. */
+/* */
+/* NOTES */
+/* None */
+/* */
+/*************************************************************************/
+
+#include "sys_cfg.h"
+
+#include "athos_api.h"
+
+#if SYSTEM_MODULE_ROM_PATCH
+
+
+LOCAL BOOLEAN _patch_dump( struct rom_patch_st *patch);
+LOCAL BOOLEAN _read_rom_patch(struct rom_patch_st *patch);
+
+
+// the patch install entry
+void (*patch_start)(void);
+
+// the eep redirect addr
+struct eep_redir_addr patch_addr = {0x0, 0x0};
+
+
+LOCAL
+BOOLEAN _patch_dump( struct rom_patch_st *patch)
+{
+// A_PRINTF("\tCRC: 0x%04x\n\r", patch->crc16);
+ A_PRINTF("\tsize: %d bytes\n\r", patch->len);
+ A_PRINTF("\tld_addr: 0x%08x\n\r", (uint32_t)patch->ld_addr);
+ A_PRINTF("\tfun_addr: 0x%08x\n\r", (uint32_t)patch->fun_addr);
+}
+
+
+
+LOCAL
+BOOLEAN _read_rom_patch(struct rom_patch_st *patch)
+{
+ BOOLEAN retVal = FALSE;
+ uint8_t *addr;
+ uint16_t i;
+ uint8_t *buf = ((uint8_t*)(patch)+(sizeof(struct rom_patch_st)-4)); //assign the patch code buffer, last 4 bytes is the data
+
+ /*! assign the load address of the patch
+ *
+ * - convert the address to dport address 0x4exxxx or 0x5xxxxx
+ */
+ //addr = (uint32_t *)((patch->ld_addr&(~0xc00000))|(0x400000));
+ addr = (uint8_t *)(patch->ld_addr);
+ if( (uint32_t)addr < SYS_D_RAM_REGION_0_BASE || (uint32_t)addr >= (SYS_D_RAM_REGION_0_BASE + SYS_RAM_SZIE) )
+ {
+ A_PRINTF("!address should be dport in ram's address, 0x%08x\n\r", (uint32_t)addr);
+ goto ERR_DONE;
+ }
+
+ _patch_dump(patch);
+
+ A_PRINTF("copy %d bytes from 0x%08x to 0x%08x", patch->len, (uint32_t)buf, (uint32_t)addr);
+ for(i=0; i<patch->len; i+=4) // word access
+ {
+ addr[i+3] = buf[i];
+ addr[i+2] = buf[i+1];
+ addr[i+1] = buf[i+2];
+ addr[i] = buf[i+3];
+ }
+
+ retVal = TRUE;
+ERR_DONE:
+ return retVal;
+
+}
+
+
+/*!
+ * decode and parse the rompatch code
+ *
+ * addr: the buffer in ram stored the downloaded buffer
+ */
+LOCAL
+BOOLEAN cmnos_romp_decode(uint32_t addr)
+{
+ int i;
+ BOOLEAN retVal = FALSE;
+ struct rom_patch_st *patch;
+ uint8_t *func_addr;
+
+ A_PRINTF("[%s+]\n\r", __FUNCTION__ );
+ {
+ /*
+ * check the integrity of the buffer
+ */
+ uint32_t *mData = (uint32_t *)addr;
+ uint32_t CheckSum = 0;
+
+ // size at here is a half-word based, divide by 2 set it to a word
+ for(i=0; i<(patch_addr.size/2); i++, mData++)
+ CheckSum = CheckSum ^ *mData;
+
+ A_PRINTF("CheckSum: 0x%08x\n\r", CheckSum);
+
+ if( CheckSum != 0 )
+ goto ERR_DONE;
+
+ /*********************************************/
+
+ patch = (struct rom_patch_st *)addr;
+
+ func_addr = (uint8_t *)patch->fun_addr;
+
+ if( _read_rom_patch(patch) )
+ {
+ //A_PRINTF("\n\r patch to 0x%08x, func at 0x%08x\n\r", (uint32_t)patch->ld_addr, (uint32_t)func_addr);
+
+ // the patch function entry, call install later
+ patch_start = (void *)func_addr;
+
+ // install the patch here
+ //patch_start();
+ }
+ else
+ {
+ A_PRINTF("patch decode fail!\n\r");
+ goto ERR_DONE;
+ }
+ }
+
+ retVal = TRUE;
+
+ERR_DONE:
+ A_PRINTF("[%s-]\n\r", __FUNCTION__ );
+
+ return retVal;
+ //
+ // if crc checking is ok, move code the where it belong according to it's ld_addr
+ //
+
+}
+
+
+/*!
+ * install
+ */
+LOCAL BOOLEAN cmnos_romp_install(void)
+{
+ /* TBD: to be removed! */
+
+ /*! call the patch function,
+ *
+ * - left the patch install did by the patch code,
+ * so that we sould build the patch code with entry function is the install process
+ * e.g void install_patch(void), which update the function table
+ */
+
+ //A_PRINTF("[%s+]\n\r", __FUNCTION__);
+ patch_start();
+ //A_PRINTF("[%s-]\n\r", __FUNCTION__);
+}
+
+/*!
+ * download
+ *
+ * offset: the offset of the eeprom redirect header(offset, size)
+ *
+ */
+LOCAL BOOLEAN cmnos_romp_download(uint16_t offset)
+{
+ BOOLEAN retVal = FALSE;
+ uint16_t buf[2];
+
+ uint16_t eep_start_ofst = EEPROM_START_OFFSET;
+ uint16_t eep_end_ofst = EEPROM_END_OFFSET;
+
+ A_PRINTF("[%s+]\n\r", __FUNCTION__ );
+
+ /* TBD: to be removed! */
+ /* read the patch from EEPROM, if there is an EEPROM exist and patch code stored inside */
+
+ /*
+ * 1. read the fixed offset address of 0xfc and find the exactly patch code is
+ * 2. read the patch code from eeprom and write to buffer ram
+ * ------------------- leave it to decode operation ------------------
+ * 3. and check the integrity of it, if the integrity is ok, goto 4
+ * 4. decode the patch pack and decode each patch code and write them to the RAM
+ *
+ */
+
+ /*
+ * read the eep redirect(offset, size) from the offset
+ */
+ if( RET_SUCCESS != A_EEP_READ(offset, sizeof(struct eep_redir_addr)/sizeof(uint16_t), buf) )
+ goto ERR_DONE;
+
+ A_PRINTF("patch.offset: 0x%04x, patch.size : 0x%04x\n\r", buf[0], buf[1]);
+
+ patch_addr.offset = buf[0];
+ patch_addr.size = buf[1];
+
+ // ATHR : 0x41544852, ((uint32_t)patch_addr == 0x41544852) ||
+ // size == 0, offset > 0x3fff or offset < 0x2000, eeprom offset is between 0x2000~0x3fff
+ if( (patch_addr.size == 0x0) ||(patch_addr.offset < eep_start_ofst ) \
+ || (patch_addr.offset > eep_end_ofst) || ((patch_addr.offset+patch_addr.size) > eep_end_ofst))
+ goto ERR_DONE;
+
+ // read the patch code to ROM_PATCH_BUF_ADDR: 0x51E000,
+ A_EEP_READ(patch_addr.offset, patch_addr.size, (uint16_t *)ROM_PATCH_BUF_ADDR);
+
+ if( A_ROMP_DECODE(ROM_PATCH_BUF_ADDR) )
+ {
+ A_ROMP_INSTALL();
+ }
+ else
+ goto ERR_DONE;
+
+ retVal = TRUE;
+ERR_DONE:
+ A_PRINTF("[%s-]\n\r", __FUNCTION__ );
+ return retVal;
+
+}
+
+/*!
+ * init
+ */
+LOCAL void cmnos_romp_init(void)
+{
+ /* TBD: to be removed! */
+ //A_PRINTF("CMNOS_ROMP_INIT!\n\r");
+}
+
+void
+cmnos_romp_module_install(struct romp_api *tbl)
+{
+ tbl->_romp_init = cmnos_romp_init;
+ tbl->_romp_download = cmnos_romp_download;
+ tbl->_romp_install = cmnos_romp_install;
+ tbl->_romp_decode = cmnos_romp_decode;
+
+}
+
+#endif