forked from Minki/linux
staging: ft1000: function write_dpram32_and_check extracted from write_blk
function write_blk is long and overly complex, consisting of a triply nested loop. It also has improper indentation and line lengths throughout, and has return type of u32 rather than int. Some of the lines, when converted to proper indentation, create checkpatch warnings for too many leading tabs. This patch extracts the innermost loop into its own function, write_dpram32_and_check. This removes several levels of indentation from the extracted lines and makes the original function simpler. Two local variables from the original function, u16 resultbuffer[] and a loop counter, have been made local variables of the new function. Two calls to msleep() have been replaced with usleep_range() as per Documentation/ timers/timers-howto.txt (which was referred to in a checkpatch warning). Several other style issues in the extracted code have been corrected as well. Signed-off-by: Kelley Nielsen <kelleynnn@gmail.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
e0a223b465
commit
eb2ec63979
@ -389,6 +389,61 @@ static int check_buffers(u16 *buff_w, u16 *buff_r, int len, int offset)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int write_dpram32_and_check(struct ft1000_usb *ft1000dev,
|
||||
u16 tempbuffer[], u16 dpram)
|
||||
{
|
||||
int status;
|
||||
u16 resultbuffer[64];
|
||||
int i;
|
||||
|
||||
for (i = 0; i < 10; i++) {
|
||||
status = ft1000_write_dpram32(ft1000dev, dpram,
|
||||
(u8 *)&tempbuffer[0], 64);
|
||||
if (status == STATUS_SUCCESS) {
|
||||
/* Work around for ASIC bit stuffing problem. */
|
||||
if ((tempbuffer[31] & 0xfe00) == 0xfe00) {
|
||||
status = ft1000_write_dpram32(ft1000dev,
|
||||
dpram+12, (u8 *)&tempbuffer[24],
|
||||
64);
|
||||
}
|
||||
/* Let's check the data written */
|
||||
status = ft1000_read_dpram32(ft1000dev, dpram,
|
||||
(u8 *)&resultbuffer[0], 64);
|
||||
if ((tempbuffer[31] & 0xfe00) == 0xfe00) {
|
||||
if (check_buffers(tempbuffer, resultbuffer, 28,
|
||||
0)) {
|
||||
DEBUG("FT1000:download:DPRAM write failed 1 during bootloading\n");
|
||||
usleep_range(9000, 11000);
|
||||
status = STATUS_FAILURE;
|
||||
break;
|
||||
}
|
||||
status = ft1000_read_dpram32(ft1000dev,
|
||||
dpram+12,
|
||||
(u8 *)&resultbuffer[0], 64);
|
||||
|
||||
if (check_buffers(tempbuffer, resultbuffer, 16,
|
||||
24)) {
|
||||
DEBUG("FT1000:download:DPRAM write failed 2 during bootloading\n");
|
||||
usleep_range(9000, 11000);
|
||||
status = STATUS_FAILURE;
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
if (check_buffers(tempbuffer, resultbuffer, 32,
|
||||
0)) {
|
||||
DEBUG("FT1000:download:DPRAM write failed 3 during bootloading\n");
|
||||
usleep_range(9000, 11000);
|
||||
status = STATUS_FAILURE;
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (status == STATUS_SUCCESS)
|
||||
break;
|
||||
}
|
||||
}
|
||||
return status;
|
||||
}
|
||||
|
||||
/* writes a block of DSP image to DPRAM
|
||||
* Parameters: struct ft1000_usb - device structure
|
||||
* u16 **pUsFile - DSP image file pointer in u16
|
||||
@ -399,10 +454,9 @@ static u32 write_blk (struct ft1000_usb *ft1000dev, u16 **pUsFile, u8 **pUcFile,
|
||||
{
|
||||
u32 Status = STATUS_SUCCESS;
|
||||
u16 dpram;
|
||||
int loopcnt, i, j;
|
||||
int loopcnt, i;
|
||||
u16 tempword;
|
||||
u16 tempbuffer[64];
|
||||
u16 resultbuffer[64];
|
||||
|
||||
//DEBUG("FT1000:download:start word_length = %d\n",(int)word_length);
|
||||
dpram = (u16)DWNLD_MAG1_PS_HDR_LOC;
|
||||
@ -452,53 +506,8 @@ static u32 write_blk (struct ft1000_usb *ft1000dev, u16 **pUsFile, u8 **pUcFile,
|
||||
}
|
||||
else
|
||||
{
|
||||
for (j=0; j<10; j++)
|
||||
{
|
||||
Status = ft1000_write_dpram32 (ft1000dev, dpram, (u8 *)&tempbuffer[0], 64);
|
||||
if (Status == STATUS_SUCCESS)
|
||||
{
|
||||
// Work around for ASIC bit stuffing problem.
|
||||
if ( (tempbuffer[31] & 0xfe00) == 0xfe00)
|
||||
{
|
||||
Status = ft1000_write_dpram32(ft1000dev, dpram+12, (u8 *)&tempbuffer[24], 64);
|
||||
}
|
||||
// Let's check the data written
|
||||
Status = ft1000_read_dpram32 (ft1000dev, dpram, (u8 *)&resultbuffer[0], 64);
|
||||
if ( (tempbuffer[31] & 0xfe00) == 0xfe00)
|
||||
{
|
||||
if (check_buffers(tempbuffer, resultbuffer, 28, 0)) {
|
||||
DEBUG("FT1000:download:DPRAM write failed 1 during bootloading\n");
|
||||
msleep(10);
|
||||
Status = STATUS_FAILURE;
|
||||
break;
|
||||
}
|
||||
Status = ft1000_read_dpram32 (ft1000dev, dpram+12, (u8 *)&resultbuffer[0], 64);
|
||||
|
||||
if (check_buffers(tempbuffer, resultbuffer, 16, 24)) {
|
||||
DEBUG("FT1000:download:DPRAM write failed 2 during bootloading\n");
|
||||
msleep(10);
|
||||
Status = STATUS_FAILURE;
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
else
|
||||
{
|
||||
if (check_buffers(tempbuffer, resultbuffer, 32, 0)) {
|
||||
DEBUG("FT1000:download:DPRAM write failed 3 during bootloading\n");
|
||||
msleep(10);
|
||||
Status = STATUS_FAILURE;
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
if (Status == STATUS_SUCCESS)
|
||||
break;
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
Status = write_dpram32_and_check(ft1000dev, tempbuffer,
|
||||
dpram);
|
||||
if (Status != STATUS_SUCCESS)
|
||||
{
|
||||
DEBUG("FT1000:download:Write failed tempbuffer[31] = 0x%x\n", tempbuffer[31]);
|
||||
|
Loading…
Reference in New Issue
Block a user