Home | History | Annotate | Line # | Download | only in v7fs
v7fs_endian.c revision 1.1
      1 /*	$NetBSD: v7fs_endian.c,v 1.1 2011/06/27 11:52:24 uch Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2011 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by UCHIYAMA Yasushi.
      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 #include <sys/cdefs.h>
     33 __KERNEL_RCSID(0, "$NetBSD: v7fs_endian.c,v 1.1 2011/06/27 11:52:24 uch Exp $");
     34 #if defined _KERNEL_OPT
     35 #include "opt_v7fs.h"
     36 #endif
     37 
     38 #include "v7fs.h"
     39 #include "v7fs_endian.h"
     40 #include "v7fs_impl.h"
     41 
     42 #ifndef BYTE_ORDER
     43 #error
     44 #endif
     45 
     46 /* PDP to Little */
     47 #define	bswap32pdp_le(x)			\
     48 	((uint32_t)				\
     49 	    ((((x) & 0xffff0000) >> 16) |	\
     50 		(((x) & 0x0000ffff) << 16)))
     51 /* PDP to Big */
     52 #define	bswap32pdp_be(x)			\
     53 	((uint32_t)				\
     54 	    ((((x) & 0xff00ff00) >> 8) |	\
     55 		(((x) & 0x00ff00ff) <<  8)))
     56 #ifdef V7FS_EI
     57 static uint32_t val32_normal_order(uint32_t);
     58 static uint32_t val32_reverse_order(uint32_t);
     59 #if BYTE_ORDER == LITTLE_ENDIAN
     60 static uint32_t val32_pdp_to_little(uint32_t);
     61 #else
     62 static uint32_t val32_pdp_to_big(uint32_t);
     63 #endif
     64 static uint16_t val16_normal_order(uint16_t);
     65 static uint16_t val16_reverse_order(uint16_t);
     66 static v7fs_daddr_t val24_reverse_order_read(uint8_t *);
     67 static void val24_reverse_order_write(v7fs_daddr_t, uint8_t *);
     68 static v7fs_daddr_t val24_pdp_read(uint8_t *);
     69 static void val24_pdp_write(v7fs_daddr_t, uint8_t *);
     70 
     71 static uint32_t
     72 val32_normal_order(uint32_t v)
     73 {
     74 
     75 	return v;
     76 }
     77 
     78 static uint32_t
     79 val32_reverse_order(uint32_t v)
     80 {
     81 
     82 	return bswap32(v);
     83 }
     84 #if BYTE_ORDER == LITTLE_ENDIAN
     85 static uint32_t
     86 val32_pdp_to_little(uint32_t v)
     87 {
     88 
     89 	return bswap32pdp_le(v);
     90 }
     91 #else
     92 static uint32_t
     93 val32_pdp_to_big(uint32_t v)
     94 {
     95 
     96 	return bswap32pdp_be(v);
     97 }
     98 #endif
     99 static uint16_t
    100 val16_normal_order(uint16_t v)
    101 {
    102 
    103 	return v;
    104 }
    105 
    106 static uint16_t
    107 val16_reverse_order(uint16_t v)
    108 {
    109 
    110 	return bswap16(v);
    111 }
    112 
    113 static v7fs_daddr_t
    114 val24_reverse_order_read(uint8_t *a)
    115 {
    116 #if BYTE_ORDER == LITTLE_ENDIAN
    117 	return (a[0] << 16) | (a[1] << 8) | a[2];
    118 #else
    119 	return (a[2] << 16) | (a[1] << 8) | a[0];
    120 #endif
    121 }
    122 
    123 static void
    124 val24_reverse_order_write(v7fs_daddr_t addr, uint8_t *a)
    125 {
    126 #if BYTE_ORDER == LITTLE_ENDIAN
    127 	a[0] = (addr >> 16) & 0xff;
    128 	a[1] = (addr >> 8) & 0xff;
    129 	a[2] = addr & 0xff;
    130 #else
    131 	a[0] = addr & 0xff;
    132 	a[1] = (addr >> 8) & 0xff;
    133 	a[2] = (addr >> 16) & 0xff;
    134 #endif
    135 }
    136 
    137 static v7fs_daddr_t
    138 val24_pdp_read(uint8_t *a)
    139 {
    140 
    141 	return (a[0] << 16) | a[1] | (a[2] << 8);
    142 }
    143 
    144 static void
    145 val24_pdp_write(v7fs_daddr_t addr, uint8_t *a)
    146 {
    147 
    148 	a[0] = (addr >> 16) & 0xff;
    149 	a[1] = addr & 0xff;
    150 	a[2] = (addr >> 8) & 0xff;
    151 }
    152 
    153 void
    154 v7fs_endian_init(struct v7fs_self *fs)
    155 {
    156 	struct endian_conversion_ops *ops = &fs->val;
    157 
    158 	switch (fs->endian)
    159 	{
    160 #if BYTE_ORDER == LITTLE_ENDIAN
    161 	case LITTLE_ENDIAN:
    162 		ops->conv32 = val32_normal_order;
    163 		ops->conv16 = val16_normal_order;
    164 		ops->conv24read = val24_normal_order_read;
    165 		ops->conv24write = val24_normal_order_write;
    166 		break;
    167 	case BIG_ENDIAN:
    168 		ops->conv32 = val32_reverse_order;
    169 		ops->conv16 = val16_reverse_order;
    170 		ops->conv24read = val24_reverse_order_read;
    171 		ops->conv24write = val24_reverse_order_write;
    172 		break;
    173 	case PDP_ENDIAN:
    174 		ops->conv32 = val32_pdp_to_little;
    175 		ops->conv16 = val16_normal_order;
    176 		ops->conv24read = val24_pdp_read;
    177 		ops->conv24write = val24_pdp_write;
    178 		break;
    179 #else /* BIG_ENDIAN */
    180 	case LITTLE_ENDIAN:
    181 		ops->conv32 = val32_reverse_order;
    182 		ops->conv16 = val16_reverse_order;
    183 		ops->conv24read = val24_reverse_order_read;
    184 		ops->conv24write = val24_reverse_order_write;
    185 		break;
    186 	case BIG_ENDIAN:
    187 		ops->conv32 = val32_normal_order;
    188 		ops->conv16 = val16_normal_order;
    189 		ops->conv24read = val24_normal_order_read;
    190 		ops->conv24write = val24_normal_order_write;
    191 		break;
    192 	case PDP_ENDIAN:
    193 		ops->conv32 = val32_pdp_to_big;
    194 		ops->conv16 = val16_reverse_order;
    195 		ops->conv24read = val24_pdp_read;
    196 		ops->conv24write = val24_pdp_write;
    197 		break;
    198 #endif
    199 	}
    200 }
    201 #endif	/* V7FS_EI */
    202 v7fs_daddr_t
    203 val24_normal_order_read(uint8_t *a)
    204 {
    205 	/*(v7fs_daddr_t)cast is required for int 16bit system. */
    206 #if BYTE_ORDER == LITTLE_ENDIAN
    207 	return ((v7fs_daddr_t)a[2] << 16) | ((v7fs_daddr_t)a[1] << 8) |
    208 	    (v7fs_daddr_t)a[0];
    209 #else
    210 	return ((v7fs_daddr_t)a[0] << 16) | ((v7fs_daddr_t)a[1] << 8) |
    211 	    (v7fs_daddr_t)a[2];
    212 #endif
    213 }
    214 
    215 void
    216 val24_normal_order_write(v7fs_daddr_t addr, uint8_t *a)
    217 {
    218 #if BYTE_ORDER == LITTLE_ENDIAN
    219 	a[0] = addr & 0xff;
    220 	a[1] = (addr >> 8) & 0xff;
    221 	a[2] = (addr >> 16) & 0xff;
    222 #else
    223 	a[0] = (addr >> 16) & 0xff;
    224 	a[1] = (addr >> 8) & 0xff;
    225 	a[2] = addr & 0xff;
    226 #endif
    227 }
    228