diff options
Diffstat (limited to 'firmware')
-rw-r--r-- | firmware/drivers/ata_mmc.c | 18 | ||||
-rw-r--r-- | firmware/hotswap.c | 9 | ||||
-rw-r--r-- | firmware/target/arm/ata-sd-pp.c | 10 | ||||
-rw-r--r-- | firmware/target/mips/ingenic_jz47xx/ata-sd-jz4740.c | 10 |
4 files changed, 26 insertions, 21 deletions
diff --git a/firmware/drivers/ata_mmc.c b/firmware/drivers/ata_mmc.c index 1dc330c538..0fe89c5be8 100644 --- a/firmware/drivers/ata_mmc.c +++ b/firmware/drivers/ata_mmc.c | |||
@@ -425,25 +425,25 @@ static int initialize_card(int card_no) | |||
425 | if (rc) | 425 | if (rc) |
426 | return rc * 10 - 5; | 426 | return rc * 10 - 5; |
427 | 427 | ||
428 | blk_exp = card_extract_bits(card->csd, 44, 4); | 428 | blk_exp = card_extract_bits(card->csd, 83, 4); |
429 | if (blk_exp < 9) /* block size < 512 bytes not supported */ | 429 | if (blk_exp < 9) /* block size < 512 bytes not supported */ |
430 | return -6; | 430 | return -6; |
431 | 431 | ||
432 | card->numblocks = (card_extract_bits(card->csd, 54, 12) + 1) | 432 | card->numblocks = (card_extract_bits(card->csd, 73, 12) + 1) |
433 | << (card_extract_bits(card->csd, 78, 3) + 2 + blk_exp - 9); | 433 | << (card_extract_bits(card->csd, 49, 3) + 2 + blk_exp - 9); |
434 | card->blocksize = BLOCK_SIZE; | 434 | card->blocksize = BLOCK_SIZE; |
435 | 435 | ||
436 | /* max transmission speed, clock divider */ | 436 | /* max transmission speed, clock divider */ |
437 | ts_exp = card_extract_bits(card->csd, 29, 3); | 437 | ts_exp = card_extract_bits(card->csd, 98, 3); |
438 | ts_exp = (ts_exp > 3) ? 3 : ts_exp; | 438 | ts_exp = (ts_exp > 3) ? 3 : ts_exp; |
439 | card->speed = mantissa[card_extract_bits(card->csd, 25, 4)] | 439 | card->speed = mantissa[card_extract_bits(card->csd, 102, 4)] |
440 | * exponent[ts_exp + 4]; | 440 | * exponent[ts_exp + 4]; |
441 | card->bitrate_register = (FREQ/4-1) / card->speed; | 441 | card->bitrate_register = (FREQ/4-1) / card->speed; |
442 | 442 | ||
443 | /* NSAC, TAAC, read timeout */ | 443 | /* NSAC, TAAC, read timeout */ |
444 | card->nsac = 100 * card_extract_bits(card->csd, 16, 8); | 444 | card->nsac = 100 * card_extract_bits(card->csd, 111, 8); |
445 | card->taac = mantissa[card_extract_bits(card->csd, 9, 4)]; | 445 | card->taac = mantissa[card_extract_bits(card->csd, 118, 4)]; |
446 | taac_exp = card_extract_bits(card->csd, 13, 3); | 446 | taac_exp = card_extract_bits(card->csd, 114, 3); |
447 | card->read_timeout = ((FREQ/4) / (card->bitrate_register + 1) | 447 | card->read_timeout = ((FREQ/4) / (card->bitrate_register + 1) |
448 | * card->taac / exponent[9 - taac_exp] | 448 | * card->taac / exponent[9 - taac_exp] |
449 | + (10 * card->nsac)); | 449 | + (10 * card->nsac)); |
@@ -451,7 +451,7 @@ static int initialize_card(int card_no) | |||
451 | card->taac = card->taac * exponent[taac_exp] / 10; | 451 | card->taac = card->taac * exponent[taac_exp] / 10; |
452 | 452 | ||
453 | /* r2w_factor, write timeout */ | 453 | /* r2w_factor, write timeout */ |
454 | card->r2w_factor = BIT_N(card_extract_bits(card->csd, 99, 3)); | 454 | card->r2w_factor = BIT_N(card_extract_bits(card->csd, 28, 3)); |
455 | card->write_timeout = card->read_timeout * card->r2w_factor; | 455 | card->write_timeout = card->read_timeout * card->r2w_factor; |
456 | 456 | ||
457 | if (card->r2w_factor > 32) /* Such cards often need extra read delay */ | 457 | if (card->r2w_factor > 32) /* Such cards often need extra read delay */ |
diff --git a/firmware/hotswap.c b/firmware/hotswap.c index 97c162ce39..ec298f7243 100644 --- a/firmware/hotswap.c +++ b/firmware/hotswap.c | |||
@@ -33,9 +33,14 @@ unsigned long card_extract_bits( | |||
33 | unsigned int start, /* bit no. to start reading */ | 33 | unsigned int start, /* bit no. to start reading */ |
34 | unsigned int size) /* how many bits to read */ | 34 | unsigned int size) /* how many bits to read */ |
35 | { | 35 | { |
36 | unsigned int long_index = start / 32; | 36 | unsigned int long_index, bit_index; |
37 | unsigned int bit_index = start % 32; | ||
38 | unsigned long result; | 37 | unsigned long result; |
38 | |||
39 | /* we assume words of CSD/CID are stored least significant word first */ | ||
40 | start = 127 - start; | ||
41 | |||
42 | long_index = start / 32; | ||
43 | bit_index = start % 32; | ||
39 | 44 | ||
40 | result = p[long_index] << bit_index; | 45 | result = p[long_index] << bit_index; |
41 | 46 | ||
diff --git a/firmware/target/arm/ata-sd-pp.c b/firmware/target/arm/ata-sd-pp.c index ade5b8090b..8f30195791 100644 --- a/firmware/target/arm/ata-sd-pp.c +++ b/firmware/target/arm/ata-sd-pp.c | |||
@@ -1306,12 +1306,12 @@ tCardInfo *card_get_info_target(int card_no) | |||
1306 | for(i=0; i<4; i++) card.cid[i] = card_info[card_no].cid[3-i]; | 1306 | for(i=0; i<4; i++) card.cid[i] = card_info[card_no].cid[3-i]; |
1307 | card.numblocks = card_info[card_no].numblocks; | 1307 | card.numblocks = card_info[card_no].numblocks; |
1308 | card.blocksize = card_info[card_no].blocksize; | 1308 | card.blocksize = card_info[card_no].blocksize; |
1309 | temp = card_extract_bits(card.csd, 29, 3); | 1309 | temp = card_extract_bits(card.csd, 98, 3); |
1310 | card.speed = mantissa[card_extract_bits(card.csd, 25, 4)] | 1310 | card.speed = mantissa[card_extract_bits(card.csd, 102, 4)] |
1311 | * exponent[temp > 2 ? 7 : temp + 4]; | 1311 | * exponent[temp > 2 ? 7 : temp + 4]; |
1312 | card.nsac = 100 * card_extract_bits(card.csd, 16, 8); | 1312 | card.nsac = 100 * card_extract_bits(card.csd, 111, 8); |
1313 | temp = card_extract_bits(card.csd, 13, 3); | 1313 | temp = card_extract_bits(card.csd, 114, 3); |
1314 | card.taac = mantissa[card_extract_bits(card.csd, 9, 4)] | 1314 | card.taac = mantissa[card_extract_bits(card.csd, 118, 4)] |
1315 | * exponent[temp] / 10; | 1315 | * exponent[temp] / 10; |
1316 | card.cid[0] = htobe32(card.cid[0]); /* ascii chars here */ | 1316 | card.cid[0] = htobe32(card.cid[0]); /* ascii chars here */ |
1317 | card.cid[1] = htobe32(card.cid[1]); /* ascii chars here */ | 1317 | card.cid[1] = htobe32(card.cid[1]); /* ascii chars here */ |
diff --git a/firmware/target/mips/ingenic_jz47xx/ata-sd-jz4740.c b/firmware/target/mips/ingenic_jz47xx/ata-sd-jz4740.c index 31a9f7d2b0..6e7f62a2e5 100644 --- a/firmware/target/mips/ingenic_jz47xx/ata-sd-jz4740.c +++ b/firmware/target/mips/ingenic_jz47xx/ata-sd-jz4740.c | |||
@@ -1675,12 +1675,12 @@ tCardInfo* card_get_info_target(int card_no) | |||
1675 | card.csd[i] = ((unsigned long*)&mmcinfo.csd)[i]; | 1675 | card.csd[i] = ((unsigned long*)&mmcinfo.csd)[i]; |
1676 | for(i=0; i<4; i++) | 1676 | for(i=0; i<4; i++) |
1677 | card.cid[i] = ((unsigned long*)&mmcinfo.cid)[i]; | 1677 | card.cid[i] = ((unsigned long*)&mmcinfo.cid)[i]; |
1678 | temp = card_extract_bits(card.csd, 29, 3); | 1678 | temp = card_extract_bits(card.csd, 98, 3); |
1679 | card.speed = sd_mantissa[card_extract_bits(card.csd, 25, 4)] | 1679 | card.speed = sd_mantissa[card_extract_bits(card.csd, 102, 4)] |
1680 | * sd_exponent[temp > 2 ? 7 : temp + 4]; | 1680 | * sd_exponent[temp > 2 ? 7 : temp + 4]; |
1681 | card.nsac = 100 * card_extract_bits(card.csd, 16, 8); | 1681 | card.nsac = 100 * card_extract_bits(card.csd, 111, 8); |
1682 | temp = card_extract_bits(card.csd, 13, 3); | 1682 | temp = card_extract_bits(card.csd, 114, 3); |
1683 | card.taac = sd_mantissa[card_extract_bits(card.csd, 9, 4)] | 1683 | card.taac = sd_mantissa[card_extract_bits(card.csd, 118, 4)] |
1684 | * sd_exponent[temp] / 10; | 1684 | * sd_exponent[temp] / 10; |
1685 | card.numblocks = mmcinfo.block_num; | 1685 | card.numblocks = mmcinfo.block_num; |
1686 | card.blocksize = mmcinfo.block_len; | 1686 | card.blocksize = mmcinfo.block_len; |