firmware/target/sh/bitswap.S

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2004 by Jens Arnold
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License
  14  * as published by the Free Software Foundation; either version 2
  15  * of the License, or (at your option) any later version.
  16  *
  17  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  18  * KIND, either express or implied.
  19  *
  20  ****************************************************************************/
  21
  22     .section    .icode,"ax",@progbits
  23     .align      2
  24     .global     _bitswap
  25     .type       _bitswap,@function
  26
  27 /* Flips the bits of all bytes in a memory area (required for mp3 data on
  28  * the Archos). This version is optimized for speed and size.
  29  *
  30  * arguments:
  31  *  r4 - start address
  32  *  r5 - length
  33  *
  34  * return value: void
  35  *
  36  * register usage:
  37  *  r0 - temporary
  38  *  r1 - bit mask for rounding to long bound / low byte (after swap)
  39  *  r2 - high byte (after swap) / combined result
  40  *  r4 - data address - 4
  41  *  r5 - end address - 4
  42  *  r7 - flip table (addressing with signed offset)
  43  *
  44  * The instruction order below is devised in a way to utilize the pipelining
  45  * of the SH1 to the max.
  46  */
  47
  48 _bitswap:
  49     mova    _fliptable,r0
  50     mov     r0,r7
  51     add     #-4,r4          /* address is shifted by 4 */
  52     add     r4,r5           /* r5 = end_address - 4 */
  53     cmp/hi  r4,r5           /* at least something to do? */
  54     bf      .exit           /* no, get out of here! */
  55
  56     add     #-3,r5          /* end offset for flipping 4 bytes per pass */
  57     mov     r4,r0
  58     tst     #1,r0           /* even address? */
  59     bt      .start2_w       /* yes, jump into main loop */
  60
  61     /* no, flip first byte */
  62     mov.b   @(4,r4),r0      /* load byte, sign extension! */
  63     add     #1,r4           /* early increment */
  64     mov.b   @(r0,r7),r0     /* fliptable offset is signed */
  65     bra     .start2_w       /* jump into main loop */
  66     mov.b   r0,@(3,r4)      /* store byte */
  67
  68     /* main loop: flips 2 words per pass */
  69     .align  2
  70 .loop2_w:
  71     mov.w   @(6,r4),r0      /* load second word */
  72     add     #4,r4           /* early increment */
  73     swap.b  r0,r2           /* get high byte (2nd word) */
  74     exts.b  r0,r0           /* prepare low byte (2nd word) */
  75     mov.b   @(r0,r7),r1     /* swap low byte (2nd word) */
  76     exts.b  r2,r0           /* prepare high byte (2nd word) */
  77     mov.b   @(r0,r7),r2     /* swap high byte (2nd word) */
  78     extu.b  r1,r0           /* zero extend low byte (2nd word) */
  79     mov.w   @r4,r1          /* load first word */
  80     shll8   r2              /* shift high byte (2nd word), low byte zeroed */
  81     or      r2,r0           /* put low byte (2nd word) in result */
  82     swap.b  r1,r2           /* get high byte (1st word) */
  83     mov.w   r0,@(2,r4)      /* store result (2nd word) */
  84     exts.b  r1,r0           /* prepare low byte (1st word) */
  85     mov.b   @(r0,r7),r1     /* swap low byte (1st word) */
  86     exts.b  r2,r0           /* prepare high byte (1st word) */
  87     mov.b   @(r0,r7),r2     /* swap high byte (1st word) */
  88     extu.b  r1,r0           /* zero extend low byte (1st word) */
  89     shll8   r2              /* shift high byte (1st word), low byte zeroed */
  90     or      r2,r0           /* put low byte (1st word) in result */
  91     mov.w   r0,@r4          /* store result (1st word) */
  92 .start2_w:
  93     cmp/hi  r4,r5           /* runs r4 up to last long bound */
  94     bt      .loop2_w
  95
  96     bra     .start_b2       /* jump into trailing byte loop */
  97     add     #3,r5           /* reset end offset */
  98
  99     /* trailing byte loop: flips 0..3 bytes */
 100 .loop_b2:
 101     mov.b   @(4,r4),r0      /* loand byte, sign extension! */
 102     add     #1,r4           /* early increment */
 103     mov.b   @(r0,r7),r0     /* fliptable offset is signed */
 104     mov.b   r0,@(3,r4)      /* store byte */
 105 .start_b2:
 106     cmp/hi  r4,r5           /* runs r4 up to end address */
 107     bt      .loop_b2
 108
 109 .exit:
 110     rts
 111     nop
 112
 113     .align  2
 114     .global _fliptable
 115
 116     .byte   0x01, 0x81, 0x41, 0xc1, 0x21, 0xa1, 0x61, 0xe1
 117     .byte   0x11, 0x91, 0x51, 0xd1, 0x31, 0xb1, 0x71, 0xf1
 118     .byte   0x09, 0x89, 0x49, 0xc9, 0x29, 0xa9, 0x69, 0xe9
 119     .byte   0x19, 0x99, 0x59, 0xd9, 0x39, 0xb9, 0x79, 0xf9
 120     .byte   0x05, 0x85, 0x45, 0xc5, 0x25, 0xa5, 0x65, 0xe5
 121     .byte   0x15, 0x95, 0x55, 0xd5, 0x35, 0xb5, 0x75, 0xf5
 122     .byte   0x0d, 0x8d, 0x4d, 0xcd, 0x2d, 0xad, 0x6d, 0xed
 123     .byte   0x1d, 0x9d, 0x5d, 0xdd, 0x3d, 0xbd, 0x7d, 0xfd
 124     .byte   0x03, 0x83, 0x43, 0xc3, 0x23, 0xa3, 0x63, 0xe3
 125     .byte   0x13, 0x93, 0x53, 0xd3, 0x33, 0xb3, 0x73, 0xf3
 126     .byte   0x0b, 0x8b, 0x4b, 0xcb, 0x2b, 0xab, 0x6b, 0xeb
 127     .byte   0x1b, 0x9b, 0x5b, 0xdb, 0x3b, 0xbb, 0x7b, 0xfb
 128     .byte   0x07, 0x87, 0x47, 0xc7, 0x27, 0xa7, 0x67, 0xe7
 129     .byte   0x17, 0x97, 0x57, 0xd7, 0x37, 0xb7, 0x77, 0xf7
 130     .byte   0x0f, 0x8f, 0x4f, 0xcf, 0x2f, 0xaf, 0x6f, 0xef
 131     .byte   0x1f, 0x9f, 0x5f, 0xdf, 0x3f, 0xbf, 0x7f, 0xff
 132 _fliptable:
 133     .byte   0x00, 0x80, 0x40, 0xc0, 0x20, 0xa0, 0x60, 0xe0
 134     .byte   0x10, 0x90, 0x50, 0xd0, 0x30, 0xb0, 0x70, 0xf0
 135     .byte   0x08, 0x88, 0x48, 0xc8, 0x28, 0xa8, 0x68, 0xe8
 136     .byte   0x18, 0x98, 0x58, 0xd8, 0x38, 0xb8, 0x78, 0xf8
 137     .byte   0x04, 0x84, 0x44, 0xc4, 0x24, 0xa4, 0x64, 0xe4
 138     .byte   0x14, 0x94, 0x54, 0xd4, 0x34, 0xb4, 0x74, 0xf4
 139     .byte   0x0c, 0x8c, 0x4c, 0xcc, 0x2c, 0xac, 0x6c, 0xec
 140     .byte   0x1c, 0x9c, 0x5c, 0xdc, 0x3c, 0xbc, 0x7c, 0xfc
 141     .byte   0x02, 0x82, 0x42, 0xc2, 0x22, 0xa2, 0x62, 0xe2
 142     .byte   0x12, 0x92, 0x52, 0xd2, 0x32, 0xb2, 0x72, 0xf2
 143     .byte   0x0a, 0x8a, 0x4a, 0xca, 0x2a, 0xaa, 0x6a, 0xea
 144     .byte   0x1a, 0x9a, 0x5a, 0xda, 0x3a, 0xba, 0x7a, 0xfa
 145     .byte   0x06, 0x86, 0x46, 0xc6, 0x26, 0xa6, 0x66, 0xe6
 146     .byte   0x16, 0x96, 0x56, 0xd6, 0x36, 0xb6, 0x76, 0xf6
 147     .byte   0x0e, 0x8e, 0x4e, 0xce, 0x2e, 0xae, 0x6e, 0xee
 148     .byte   0x1e, 0x9e, 0x5e, 0xde, 0x3e, 0xbe, 0x7e, 0xfe
 149
 150
 151 .end:
 152     .size   _bitswap,.end-_bitswap