summaryrefslogtreecommitdiff
path: root/firmware
diff options
context:
space:
mode:
Diffstat (limited to 'firmware')
-rw-r--r--firmware/drivers/ata_mmc.c18
-rw-r--r--firmware/hotswap.c9
-rw-r--r--firmware/target/arm/ata-sd-pp.c10
-rw-r--r--firmware/target/mips/ingenic_jz47xx/ata-sd-jz4740.c10
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;