1*0d5acd74SJohn Marino /* $FreeBSD: head/lib/libiconv_modules/mapper_zone/citrus_mapper_zone.c 219019 2011-02-25 00:04:39Z gabor $ */
2*0d5acd74SJohn Marino /*	$NetBSD: citrus_mapper_zone.c,v 1.4 2003/07/12 15:39:21 tshiozak Exp $	*/
3*0d5acd74SJohn Marino 
4*0d5acd74SJohn Marino /*-
5*0d5acd74SJohn Marino  * Copyright (c)2003 Citrus Project,
6*0d5acd74SJohn Marino  * All rights reserved.
7*0d5acd74SJohn Marino  *
8*0d5acd74SJohn Marino  * Redistribution and use in source and binary forms, with or without
9*0d5acd74SJohn Marino  * modification, are permitted provided that the following conditions
10*0d5acd74SJohn Marino  * are met:
11*0d5acd74SJohn Marino  * 1. Redistributions of source code must retain the above copyright
12*0d5acd74SJohn Marino  *    notice, this list of conditions and the following disclaimer.
13*0d5acd74SJohn Marino  * 2. Redistributions in binary form must reproduce the above copyright
14*0d5acd74SJohn Marino  *    notice, this list of conditions and the following disclaimer in the
15*0d5acd74SJohn Marino  *    documentation and/or other materials provided with the distribution.
16*0d5acd74SJohn Marino  *
17*0d5acd74SJohn Marino  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18*0d5acd74SJohn Marino  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19*0d5acd74SJohn Marino  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20*0d5acd74SJohn Marino  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21*0d5acd74SJohn Marino  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22*0d5acd74SJohn Marino  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23*0d5acd74SJohn Marino  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24*0d5acd74SJohn Marino  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25*0d5acd74SJohn Marino  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26*0d5acd74SJohn Marino  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27*0d5acd74SJohn Marino  * SUCH DAMAGE.
28*0d5acd74SJohn Marino  */
29*0d5acd74SJohn Marino 
30*0d5acd74SJohn Marino #include <sys/cdefs.h>
31*0d5acd74SJohn Marino #include <sys/queue.h>
32*0d5acd74SJohn Marino 
33*0d5acd74SJohn Marino #include <assert.h>
34*0d5acd74SJohn Marino #include <errno.h>
35*0d5acd74SJohn Marino #include <stdio.h>
36*0d5acd74SJohn Marino #include <stdlib.h>
37*0d5acd74SJohn Marino #include <string.h>
38*0d5acd74SJohn Marino 
39*0d5acd74SJohn Marino #include "citrus_namespace.h"
40*0d5acd74SJohn Marino #include "citrus_types.h"
41*0d5acd74SJohn Marino #include "citrus_bcs.h"
42*0d5acd74SJohn Marino #include "citrus_module.h"
43*0d5acd74SJohn Marino #include "citrus_region.h"
44*0d5acd74SJohn Marino #include "citrus_memstream.h"
45*0d5acd74SJohn Marino #include "citrus_mmap.h"
46*0d5acd74SJohn Marino #include "citrus_hash.h"
47*0d5acd74SJohn Marino #include "citrus_mapper.h"
48*0d5acd74SJohn Marino #include "citrus_mapper_zone.h"
49*0d5acd74SJohn Marino 
50*0d5acd74SJohn Marino /* ---------------------------------------------------------------------- */
51*0d5acd74SJohn Marino 
52*0d5acd74SJohn Marino _CITRUS_MAPPER_DECLS(mapper_zone);
53*0d5acd74SJohn Marino _CITRUS_MAPPER_DEF_OPS(mapper_zone);
54*0d5acd74SJohn Marino 
55*0d5acd74SJohn Marino 
56*0d5acd74SJohn Marino /* ---------------------------------------------------------------------- */
57*0d5acd74SJohn Marino 
58*0d5acd74SJohn Marino struct _zone {
59*0d5acd74SJohn Marino 	uint32_t	 z_begin;
60*0d5acd74SJohn Marino 	uint32_t	 z_end;
61*0d5acd74SJohn Marino };
62*0d5acd74SJohn Marino 
63*0d5acd74SJohn Marino struct _citrus_mapper_zone {
64*0d5acd74SJohn Marino 	struct _zone	 mz_col;
65*0d5acd74SJohn Marino 	struct _zone	 mz_row;
66*0d5acd74SJohn Marino 	int32_t		 mz_col_offset;
67*0d5acd74SJohn Marino 	int32_t		 mz_row_offset;
68*0d5acd74SJohn Marino 	int		 mz_col_bits;
69*0d5acd74SJohn Marino };
70*0d5acd74SJohn Marino 
71*0d5acd74SJohn Marino struct _parse_state {
72*0d5acd74SJohn Marino 	enum { S_BEGIN, S_OFFSET }	ps_state;
73*0d5acd74SJohn Marino 	union {
74*0d5acd74SJohn Marino 		uint32_t	u_imm;
75*0d5acd74SJohn Marino 		int32_t		s_imm;
76*0d5acd74SJohn Marino 		struct _zone	zone;
77*0d5acd74SJohn Marino 	} u;
78*0d5acd74SJohn Marino #define ps_u_imm	u.u_imm
79*0d5acd74SJohn Marino #define ps_s_imm	u.s_imm
80*0d5acd74SJohn Marino #define ps_zone		u.zone
81*0d5acd74SJohn Marino 	int ps_top;
82*0d5acd74SJohn Marino };
83*0d5acd74SJohn Marino 
84*0d5acd74SJohn Marino int
_citrus_mapper_zone_mapper_getops(struct _citrus_mapper_ops * ops)85*0d5acd74SJohn Marino _citrus_mapper_zone_mapper_getops(struct _citrus_mapper_ops *ops)
86*0d5acd74SJohn Marino {
87*0d5acd74SJohn Marino 
88*0d5acd74SJohn Marino 	memcpy(ops, &_citrus_mapper_zone_mapper_ops,
89*0d5acd74SJohn Marino 	       sizeof(_citrus_mapper_zone_mapper_ops));
90*0d5acd74SJohn Marino 
91*0d5acd74SJohn Marino 	return (0);
92*0d5acd74SJohn Marino }
93*0d5acd74SJohn Marino 
94*0d5acd74SJohn Marino #define BUFSIZE 20
95*0d5acd74SJohn Marino #define T_ERR	0x100
96*0d5acd74SJohn Marino #define T_IMM	0x101
97*0d5acd74SJohn Marino 
98*0d5acd74SJohn Marino static int
get_imm(struct _memstream * ms,struct _parse_state * ps)99*0d5acd74SJohn Marino get_imm(struct _memstream *ms, struct _parse_state *ps)
100*0d5acd74SJohn Marino {
101*0d5acd74SJohn Marino 	int c, i, sign = 0;
102*0d5acd74SJohn Marino 	char buf[BUFSIZE + 1];
103*0d5acd74SJohn Marino 	char *p;
104*0d5acd74SJohn Marino 
105*0d5acd74SJohn Marino 	for (i = 0; i < BUFSIZE; i++) {
106*0d5acd74SJohn Marino retry:
107*0d5acd74SJohn Marino 		c = _memstream_peek(ms);
108*0d5acd74SJohn Marino 		if (i == 0) {
109*0d5acd74SJohn Marino 			if (sign == 0 && (c == '+' || c == '-')) {
110*0d5acd74SJohn Marino 				sign = c;
111*0d5acd74SJohn Marino 				_memstream_getc(ms);
112*0d5acd74SJohn Marino 				goto retry;
113*0d5acd74SJohn Marino 			} else if (!_bcs_isdigit(c))
114*0d5acd74SJohn Marino 				break;
115*0d5acd74SJohn Marino 		} else if (!_bcs_isxdigit(c))
116*0d5acd74SJohn Marino 			if (!(i == 1 && c == 'x'))
117*0d5acd74SJohn Marino 				break;
118*0d5acd74SJohn Marino 		buf[i] = _memstream_getc(ms);
119*0d5acd74SJohn Marino 	}
120*0d5acd74SJohn Marino 	buf[i] = '\0';
121*0d5acd74SJohn Marino 	ps->ps_u_imm = strtoul(buf, &p, 0);
122*0d5acd74SJohn Marino 	if ((p - buf) != i)
123*0d5acd74SJohn Marino 		return (T_ERR);
124*0d5acd74SJohn Marino 	if (sign == '-')
125*0d5acd74SJohn Marino 		ps->ps_u_imm = (unsigned long)-(long)ps->ps_u_imm;
126*0d5acd74SJohn Marino 	return (T_IMM);
127*0d5acd74SJohn Marino }
128*0d5acd74SJohn Marino 
129*0d5acd74SJohn Marino static int
get_tok(struct _memstream * ms,struct _parse_state * ps)130*0d5acd74SJohn Marino get_tok(struct _memstream *ms, struct _parse_state *ps)
131*0d5acd74SJohn Marino {
132*0d5acd74SJohn Marino 	int c;
133*0d5acd74SJohn Marino 
134*0d5acd74SJohn Marino loop:
135*0d5acd74SJohn Marino 	c = _memstream_peek(ms);
136*0d5acd74SJohn Marino 	if (c == 0x00)
137*0d5acd74SJohn Marino 		return (EOF);
138*0d5acd74SJohn Marino 	if (_bcs_isspace(c)) {
139*0d5acd74SJohn Marino 		_memstream_getc(ms);
140*0d5acd74SJohn Marino 		goto loop;
141*0d5acd74SJohn Marino 	}
142*0d5acd74SJohn Marino 
143*0d5acd74SJohn Marino 	switch (ps->ps_state) {
144*0d5acd74SJohn Marino 	case S_BEGIN:
145*0d5acd74SJohn Marino 		switch (c) {
146*0d5acd74SJohn Marino 		case ':':
147*0d5acd74SJohn Marino 		case '-':
148*0d5acd74SJohn Marino 		case '/':
149*0d5acd74SJohn Marino 			_memstream_getc(ms);
150*0d5acd74SJohn Marino 			return (c);
151*0d5acd74SJohn Marino 		case '0':
152*0d5acd74SJohn Marino 		case '1':
153*0d5acd74SJohn Marino 		case '2':
154*0d5acd74SJohn Marino 		case '3':
155*0d5acd74SJohn Marino 		case '4':
156*0d5acd74SJohn Marino 		case '5':
157*0d5acd74SJohn Marino 		case '6':
158*0d5acd74SJohn Marino 		case '7':
159*0d5acd74SJohn Marino 		case '8':
160*0d5acd74SJohn Marino 		case '9':
161*0d5acd74SJohn Marino 			return (get_imm(ms, ps));
162*0d5acd74SJohn Marino 		}
163*0d5acd74SJohn Marino 		break;
164*0d5acd74SJohn Marino 	case S_OFFSET:
165*0d5acd74SJohn Marino 		switch (c) {
166*0d5acd74SJohn Marino 		case '/':
167*0d5acd74SJohn Marino 			_memstream_getc(ms);
168*0d5acd74SJohn Marino 			return (c);
169*0d5acd74SJohn Marino 		case '+':
170*0d5acd74SJohn Marino 		case '-':
171*0d5acd74SJohn Marino 		case '0':
172*0d5acd74SJohn Marino 		case '1':
173*0d5acd74SJohn Marino 		case '2':
174*0d5acd74SJohn Marino 		case '3':
175*0d5acd74SJohn Marino 		case '4':
176*0d5acd74SJohn Marino 		case '5':
177*0d5acd74SJohn Marino 		case '6':
178*0d5acd74SJohn Marino 		case '7':
179*0d5acd74SJohn Marino 		case '8':
180*0d5acd74SJohn Marino 		case '9':
181*0d5acd74SJohn Marino 			return (get_imm(ms, ps));
182*0d5acd74SJohn Marino 		}
183*0d5acd74SJohn Marino 		break;
184*0d5acd74SJohn Marino 	}
185*0d5acd74SJohn Marino 	return (T_ERR);
186*0d5acd74SJohn Marino }
187*0d5acd74SJohn Marino 
188*0d5acd74SJohn Marino static int
parse_zone(struct _memstream * ms,struct _parse_state * ps,struct _zone * z)189*0d5acd74SJohn Marino parse_zone(struct _memstream *ms, struct _parse_state *ps, struct _zone *z)
190*0d5acd74SJohn Marino {
191*0d5acd74SJohn Marino 
192*0d5acd74SJohn Marino 	if (get_tok(ms, ps) != T_IMM)
193*0d5acd74SJohn Marino 		return (-1);
194*0d5acd74SJohn Marino 	z->z_begin = ps->ps_u_imm;
195*0d5acd74SJohn Marino 	if (get_tok(ms, ps) != '-')
196*0d5acd74SJohn Marino 		return (-1);
197*0d5acd74SJohn Marino 	if (get_tok(ms, ps) != T_IMM)
198*0d5acd74SJohn Marino 		return (-1);
199*0d5acd74SJohn Marino 	z->z_end = ps->ps_u_imm;
200*0d5acd74SJohn Marino 
201*0d5acd74SJohn Marino 	if (z->z_begin > z->z_end)
202*0d5acd74SJohn Marino 		return (-1);
203*0d5acd74SJohn Marino 
204*0d5acd74SJohn Marino 	return (0);
205*0d5acd74SJohn Marino }
206*0d5acd74SJohn Marino 
207*0d5acd74SJohn Marino static int
check_rowcol(struct _zone * z,int32_t ofs,uint32_t maxval)208*0d5acd74SJohn Marino check_rowcol(struct _zone *z, int32_t ofs, uint32_t maxval)
209*0d5acd74SJohn Marino {
210*0d5acd74SJohn Marino 	uint32_t remain;
211*0d5acd74SJohn Marino 
212*0d5acd74SJohn Marino 	if (maxval != 0 && z->z_end >= maxval)
213*0d5acd74SJohn Marino 		return (-1);
214*0d5acd74SJohn Marino 
215*0d5acd74SJohn Marino 	if (ofs > 0) {
216*0d5acd74SJohn Marino 		if (maxval == 0)
217*0d5acd74SJohn Marino 			/* this should 0x100000000 - z->z_end */
218*0d5acd74SJohn Marino 			remain = (z->z_end == 0) ? 0xFFFFFFFF :
219*0d5acd74SJohn Marino 			    0xFFFFFFFF - z->z_end + 1;
220*0d5acd74SJohn Marino 		else
221*0d5acd74SJohn Marino 			remain = maxval - z->z_end;
222*0d5acd74SJohn Marino 		if ((uint32_t)ofs > remain)
223*0d5acd74SJohn Marino 			return (-1);
224*0d5acd74SJohn Marino 	} else if (ofs < 0) {
225*0d5acd74SJohn Marino 		if (z->z_begin < (uint32_t)-ofs)
226*0d5acd74SJohn Marino 			return (-1);
227*0d5acd74SJohn Marino 	}
228*0d5acd74SJohn Marino 
229*0d5acd74SJohn Marino 	return (0);
230*0d5acd74SJohn Marino }
231*0d5acd74SJohn Marino 
232*0d5acd74SJohn Marino static int
parse_var(struct _citrus_mapper_zone * mz,struct _memstream * ms)233*0d5acd74SJohn Marino parse_var(struct _citrus_mapper_zone *mz, struct _memstream *ms)
234*0d5acd74SJohn Marino {
235*0d5acd74SJohn Marino 	struct _parse_state ps;
236*0d5acd74SJohn Marino 	uint32_t colmax, rowmax;
237*0d5acd74SJohn Marino 	int isrc, ret;
238*0d5acd74SJohn Marino 
239*0d5acd74SJohn Marino 	ps.ps_state = S_BEGIN;
240*0d5acd74SJohn Marino 
241*0d5acd74SJohn Marino 	if (parse_zone(ms, &ps, &mz->mz_col))
242*0d5acd74SJohn Marino 		return (-1);
243*0d5acd74SJohn Marino 
244*0d5acd74SJohn Marino 	ret = get_tok(ms, &ps);
245*0d5acd74SJohn Marino 	if (ret == '/') {
246*0d5acd74SJohn Marino 		/* rowzone / colzone / bits */
247*0d5acd74SJohn Marino 		isrc = 1;
248*0d5acd74SJohn Marino 		mz->mz_row = mz->mz_col;
249*0d5acd74SJohn Marino 
250*0d5acd74SJohn Marino 		if (parse_zone(ms, &ps, &mz->mz_col))
251*0d5acd74SJohn Marino 			return (-1);
252*0d5acd74SJohn Marino 		if (get_tok(ms, &ps) != '/')
253*0d5acd74SJohn Marino 			return (-1);
254*0d5acd74SJohn Marino 		if (get_tok(ms, &ps) != T_IMM)
255*0d5acd74SJohn Marino 			return (-1);
256*0d5acd74SJohn Marino 		mz->mz_col_bits = ps.ps_u_imm;
257*0d5acd74SJohn Marino 		if (mz->mz_col_bits < 0 || mz->mz_col_bits > 32)
258*0d5acd74SJohn Marino 			return (-1);
259*0d5acd74SJohn Marino 		ret = get_tok(ms, &ps);
260*0d5acd74SJohn Marino 	} else {
261*0d5acd74SJohn Marino 		/* colzone */
262*0d5acd74SJohn Marino 		isrc = 0;
263*0d5acd74SJohn Marino 		mz->mz_col_bits = 32;
264*0d5acd74SJohn Marino 		mz->mz_row.z_begin = mz->mz_row.z_end = 0;
265*0d5acd74SJohn Marino 	}
266*0d5acd74SJohn Marino 	if (ret == ':') {
267*0d5acd74SJohn Marino 		/* offset */
268*0d5acd74SJohn Marino 		ps.ps_state = S_OFFSET;
269*0d5acd74SJohn Marino 		if (get_tok(ms, &ps) != T_IMM)
270*0d5acd74SJohn Marino 			return (-1);
271*0d5acd74SJohn Marino 		mz->mz_col_offset = ps.ps_s_imm;
272*0d5acd74SJohn Marino 		if (isrc) {
273*0d5acd74SJohn Marino 			/* row/col */
274*0d5acd74SJohn Marino 			mz->mz_row_offset = mz->mz_col_offset;
275*0d5acd74SJohn Marino 			if (get_tok(ms, &ps) != '/')
276*0d5acd74SJohn Marino 				return (-1);
277*0d5acd74SJohn Marino 			if (get_tok(ms, &ps) != T_IMM)
278*0d5acd74SJohn Marino 				return (-1);
279*0d5acd74SJohn Marino 			mz->mz_col_offset = ps.ps_s_imm;
280*0d5acd74SJohn Marino 		} else
281*0d5acd74SJohn Marino 			mz->mz_row_offset = 0;
282*0d5acd74SJohn Marino 		ret = get_tok(ms, &ps);
283*0d5acd74SJohn Marino 	}
284*0d5acd74SJohn Marino 	if (ret != EOF)
285*0d5acd74SJohn Marino 		return (-1);
286*0d5acd74SJohn Marino 
287*0d5acd74SJohn Marino 	/* sanity check */
288*0d5acd74SJohn Marino 	colmax = (mz->mz_col_bits == 32) ? 0 : 1 << mz->mz_col_bits;
289*0d5acd74SJohn Marino 	rowmax = (mz->mz_col_bits == 0) ? 0 : 1 << (32-mz->mz_col_bits);
290*0d5acd74SJohn Marino 	if (check_rowcol(&mz->mz_col, mz->mz_col_offset, colmax))
291*0d5acd74SJohn Marino 		return (-1);
292*0d5acd74SJohn Marino 	if (check_rowcol(&mz->mz_row, mz->mz_row_offset, rowmax))
293*0d5acd74SJohn Marino 		return (-1);
294*0d5acd74SJohn Marino 
295*0d5acd74SJohn Marino 	return (0);
296*0d5acd74SJohn Marino }
297*0d5acd74SJohn Marino 
298*0d5acd74SJohn Marino static int
299*0d5acd74SJohn Marino /*ARGSUSED*/
_citrus_mapper_zone_mapper_init(struct _citrus_mapper_area * __restrict ma __unused,struct _citrus_mapper * __restrict cm,const char * __restrict dir __unused,const void * __restrict var,size_t lenvar,struct _citrus_mapper_traits * __restrict mt,size_t lenmt)300*0d5acd74SJohn Marino _citrus_mapper_zone_mapper_init(struct _citrus_mapper_area *__restrict ma __unused,
301*0d5acd74SJohn Marino     struct _citrus_mapper * __restrict cm, const char * __restrict dir __unused,
302*0d5acd74SJohn Marino     const void * __restrict var, size_t lenvar,
303*0d5acd74SJohn Marino     struct _citrus_mapper_traits * __restrict mt, size_t lenmt)
304*0d5acd74SJohn Marino {
305*0d5acd74SJohn Marino 	struct _citrus_mapper_zone *mz;
306*0d5acd74SJohn Marino 	struct _memstream ms;
307*0d5acd74SJohn Marino 	struct _region r;
308*0d5acd74SJohn Marino 
309*0d5acd74SJohn Marino 	if (lenmt < sizeof(*mt))
310*0d5acd74SJohn Marino 		return (EINVAL);
311*0d5acd74SJohn Marino 
312*0d5acd74SJohn Marino 	mz = malloc(sizeof(*mz));
313*0d5acd74SJohn Marino 	if (mz == NULL)
314*0d5acd74SJohn Marino 		return (errno);
315*0d5acd74SJohn Marino 
316*0d5acd74SJohn Marino 	mz->mz_col.z_begin = mz->mz_col.z_end = 0;
317*0d5acd74SJohn Marino 	mz->mz_row.z_begin = mz->mz_row.z_end = 0;
318*0d5acd74SJohn Marino 	mz->mz_col_bits = 0;
319*0d5acd74SJohn Marino 	mz->mz_row_offset = 0;
320*0d5acd74SJohn Marino 	mz->mz_col_offset = 0;
321*0d5acd74SJohn Marino 
322*0d5acd74SJohn Marino 	_region_init(&r, __DECONST(void *, var), lenvar);
323*0d5acd74SJohn Marino 	_memstream_bind(&ms, &r);
324*0d5acd74SJohn Marino 	if (parse_var(mz, &ms)) {
325*0d5acd74SJohn Marino 		free(mz);
326*0d5acd74SJohn Marino 		return (EINVAL);
327*0d5acd74SJohn Marino 	}
328*0d5acd74SJohn Marino 	cm->cm_closure = mz;
329*0d5acd74SJohn Marino 	mt->mt_src_max = mt->mt_dst_max = 1;	/* 1:1 converter */
330*0d5acd74SJohn Marino 	mt->mt_state_size = 0;			/* stateless */
331*0d5acd74SJohn Marino 
332*0d5acd74SJohn Marino 	return (0);
333*0d5acd74SJohn Marino }
334*0d5acd74SJohn Marino 
335*0d5acd74SJohn Marino static void
336*0d5acd74SJohn Marino /*ARGSUSED*/
_citrus_mapper_zone_mapper_uninit(struct _citrus_mapper * cm __unused)337*0d5acd74SJohn Marino _citrus_mapper_zone_mapper_uninit(struct _citrus_mapper *cm __unused)
338*0d5acd74SJohn Marino {
339*0d5acd74SJohn Marino 
340*0d5acd74SJohn Marino }
341*0d5acd74SJohn Marino 
342*0d5acd74SJohn Marino static int
343*0d5acd74SJohn Marino /*ARGSUSED*/
_citrus_mapper_zone_mapper_convert(struct _citrus_mapper * __restrict cm,_citrus_index_t * __restrict dst,_citrus_index_t src,void * __restrict ps __unused)344*0d5acd74SJohn Marino _citrus_mapper_zone_mapper_convert(struct _citrus_mapper * __restrict cm,
345*0d5acd74SJohn Marino     _citrus_index_t * __restrict dst, _citrus_index_t src,
346*0d5acd74SJohn Marino     void * __restrict ps __unused)
347*0d5acd74SJohn Marino {
348*0d5acd74SJohn Marino 	struct _citrus_mapper_zone *mz = cm->cm_closure;
349*0d5acd74SJohn Marino 	uint32_t col, row;
350*0d5acd74SJohn Marino 
351*0d5acd74SJohn Marino 	if (mz->mz_col_bits == 32) {
352*0d5acd74SJohn Marino 		col = src;
353*0d5acd74SJohn Marino 		row = 0;
354*0d5acd74SJohn Marino 		if (col < mz->mz_col.z_begin || col > mz->mz_col.z_end)
355*0d5acd74SJohn Marino 			return (_CITRUS_MAPPER_CONVERT_NONIDENTICAL);
356*0d5acd74SJohn Marino 		if (mz->mz_col_offset > 0)
357*0d5acd74SJohn Marino 			col += (uint32_t)mz->mz_col_offset;
358*0d5acd74SJohn Marino 		else
359*0d5acd74SJohn Marino 			col -= (uint32_t)-mz->mz_col_offset;
360*0d5acd74SJohn Marino 		*dst = col;
361*0d5acd74SJohn Marino 	} else {
362*0d5acd74SJohn Marino 		col = src & (((uint32_t)1 << mz->mz_col_bits) - 1);
363*0d5acd74SJohn Marino 		row = src >> mz->mz_col_bits;
364*0d5acd74SJohn Marino 		if (row < mz->mz_row.z_begin || row > mz->mz_row.z_end ||
365*0d5acd74SJohn Marino 		    col < mz->mz_col.z_begin || col > mz->mz_col.z_end)
366*0d5acd74SJohn Marino 			return (_CITRUS_MAPPER_CONVERT_NONIDENTICAL);
367*0d5acd74SJohn Marino 		if (mz->mz_col_offset > 0)
368*0d5acd74SJohn Marino 			col += (uint32_t)mz->mz_col_offset;
369*0d5acd74SJohn Marino 		else
370*0d5acd74SJohn Marino 			col -= (uint32_t)-mz->mz_col_offset;
371*0d5acd74SJohn Marino 		if (mz->mz_row_offset > 0)
372*0d5acd74SJohn Marino 			row += (uint32_t)mz->mz_row_offset;
373*0d5acd74SJohn Marino 		else
374*0d5acd74SJohn Marino 			row -= (uint32_t)-mz->mz_row_offset;
375*0d5acd74SJohn Marino 		*dst = col | (row << mz->mz_col_bits);
376*0d5acd74SJohn Marino 	}
377*0d5acd74SJohn Marino 	return (_CITRUS_MAPPER_CONVERT_SUCCESS);
378*0d5acd74SJohn Marino }
379*0d5acd74SJohn Marino 
380*0d5acd74SJohn Marino static void
381*0d5acd74SJohn Marino /*ARGSUSED*/
_citrus_mapper_zone_mapper_init_state(void)382*0d5acd74SJohn Marino _citrus_mapper_zone_mapper_init_state(void)
383*0d5acd74SJohn Marino {
384*0d5acd74SJohn Marino 
385*0d5acd74SJohn Marino }
386