1*2fe8fb19SBen Gras /* $NetBSD: swab.c,v 1.18 2011/01/04 17:14:07 martin Exp $ */
2*2fe8fb19SBen Gras
3*2fe8fb19SBen Gras /*
4*2fe8fb19SBen Gras * Copyright (c) 1988, 1993
5*2fe8fb19SBen Gras * The Regents of the University of California. All rights reserved.
6*2fe8fb19SBen Gras *
7*2fe8fb19SBen Gras * This code is derived from software contributed to Berkeley by
8*2fe8fb19SBen Gras * Jeffrey Mogul.
9*2fe8fb19SBen Gras *
10*2fe8fb19SBen Gras * Redistribution and use in source and binary forms, with or without
11*2fe8fb19SBen Gras * modification, are permitted provided that the following conditions
12*2fe8fb19SBen Gras * are met:
13*2fe8fb19SBen Gras * 1. Redistributions of source code must retain the above copyright
14*2fe8fb19SBen Gras * notice, this list of conditions and the following disclaimer.
15*2fe8fb19SBen Gras * 2. Redistributions in binary form must reproduce the above copyright
16*2fe8fb19SBen Gras * notice, this list of conditions and the following disclaimer in the
17*2fe8fb19SBen Gras * documentation and/or other materials provided with the distribution.
18*2fe8fb19SBen Gras * 3. Neither the name of the University nor the names of its contributors
19*2fe8fb19SBen Gras * may be used to endorse or promote products derived from this software
20*2fe8fb19SBen Gras * without specific prior written permission.
21*2fe8fb19SBen Gras *
22*2fe8fb19SBen Gras * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
23*2fe8fb19SBen Gras * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24*2fe8fb19SBen Gras * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25*2fe8fb19SBen Gras * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
26*2fe8fb19SBen Gras * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27*2fe8fb19SBen Gras * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28*2fe8fb19SBen Gras * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29*2fe8fb19SBen Gras * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30*2fe8fb19SBen Gras * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31*2fe8fb19SBen Gras * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32*2fe8fb19SBen Gras * SUCH DAMAGE.
33*2fe8fb19SBen Gras */
34*2fe8fb19SBen Gras
35*2fe8fb19SBen Gras #include <sys/cdefs.h>
36*2fe8fb19SBen Gras #if defined(LIBC_SCCS) && !defined(lint)
37*2fe8fb19SBen Gras #if 0
38*2fe8fb19SBen Gras static char sccsid[] = "@(#)swab.c 8.1 (Berkeley) 6/4/93";
39*2fe8fb19SBen Gras #else
40*2fe8fb19SBen Gras __RCSID("$NetBSD: swab.c,v 1.18 2011/01/04 17:14:07 martin Exp $");
41*2fe8fb19SBen Gras #endif
42*2fe8fb19SBen Gras #endif /* LIBC_SCCS and not lint */
43*2fe8fb19SBen Gras
44*2fe8fb19SBen Gras #include <assert.h>
45*2fe8fb19SBen Gras #include <unistd.h>
46*2fe8fb19SBen Gras
47*2fe8fb19SBen Gras void
swab(const void * __restrict from,void * __restrict to,ssize_t len)48*2fe8fb19SBen Gras swab(const void * __restrict from, void * __restrict to, ssize_t len)
49*2fe8fb19SBen Gras {
50*2fe8fb19SBen Gras char temp;
51*2fe8fb19SBen Gras const char *fp;
52*2fe8fb19SBen Gras char *tp;
53*2fe8fb19SBen Gras
54*2fe8fb19SBen Gras if (len <= 1)
55*2fe8fb19SBen Gras return;
56*2fe8fb19SBen Gras
57*2fe8fb19SBen Gras _DIAGASSERT(from != NULL);
58*2fe8fb19SBen Gras _DIAGASSERT(to != NULL);
59*2fe8fb19SBen Gras
60*2fe8fb19SBen Gras len /= 2;
61*2fe8fb19SBen Gras fp = (const char *)from;
62*2fe8fb19SBen Gras tp = (char *)to;
63*2fe8fb19SBen Gras #define STEP temp = *fp++,*tp++ = *fp++,*tp++ = temp
64*2fe8fb19SBen Gras
65*2fe8fb19SBen Gras if (__predict_false(len == 1)) {
66*2fe8fb19SBen Gras STEP;
67*2fe8fb19SBen Gras return;
68*2fe8fb19SBen Gras }
69*2fe8fb19SBen Gras
70*2fe8fb19SBen Gras /* round to multiple of 8 */
71*2fe8fb19SBen Gras while ((--len % 8) != 0)
72*2fe8fb19SBen Gras STEP;
73*2fe8fb19SBen Gras len /= 8;
74*2fe8fb19SBen Gras if (len == 0)
75*2fe8fb19SBen Gras return;
76*2fe8fb19SBen Gras while (len-- != 0) {
77*2fe8fb19SBen Gras STEP; STEP; STEP; STEP;
78*2fe8fb19SBen Gras STEP; STEP; STEP; STEP;
79*2fe8fb19SBen Gras }
80*2fe8fb19SBen Gras }
81