| /* Conversion between UTF-16 and UTF-32 BE/internal. |
| |
| This module uses the Z9-109 variants of the Convert Unicode |
| instructions. |
| Copyright (C) 1997-2018 Free Software Foundation, Inc. |
| |
| Author: Andreas Krebbel <Andreas.Krebbel@de.ibm.com> |
| Based on the work by Ulrich Drepper <drepper@cygnus.com>, 1997. |
| |
| Thanks to Daniel Appich who covered the relevant performance work |
| in his diploma thesis. |
| |
| This is free software; you can redistribute it and/or |
| modify it under the terms of the GNU Lesser General Public |
| License as published by the Free Software Foundation; either |
| version 2.1 of the License, or (at your option) any later version. |
| |
| This 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 |
| Lesser General Public License for more details. |
| |
| You should have received a copy of the GNU Lesser General Public |
| License along with the GNU C Library; if not, see |
| <http://www.gnu.org/licenses/>. */ |
| |
| #include <dlfcn.h> |
| #include <stdint.h> |
| #include <unistd.h> |
| #include <gconv.h> |
| #include <string.h> |
| |
| /* Select which versions should be defined depending on support |
| for multiarch, vector and used minimum architecture level. */ |
| #define HAVE_FROM_C 1 |
| #define FROM_LOOP_DEFAULT FROM_LOOP_C |
| #define HAVE_TO_C 1 |
| #define TO_LOOP_DEFAULT TO_LOOP_C |
| |
| #if defined HAVE_S390_VX_ASM_SUPPORT && defined USE_MULTIARCH |
| # define HAVE_FROM_VX 1 |
| # define HAVE_FROM_VX_CU 1 |
| # define HAVE_TO_VX 1 |
| # define HAVE_TO_VX_CU 1 |
| #else |
| # define HAVE_FROM_VX 0 |
| # define HAVE_FROM_VX_CU 0 |
| # define HAVE_TO_VX 0 |
| # define HAVE_TO_VX_CU 0 |
| #endif |
| |
| #if defined HAVE_S390_VX_GCC_SUPPORT |
| # define ASM_CLOBBER_VR(NR) , NR |
| #else |
| # define ASM_CLOBBER_VR(NR) |
| #endif |
| |
| #if defined __s390x__ |
| # define CONVERT_32BIT_SIZE_T(REG) |
| #else |
| # define CONVERT_32BIT_SIZE_T(REG) "llgfr %" #REG ",%" #REG "\n\t" |
| #endif |
| |
| /* UTF-32 big endian byte order mark. */ |
| #define BOM_UTF32 0x0000feffu |
| |
| /* UTF-16 big endian byte order mark. */ |
| #define BOM_UTF16 0xfeff |
| |
| #define DEFINE_INIT 0 |
| #define DEFINE_FINI 0 |
| #define MIN_NEEDED_FROM 2 |
| #define MAX_NEEDED_FROM 4 |
| #define MIN_NEEDED_TO 4 |
| #define FROM_LOOP FROM_LOOP_DEFAULT |
| #define TO_LOOP TO_LOOP_DEFAULT |
| #define FROM_DIRECTION (dir == from_utf16) |
| #define ONE_DIRECTION 0 |
| |
| /* Direction of the transformation. */ |
| enum direction |
| { |
| illegal_dir, |
| to_utf16, |
| from_utf16 |
| }; |
| |
| struct utf16_data |
| { |
| enum direction dir; |
| int emit_bom; |
| }; |
| |
| |
| extern int gconv_init (struct __gconv_step *step); |
| int |
| gconv_init (struct __gconv_step *step) |
| { |
| /* Determine which direction. */ |
| struct utf16_data *new_data; |
| enum direction dir = illegal_dir; |
| int emit_bom; |
| int result; |
| |
| emit_bom = (__strcasecmp (step->__to_name, "UTF-32//") == 0 |
| || __strcasecmp (step->__to_name, "UTF-16//") == 0); |
| |
| if (__strcasecmp (step->__from_name, "UTF-16BE//") == 0 |
| && (__strcasecmp (step->__to_name, "UTF-32//") == 0 |
| || __strcasecmp (step->__to_name, "UTF-32BE//") == 0 |
| || __strcasecmp (step->__to_name, "INTERNAL") == 0)) |
| { |
| dir = from_utf16; |
| } |
| else if ((__strcasecmp (step->__to_name, "UTF-16//") == 0 |
| || __strcasecmp (step->__to_name, "UTF-16BE//") == 0) |
| && (__strcasecmp (step->__from_name, "UTF-32BE//") == 0 |
| || __strcasecmp (step->__from_name, "INTERNAL") == 0)) |
| { |
| dir = to_utf16; |
| } |
| |
| result = __GCONV_NOCONV; |
| if (dir != illegal_dir) |
| { |
| new_data = (struct utf16_data *) malloc (sizeof (struct utf16_data)); |
| |
| result = __GCONV_NOMEM; |
| if (new_data != NULL) |
| { |
| new_data->dir = dir; |
| new_data->emit_bom = emit_bom; |
| step->__data = new_data; |
| |
| if (dir == from_utf16) |
| { |
| step->__min_needed_from = MIN_NEEDED_FROM; |
| step->__max_needed_from = MIN_NEEDED_FROM; |
| step->__min_needed_to = MIN_NEEDED_TO; |
| step->__max_needed_to = MIN_NEEDED_TO; |
| } |
| else |
| { |
| step->__min_needed_from = MIN_NEEDED_TO; |
| step->__max_needed_from = MIN_NEEDED_TO; |
| step->__min_needed_to = MIN_NEEDED_FROM; |
| step->__max_needed_to = MIN_NEEDED_FROM; |
| } |
| |
| step->__stateful = 0; |
| |
| result = __GCONV_OK; |
| } |
| } |
| |
| return result; |
| } |
| |
| |
| extern void gconv_end (struct __gconv_step *data); |
| void |
| gconv_end (struct __gconv_step *data) |
| { |
| free (data->__data); |
| } |
| |
| #define PREPARE_LOOP \ |
| enum direction dir = ((struct utf16_data *) step->__data)->dir; \ |
| int emit_bom = ((struct utf16_data *) step->__data)->emit_bom; \ |
| \ |
| if (emit_bom && !data->__internal_use \ |
| && data->__invocation_counter == 0) \ |
| { \ |
| if (dir == to_utf16) \ |
| { \ |
| /* Emit the UTF-16 Byte Order Mark. */ \ |
| if (__glibc_unlikely (outbuf + 2 > outend)) \ |
| return __GCONV_FULL_OUTPUT; \ |
| \ |
| put16u (outbuf, BOM_UTF16); \ |
| outbuf += 2; \ |
| } \ |
| else \ |
| { \ |
| /* Emit the UTF-32 Byte Order Mark. */ \ |
| if (__glibc_unlikely (outbuf + 4 > outend)) \ |
| return __GCONV_FULL_OUTPUT; \ |
| \ |
| put32u (outbuf, BOM_UTF32); \ |
| outbuf += 4; \ |
| } \ |
| } |
| |
| /* Conversion function from UTF-16 to UTF-32 internal/BE. */ |
| |
| #if HAVE_FROM_C == 1 |
| /* The software routine is copied from utf-16.c (minus bytes |
| swapping). */ |
| # define BODY_FROM_C \ |
| { \ |
| uint16_t u1 = get16 (inptr); \ |
| \ |
| if (__builtin_expect (u1 < 0xd800, 1) || u1 > 0xdfff) \ |
| { \ |
| /* No surrogate. */ \ |
| put32 (outptr, u1); \ |
| inptr += 2; \ |
| } \ |
| else \ |
| { \ |
| /* An isolated low-surrogate was found. This has to be \ |
| considered ill-formed. */ \ |
| if (__glibc_unlikely (u1 >= 0xdc00)) \ |
| { \ |
| STANDARD_FROM_LOOP_ERR_HANDLER (2); \ |
| } \ |
| /* It's a surrogate character. At least the first word says \ |
| it is. */ \ |
| if (__glibc_unlikely (inptr + 4 > inend)) \ |
| { \ |
| /* We don't have enough input for another complete input \ |
| character. */ \ |
| result = __GCONV_INCOMPLETE_INPUT; \ |
| break; \ |
| } \ |
| \ |
| inptr += 2; \ |
| uint16_t u2 = get16 (inptr); \ |
| if (__builtin_expect (u2 < 0xdc00, 0) \ |
| || __builtin_expect (u2 > 0xdfff, 0)) \ |
| { \ |
| /* This is no valid second word for a surrogate. */ \ |
| inptr -= 2; \ |
| STANDARD_FROM_LOOP_ERR_HANDLER (2); \ |
| } \ |
| \ |
| put32 (outptr, ((u1 - 0xd7c0) << 10) + (u2 - 0xdc00)); \ |
| inptr += 2; \ |
| } \ |
| outptr += 4; \ |
| } |
| |
| |
| /* Generate loop-function with software routing. */ |
| # define MIN_NEEDED_INPUT MIN_NEEDED_FROM |
| # define MAX_NEEDED_INPUT MAX_NEEDED_FROM |
| # define MIN_NEEDED_OUTPUT MIN_NEEDED_TO |
| # define FROM_LOOP_C __from_utf16_loop_c |
| # define LOOPFCT FROM_LOOP_C |
| # define LOOP_NEED_FLAGS |
| # define BODY BODY_FROM_C |
| # include <iconv/loop.c> |
| #else |
| # define FROM_LOOP_C NULL |
| #endif /* HAVE_FROM_C != 1 */ |
| |
| #if HAVE_FROM_VX == 1 |
| # define BODY_FROM_VX \ |
| { \ |
| size_t inlen = inend - inptr; \ |
| size_t outlen = outend - outptr; \ |
| unsigned long tmp, tmp2, tmp3; \ |
| asm volatile (".machine push\n\t" \ |
| ".machine \"z13\"\n\t" \ |
| ".machinemode \"zarch_nohighgprs\"\n\t" \ |
| /* Setup to check for surrogates. */ \ |
| " larl %[R_TMP],9f\n\t" \ |
| " vlm %%v30,%%v31,0(%[R_TMP])\n\t" \ |
| CONVERT_32BIT_SIZE_T ([R_INLEN]) \ |
| CONVERT_32BIT_SIZE_T ([R_OUTLEN]) \ |
| /* Loop which handles UTF-16 chars <0xd800, >0xdfff. */ \ |
| "0: clgijl %[R_INLEN],16,2f\n\t" \ |
| " clgijl %[R_OUTLEN],32,2f\n\t" \ |
| "1: vl %%v16,0(%[R_IN])\n\t" \ |
| /* Check for surrogate chars. */ \ |
| " vstrchs %%v19,%%v16,%%v30,%%v31\n\t" \ |
| " jno 10f\n\t" \ |
| /* Enlarge to UTF-32. */ \ |
| " vuplhh %%v17,%%v16\n\t" \ |
| " la %[R_IN],16(%[R_IN])\n\t" \ |
| " vupllh %%v18,%%v16\n\t" \ |
| " aghi %[R_INLEN],-16\n\t" \ |
| /* Store 32 bytes to buf_out. */ \ |
| " vstm %%v17,%%v18,0(%[R_OUT])\n\t" \ |
| " aghi %[R_OUTLEN],-32\n\t" \ |
| " la %[R_OUT],32(%[R_OUT])\n\t" \ |
| " clgijl %[R_INLEN],16,2f\n\t" \ |
| " clgijl %[R_OUTLEN],32,2f\n\t" \ |
| " j 1b\n\t" \ |
| /* Setup to check for ch >= 0xd800 && ch <= 0xdfff. (v30, v31) */ \ |
| "9: .short 0xd800,0xdfff,0x0,0x0,0x0,0x0,0x0,0x0\n\t" \ |
| " .short 0xa000,0xc000,0x0,0x0,0x0,0x0,0x0,0x0\n\t" \ |
| /* At least one uint16_t is in range of surrogates. \ |
| Store the preceding chars. */ \ |
| "10: vlgvb %[R_TMP],%%v19,7\n\t" \ |
| " vuplhh %%v17,%%v16\n\t" \ |
| " sllg %[R_TMP3],%[R_TMP],1\n\t" /* Number of out bytes. */ \ |
| " ahik %[R_TMP2],%[R_TMP3],-1\n\t" /* Highest index to store. */ \ |
| " jl 12f\n\t" \ |
| " vstl %%v17,%[R_TMP2],0(%[R_OUT])\n\t" \ |
| " vupllh %%v18,%%v16\n\t" \ |
| " ahi %[R_TMP2],-16\n\t" \ |
| " jl 11f\n\t" \ |
| " vstl %%v18,%[R_TMP2],16(%[R_OUT])\n\t" \ |
| "11: \n\t" /* Update pointers. */ \ |
| " la %[R_IN],0(%[R_TMP],%[R_IN])\n\t" \ |
| " slgr %[R_INLEN],%[R_TMP]\n\t" \ |
| " la %[R_OUT],0(%[R_TMP3],%[R_OUT])\n\t" \ |
| " slgr %[R_OUTLEN],%[R_TMP3]\n\t" \ |
| /* Calculate remaining uint16_t values in loaded vrs. */ \ |
| "12: lghi %[R_TMP2],16\n\t" \ |
| " slgr %[R_TMP2],%[R_TMP]\n\t" \ |
| " srl %[R_TMP2],1\n\t" \ |
| " llh %[R_TMP],0(%[R_IN])\n\t" \ |
| " aghi %[R_OUTLEN],-4\n\t" \ |
| " j 16f\n\t" \ |
| /* Handle remaining bytes. */ \ |
| "2: \n\t" \ |
| /* Zero, one or more bytes available? */ \ |
| " clgfi %[R_INLEN],1\n\t" \ |
| " je 97f\n\t" /* Only one byte available. */ \ |
| " jl 99f\n\t" /* End if no bytes available. */ \ |
| /* Calculate remaining uint16_t values in inptr. */ \ |
| " srlg %[R_TMP2],%[R_INLEN],1\n\t" \ |
| /* Handle remaining uint16_t values. */ \ |
| "13: llh %[R_TMP],0(%[R_IN])\n\t" \ |
| " slgfi %[R_OUTLEN],4\n\t" \ |
| " jl 96f \n\t" \ |
| " clfi %[R_TMP],0xd800\n\t" \ |
| " jhe 15f\n\t" \ |
| "14: st %[R_TMP],0(%[R_OUT])\n\t" \ |
| " la %[R_IN],2(%[R_IN])\n\t" \ |
| " aghi %[R_INLEN],-2\n\t" \ |
| " la %[R_OUT],4(%[R_OUT])\n\t" \ |
| " brctg %[R_TMP2],13b\n\t" \ |
| " j 0b\n\t" /* Switch to vx-loop. */ \ |
| /* Handle UTF-16 surrogate pair. */ \ |
| "15: clfi %[R_TMP],0xdfff\n\t" \ |
| " jh 14b\n\t" /* Jump away if ch > 0xdfff. */ \ |
| "16: clfi %[R_TMP],0xdc00\n\t" \ |
| " jhe 98f\n\t" /* Jump away in case of low-surrogate. */ \ |
| " slgfi %[R_INLEN],4\n\t" \ |
| " jl 97f\n\t" /* Big enough input? */ \ |
| " llh %[R_TMP3],2(%[R_IN])\n\t" /* Load low surrogate. */ \ |
| " slfi %[R_TMP],0xd7c0\n\t" \ |
| " sll %[R_TMP],10\n\t" \ |
| " risbgn %[R_TMP],%[R_TMP3],54,63,0\n\t" /* Insert klmnopqrst. */ \ |
| " nilf %[R_TMP3],0xfc00\n\t" \ |
| " clfi %[R_TMP3],0xdc00\n\t" /* Check if it starts with 0xdc00. */ \ |
| " jne 98f\n\t" \ |
| " st %[R_TMP],0(%[R_OUT])\n\t" \ |
| " la %[R_IN],4(%[R_IN])\n\t" \ |
| " la %[R_OUT],4(%[R_OUT])\n\t" \ |
| " aghi %[R_TMP2],-2\n\t" \ |
| " jh 13b\n\t" /* Handle remaining uint16_t values. */ \ |
| " j 0b\n\t" /* Switch to vx-loop. */ \ |
| "96: \n\t" /* Return full output. */ \ |
| " lghi %[R_RES],%[RES_OUT_FULL]\n\t" \ |
| " j 99f\n\t" \ |
| "97: \n\t" /* Return incomplete input. */ \ |
| " lghi %[R_RES],%[RES_IN_FULL]\n\t" \ |
| " j 99f\n\t" \ |
| "98:\n\t" /* Return Illegal character. */ \ |
| " lghi %[R_RES],%[RES_IN_ILL]\n\t" \ |
| "99:\n\t" \ |
| ".machine pop" \ |
| : /* outputs */ [R_IN] "+a" (inptr) \ |
| , [R_INLEN] "+d" (inlen), [R_OUT] "+a" (outptr) \ |
| , [R_OUTLEN] "+d" (outlen), [R_TMP] "=a" (tmp) \ |
| , [R_TMP2] "=d" (tmp2), [R_TMP3] "=a" (tmp3) \ |
| , [R_RES] "+d" (result) \ |
| : /* inputs */ \ |
| [RES_OUT_FULL] "i" (__GCONV_FULL_OUTPUT) \ |
| , [RES_IN_ILL] "i" (__GCONV_ILLEGAL_INPUT) \ |
| , [RES_IN_FULL] "i" (__GCONV_INCOMPLETE_INPUT) \ |
| : /* clobber list */ "memory", "cc" \ |
| ASM_CLOBBER_VR ("v16") ASM_CLOBBER_VR ("v17") \ |
| ASM_CLOBBER_VR ("v18") ASM_CLOBBER_VR ("v19") \ |
| ASM_CLOBBER_VR ("v30") ASM_CLOBBER_VR ("v31") \ |
| ); \ |
| if (__glibc_likely (inptr == inend) \ |
| || result != __GCONV_ILLEGAL_INPUT) \ |
| break; \ |
| \ |
| STANDARD_FROM_LOOP_ERR_HANDLER (2); \ |
| } |
| |
| /* Generate loop-function with hardware vector instructions. */ |
| # define MIN_NEEDED_INPUT MIN_NEEDED_FROM |
| # define MAX_NEEDED_INPUT MAX_NEEDED_FROM |
| # define MIN_NEEDED_OUTPUT MIN_NEEDED_TO |
| # define FROM_LOOP_VX __from_utf16_loop_vx |
| # define LOOPFCT FROM_LOOP_VX |
| # define LOOP_NEED_FLAGS |
| # define BODY BODY_FROM_VX |
| # include <iconv/loop.c> |
| #else |
| # define FROM_LOOP_VX NULL |
| #endif /* HAVE_FROM_VX != 1 */ |
| |
| #if HAVE_FROM_VX_CU == 1 |
| #define BODY_FROM_VX_CU \ |
| { \ |
| register const unsigned char* pInput asm ("8") = inptr; \ |
| register size_t inlen asm ("9") = inend - inptr; \ |
| register unsigned char* pOutput asm ("10") = outptr; \ |
| register size_t outlen asm ("11") = outend - outptr; \ |
| unsigned long tmp, tmp2, tmp3; \ |
| asm volatile (".machine push\n\t" \ |
| ".machine \"z13\"\n\t" \ |
| ".machinemode \"zarch_nohighgprs\"\n\t" \ |
| /* Setup to check for surrogates. */ \ |
| " larl %[R_TMP],9f\n\t" \ |
| " vlm %%v30,%%v31,0(%[R_TMP])\n\t" \ |
| CONVERT_32BIT_SIZE_T ([R_INLEN]) \ |
| CONVERT_32BIT_SIZE_T ([R_OUTLEN]) \ |
| /* Loop which handles UTF-16 chars <0xd800, >0xdfff. */ \ |
| "0: clgijl %[R_INLEN],16,20f\n\t" \ |
| " clgijl %[R_OUTLEN],32,20f\n\t" \ |
| "1: vl %%v16,0(%[R_IN])\n\t" \ |
| /* Check for surrogate chars. */ \ |
| " vstrchs %%v19,%%v16,%%v30,%%v31\n\t" \ |
| " jno 10f\n\t" \ |
| /* Enlarge to UTF-32. */ \ |
| " vuplhh %%v17,%%v16\n\t" \ |
| " la %[R_IN],16(%[R_IN])\n\t" \ |
| " vupllh %%v18,%%v16\n\t" \ |
| " aghi %[R_INLEN],-16\n\t" \ |
| /* Store 32 bytes to buf_out. */ \ |
| " vstm %%v17,%%v18,0(%[R_OUT])\n\t" \ |
| " aghi %[R_OUTLEN],-32\n\t" \ |
| " la %[R_OUT],32(%[R_OUT])\n\t" \ |
| " clgijl %[R_INLEN],16,20f\n\t" \ |
| " clgijl %[R_OUTLEN],32,20f\n\t" \ |
| " j 1b\n\t" \ |
| /* Setup to check for ch >= 0xd800 && ch <= 0xdfff. (v30, v31) */ \ |
| "9: .short 0xd800,0xdfff,0x0,0x0,0x0,0x0,0x0,0x0\n\t" \ |
| " .short 0xa000,0xc000,0x0,0x0,0x0,0x0,0x0,0x0\n\t" \ |
| /* At least one uint16_t is in range of surrogates. \ |
| Store the preceding chars. */ \ |
| "10: vlgvb %[R_TMP],%%v19,7\n\t" \ |
| " vuplhh %%v17,%%v16\n\t" \ |
| " sllg %[R_TMP3],%[R_TMP],1\n\t" /* Number of out bytes. */ \ |
| " ahik %[R_TMP2],%[R_TMP3],-1\n\t" /* Highest index to store. */ \ |
| " jl 20f\n\t" \ |
| " vstl %%v17,%[R_TMP2],0(%[R_OUT])\n\t" \ |
| " vupllh %%v18,%%v16\n\t" \ |
| " ahi %[R_TMP2],-16\n\t" \ |
| " jl 11f\n\t" \ |
| " vstl %%v18,%[R_TMP2],16(%[R_OUT])\n\t" \ |
| "11: \n\t" /* Update pointers. */ \ |
| " la %[R_IN],0(%[R_TMP],%[R_IN])\n\t" \ |
| " slgr %[R_INLEN],%[R_TMP]\n\t" \ |
| " la %[R_OUT],0(%[R_TMP3],%[R_OUT])\n\t" \ |
| " slgr %[R_OUTLEN],%[R_TMP3]\n\t" \ |
| /* Handles UTF16 surrogates with convert instruction. */ \ |
| "20: cu24 %[R_OUT],%[R_IN],1\n\t" \ |
| " jo 0b\n\t" /* Try vector implemenation again. */ \ |
| " lochil %[R_RES],%[RES_OUT_FULL]\n\t" /* cc == 1. */ \ |
| " lochih %[R_RES],%[RES_IN_ILL]\n\t" /* cc == 2. */ \ |
| ".machine pop" \ |
| : /* outputs */ [R_IN] "+a" (pInput) \ |
| , [R_INLEN] "+d" (inlen), [R_OUT] "+a" (pOutput) \ |
| , [R_OUTLEN] "+d" (outlen), [R_TMP] "=a" (tmp) \ |
| , [R_TMP2] "=d" (tmp2), [R_TMP3] "=a" (tmp3) \ |
| , [R_RES] "+d" (result) \ |
| : /* inputs */ \ |
| [RES_OUT_FULL] "i" (__GCONV_FULL_OUTPUT) \ |
| , [RES_IN_ILL] "i" (__GCONV_ILLEGAL_INPUT) \ |
| : /* clobber list */ "memory", "cc" \ |
| ASM_CLOBBER_VR ("v16") ASM_CLOBBER_VR ("v17") \ |
| ASM_CLOBBER_VR ("v18") ASM_CLOBBER_VR ("v19") \ |
| ASM_CLOBBER_VR ("v30") ASM_CLOBBER_VR ("v31") \ |
| ); \ |
| inptr = pInput; \ |
| outptr = pOutput; \ |
| \ |
| if (__glibc_likely (inlen == 0) \ |
| || result == __GCONV_FULL_OUTPUT) \ |
| break; \ |
| if (inlen == 1) \ |
| { \ |
| /* Input does not contain a complete utf16 character. */ \ |
| result = __GCONV_INCOMPLETE_INPUT; \ |
| break; \ |
| } \ |
| else if (result != __GCONV_ILLEGAL_INPUT) \ |
| { \ |
| /* Input is >= 2 and < 4 bytes (as cu24 would have processed \ |
| a possible next utf16 character) and not illegal. \ |
| => we have a single high surrogate at end of input. */ \ |
| result = __GCONV_INCOMPLETE_INPUT; \ |
| break; \ |
| } \ |
| \ |
| STANDARD_FROM_LOOP_ERR_HANDLER (2); \ |
| } |
| |
| /* Generate loop-function with hardware vector and utf-convert instructions. */ |
| # define MIN_NEEDED_INPUT MIN_NEEDED_FROM |
| # define MAX_NEEDED_INPUT MAX_NEEDED_FROM |
| # define MIN_NEEDED_OUTPUT MIN_NEEDED_TO |
| # define FROM_LOOP_VX_CU __from_utf16_loop_vx_cu |
| # define LOOPFCT FROM_LOOP_VX_CU |
| # define LOOP_NEED_FLAGS |
| # define BODY BODY_FROM_VX_CU |
| # include <iconv/loop.c> |
| #else |
| # define FROM_LOOP_VX_CU NULL |
| #endif /* HAVE_FROM_VX_CU != 1 */ |
| |
| /* Conversion from UTF-32 internal/BE to UTF-16. */ |
| |
| #if HAVE_TO_C == 1 |
| /* The software routine is copied from utf-16.c (minus bytes |
| swapping). */ |
| # define BODY_TO_C \ |
| { \ |
| uint32_t c = get32 (inptr); \ |
| \ |
| if (__builtin_expect (c <= 0xd7ff, 1) \ |
| || (c > 0xdfff && c <= 0xffff)) \ |
| { \ |
| /* Two UTF-16 chars. */ \ |
| put16 (outptr, c); \ |
| } \ |
| else if (__builtin_expect (c >= 0x10000, 1) \ |
| && __builtin_expect (c <= 0x10ffff, 1)) \ |
| { \ |
| /* Four UTF-16 chars. */ \ |
| uint16_t zabcd = ((c & 0x1f0000) >> 16) - 1; \ |
| uint16_t out; \ |
| \ |
| /* Generate a surrogate character. */ \ |
| if (__glibc_unlikely (outptr + 4 > outend)) \ |
| { \ |
| /* Overflow in the output buffer. */ \ |
| result = __GCONV_FULL_OUTPUT; \ |
| break; \ |
| } \ |
| \ |
| out = 0xd800; \ |
| out |= (zabcd & 0xff) << 6; \ |
| out |= (c >> 10) & 0x3f; \ |
| put16 (outptr, out); \ |
| outptr += 2; \ |
| \ |
| out = 0xdc00; \ |
| out |= c & 0x3ff; \ |
| put16 (outptr, out); \ |
| } \ |
| else \ |
| { \ |
| STANDARD_TO_LOOP_ERR_HANDLER (4); \ |
| } \ |
| outptr += 2; \ |
| inptr += 4; \ |
| } |
| |
| /* Generate loop-function with software routing. */ |
| # define MIN_NEEDED_INPUT MIN_NEEDED_TO |
| # define MIN_NEEDED_OUTPUT MIN_NEEDED_FROM |
| # define MAX_NEEDED_OUTPUT MAX_NEEDED_FROM |
| # define TO_LOOP_C __to_utf16_loop_c |
| # define LOOPFCT TO_LOOP_C |
| # define LOOP_NEED_FLAGS |
| # define BODY BODY_TO_C |
| # include <iconv/loop.c> |
| #else |
| # define TO_LOOP_C NULL |
| #endif /* HAVE_TO_C != 1 */ |
| |
| #if HAVE_TO_VX == 1 |
| # define BODY_TO_VX \ |
| { \ |
| size_t inlen = inend - inptr; \ |
| size_t outlen = outend - outptr; \ |
| unsigned long tmp, tmp2, tmp3; \ |
| asm volatile (".machine push\n\t" \ |
| ".machine \"z13\"\n\t" \ |
| ".machinemode \"zarch_nohighgprs\"\n\t" \ |
| /* Setup to check for surrogates. */ \ |
| " larl %[R_TMP],9f\n\t" \ |
| " vlm %%v30,%%v31,0(%[R_TMP])\n\t" \ |
| CONVERT_32BIT_SIZE_T ([R_INLEN]) \ |
| CONVERT_32BIT_SIZE_T ([R_OUTLEN]) \ |
| /* Loop which handles UTF-32 chars \ |
| ch < 0xd800 || (ch > 0xdfff && ch < 0x10000). */ \ |
| "0: clgijl %[R_INLEN],32,2f\n\t" \ |
| " clgijl %[R_OUTLEN],16,2f\n\t" \ |
| "1: vlm %%v16,%%v17,0(%[R_IN])\n\t" \ |
| " lghi %[R_TMP2],0\n\t" \ |
| /* Shorten to UTF-16. */ \ |
| " vpkf %%v18,%%v16,%%v17\n\t" \ |
| /* Check for surrogate chars. */ \ |
| " vstrcfs %%v19,%%v16,%%v30,%%v31\n\t" \ |
| " jno 10f\n\t" \ |
| " vstrcfs %%v19,%%v17,%%v30,%%v31\n\t" \ |
| " jno 11f\n\t" \ |
| /* Store 16 bytes to buf_out. */ \ |
| " vst %%v18,0(%[R_OUT])\n\t" \ |
| " la %[R_IN],32(%[R_IN])\n\t" \ |
| " aghi %[R_INLEN],-32\n\t" \ |
| " aghi %[R_OUTLEN],-16\n\t" \ |
| " la %[R_OUT],16(%[R_OUT])\n\t" \ |
| " clgijl %[R_INLEN],32,2f\n\t" \ |
| " clgijl %[R_OUTLEN],16,2f\n\t" \ |
| " j 1b\n\t" \ |
| /* Calculate remaining uint32_t values in inptr. */ \ |
| "2: \n\t" \ |
| " clgije %[R_INLEN],0,99f\n\t" \ |
| " clgijl %[R_INLEN],4,92f\n\t" \ |
| " srlg %[R_TMP2],%[R_INLEN],2\n\t" \ |
| " j 20f\n\t" \ |
| /* Setup to check for ch >= 0xd800 && ch <= 0xdfff \ |
| and check for ch >= 0x10000. (v30, v31) */ \ |
| "9: .long 0xd800,0xdfff,0x10000,0x10000\n\t" \ |
| " .long 0xa0000000,0xc0000000, 0xa0000000,0xa0000000\n\t" \ |
| /* At least on UTF32 char is in range of surrogates. \ |
| Store the preceding characters. */ \ |
| "11: ahi %[R_TMP2],16\n\t" \ |
| "10: vlgvb %[R_TMP],%%v19,7\n\t" \ |
| " agr %[R_TMP],%[R_TMP2]\n\t" \ |
| " srlg %[R_TMP3],%[R_TMP],1\n\t" /* Number of out bytes. */ \ |
| " ahik %[R_TMP2],%[R_TMP3],-1\n\t" /* Highest index to store. */ \ |
| " jl 12f\n\t" \ |
| " vstl %%v18,%[R_TMP2],0(%[R_OUT])\n\t" \ |
| /* Update pointers. */ \ |
| " la %[R_IN],0(%[R_TMP],%[R_IN])\n\t" \ |
| " slgr %[R_INLEN],%[R_TMP]\n\t" \ |
| " la %[R_OUT],0(%[R_TMP3],%[R_OUT])\n\t" \ |
| " slgr %[R_OUTLEN],%[R_TMP3]\n\t" \ |
| /* Calculate remaining uint32_t values in vrs. */ \ |
| "12: lghi %[R_TMP2],8\n\t" \ |
| " srlg %[R_TMP3],%[R_TMP3],1\n\t" \ |
| " slgr %[R_TMP2],%[R_TMP3]\n\t" \ |
| /* Handle remaining UTF-32 characters. */ \ |
| "20: l %[R_TMP],0(%[R_IN])\n\t" \ |
| " aghi %[R_INLEN],-4\n\t" \ |
| /* Test if ch is 2byte UTF-16 char. */ \ |
| " clfi %[R_TMP],0xffff\n\t" \ |
| " jh 21f\n\t" \ |
| /* Handle 2 byte UTF16 char. */ \ |
| " lgr %[R_TMP3],%[R_TMP]\n\t" \ |
| " nilf %[R_TMP],0xf800\n\t" \ |
| " clfi %[R_TMP],0xd800\n\t" \ |
| " je 91f\n\t" /* Do not accept UTF-16 surrogates. */ \ |
| " slgfi %[R_OUTLEN],2\n\t" \ |
| " jl 90f \n\t" \ |
| " sth %[R_TMP3],0(%[R_OUT])\n\t" \ |
| " la %[R_IN],4(%[R_IN])\n\t" \ |
| " la %[R_OUT],2(%[R_OUT])\n\t" \ |
| " brctg %[R_TMP2],20b\n\t" \ |
| " j 0b\n\t" /* Switch to vx-loop. */ \ |
| /* Test if ch is 4byte UTF-16 char. */ \ |
| "21: clfi %[R_TMP],0x10ffff\n\t" \ |
| " jh 91f\n\t" /* ch > 0x10ffff is not allowed! */ \ |
| /* Handle 4 byte UTF16 char. */ \ |
| " slgfi %[R_OUTLEN],4\n\t" \ |
| " jl 90f \n\t" \ |
| " slfi %[R_TMP],0x10000\n\t" /* zabcd = uvwxy - 1. */ \ |
| " llilf %[R_TMP3],0xd800dc00\n\t" \ |
| " la %[R_IN],4(%[R_IN])\n\t" \ |
| " risbgn %[R_TMP3],%[R_TMP],38,47,6\n\t" /* High surrogate. */ \ |
| " risbgn %[R_TMP3],%[R_TMP],54,63,0\n\t" /* Low surrogate. */ \ |
| " st %[R_TMP3],0(%[R_OUT])\n\t" \ |
| " la %[R_OUT],4(%[R_OUT])\n\t" \ |
| " brctg %[R_TMP2],20b\n\t" \ |
| " j 0b\n\t" /* Switch to vx-loop. */ \ |
| "92: lghi %[R_RES],%[RES_IN_FULL]\n\t" \ |
| " j 99f\n\t" \ |
| "91: lghi %[R_RES],%[RES_IN_ILL]\n\t" \ |
| " j 99f\n\t" \ |
| "90: lghi %[R_RES],%[RES_OUT_FULL]\n\t" \ |
| "99: \n\t" \ |
| ".machine pop" \ |
| : /* outputs */ [R_IN] "+a" (inptr) \ |
| , [R_INLEN] "+d" (inlen), [R_OUT] "+a" (outptr) \ |
| , [R_OUTLEN] "+d" (outlen), [R_TMP] "=a" (tmp) \ |
| , [R_TMP2] "=d" (tmp2), [R_TMP3] "=a" (tmp3) \ |
| , [R_RES] "+d" (result) \ |
| : /* inputs */ \ |
| [RES_OUT_FULL] "i" (__GCONV_FULL_OUTPUT) \ |
| , [RES_IN_ILL] "i" (__GCONV_ILLEGAL_INPUT) \ |
| , [RES_IN_FULL] "i" (__GCONV_INCOMPLETE_INPUT) \ |
| : /* clobber list */ "memory", "cc" \ |
| ASM_CLOBBER_VR ("v16") ASM_CLOBBER_VR ("v17") \ |
| ASM_CLOBBER_VR ("v18") ASM_CLOBBER_VR ("v19") \ |
| ASM_CLOBBER_VR ("v30") ASM_CLOBBER_VR ("v31") \ |
| ); \ |
| if (__glibc_likely (inptr == inend) \ |
| || result != __GCONV_ILLEGAL_INPUT) \ |
| break; \ |
| \ |
| STANDARD_TO_LOOP_ERR_HANDLER (4); \ |
| } |
| |
| /* Generate loop-function with hardware vector instructions. */ |
| # define MIN_NEEDED_INPUT MIN_NEEDED_TO |
| # define MIN_NEEDED_OUTPUT MIN_NEEDED_FROM |
| # define MAX_NEEDED_OUTPUT MAX_NEEDED_FROM |
| # define TO_LOOP_VX __to_utf16_loop_vx |
| # define LOOPFCT TO_LOOP_VX |
| # define LOOP_NEED_FLAGS |
| # define BODY BODY_TO_VX |
| # include <iconv/loop.c> |
| #else |
| # define TO_LOOP_VX NULL |
| #endif /* HAVE_TO_VX != 1 */ |
| |
| #if HAVE_TO_VX_CU == 1 |
| #define BODY_TO_VX_CU \ |
| { \ |
| register const unsigned char* pInput asm ("8") = inptr; \ |
| register size_t inlen asm ("9") = inend - inptr; \ |
| register unsigned char* pOutput asm ("10") = outptr; \ |
| register size_t outlen asm ("11") = outend - outptr; \ |
| unsigned long tmp, tmp2, tmp3; \ |
| asm volatile (".machine push\n\t" \ |
| ".machine \"z13\"\n\t" \ |
| ".machinemode \"zarch_nohighgprs\"\n\t" \ |
| /* Setup to check for surrogates. */ \ |
| " larl %[R_TMP],9f\n\t" \ |
| " vlm %%v30,%%v31,0(%[R_TMP])\n\t" \ |
| CONVERT_32BIT_SIZE_T ([R_INLEN]) \ |
| CONVERT_32BIT_SIZE_T ([R_OUTLEN]) \ |
| /* Loop which handles UTF-32 chars \ |
| ch < 0xd800 || (ch > 0xdfff && ch < 0x10000). */ \ |
| "0: clgijl %[R_INLEN],32,20f\n\t" \ |
| " clgijl %[R_OUTLEN],16,20f\n\t" \ |
| "1: vlm %%v16,%%v17,0(%[R_IN])\n\t" \ |
| " lghi %[R_TMP2],0\n\t" \ |
| /* Shorten to UTF-16. */ \ |
| " vpkf %%v18,%%v16,%%v17\n\t" \ |
| /* Check for surrogate chars. */ \ |
| " vstrcfs %%v19,%%v16,%%v30,%%v31\n\t" \ |
| " jno 10f\n\t" \ |
| " vstrcfs %%v19,%%v17,%%v30,%%v31\n\t" \ |
| " jno 11f\n\t" \ |
| /* Store 16 bytes to buf_out. */ \ |
| " vst %%v18,0(%[R_OUT])\n\t" \ |
| " la %[R_IN],32(%[R_IN])\n\t" \ |
| " aghi %[R_INLEN],-32\n\t" \ |
| " aghi %[R_OUTLEN],-16\n\t" \ |
| " la %[R_OUT],16(%[R_OUT])\n\t" \ |
| " clgijl %[R_INLEN],32,20f\n\t" \ |
| " clgijl %[R_OUTLEN],16,20f\n\t" \ |
| " j 1b\n\t" \ |
| /* Setup to check for ch >= 0xd800 && ch <= 0xdfff \ |
| and check for ch >= 0x10000. (v30, v31) */ \ |
| "9: .long 0xd800,0xdfff,0x10000,0x10000\n\t" \ |
| " .long 0xa0000000,0xc0000000, 0xa0000000,0xa0000000\n\t" \ |
| /* At least one UTF32 char is in range of surrogates. \ |
| Store the preceding characters. */ \ |
| "11: ahi %[R_TMP2],16\n\t" \ |
| "10: vlgvb %[R_TMP],%%v19,7\n\t" \ |
| " agr %[R_TMP],%[R_TMP2]\n\t" \ |
| " srlg %[R_TMP3],%[R_TMP],1\n\t" /* Number of out bytes. */ \ |
| " ahik %[R_TMP2],%[R_TMP3],-1\n\t" /* Highest index to store. */ \ |
| " jl 20f\n\t" \ |
| " vstl %%v18,%[R_TMP2],0(%[R_OUT])\n\t" \ |
| /* Update pointers. */ \ |
| " la %[R_IN],0(%[R_TMP],%[R_IN])\n\t" \ |
| " slgr %[R_INLEN],%[R_TMP]\n\t" \ |
| " la %[R_OUT],0(%[R_TMP3],%[R_OUT])\n\t" \ |
| " slgr %[R_OUTLEN],%[R_TMP3]\n\t" \ |
| /* Handles UTF16 surrogates with convert instruction. */ \ |
| "20: cu42 %[R_OUT],%[R_IN]\n\t" \ |
| " jo 0b\n\t" /* Try vector implemenation again. */ \ |
| " lochil %[R_RES],%[RES_OUT_FULL]\n\t" /* cc == 1. */ \ |
| " lochih %[R_RES],%[RES_IN_ILL]\n\t" /* cc == 2. */ \ |
| ".machine pop" \ |
| : /* outputs */ [R_IN] "+a" (pInput) \ |
| , [R_INLEN] "+d" (inlen), [R_OUT] "+a" (pOutput) \ |
| , [R_OUTLEN] "+d" (outlen), [R_TMP] "=a" (tmp) \ |
| , [R_TMP2] "=d" (tmp2), [R_TMP3] "=a" (tmp3) \ |
| , [R_RES] "+d" (result) \ |
| : /* inputs */ \ |
| [RES_OUT_FULL] "i" (__GCONV_FULL_OUTPUT) \ |
| , [RES_IN_ILL] "i" (__GCONV_ILLEGAL_INPUT) \ |
| : /* clobber list */ "memory", "cc" \ |
| ASM_CLOBBER_VR ("v16") ASM_CLOBBER_VR ("v17") \ |
| ASM_CLOBBER_VR ("v18") ASM_CLOBBER_VR ("v19") \ |
| ASM_CLOBBER_VR ("v30") ASM_CLOBBER_VR ("v31") \ |
| ); \ |
| inptr = pInput; \ |
| outptr = pOutput; \ |
| \ |
| if (__glibc_likely (inlen == 0) \ |
| || result == __GCONV_FULL_OUTPUT) \ |
| break; \ |
| if (inlen < 4) \ |
| { \ |
| result = __GCONV_INCOMPLETE_INPUT; \ |
| break; \ |
| } \ |
| \ |
| STANDARD_TO_LOOP_ERR_HANDLER (4); \ |
| } |
| |
| /* Generate loop-function with hardware vector and utf-convert instructions. */ |
| # define MIN_NEEDED_INPUT MIN_NEEDED_TO |
| # define MIN_NEEDED_OUTPUT MIN_NEEDED_FROM |
| # define MAX_NEEDED_OUTPUT MAX_NEEDED_FROM |
| # define TO_LOOP_VX_CU __to_utf16_loop_vx_cu |
| # define LOOPFCT TO_LOOP_VX_CU |
| # define LOOP_NEED_FLAGS |
| # define BODY BODY_TO_VX_CU |
| # include <iconv/loop.c> |
| #else |
| # define TO_LOOP_VX_CU NULL |
| #endif /* HAVE_TO_VX_CU != 1 */ |
| |
| /* This file also exists in sysdeps/s390/multiarch/ which |
| generates ifunc resolvers for FROM/TO_LOOP functions |
| and includes iconv/skeleton.c afterwards. */ |
| #if ! defined USE_MULTIARCH |
| # include <iconv/skeleton.c> |
| #endif |
