MultiMedia/cdxlplay/p2c/p2c_2.c

   1 /*
   2 **  Planar 2 Chunky routine (C) 2009 Fredrik Wikstrom
   3 **/
   4
   5 static void p2c_2 (const uint16_t *planar, uint32_t plane_size, uint8_t *chunky,
   6         uint32_t width, uint32_t height)
   7 {
   8         uint32_t *cp;
   9         const uint16_t *pp1, *pp2;
  10         uint32_t cd1, cd2, cd3, cd4;
  11         uint32_t pd1, pd2;
  12         uint32_t x, y;
  13         cp = (uint32_t *)chunky;
  14         pp1 = planar;
  15         pp2 = (const uint16_t *)((const uint8_t *)pp1 + plane_size);
  16         for (y = 0; y < height; y++) {
  17                 for (x = 0; x < width; x++) {
  18                         pd1 = *pp1++;
  19                         pd2 = *pp2++;
  20
  21 #ifdef WORDS_BIGENDIAN
  22                         cd1  = ((pd1 << 9 ) & 0x01000000)|((pd2 << 10) & 0x02000000);
  23
  24                         cd2  = ((pd1 << 13) & 0x01000000)|((pd2 << 14) & 0x02000000);
  25
  26                         cd3  = ((pd1 << 17) & 0x01000000)|((pd2 << 18) & 0x02000000);
  27
  28                         cd4  = ((pd1 << 21) & 0x01000000)|((pd2 << 22) & 0x02000000);
  29
  30                         cd1 |= ((pd1 << 2 ) & 0x00010000)|((pd2 << 3 ) & 0x00020000);
  31
  32                         cd2 |= ((pd1 << 6 ) & 0x00010000)|((pd2 << 7 ) & 0x00020000);
  33
  34                         cd3 |= ((pd1 << 10) & 0x00010000)|((pd2 << 11) & 0x00020000);
  35
  36                         cd4 |= ((pd1 << 14) & 0x00010000)|((pd2 << 15) & 0x00020000);
  37
  38                         cd1 |= ((pd1 >> 5 ) & 0x00000100)|((pd2 >> 4 ) & 0x00000200);
  39
  40                         cd2 |= ((pd1 >> 1 ) & 0x00000100)|((pd2      ) & 0x00000200);
  41
  42                         cd3 |= ((pd1 << 3 ) & 0x00000100)|((pd2 << 4 ) & 0x00000200);
  43
  44                         cd4 |= ((pd1 << 7 ) & 0x00000100)|((pd2 << 8 ) & 0x00000200);
  45
  46                         cd1 |= ((pd1 >> 12) & 0x00000001)|((pd2 >> 11) & 0x00000002);
  47
  48                         cd2 |= ((pd1 >> 8 ) & 0x00000001)|((pd2 >> 7 ) & 0x00000002);
  49
  50                         cd3 |= ((pd1 >> 4 ) & 0x00000001)|((pd2 >> 3 ) & 0x00000002);
  51
  52                         cd4 |= ((pd1      ) & 0x00000001)|((pd2 << 1 ) & 0x00000002);
  53 #else
  54                         cd1  = ((pd1 >> 7 ) & 0x00000001)|((pd2 >> 6 ) & 0x00000002);
  55
  56                         cd2  = ((pd1 >> 3 ) & 0x00000001)|((pd2 >> 2 ) & 0x00000002);
  57
  58                         cd3  = ((pd1 >> 15) & 0x00000001)|((pd2 >> 14) & 0x00000002);
  59
  60                         cd4  = ((pd1 >> 11) & 0x00000001)|((pd2 >> 10) & 0x00000002);
  61
  62                         cd1 |= ((pd1 << 2 ) & 0x00000100)|((pd2 << 3 ) & 0x00000200);
  63
  64                         cd2 |= ((pd1 << 6 ) & 0x00000100)|((pd2 << 7 ) & 0x00000200);
  65
  66                         cd3 |= ((pd1 >> 6 ) & 0x00000100)|((pd2 >> 5 ) & 0x00000200);
  67
  68                         cd4 |= ((pd1 >> 2 ) & 0x00000100)|((pd2 >> 1 ) & 0x00000200);
  69
  70                         cd1 |= ((pd1 << 11) & 0x00010000)|((pd2 << 12) & 0x00020000);
  71
  72                         cd2 |= ((pd1 << 15) & 0x00010000)|((pd2 << 16) & 0x00020000);
  73
  74                         cd3 |= ((pd1 << 3 ) & 0x00010000)|((pd2 << 4 ) & 0x00020000);
  75
  76                         cd4 |= ((pd1 << 7 ) & 0x00010000)|((pd2 << 8 ) & 0x00020000);
  77
  78                         cd1 |= ((pd1 << 20) & 0x01000000)|((pd2 << 21) & 0x02000000);
  79
  80                         cd2 |= ((pd1 << 24) & 0x01000000)|((pd2 << 25) & 0x02000000);
  81
  82                         cd3 |= ((pd1 << 12) & 0x01000000)|((pd2 << 13) & 0x02000000);
  83
  84                         cd4 |= ((pd1 << 16) & 0x01000000)|((pd2 << 17) & 0x02000000);
  85 #endif
  86
  87                         *cp++ = cd1;
  88                         *cp++ = cd2;
  89                         *cp++ = cd3;
  90                         *cp++ = cd4;
  91                 }
  92         }
  93 }