123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110 |
- /*
- * Based on arch/arm/kernel/io.c
- *
- * Copyright (C) 2012 ARM Ltd.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 as
- * published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program. If not, see <http://www.gnu.org/licenses/>.
- */
- #include <linux/export.h>
- #include <linux/types.h>
- #include <linux/io.h>
- /*
- * Copy data from IO memory space to "real" memory space.
- */
- void __memcpy_fromio(void *to, const volatile void __iomem *from, size_t count)
- {
- while (count && (!IS_ALIGNED((unsigned long)from, 8) ||
- !IS_ALIGNED((unsigned long)to, 8))) {
- *(u8 *)to = __raw_readb(from);
- from++;
- to++;
- count--;
- }
- while (count >= 8) {
- *(u64 *)to = __raw_readq(from);
- from += 8;
- to += 8;
- count -= 8;
- }
- while (count) {
- *(u8 *)to = __raw_readb(from);
- from++;
- to++;
- count--;
- }
- }
- EXPORT_SYMBOL(__memcpy_fromio);
- /*
- * Copy data from "real" memory space to IO memory space.
- */
- void __memcpy_toio(volatile void __iomem *to, const void *from, size_t count)
- {
- while (count && (!IS_ALIGNED((unsigned long)to, 8) ||
- !IS_ALIGNED((unsigned long)from, 8))) {
- __raw_writeb(*(volatile u8 *)from, to);
- from++;
- to++;
- count--;
- }
- while (count >= 8) {
- __raw_writeq(*(volatile u64 *)from, to);
- from += 8;
- to += 8;
- count -= 8;
- }
- while (count) {
- __raw_writeb(*(volatile u8 *)from, to);
- from++;
- to++;
- count--;
- }
- }
- EXPORT_SYMBOL(__memcpy_toio);
- /*
- * "memset" on IO memory space.
- */
- void __memset_io(volatile void __iomem *dst, int c, size_t count)
- {
- u64 qc = (u8)c;
- qc |= qc << 8;
- qc |= qc << 16;
- qc |= qc << 32;
- while (count && !IS_ALIGNED((unsigned long)dst, 8)) {
- __raw_writeb(c, dst);
- dst++;
- count--;
- }
- while (count >= 8) {
- __raw_writeq(qc, dst);
- dst += 8;
- count -= 8;
- }
- while (count) {
- __raw_writeb(c, dst);
- dst++;
- count--;
- }
- }
- EXPORT_SYMBOL(__memset_io);
|