1 /* $NetBSD: byte_swap.h,v 1.2 2014/10/29 01:33:39 dennis Exp $ */ 2 3 /*- 4 * Copyright (c) 2014 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Matt Thomas of 3am Software Foundry. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 #ifndef _OR1K_BYTE_SWAP_H_ 33 #define _OR1K_BYTE_SWAP_H_ 34 35 #ifdef _LOCORE 36 37 #define BSWAP16(_src, _dst, _tmp) \ 38 l.extbz _dst, _src; \ 39 l.slli _dst, _dst, 8; \ 40 l.srli _tmp, _src, 8; \ 41 l.extbz _tmp, _tmp; \ 42 l.or _dst, _dst, _tmp 43 44 #define BSWAP32(_src, _dst, _tmp) \ 45 l.movhi _tmp, 0xff00 ;\ 46 l.ori _tmp, _tmp, 0xff00 /* tmp = 0xff00ff00 */ ;\ 47 l.slri _dst, _tmp, 8 /* dst = 0x00ff00ff */ ;\ 48 l.and _tmp, _tmp, _src /* tmp = 0xaa00cc00 */ ;\ 49 l.and _dst, _dst, _src /* dst = 0x00bb00dd */ ;\ 50 l.ror _tmp, _tmp, 24 /* tmp = 0x00cc00aa */ ;\ 51 l.ror _dst, _dst, 8 /* dst = 0xdd00bb00 */ ;\ 52 l.or _dst, _dst, _tmp /* dst = 0xddccbbaa */ ;\ 53 54 #else 55 56 #include <sys/types.h> 57 __BEGIN_DECLS 58 59 #define __BYTE_SWAP_U64_VARIABLE __byte_swap_u64_variable 60 static __inline uint64_t 61 __byte_swap_u64_variable(uint64_t v) 62 { 63 v = ((v & 0x000000ff) << (56 - 0)) | ((v >> (56 - 0)) & 0x000000ff) 64 | ((v & 0x0000ff00) << (48 - 8)) | ((v >> (48 - 8)) & 0x0000ff00) 65 | ((v & 0x00ff0000) << (40 - 16)) | ((v >> (40 - 16)) & 0x00ff0000) 66 | ((v & 0xff000000) << (32 - 24)) | ((v >> (32 - 24)) & 0xff000000); 67 68 return v; 69 } 70 71 #define __BYTE_SWAP_U32_VARIABLE __byte_swap_u32_variable 72 static __inline uint32_t 73 __byte_swap_u32_variable(uint32_t v) 74 { 75 v = ((v & 0x00ff) << (24 - 0)) | ((v >> (24 - 0)) & 0x00ff) 76 | ((v & 0xff00) << (16 - 8)) | ((v >> (16 - 8)) & 0xff00); 77 78 return v; 79 } 80 81 #define __BYTE_SWAP_U16_VARIABLE __byte_swap_u16_variable 82 static __inline uint16_t 83 __byte_swap_u16_variable(uint16_t v) 84 { 85 v &= 0xffff; 86 v = (v >> 8) | (v << 8); 87 88 return v; 89 } 90 91 __END_DECLS 92 93 #endif /* _LOCORE */ 94 95 #endif /* _OR1K_BYTE_SWAP_H_ */ 96