platform/psp/asm_utils.s

   1 # vim:filetype=mips
   2
   3 # some asm utils
   4 # (c) Copyright 2007, Grazvydas "notaz" Ignotas
   5 # All Rights Reserved
   6
   7 .set noreorder
   8 .set noat
   9
  10 .data
  11 .align 4
  12
  13 .byte  0,  1,  6, 11, 16, 21, 26, 31 # -4
  14 .byte  0,  2,  7, 12, 16, 21, 26, 31 # -3
  15 .byte  0,  3,  7, 12, 17, 22, 26, 31 # -2
  16 .byte  0,  4,  8, 13, 17, 22, 26, 31 # -1
  17 pal_gmtab:
  18 .byte  0,  5, 10, 15, 16, 21, 26, 31 #  0
  19 .byte  0,  6, 10, 15, 19, 23, 27, 31
  20 .byte  0,  7, 11, 15, 19, 23, 27, 31
  21 .byte  0,  8, 12, 16, 19, 23, 27, 31
  22 .byte  0,  9, 12, 16, 20, 24, 27, 31
  23 .byte  0, 10, 13, 17, 20, 24, 27, 31
  24 .byte  0, 10, 14, 17, 21, 24, 28, 31
  25 .byte  0, 11, 15, 18, 21, 24, 28, 31
  26 .byte  0, 12, 15, 18, 22, 25, 28, 31
  27 .byte  0, 13, 16, 19, 22, 25, 28, 31
  28 .byte  0, 14, 17, 20, 22, 25, 28, 31 # 10
  29 .byte  0, 15, 17, 20, 23, 26, 28, 31
  30 .byte  0, 16, 18, 21, 23, 26, 28, 31
  31 .byte  0, 16, 19, 21, 24, 26, 29, 31
  32 .byte  0, 17, 20, 22, 24, 26, 29, 31
  33 .byte  0, 18, 20, 22, 25, 27, 29, 31
  34 .byte  0, 19, 21, 23, 25, 27, 29, 31 # 16
  35
  36 .text
  37 .align 4
  38
  39 # bbbb bggg gggr rrrr
  40
  41 #.global pal_gmtab
  42 .global do_pal_convert # dest, src, gammaa_val, black_lvl
  43
  44 do_pal_convert:
  45     bnez    $a2, dpc_gma
  46     li      $t0, 64/2
  47     bnez    $a3, dpc_gma
  48     lui     $t2, 0x00e
  49     ori     $t2, 0x00e
  50     lui     $t3, 0x006
  51     ori     $t3, 0x006
  52     lui     $t4, 0x0e0
  53     ori     $t4, 0x0e0
  54     lui     $t6, 0xe00
  55     ori     $t6, 0xe00
  56     lui     $t7, 0x600
  57     ori     $t7, 0x600
  58
  59 dpc_loop:
  60     lw      $v0, 0($a1)
  61     addiu   $a1, 4
  62     and     $v1, $v0, $t2   # r
  63     sll     $v1, 1
  64     and     $t9, $v0, $t3
  65     srl     $t9, 1
  66     or      $v1, $t9        # r
  67     and     $t9, $v0, $t4   # g
  68     sll     $t8, $t9, 3
  69     or      $v1, $t8
  70     or      $v1, $t9        # g
  71     and     $t9, $v0, $t6   # b
  72     sll     $t9, 4
  73     or      $v1, $t9
  74     and     $t9, $v0, $t7
  75     sll     $t9, 2
  76     or      $v1, $t9        # b
  77     sw      $v1, 0($a0)
  78     addiu   $t0, -1
  79     bnez    $t0, dpc_loop
  80     addiu   $a0, 4
  81
  82     jr      $ra
  83     nop
  84
  85 # non-zero gamma
  86 dpc_gma:
  87     slt     $t2, $a2, $0
  88     sll     $a2, 3
  89     lui     $t1, %hi(pal_gmtab)
  90     addiu   $t1, %lo(pal_gmtab)
  91     addu    $a2, $t1
  92     beqz    $a3, dpc_gma_loop
  93     sb      $0,  0($a2)        # black level 0
  94     bnez    $t2, dpc_gma_loop  # gamma < 0, keep black at 0
  95     addiu   $a3, -2
  96     slt     $t2, $a3, $0       # t2 = a3_orig == 1 ? 1 : 0
  97     lb      $t1, 1($a2)
  98     addiu   $t1, -2
  99     srlv    $t1, $t1, $t2
 100     sb      $t1, 0($a2)
 101
 102 dpc_gma_loop:
 103     lw      $v0, 0($a1)
 104     addiu   $a1, 4
 105     ext     $v1, $v0, 1, 3
 106     addu    $v1, $a2
 107     lb      $v1, 0($v1)
 108     ext     $t1, $v0, 5, 3
 109     addu    $t1, $a2
 110     lb      $t1, 0($t1)
 111     ext     $t2, $v0, 9, 3
 112     addu    $t2, $a2
 113     lb      $t2, 0($t2)
 114     ext     $t3, $v0, 17, 3
 115     addu    $t3, $a2
 116     lb      $t3, 0($t3)
 117     ext     $t4, $v0, 21, 3
 118     addu    $t4, $a2
 119     lb      $t4, 0($t4)
 120     ext     $t5, $v0, 25, 3
 121     addu    $t5, $a2
 122     lb      $t5, 0($t5)
 123     ins     $v1, $t1,  6, 5
 124     ins     $v1, $t2, 11, 5
 125     ins     $v1, $t3, 16, 5
 126     ins     $v1, $t4, 22, 5
 127     ins     $v1, $t5, 27, 5
 128     sw      $v1, 0($a0)
 129     addiu   $t0, -1
 130     bnez    $t0, dpc_gma_loop
 131     addiu   $a0, 4
 132
 133     jr      $ra
 134     nop
 135