1 /***************************************************************************
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
10 * Copyright (C) 2010 by Michael Sevakis
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 ****************************************************************************/
22 /***************************************************************************
23 * void bitmod32(volatile uint32_t *addr, uint32_t bits, uint32_t mask)
25 .section .text, "ax", %progbits
28 .type bitmod32, %function
33 and r1, r1, r2 @ Only allow mod of bits in 'mask'
34 bic r3, r3, r2 @ Clear mask bits
35 orr r3, r3, r1 @ Set according to 'bits'
39 .size bitmod32, .-bitmod32
41 /***************************************************************************
42 * void bitset32(volatile uint32_t *addr, uint32_t mask)
44 .section .text, "ax", %progbits
47 .type bitset32, %function
56 .size bitset32, .-bitset32
59 /***************************************************************************
60 * void bitclr32(volatile uint32_t *addr, uint32_t mask)
62 .section .text, "ax", %progbits
65 .type bitclr32, %function
74 .size bitclr32, .-bitclr32