r8169: support new firmware format.
The new firmware format adds versioning as firmware for a specific chipset appears to be subject to change. Current "legacy" format is still supported. Signed-off-by: Hayes Wang <hayeswang@realtek.com> Signed-off-by: Francois Romieu <romieu@fr.zoreil.com>
This commit is contained in:
Родитель
1c361efb22
Коммит
960aee6c7d
|
@ -1754,18 +1754,52 @@ static void rtl_writephy_batch(struct rtl8169_private *tp,
|
|||
#define PHY_DELAY_MS 0xe0000000
|
||||
#define PHY_WRITE_ERI_WORD 0xf0000000
|
||||
|
||||
struct fw_info {
|
||||
u32 magic;
|
||||
char version[RTL_VER_SIZE];
|
||||
__le32 fw_start;
|
||||
__le32 fw_len;
|
||||
u8 chksum;
|
||||
} __packed;
|
||||
|
||||
#define FW_OPCODE_SIZE sizeof(typeof(*((struct rtl_fw_phy_action *)0)->code))
|
||||
|
||||
static bool rtl_fw_format_ok(struct rtl8169_private *tp, struct rtl_fw *rtl_fw)
|
||||
{
|
||||
const struct firmware *fw = rtl_fw->fw;
|
||||
struct fw_info *fw_info = (struct fw_info *)fw->data;
|
||||
struct rtl_fw_phy_action *pa = &rtl_fw->phy_action;
|
||||
char *version = rtl_fw->version;
|
||||
bool rc = false;
|
||||
|
||||
if (fw->size < FW_OPCODE_SIZE)
|
||||
goto out;
|
||||
else {
|
||||
|
||||
if (!fw_info->magic) {
|
||||
size_t i, size, start;
|
||||
u8 checksum = 0;
|
||||
|
||||
if (fw->size < sizeof(*fw_info))
|
||||
goto out;
|
||||
|
||||
for (i = 0; i < fw->size; i++)
|
||||
checksum += fw->data[i];
|
||||
if (checksum != 0)
|
||||
goto out;
|
||||
|
||||
start = le32_to_cpu(fw_info->fw_start);
|
||||
if (start > fw->size)
|
||||
goto out;
|
||||
|
||||
size = le32_to_cpu(fw_info->fw_len);
|
||||
if (size > (fw->size - start) / FW_OPCODE_SIZE)
|
||||
goto out;
|
||||
|
||||
memcpy(version, fw_info->version, RTL_VER_SIZE);
|
||||
|
||||
pa->code = (__le32 *)(fw->data + start);
|
||||
pa->size = size;
|
||||
} else {
|
||||
if (fw->size % FW_OPCODE_SIZE)
|
||||
goto out;
|
||||
|
||||
|
|
Загрузка…
Ссылка в новой задаче