Updated our source code header to explicitly mention that we are GPL v2 or
[Rockbox.git] / firmware / hotswap.c
blobcb8a539c01c5da7b18d4dcc254f72efb08de131e
1 /***************************************************************************
2 * __________ __ ___.
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
7 * \/ \/ \/ \/ \/
8 * $Id$
10 * Copyright (C) 2004 by Jens Arnold
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.
17 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
18 * KIND, either express or implied.
20 ****************************************************************************/
21 #include <stdbool.h>
22 #include "config.h"
23 #ifdef HAVE_MMC
24 #include "ata_mmc.h"
25 #else
26 #include "hotswap.h"
27 #endif
29 /* helper function to extract n (<=32) bits from an arbitrary position.
30 counting from MSB to LSB */
31 unsigned long card_extract_bits(
32 const unsigned long *p, /* the start of the bitfield array */
33 unsigned int start, /* bit no. to start reading */
34 unsigned int size) /* how many bits to read */
36 unsigned int long_index = start / 32;
37 unsigned int bit_index = start % 32;
38 unsigned long result;
40 result = p[long_index] << bit_index;
42 if (bit_index + size > 32) /* crossing longword boundary */
43 result |= p[long_index+1] >> (32 - bit_index);
45 result >>= 32 - size;
47 return result;