tsiry-sandratraina.com
A modern Music Player Daemon based on Rockbox open source high quality audio player
libadwaita
audio
rust
zig
deno
mpris
rockbox
mpd
1/***************************************************************************
2 * __________ __ ___.
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
7 * \/ \/ \/ \/ \/
8 * $Id$
9 *
10 * Copyright (C) 2004 by Jens Arnold
11 *
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License
14 * as published by the Free Software Foundation; either version 2
15 * of the License, or (at your option) any later version.
16 *
17 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
18 * KIND, either express or implied.
19 *
20 ****************************************************************************/
21#include "config.h"
22#include "logf.h"
23#include "sdmmc.h"
24
25static const unsigned char sd_mantissa[] = { /* *10 */
26 0, 10, 12, 13, 15, 20, 25, 30, 35, 40, 45, 50, 55, 60, 70, 80 };
27static const unsigned int sd_exponent[] = { /* use varies, div10 */
28 1,10,100,1000,10000,100000,1000000,10000000,100000000,1000000000 };
29
30void sd_parse_csd(tCardInfo *card)
31{
32 unsigned int c_size, c_mult;
33 const int csd_version = card_extract_bits(card->csd, 127, 2);
34 if(csd_version == 0)
35 {
36 /* CSD version 1.0 */
37 int max_read_bl_len;
38
39 c_size = card_extract_bits(card->csd, 73, 12) + 1;
40 c_mult = 4 << card_extract_bits(card->csd, 49, 3);
41 max_read_bl_len = 1 << card_extract_bits(card->csd, 83, 4);
42 card->numblocks = c_size * c_mult * (max_read_bl_len/512);
43 }
44 else if(csd_version == 1)
45 {
46 /* CSD version 2.0 */
47 c_size = card_extract_bits(card->csd, 69, 22) + 1;
48 card->numblocks = c_size << 10;
49 }
50 else if(csd_version == 2)
51 {
52 /* CSD version 3.0 */
53 c_size = card_extract_bits(card->csd, 75, 28) + 1;
54 card->numblocks = c_size << 10;
55 }
56 card->sd2plus = csd_version >= 1;
57
58 card->blocksize = 512; /* Always use 512 byte blocks */
59
60 card->speed = sd_mantissa[card_extract_bits(card->csd, 102, 4)] *
61 sd_exponent[card_extract_bits(card->csd, 98, 3) + 4];
62
63 card->nsac = 100 * card_extract_bits(card->csd, 111, 8);
64
65 card->taac = sd_mantissa[card_extract_bits(card->csd, 118, 4)] *
66 sd_exponent[card_extract_bits(card->csd, 114, 3)];
67
68 card->r2w_factor = card_extract_bits(card->csd, 28, 3);
69
70 logf("CSD%d.0 numblocks:%lld speed:%ld", csd_version+1, card->numblocks, card->speed);
71 logf("nsac: %d taac: %ld r2w: %d", card->nsac, card->taac, card->r2w_factor);
72}
73
74
75/* helper function to extract n (<=32) bits from an arbitrary position.
76 counting from MSB to LSB */
77unsigned long card_extract_bits(
78 const unsigned long *p, /* the start of the bitfield array */
79 unsigned int start, /* bit no. to start reading */
80 unsigned int size) /* how many bits to read */
81{
82 unsigned int long_index, bit_index;
83 unsigned long result;
84
85 /* we assume words of CSD/CID are stored most significant word first */
86 start = 127 - start;
87
88 long_index = start / 32;
89 bit_index = start % 32;
90
91 result = p[long_index] << bit_index;
92
93 if (bit_index + size > 32) /* crossing longword boundary */
94 result |= p[long_index+1] >> (32 - bit_index);
95
96 result >>= 32 - size;
97
98 return result;
99}