rsCpuIntrinsic3DLUT.cpp revision 7c4d899920c9aecb5e64da2f667a4a24496bbbe5 
1/*
2 * Copyright (C) 2012 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 *      http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
17
18#include "rsCpuIntrinsic.h"
19#include "rsCpuIntrinsicInlines.h"
20
21using namespace android;
22using namespace android::renderscript;
23
24namespace android {
25namespace renderscript {
26
27
28class RsdCpuScriptIntrinsic3DLUT : public RsdCpuScriptIntrinsic {
29public:
30    virtual void populateScript(Script *);
31    virtual void invokeFreeChildren();
32
33    virtual void setGlobalObj(uint32_t slot, ObjectBase *data);
34
35    virtual ~RsdCpuScriptIntrinsic3DLUT();
36    RsdCpuScriptIntrinsic3DLUT(RsdCpuReferenceImpl *ctx, const Script *s, const Element *e);
37
38protected:
39    ObjectBaseRef<Allocation> mLUT;
40
41    static void kernel(const RsForEachStubParamStruct *p,
42                       uint32_t xstart, uint32_t xend,
43                       uint32_t instep, uint32_t outstep);
44};
45
46}
47}
48
49
50void RsdCpuScriptIntrinsic3DLUT::setGlobalObj(uint32_t slot, ObjectBase *data) {
51    rsAssert(slot == 0);
52    mLUT.set(static_cast<Allocation *>(data));
53}
54
55extern "C" size_t rsdIntrinsic3DLUT_K(void *dst, void const *in, size_t count,
56                                      void const *lut,
57                                      int32_t pitchy, int32_t pitchz,
58                                      int dimx, int dimy, int dimz);
59
60
61void RsdCpuScriptIntrinsic3DLUT::kernel(const RsForEachStubParamStruct *p,
62                                      uint32_t xstart, uint32_t xend,
63                                      uint32_t instep, uint32_t outstep) {
64    RsdCpuScriptIntrinsic3DLUT *cp = (RsdCpuScriptIntrinsic3DLUT *)p->usr;
65
66    uchar4 *out = (uchar4 *)p->out;
67    uchar4 *in = (uchar4 *)p->in;
68    uint32_t x1 = xstart;
69    uint32_t x2 = xend;
70
71    const uchar *bp = (const uchar *)cp->mLUT->mHal.drvState.lod[0].mallocPtr;
72
73    int4 dims = {
74        static_cast<int>(cp->mLUT->mHal.drvState.lod[0].dimX - 1),
75        static_cast<int>(cp->mLUT->mHal.drvState.lod[0].dimY - 1),
76        static_cast<int>(cp->mLUT->mHal.drvState.lod[0].dimZ - 1),
77        -1
78    };
79    const float4 m = (float4)(1.f / 255.f) * convert_float4(dims);
80    const int4 coordMul = convert_int4(m * (float4)0x8000);
81    const size_t stride_y = cp->mLUT->mHal.drvState.lod[0].stride;
82    const size_t stride_z = stride_y * cp->mLUT->mHal.drvState.lod[0].dimY;
83
84    //ALOGE("strides %zu %zu", stride_y, stride_z);
85
86    while (x1 < x2) {
87#if defined(ARCH_ARM_HAVE_VFP)
88        if (gArchUseSIMD) {
89            int32_t len = (x2 - x1 - 1);
90            if(len >= 8) {
91                size_t done;
92               done = len - rsdIntrinsic3DLUT_K(out, in, len,
93                                      bp, stride_y, stride_z,
94                                      dims.x, dims.y, dims.z);
95
96                x1 += done;
97                out += done;
98                in += done;
99            }
100        }
101#endif
102
103        int4 baseCoord = convert_int4(*in) * coordMul;
104        int4 coord1 = baseCoord >> (int4)15;
105        //int4 coord2 = min(coord1 + 1, gDims - 1);
106
107        int4 weight2 = baseCoord & 0x7fff;
108        int4 weight1 = (int4)0x8000 - weight2;
109
110        //ALOGE("coord1      %08x %08x %08x %08x", coord1.x, coord1.y, coord1.z, coord1.w);
111        const uchar *bp2 = bp + (coord1.x * 4) + (coord1.y * stride_y) + (coord1.z * stride_z);
112        const uchar4 *pt_00 = (const uchar4 *)&bp2[0];
113        const uchar4 *pt_10 = (const uchar4 *)&bp2[stride_y];
114        const uchar4 *pt_01 = (const uchar4 *)&bp2[stride_z];
115        const uchar4 *pt_11 = (const uchar4 *)&bp2[stride_y + stride_z];
116
117        uint4 v000 = convert_uint4(pt_00[0]);
118        uint4 v100 = convert_uint4(pt_00[1]);
119        uint4 v010 = convert_uint4(pt_10[0]);
120        uint4 v110 = convert_uint4(pt_10[1]);
121        uint4 v001 = convert_uint4(pt_01[0]);
122        uint4 v101 = convert_uint4(pt_01[1]);
123        uint4 v011 = convert_uint4(pt_11[0]);
124        uint4 v111 = convert_uint4(pt_11[1]);
125
126        uint4 yz00 = ((v000 * weight1.x) + (v100 * weight2.x)) >> (int4)7;
127        uint4 yz10 = ((v010 * weight1.x) + (v110 * weight2.x)) >> (int4)7;
128        uint4 yz01 = ((v001 * weight1.x) + (v101 * weight2.x)) >> (int4)7;
129        uint4 yz11 = ((v011 * weight1.x) + (v111 * weight2.x)) >> (int4)7;
130
131        uint4 z0 = ((yz00 * weight1.y) + (yz10 * weight2.y)) >> (int4)15;
132        uint4 z1 = ((yz01 * weight1.y) + (yz11 * weight2.y)) >> (int4)15;
133
134        uint4 v = ((z0 * weight1.z) + (z1 * weight2.z)) >> (int4)15;
135        uint4 v2 = (v + 0x7f) >> (int4)8;
136
137        uchar4 ret = convert_uchar4(v2);
138        ret.w = in->w;
139
140        #if 0
141        if (!x1) {
142            ALOGE("in          %08x %08x %08x %08x", in->r, in->g, in->b, in->a);
143            ALOGE("baseCoord   %08x %08x %08x %08x", baseCoord.x, baseCoord.y, baseCoord.z, baseCoord.w);
144            ALOGE("coord1      %08x %08x %08x %08x", coord1.x, coord1.y, coord1.z, coord1.w);
145            ALOGE("weight1     %08x %08x %08x %08x", weight1.x, weight1.y, weight1.z, weight1.w);
146            ALOGE("weight2     %08x %08x %08x %08x", weight2.x, weight2.y, weight2.z, weight2.w);
147
148            ALOGE("v000        %08x %08x %08x %08x", v000.x, v000.y, v000.z, v000.w);
149            ALOGE("v100        %08x %08x %08x %08x", v100.x, v100.y, v100.z, v100.w);
150            ALOGE("yz00        %08x %08x %08x %08x", yz00.x, yz00.y, yz00.z, yz00.w);
151            ALOGE("z0          %08x %08x %08x %08x", z0.x, z0.y, z0.z, z0.w);
152
153            ALOGE("v           %08x %08x %08x %08x", v.x, v.y, v.z, v.w);
154            ALOGE("v2          %08x %08x %08x %08x", v2.x, v2.y, v2.z, v2.w);
155        }
156        #endif
157        *out = ret;
158
159
160        in++;
161        out++;
162        x1++;
163    }
164}
165
166RsdCpuScriptIntrinsic3DLUT::RsdCpuScriptIntrinsic3DLUT(RsdCpuReferenceImpl *ctx,
167                                                     const Script *s, const Element *e)
168            : RsdCpuScriptIntrinsic(ctx, s, e, RS_SCRIPT_INTRINSIC_ID_3DLUT) {
169
170    mRootPtr = &kernel;
171}
172
173RsdCpuScriptIntrinsic3DLUT::~RsdCpuScriptIntrinsic3DLUT() {
174}
175
176void RsdCpuScriptIntrinsic3DLUT::populateScript(Script *s) {
177    s->mHal.info.exportedVariableCount = 1;
178}
179
180void RsdCpuScriptIntrinsic3DLUT::invokeFreeChildren() {
181    mLUT.clear();
182}
183
184
185RsdCpuScriptImpl * rsdIntrinsic_3DLUT(RsdCpuReferenceImpl *ctx,
186                                    const Script *s, const Element *e) {
187
188    return new RsdCpuScriptIntrinsic3DLUT(ctx, s, e);
189}
190
191
192