1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
|
/**
******************************************************************************
*
* @file fw.c
*
* @brief ecrnx sdio firmware download functions
*
* Copyright (C) ESWIN 2015-2020
*
******************************************************************************
*/
#include <linux/firmware.h>
#include "core.h"
#include "sdio.h"
#include "fw_head_check.h"
extern char *fw_name;
void eswin_fw_file_download(struct eswin *tr)
{
int ret;
unsigned int length_all;
unsigned char length_str[9]={0};
unsigned int lengthLeft, lengthSend, offset = HEAD_SIZE;
const u8 * dataAddr;
struct sk_buff *skb;
int file_num = 0;
unsigned int file_load_addr[3] = {0x10000U, 0x60800U, 0x80000U}; // ilm addr; dlm addr offset 0x800 for bootrom log; iram0 addr
char str_sync[4] = {0x63, 0x6E, 0x79, 0x73};
char str_cfg[] = {0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00}; // default for sync
skb = dev_alloc_skb(1024);
ECRNX_PRINT("%s entry!!", __func__);
/* 1 sync */
memcpy(skb->data, str_sync, 4);
tr->ops->write(tr, skb->data, 4);
ret = tr->ops->wait_ack(tr);
ECRNX_PRINT("dl-fw >> sync, ret: %d\n", ret);
dataAddr = tr->fw->data;
length_all = tr->fw->size - offset;
while(length_all)
{
memcpy(length_str, dataAddr + offset, 8);
ECRNX_PRINT("-------------------------------------%s\n", length_str);
offset+=8;
length_all-=8;
ret = kstrtol(length_str, 10, (long*)&lengthLeft);
//ECRNX_PRINT("dl-fw >> file len, ret: %d len:%d\n", ret, lengthLeft);
if(ret==0 && lengthLeft)
{
length_all-=lengthLeft;
/* 2 cfg addr and length */
str_cfg[4] = (char)((file_load_addr[file_num]) & 0xFF);
str_cfg[5] = (char)(((file_load_addr[file_num])>>8) & 0xFF);
str_cfg[6] = (char)(((file_load_addr[file_num])>>16) & 0xFF);
str_cfg[7] = (char)(((file_load_addr[file_num])>>24) & 0xFF);
file_num++;
str_cfg[8] = (char)((lengthLeft) & 0xFF);
str_cfg[9] = (char)(((lengthLeft)>>8) & 0xFF);
str_cfg[10] = (char)(((lengthLeft)>>16) & 0xFF);
str_cfg[11] = (char)(((lengthLeft)>>24) & 0xFF);
memcpy(skb->data, &str_cfg[0], 12);
tr->ops->write(tr, skb->data, 12);
ret = tr->ops->wait_ack(tr);
//ECRNX_PRINT("dl-fw >> cfg, ret: %d\n", ret);
/* 3 load fw */
do {
lengthSend = (lengthLeft >= 1024) ? 1024 : lengthLeft; //ECO3 supprot 64K buff
if(lengthLeft%512==0)
{
memcpy(skb->data, dataAddr + offset, lengthSend);
tr->ops->write(tr, skb->data, lengthSend);
//ECRNX_PRINT("dl-fw >> ld(%d), ret: %d\n", offset/1024, ret);
ret = tr->ops->wait_ack(tr);
}
else
{
memcpy(skb->data, dataAddr + offset, lengthSend&0xFFFFFE00U);
tr->ops->write(tr, skb->data, lengthSend&0xFFFFFE00U);
//ECRNX_PRINT("dl-fw >> ld(%d), ret: %d\n", offset/1024, ret);
ret = tr->ops->wait_ack(tr);
memcpy(skb->data, dataAddr + offset + (int)(lengthLeft&0xFFFFFE00U), lengthSend&0x1FFU);
tr->ops->write(tr, skb->data, lengthSend&0x1FFU);
//ECRNX_PRINT("dl-fw >> ld(%d), ret: %d\n", offset/1024, ret);
ret = tr->ops->wait_ack(tr);
}
//ECRNX_PRINT("dl-fw >> ld-ack(%d), ret: %d\n", offset/1024, ret);
offset += lengthSend;
lengthLeft -= lengthSend;
} while(lengthLeft);
//ECRNX_PRINT("dl-fw >> ld, ret: %d\n", ret);
}
}
/* 4 start up */
memset(skb->data, 0, 12);
tr->ops->write(tr, skb->data, 12);
tr->ops->wait_ack(tr);
dev_kfree_skb(skb);
}
bool eswin_fw_file_chech(struct eswin *tr)
{
int status;
if (fw_name == NULL)
goto err_fw;
if (tr->fw)
return true;
ECRNX_PRINT("%s, Checking firmware... (%s)\n", __func__, fw_name);
status = request_firmware((const struct firmware **)&tr->fw, fw_name, tr->dev);
if (status != 0) {
ECRNX_PRINT("%s, error status = %d\n", __func__, status);
goto err_fw;
}
ECRNX_PRINT("%s, request fw OK and size is %d\n",
__func__, tr->fw->size);
if(fw_check_head(tr) == false)
{
goto err_fw;
}
return true;
err_fw:
tr->fw = NULL;
return false;
}
|
