| /* |
| * Blackfin Pixel Operations |
| * Copyright (C) 2007 Marc Hoffman <marc.hoffman@analog.com> |
| * |
| * This file is part of FFmpeg. |
| * |
| * FFmpeg 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. |
| * |
| * FFmpeg 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 FFmpeg; if not, write to the Free Software |
| * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
| */ |
| #include "config_bfin.h" |
| |
| DEFUN(put_pixels_clamped,mL1, |
| (int16_t *block, uint8_t *dest, int line_size)): |
| [--SP] = (R7:4); |
| R4 = 0; |
| R5.l = 0x00ff; |
| R5.h = 0x00ff; |
| I0 = R0; // block |
| I1 = R1; // dest |
| R2 += -4; // line_size |
| M1 = R2; |
| P0 = 8; |
| R0 = [I0++]; |
| R1 = [I0++]; |
| R2 = MAX(R0, R4) (V); |
| LSETUP (ppc$0,ppc$1) LC0=P0; |
| ppc$0: R2 = MIN(R2, R5) (V); |
| R3 = MAX(R1, R4) (V); |
| R3 = MIN(R3, R5) (V) || R0 = [I0++]; |
| R6 = BYTEPACK (R2,R3) || R1 = [I0++]; |
| R2 = MAX(R0, R4) (V) || [I1++] = R6; |
| R2 = MIN(R2, R5) (V); |
| R3 = MAX(R1, R4) (V); |
| R3 = MIN(R3, R5) (V) || R0 = [I0++]; |
| R6 = BYTEPACK (R2,R3) || R1 = [I0++]; |
| ppc$1: R2 = Max(R0, R4) (V) || [I1++M1] = R6; |
| |
| (R7:4) = [SP++]; |
| RTS; |
| DEFUN_END(put_pixels_clamped) |
| |
| DEFUN(add_pixels_clamped,mL1, |
| (int16_t *block, uint8_t *dest, int line_size)): |
| [-- SP] = (R7:4); |
| R4 = 0; |
| I0 = 0; |
| R2 += -4; // line_size |
| M0 = R2; |
| I1 = R1; // dest |
| I3 = R0; // block |
| I2 = R1; // dest |
| P0 = 8; |
| M3 = 2; |
| R0 = [I3++] || R2 = [I1]; |
| R2 = R2 << 8 || R0.H = W[I3--] || R3 = [I1++]; |
| R3 = R3 >> 8 || R1.L = W[I3] || I3 += 4; |
| R6 = BYTEOP3P(R1:0, R3:2) (LO) || R1.H = W[I3++] || R2 = [I1]; |
| |
| LSETUP(apc$2,apc$3) LC1 = P0; |
| apc$2: R7 = BYTEOP3P(R1:0, R3:2) (HI, R) || R0 = [I3++] || R3 = [I1++M0]; |
| R2 = R2 << 8 || R0.H = W[I3--]; |
| R3 = R3 >> 8 || R1.L = W[I3] || I3 += 4; |
| R6 = R6 + R7 (S) || R1.H = W[I3]; |
| R6 = BYTEOP3P(R1:0, R3:2) (LO) || I3+=M3 || [I2++]=R6; |
| R7 = BYTEOP3P(R1:0, R3:2) (HI, R) || R0 = [I3++] || R2 = [I1]; |
| R2 = R2 << 8 || R0.H = W[I3--] || R3 = [I1++]; |
| R3 = R3 >> 8 || R1.L = W[I3] || I3 += 4; |
| R6 = R6 + R7 (S) || R1.H = W[I3++]; |
| apc$3: R6 = BYTEOP3P(R1:0, R3:2) (LO) || [I2++M0] = R6 || R2 = [I1]; |
| |
| (R7:4) = [SP++]; |
| RTS; |
| DEFUN_END(add_pixels_clamped) |
| |
| DEFUN(diff_pixels,mL1, |
| (int16_t *block, uint8_t *s1, uint8_t *s2, int stride)): |
| link 0; |
| [--sp] = (r7:4); |
| p0=8; |
| i3=r0; // block |
| i0=r1; // s1 |
| i1=r2; // s2 |
| r2=[fp+20]; // stride |
| r2+=-8; |
| m0=r2; |
| |
| |
| LSETUP(.LS0,.LE0) LC0=P0; |
| DISALGNEXCPT || R0 = [I0++] || R2 =[I1++]; |
| |
| .LS0: DISALGNEXCPT || R1 = [I0++] || R3 = [I1++]; |
| (R5,R4) = BYTEOP16M (R1:0,R3:2) || R0 = [I0++M0] || R2 = [I1++M0]; |
| (R7,R6) = BYTEOP16M (R1:0,R3:2) (R)|| R0 = [I0++] || [I3++] = R4; |
| DISALGNEXCPT || R2 = [I1++] || [I3++] = R5; |
| [i3++]=r6; |
| .LE0: [i3++]=r7; |
| |
| (r7:4) = [sp++]; |
| unlink; |
| rts; |
| DEFUN_END(diff_pixels) |
| |
| /* |
| for (i = 0; i < 16; i++) { |
| for (j = 0; j < 16; j++) { |
| sum += pix[j]; |
| } |
| pix += line_size; |
| } |
| */ |
| DEFUN(pix_sum,mL1, |
| (uint8_t *p, int stride)): |
| link 0; |
| [--sp] = (r7:4); |
| p0=8; |
| i0=r0; // s1 |
| i1=r0; |
| m1=r1; |
| r1=r1+r1; |
| r1+=-16; // stride |
| m0=r1; |
| i1+=m1; |
| |
| r6=0; |
| |
| LSETUP(LS$PS,LE$PS) LC0=P0; |
| DISALGNEXCPT || R0 = [I0++] || R2 =[I1++]; |
| |
| LS$PS: DISALGNEXCPT || R1 = [I0++] || R3 = [I1++]; |
| (R5,R4) = BYTEOP16P (R3:2,R1:0) || R0 = [I0++] || R2 = [I1++]; |
| r6=r6+|+r5; |
| r6=r6+|+r4; |
| (R5,R4) = BYTEOP16P (R3:2,R1:0) (R)|| R1 = [I0++] || R3 = [I1++]; |
| r6=r6+|+r5; |
| r6=r6+|+r4; |
| (R5,R4) = BYTEOP16P (R3:2,R1:0) || R0 = [I0++m0] || R2 = [I1++m0]; |
| r6=r6+|+r5; |
| r6=r6+|+r4; |
| (R5,R4) = BYTEOP16P (R3:2,R1:0) (R)|| R0 = [I0++] || R2 = [I1++]; |
| r6=r6+|+r5; |
| LE$PS: r6=r6+|+r4; |
| r0.l=r6.l+r6.h; |
| r0.h=0; |
| |
| (r7:4) = [sp++]; |
| unlink; |
| rts; |
| DEFUN_END(pix_sum) |
| |
| |
| DEFUN(get_pixels,mL1, |
| (int16_t *av_restrict block, const uint8_t *pixels, int line_size)): |
| [--sp] = (r7:4); |
| i3=r0; // dest |
| i0=r1; // src0 |
| p0=8; |
| r2+=-8; |
| m0=r2; |
| LSETUP(gp8$0,gp8$1) LC0=P0; |
| |
| DISALGNEXCPT || R0 = [I0++]; |
| DISALGNEXCPT || R1 = [I0++]; |
| |
| gp8$0: (R7,R6) = byteunpack R1:0 || R0 = [I0++M0]; |
| (R5,R4) = byteunpack R1:0 (R) || R0 = [I0++] || [I3++]=R6; |
| DISALGNEXCPT || R1 = [I0++] || [I3++]=R7; |
| [I3++]=R4; |
| gp8$1: [I3++]=R5 |
| |
| |
| (r7:4) = [sp++]; |
| RTS; |
| DEFUN_END(get_pixels) |
| |
| |
| /* sad = sad16x16 (ubyte *mb, ubyte *refwin, srcwidth, refwinwidth, h) */ |
| /* 91 cycles */ |
| DEFUN(z_sad16x16,mL1, |
| (uint8_t *blk1, uint8_t *blk2, int dsz, int line_size, int h)): |
| link 0; |
| I0 = R0; |
| I1 = R1; |
| |
| A1 = A0 = 0; |
| R0 = [sp+20]; // rwidth |
| P2 = [sp+24]; // height |
| R3 = 16; |
| R0 = R0 - R3; |
| R3 = R2 - R3; |
| M1 = R0; |
| M0 = R3; |
| |
| DISALGNEXCPT || R0 = [I0++] || R2 = [I1++]; |
| LSETUP (s$16, e$16) LC0=P2; |
| s$16: DISALGNEXCPT || R1 = [I0++] || R3 = [I1++]; |
| SAA (R1:0,R3:2) || R0 = [I0++] || R2 = [I1++]; |
| SAA (R1:0,R3:2) (R) || R1 = [I0++] || R3 = [I1++]; |
| SAA (R1:0,R3:2) || R0 = [I0++M0] || R2 = [I1++M1]; |
| e$16: SAA (R1:0,R3:2) (R) || R0 = [I0++] || R2 = [I1++]; |
| |
| R3=A1.L+A1.H, R2=A0.L+A0.H ; |
| R0 = R2 + R3 ; |
| unlink; |
| RTS; |
| DEFUN_END(z_sad16x16) |
| |
| /* sad = sad8x8 (ubyte *mb, ubyte *refwin, int srcwidth, int refwinwidth, int h) */ |
| /* 36 cycles */ |
| DEFUN(z_sad8x8,mL1, |
| (uint8_t *blk1, uint8_t *blk2, int dsz, int line_size, int h)): |
| I0 = R0; |
| I1 = R1; |
| |
| A1 = A0 = 0; |
| r0 = [sp+12]; // rwidth |
| P2 = [sp+16]; //height |
| R3 = 8; |
| R0 = R0 - R3; |
| R3 = R2 - R3; |
| M0 = R3; |
| M1 = R0; |
| |
| LSETUP (s$8, e$8) LC0=P2; |
| DISALGNEXCPT || R0 = [I0++] || R2 = [I1++]; |
| DISALGNEXCPT || R1 = [I0++] || R3 = [I1++]; |
| s$8: SAA (R1:0,R3:2) || R0 = [I0++M0] || R2 = [I1++M1]; |
| SAA (R1:0,R3:2) (R) || R0 = [I0++] || R2 = [I1++]; |
| e$8: DISALGNEXCPT || R1 = [I0++] || R3 = [I1++]; |
| |
| R3=A1.L+A1.H, R2=A0.L+A0.H ; |
| R0 = R2 + R3 ; |
| RTS; |
| DEFUN_END(z_sad8x8) |
| |
| DEFUN(pix_norm1,mL1, |
| (uint8_t * pix, int line_size)): |
| [--SP]=(R7:4,P5:3); |
| |
| // Fetch the input arguments. |
| P1 = R0; // pix |
| P0 = R1; // line_size |
| P5 = 16; // loop ctr. |
| P0 -= P5; |
| M0 = P0; // M0 = line_size-16; |
| // Now for the real work. |
| A1 = A0 = 0; |
| lsetup(_pix_norm1_blkfn_loopStart, _pix_norm1_blkfn_loopEnd) LC1 = P5; |
| I0 = P1; |
| DISALGNEXCPT || r0 = [i0++]; |
| |
| _pix_norm1_blkfn_loopStart: |
| // following unpacks pix1[0..15] pix1+line_size[0..15] |
| DISALGNEXCPT || r1 = [i0++]; |
| |
| (r5, r4) = byteunpack r1:0 || r0 = [i0++]; |
| a1 += r5.h * r5.h, a0 += r5.l * r5.l (is); |
| a1 += r4.h * r4.h, a0 += r4.l * r4.l (is); |
| (r5, r4) = byteunpack r1:0(r) || r1 = [i0++]; |
| a1 += r5.h * r5.h, a0 += r5.l * r5.l (is); |
| a1 += r4.h * r4.h, a0 += r4.l * r4.l (is); |
| (r5, r4) = byteunpack r1:0 || r0 = [i0++M0]; |
| a1 += r5.h * r5.h, a0 += r5.l * r5.l (is); |
| a1 += r4.h * r4.h, a0 += r4.l * r4.l (is); |
| (r5, r4) = byteunpack r1:0(r) || r0 = [i0++]; |
| a1 += r5.h * r5.h, a0 += r5.l * r5.l (is); |
| _pix_norm1_blkfn_loopEnd: |
| a1 += r4.h * r4.h, a0 += r4.l * r4.l (is); |
| |
| |
| // Clean up at the end: |
| R2 = A0, R3 = A1; |
| R0 = R2 + R3 (S); |
| |
| (R7:4,P5:3)=[SP++]; |
| |
| RTS; |
| DEFUN_END(pix_norm1) |
| |
| DEFUN(sse4,mL1, |
| (void *v, uint8_t *pix1, uint8_t *pix2, int line_size, int h)): |
| link 0; |
| [--sp] = (r7:6); |
| p0=[fp+24]; // h |
| i0=r1; // pix1 |
| i1=r2; // pix2 |
| r2=[fp+20]; // line_size |
| r2+=-4; |
| m0=r2; |
| |
| a0=a1=0; |
| LSETUP(.S40,.E40) LC0=P0; |
| DISALGNEXCPT || R0 = [I0++] || R2 =[I1++]; |
| |
| .S40: DISALGNEXCPT || R1 = [I0++M0] || R3 = [I1++M0]; |
| (R7,R6) = BYTEOP16M (R1:0,R3:2); |
| a0 += r7.l * r7.l, a1 += r7.h * r7.h (is); |
| .E40: a0 += r6.l * r6.l, a1 += r6.h * r6.h (is); |
| a0 += a1; |
| r0 = a0; |
| |
| (r7:6) = [sp++]; |
| unlink; |
| rts; |
| DEFUN_END(sse4) |
| |
| DEFUN(sse8,mL1, |
| (void *v, uint8_t *pix1, uint8_t *pix2, int line_size, int h)): |
| link 0; |
| [--sp] = (r7:6); |
| p0=[fp+24]; // h |
| i0=r1; // pix1 |
| i1=r2; // pix2 |
| r2=[fp+20]; // line_size |
| r2+=-8; |
| m0=r2; |
| |
| a0=a1=0; |
| LSETUP(.S80,.E80) LC0=P0; |
| DISALGNEXCPT || R0 = [I0++] || R2 =[I1++]; |
| |
| .S80: DISALGNEXCPT || R1 = [I0++] || R3 = [I1++]; |
| (R7,R6) = BYTEOP16M (R1:0,R3:2) || R0 = [I0++M0] || R2 = [I1++M0]; |
| a0 += r7.l * r7.l, a1 += r7.h * r7.h (is); |
| a0 += r6.l * r6.l, a1 += r6.h * r6.h (is); |
| (R7,R6) = BYTEOP16M (R1:0,R3:2) (R)|| R0 = [I0++] || R2 = [I1++]; |
| a0 += r7.l * r7.l, a1 += r7.h * r7.h (is); |
| .E80: a0 += r6.l * r6.l, a1 += r6.h * r6.h (is); |
| a0 += a1; |
| r0 = a0; |
| |
| (r7:6) = [sp++]; |
| unlink; |
| rts; |
| DEFUN_END(sse8) |
| |
| DEFUN(sse16,mL1, |
| (void *v, uint8_t *pix1, uint8_t *pix2, int line_size, int h)): |
| link 0; |
| [--sp] = (r7:6); |
| p0=[fp+24]; // h |
| i0=r1; // pix1 |
| i1=r2; // pix2 |
| r2=[fp+20]; // line_size |
| r2+=-16; |
| m0=r2; |
| |
| a0=a1=0; |
| DISALGNEXCPT || R0 = [I0++] || R2 =[I1++]; |
| LSETUP(.S160,.E160) LC0=P0; |
| |
| .S160: DISALGNEXCPT || R1 = [I0++] || R3 = [I1++]; |
| (R7,R6) = BYTEOP16M (R1:0,R3:2) || R0 = [I0++] || R2 = [I1++]; |
| a0 += r7.l * r7.l, a1 += r7.h * r7.h (is); |
| a0 += r6.l * r6.l, a1 += r6.h * r6.h (is); |
| (R7,R6) = BYTEOP16M (R1:0,R3:2) (R)|| R1 = [I0++] || R3 = [I1++]; |
| a0 += r7.l * r7.l, a1 += r7.h * r7.h (is); |
| a0 += r6.l * r6.l, a1 += r6.h * r6.h (is); |
| (R7,R6) = BYTEOP16M (R1:0,R3:2) || R0 = [I0++M0] || R2 = [I1++M0]; |
| a0 += r7.l * r7.l, a1 += r7.h * r7.h (is); |
| a0 += r6.l * r6.l, a1 += r6.h * r6.h (is); |
| (R7,R6) = BYTEOP16M (R1:0,R3:2) (R)|| R0 = [I0++] || R2 = [I1++]; |
| a0 += r7.l * r7.l, a1 += r7.h * r7.h (is); |
| .E160: a0 += r6.l * r6.l, a1 += r6.h * r6.h (is); |
| a0 += a1; |
| r0 = a0; |
| |
| (r7:6) = [sp++]; |
| unlink; |
| rts; |
| DEFUN_END(sse16) |