|
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430 |
- // Tencent is pleased to support the open source community by making ncnn available.
- //
- // Copyright (C) 2017 THL A29 Limited, a Tencent company. All rights reserved.
- //
- // Licensed under the BSD 3-Clause License (the "License"); you may not use this file except
- // in compliance with the License. You may obtain a copy of the License at
- //
- // https://opensource.org/licenses/BSD-3-Clause
- //
- // Unless required by applicable law or agreed to in writing, software distributed
- // under the License is distributed on an "AS IS" BASIS, WITHOUT WARRANTIES OR
- // CONDITIONS OF ANY KIND, either express or implied. See the License for the
- // specific language governing permissions and limitations under the License.
-
- #include "mat.h"
- #include <limits.h>
- #include <math.h>
- #include <algorithm>
- #if __ARM_NEON
- #include <arm_neon.h>
- #endif // __ARM_NEON
- #include "platform.h"
-
- namespace ncnn {
-
- #if NCNN_PIXEL
- static int from_rgb(const unsigned char* rgb, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 3, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w * 3;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr0 = m.channel(0);
- float* ptr1 = m.channel(1);
- float* ptr2 = m.channel(2);
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- for (; nn>0; nn--)
- {
- uint8x8x3_t _rgb = vld3_u8(rgb);
- uint16x8_t _r16 = vmovl_u8(_rgb.val[0]);
- uint16x8_t _g16 = vmovl_u8(_rgb.val[1]);
- uint16x8_t _b16 = vmovl_u8(_rgb.val[2]);
-
- float32x4_t _rlow = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_r16)));
- float32x4_t _rhigh = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_r16)));
- float32x4_t _glow = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_g16)));
- float32x4_t _ghigh = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_g16)));
- float32x4_t _blow = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_b16)));
- float32x4_t _bhigh = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_b16)));
-
- vst1q_f32(ptr0, _rlow);
- vst1q_f32(ptr0+4, _rhigh);
- vst1q_f32(ptr1, _glow);
- vst1q_f32(ptr1+4, _ghigh);
- vst1q_f32(ptr2, _blow);
- vst1q_f32(ptr2+4, _bhigh);
-
- rgb += 3*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "0: \n"
- "pld [%1, #256] \n"
- "vld3.u8 {d0-d2}, [%1]! \n"
- "vmovl.u8 q8, d0 \n"
- "vmovl.u8 q9, d1 \n"
- "vmovl.u8 q10, d2 \n"
- "vmovl.u16 q0, d16 \n"
- "vmovl.u16 q1, d17 \n"
- "vmovl.u16 q2, d18 \n"
- "vmovl.u16 q3, d19 \n"
- "vmovl.u16 q8, d20 \n"
- "vmovl.u16 q9, d21 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "vcvt.f32.u32 q2, q2 \n"
- "vcvt.f32.u32 q3, q3 \n"
- "vcvt.f32.u32 q8, q8 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%2 :128]! \n"
- "vcvt.f32.u32 q9, q9 \n"
- "vst1.f32 {d4-d7}, [%3 :128]! \n"
- "vst1.f32 {d16-d19}, [%4 :128]!\n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(rgb), // %1
- "=r"(ptr0), // %2
- "=r"(ptr1), // %3
- "=r"(ptr2) // %4
- : "0"(nn),
- "1"(rgb),
- "2"(ptr0),
- "3"(ptr1),
- "4"(ptr2)
- : "cc", "memory", "q0", "q1", "q2", "q3", "q8", "q9", "q10"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr0 = rgb[0];
- *ptr1 = rgb[1];
- *ptr2 = rgb[2];
-
- rgb += 3;
- ptr0++;
- ptr1++;
- ptr2++;
- }
-
- rgb += wgap;
- }
-
- return 0;
- }
-
- static void to_rgb(const Mat& m, unsigned char* rgb, int stride)
- {
- int w = m.w;
- int h = m.h;
-
- const int wgap = stride - w * 3;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- const float* ptr0 = m.channel(0);
- const float* ptr1 = m.channel(1);
- const float* ptr2 = m.channel(2);
-
- for (int y=0; y<h; y++)
- {
- #define SATURATE_CAST_UCHAR(X) (unsigned char)::std::min(::std::max((int)(X), 0), 255);
-
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- for (; nn>0; nn--)
- {
- float32x4_t _rlow = vld1q_f32(ptr0);
- float32x4_t _rhigh = vld1q_f32(ptr0+4);
- float32x4_t _glow = vld1q_f32(ptr1);
- float32x4_t _ghigh = vld1q_f32(ptr1+4);
- float32x4_t _blow = vld1q_f32(ptr2);
- float32x4_t _bhigh = vld1q_f32(ptr2+4);
-
- int16x8_t _r16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_rlow)), vmovn_s32(vcvtq_s32_f32(_rhigh)));
- int16x8_t _g16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_glow)), vmovn_s32(vcvtq_s32_f32(_ghigh)));
- int16x8_t _b16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_blow)), vmovn_s32(vcvtq_s32_f32(_bhigh)));
-
- uint8x8x3_t _rgb;
- _rgb.val[0] = vqmovun_s16(_r16);
- _rgb.val[1] = vqmovun_s16(_g16);
- _rgb.val[2] = vqmovun_s16(_b16);
-
- vst3_u8(rgb, _rgb);
-
- rgb += 3*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- }
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- rgb[0] = SATURATE_CAST_UCHAR(*ptr0);
- rgb[1] = SATURATE_CAST_UCHAR(*ptr1);
- rgb[2] = SATURATE_CAST_UCHAR(*ptr2);
-
- rgb += 3;
- ptr0++;
- ptr1++;
- ptr2++;
- }
-
- #undef SATURATE_CAST_UCHAR
- rgb += wgap;
- }
- }
-
- static int from_gray(const unsigned char* gray, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 1, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr = m;
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 4;
- int remain = w - (nn << 4);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- for (; nn>0; nn--)
- {
- uint8x16_t _gray = vld1q_u8(gray);
- uint16x8_t _gray16_0 = vmovl_u8(vget_low_u8(_gray));
- uint16x8_t _gray16_1 = vmovl_u8(vget_high_u8(_gray));
-
- float32x4_t _graylow_0 = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_gray16_0)));
- float32x4_t _grayhigh_0 = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_gray16_0)));
- float32x4_t _graylow_1 = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_gray16_1)));
- float32x4_t _grayhigh_1 = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_gray16_1)));
-
- vst1q_f32(ptr, _graylow_0);
- vst1q_f32(ptr+4, _grayhigh_0);
- vst1q_f32(ptr+8, _graylow_1);
- vst1q_f32(ptr+12, _grayhigh_1);
-
- gray += 16;
- ptr += 16;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "0: \n"
- "pld [%1, #128] \n"
- "vld1.u8 {d0,d1}, [%1]! \n"
- "vmovl.u8 q8, d0 \n"
- "vmovl.u8 q9, d1 \n"
- "vmovl.u16 q0, d16 \n"
- "vmovl.u16 q1, d17 \n"
- "vmovl.u16 q2, d18 \n"
- "vmovl.u16 q3, d19 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "vcvt.f32.u32 q2, q2 \n"
- "vcvt.f32.u32 q3, q3 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%2 :128]! \n"
- "vst1.f32 {d4-d7}, [%2 :128]! \n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(gray), // %1
- "=r"(ptr) // %2
- : "0"(nn),
- "1"(gray),
- "2"(ptr)
- : "cc", "memory", "q0", "q1", "q2", "q3", "q8", "q9"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr = *gray;
-
- gray++;
- ptr++;
- }
-
- gray += wgap;
- }
-
- return 0;
- }
-
- static void to_gray(const Mat& m, unsigned char* gray, int stride)
- {
- int w = m.w;
- int h = m.h;
-
- const int wgap = stride - w;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- const float* ptr = m;
-
- for (int y=0; y<h; y++)
- {
- #define SATURATE_CAST_UCHAR(X) (unsigned char)::std::min(::std::max((int)(X), 0), 255);
-
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- for (; nn>0; nn--)
- {
- float32x4_t _glow = vld1q_f32(ptr);
- float32x4_t _ghigh = vld1q_f32(ptr+4);
-
- int16x8_t _g16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_glow)), vmovn_s32(vcvtq_s32_f32(_ghigh)));
-
- uint8x8_t _gray = vqmovun_s16(_g16);
-
- vst1_u8(gray, _gray);
-
- gray += 8;
- ptr += 8;
- }
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *gray = SATURATE_CAST_UCHAR(*ptr);
-
- gray++;
- ptr++;
- }
-
- #undef SATURATE_CAST_UCHAR
- gray += wgap;
- }
- }
-
- static int from_rgba(const unsigned char* rgba, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 4, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr0 = m.channel(0);
- float* ptr1 = m.channel(1);
- float* ptr2 = m.channel(2);
- float* ptr3 = m.channel(3);
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- for (; nn>0; nn--)
- {
- uint8x8x4_t _rgba = vld4_u8(rgba);
- int16x8_t _r16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[0]));
- int16x8_t _g16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[1]));
- int16x8_t _b16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[2]));
- int16x8_t _a16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[3]));
-
- float32x4_t _rlow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_r16)));
- float32x4_t _rhigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_r16)));
- float32x4_t _glow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_g16)));
- float32x4_t _ghigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_g16)));
- float32x4_t _blow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_b16)));
- float32x4_t _bhigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_b16)));
- float32x4_t _alow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_a16)));
- float32x4_t _ahigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_a16)));
-
- vst1q_f32(ptr0, _rlow);
- vst1q_f32(ptr0+4, _rhigh);
- vst1q_f32(ptr1, _glow);
- vst1q_f32(ptr1+4, _ghigh);
- vst1q_f32(ptr2, _blow);
- vst1q_f32(ptr2+4, _bhigh);
- vst1q_f32(ptr3, _alow);
- vst1q_f32(ptr3+4, _ahigh);
-
- rgba += 4*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- ptr3 += 8;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "0: \n"
- "pld [%1, #256] \n"
- "vld4.u8 {d0-d3}, [%1]! \n"
- "vmovl.u8 q8, d0 \n"
- "vmovl.u8 q9, d1 \n"
- "vmovl.u8 q10, d2 \n"
- "vmovl.u8 q11, d3 \n"
- "vmovl.u16 q0, d16 \n"
- "vmovl.u16 q1, d17 \n"
- "vmovl.u16 q2, d18 \n"
- "vmovl.u16 q3, d19 \n"
- "vmovl.u16 q8, d20 \n"
- "vmovl.u16 q9, d21 \n"
- "vmovl.u16 q10, d22 \n"
- "vmovl.u16 q11, d23 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "vcvt.f32.u32 q2, q2 \n"
- "vcvt.f32.u32 q3, q3 \n"
- "vcvt.f32.u32 q8, q8 \n"
- "vcvt.f32.u32 q9, q9 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%2 :128]! \n"
- "vcvt.f32.u32 q10, q10 \n"
- "vcvt.f32.u32 q11, q11 \n"
- "vst1.f32 {d4-d7}, [%3 :128]! \n"
- "vst1.f32 {d16-d19}, [%4 :128]!\n"
- "vst1.f32 {d20-d23}, [%5 :128]!\n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(rgba), // %1
- "=r"(ptr0), // %2
- "=r"(ptr1), // %3
- "=r"(ptr2), // %4
- "=r"(ptr3) // %5
- : "0"(nn),
- "1"(rgba),
- "2"(ptr0),
- "3"(ptr1),
- "4"(ptr2),
- "5"(ptr3)
- : "cc", "memory", "q0", "q1", "q2", "q3", "q8", "q9", "q10", "q11"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr0 = rgba[0];
- *ptr1 = rgba[1];
- *ptr2 = rgba[2];
- *ptr3 = rgba[3];
-
- rgba += 4;
- ptr0++;
- ptr1++;
- ptr2++;
- ptr3++;
- }
-
- rgba += wgap;
- }
-
- return 0;
- }
-
- static void to_rgba(const Mat& m, unsigned char* rgba, int stride)
- {
- int w = m.w;
- int h = m.h;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- const float* ptr0 = m.channel(0);
- const float* ptr1 = m.channel(1);
- const float* ptr2 = m.channel(2);
- const float* ptr3 = m.channel(3);
-
- for (int y=0; y<h; y++)
- {
- #define SATURATE_CAST_UCHAR(X) (unsigned char)::std::min(::std::max((int)(X), 0), 255);
-
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- for (; nn>0; nn--)
- {
- float32x4_t _rlow = vld1q_f32(ptr0);
- float32x4_t _rhigh = vld1q_f32(ptr0+4);
- float32x4_t _glow = vld1q_f32(ptr1);
- float32x4_t _ghigh = vld1q_f32(ptr1+4);
- float32x4_t _blow = vld1q_f32(ptr2);
- float32x4_t _bhigh = vld1q_f32(ptr2+4);
- float32x4_t _alow = vld1q_f32(ptr3);
- float32x4_t _ahigh = vld1q_f32(ptr3+4);
-
- int16x8_t _r16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_rlow)), vmovn_s32(vcvtq_s32_f32(_rhigh)));
- int16x8_t _g16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_glow)), vmovn_s32(vcvtq_s32_f32(_ghigh)));
- int16x8_t _b16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_blow)), vmovn_s32(vcvtq_s32_f32(_bhigh)));
- int16x8_t _a16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_alow)), vmovn_s32(vcvtq_s32_f32(_ahigh)));
-
- uint8x8x4_t _rgba;
- _rgba.val[0] = vqmovun_s16(_r16);
- _rgba.val[1] = vqmovun_s16(_g16);
- _rgba.val[2] = vqmovun_s16(_b16);
- _rgba.val[3] = vqmovun_s16(_a16);
-
- vst4_u8(rgba, _rgba);
-
- rgba += 4*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- ptr3 += 8;
- }
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- rgba[0] = SATURATE_CAST_UCHAR(*ptr0);
- rgba[1] = SATURATE_CAST_UCHAR(*ptr1);
- rgba[2] = SATURATE_CAST_UCHAR(*ptr2);
- rgba[3] = SATURATE_CAST_UCHAR(*ptr3);
-
- rgba += 4;
- ptr0++;
- ptr1++;
- ptr2++;
- ptr3++;
- }
-
- #undef SATURATE_CAST_UCHAR
- rgba += wgap;
- }
- }
-
- static int from_rgb2bgr(const unsigned char* rgb, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 3, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w * 3;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr0 = m.channel(0);
- float* ptr1 = m.channel(1);
- float* ptr2 = m.channel(2);
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- for (; nn>0; nn--)
- {
- uint8x8x3_t _rgb = vld3_u8(rgb);
- uint16x8_t _r16 = vmovl_u8(_rgb.val[0]);
- uint16x8_t _g16 = vmovl_u8(_rgb.val[1]);
- uint16x8_t _b16 = vmovl_u8(_rgb.val[2]);
-
- float32x4_t _rlow = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_r16)));
- float32x4_t _rhigh = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_r16)));
- float32x4_t _glow = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_g16)));
- float32x4_t _ghigh = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_g16)));
- float32x4_t _blow = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_b16)));
- float32x4_t _bhigh = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_b16)));
-
- vst1q_f32(ptr2, _rlow);
- vst1q_f32(ptr2+4, _rhigh);
- vst1q_f32(ptr1, _glow);
- vst1q_f32(ptr1+4, _ghigh);
- vst1q_f32(ptr0, _blow);
- vst1q_f32(ptr0+4, _bhigh);
-
- rgb += 3*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "0: \n"
- "pld [%1, #256] \n"
- "vld3.u8 {d0-d2}, [%1]! \n"
- "vmovl.u8 q8, d0 \n"
- "vmovl.u8 q9, d1 \n"
- "vmovl.u8 q10, d2 \n"
- "vmovl.u16 q0, d16 \n"
- "vmovl.u16 q1, d17 \n"
- "vmovl.u16 q2, d18 \n"
- "vmovl.u16 q3, d19 \n"
- "vmovl.u16 q8, d20 \n"
- "vmovl.u16 q9, d21 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "vcvt.f32.u32 q2, q2 \n"
- "vcvt.f32.u32 q3, q3 \n"
- "vcvt.f32.u32 q8, q8 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%4 :128]! \n"
- "vcvt.f32.u32 q9, q9 \n"
- "vst1.f32 {d4-d7}, [%3 :128]! \n"
- "vst1.f32 {d16-d19}, [%2 :128]!\n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(rgb), // %1
- "=r"(ptr0), // %2
- "=r"(ptr1), // %3
- "=r"(ptr2) // %4
- : "0"(nn),
- "1"(rgb),
- "2"(ptr0),
- "3"(ptr1),
- "4"(ptr2)
- : "cc", "memory", "q0", "q1", "q2", "q3", "q8", "q9", "q10"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr0 = rgb[2];
- *ptr1 = rgb[1];
- *ptr2 = rgb[0];
-
- rgb += 3;
- ptr0++;
- ptr1++;
- ptr2++;
- }
-
- rgb += wgap;
- }
-
- return 0;
- }
-
- static void to_bgr2rgb(const Mat& m, unsigned char* rgb, int stride)
- {
- int w = m.w;
- int h = m.h;
-
- const int wgap = stride - w * 3;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- const float* ptr0 = m.channel(0);
- const float* ptr1 = m.channel(1);
- const float* ptr2 = m.channel(2);
-
- for (int y=0; y<h; y++)
- {
- #define SATURATE_CAST_UCHAR(X) (unsigned char)::std::min(::std::max((int)(X), 0), 255);
-
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- for (; nn>0; nn--)
- {
- float32x4_t _rlow = vld1q_f32(ptr2);
- float32x4_t _rhigh = vld1q_f32(ptr2+4);
- float32x4_t _glow = vld1q_f32(ptr1);
- float32x4_t _ghigh = vld1q_f32(ptr1+4);
- float32x4_t _blow = vld1q_f32(ptr0);
- float32x4_t _bhigh = vld1q_f32(ptr0+4);
-
- int16x8_t _r16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_rlow)), vmovn_s32(vcvtq_s32_f32(_rhigh)));
- int16x8_t _g16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_glow)), vmovn_s32(vcvtq_s32_f32(_ghigh)));
- int16x8_t _b16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_blow)), vmovn_s32(vcvtq_s32_f32(_bhigh)));
-
- uint8x8x3_t _rgb;
- _rgb.val[0] = vqmovun_s16(_r16);
- _rgb.val[1] = vqmovun_s16(_g16);
- _rgb.val[2] = vqmovun_s16(_b16);
-
- vst3_u8(rgb, _rgb);
-
- rgb += 3*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- }
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- rgb[2] = SATURATE_CAST_UCHAR(*ptr0);
- rgb[1] = SATURATE_CAST_UCHAR(*ptr1);
- rgb[0] = SATURATE_CAST_UCHAR(*ptr2);
-
- rgb += 3;
- ptr0++;
- ptr1++;
- ptr2++;
- }
-
- #undef SATURATE_CAST_UCHAR
- rgb += wgap;
- }
- }
-
- static int from_rgb2gray(const unsigned char* rgb, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- // coeffs for r g b = 0.299f, 0.587f, 0.114f
- const unsigned char Y_shift = 8;//14
- const unsigned char R2Y = 77;
- const unsigned char G2Y = 150;
- const unsigned char B2Y = 29;
-
- m.create(w, h, 1, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w * 3;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr = m;
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- uint8x8_t _R2Y = vdup_n_u8(R2Y);
- uint8x8_t _G2Y = vdup_n_u8(G2Y);
- uint8x8_t _B2Y = vdup_n_u8(B2Y);
- for (; nn>0; nn--)
- {
- uint8x8x3_t _rgb = vld3_u8(rgb);
-
- uint16x8_t _y16 = vmull_u8(_rgb.val[0], _R2Y);
- _y16 = vmlal_u8(_y16, _rgb.val[1], _G2Y);
- _y16 = vmlal_u8(_y16, _rgb.val[2], _B2Y);
- _y16 = vshrq_n_u16(_y16, Y_shift);
-
- float32x4_t _ylow = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_y16)));
- float32x4_t _yhigh = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_y16)));
-
- vst1q_f32(ptr, _ylow);
- vst1q_f32(ptr+4, _yhigh);
-
- rgb += 3*8;
- ptr += 8;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "vdup.u8 d16, %6 \n"
- "vdup.u8 d17, %7 \n"
- "vdup.u8 d18, %8 \n"
- "0: \n"
- "pld [%1, #256] \n"
- "vld3.u8 {d0-d2}, [%1]! \n"
- "vmull.u8 q2, d0, d16 \n"
- "vmlal.u8 q2, d1, d17 \n"
- "vmlal.u8 q2, d2, d18 \n"
- "vshr.u16 q2, q2, #8 \n" // Y_shift
- "vmovl.u16 q0, d4 \n"
- "vmovl.u16 q1, d5 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%2 :128]! \n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(rgb), // %1
- "=r"(ptr) // %2
- : "0"(nn),
- "1"(rgb),
- "2"(ptr),
- "r"(R2Y), // %6
- "r"(G2Y), // %7
- "r"(B2Y) // %8
- : "cc", "memory", "q0", "q1", "q2", "q8", "q9"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr = static_cast<float>((rgb[0] * R2Y + rgb[1] * G2Y + rgb[2] * B2Y) >> Y_shift);
-
- rgb += 3;
- ptr++;
- }
-
- rgb += wgap;
- }
-
- return 0;
- }
-
- static int from_rgb2rgba(const unsigned char* rgb, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 4, 4u, allocator);
- if (m.empty())
- return -100;
-
- Mat rgb_channels = m.channel_range(0, 3);
- from_rgb(rgb, w, h, stride, rgb_channels, allocator);
-
- Mat alpha_channel = m.channel(3);
- alpha_channel.fill(255.f);
-
- return 0;
- }
-
- static void to_rgb2rgba(const Mat& m, unsigned char* rgba, int stride)
- {
- int w = m.w;
- int h = m.h;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- const float* ptr0 = m.channel(0);
- const float* ptr1 = m.channel(1);
- const float* ptr2 = m.channel(2);
-
- for (int y=0; y<h; y++)
- {
- #define SATURATE_CAST_UCHAR(X) (unsigned char)::std::min(::std::max((int)(X), 0), 255);
-
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- uint8x8_t _a = vdup_n_u8(255);
- for (; nn>0; nn--)
- {
- float32x4_t _rlow = vld1q_f32(ptr0);
- float32x4_t _rhigh = vld1q_f32(ptr0+4);
- float32x4_t _glow = vld1q_f32(ptr1);
- float32x4_t _ghigh = vld1q_f32(ptr1+4);
- float32x4_t _blow = vld1q_f32(ptr2);
- float32x4_t _bhigh = vld1q_f32(ptr2+4);
-
- int16x8_t _r16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_rlow)), vmovn_s32(vcvtq_s32_f32(_rhigh)));
- int16x8_t _g16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_glow)), vmovn_s32(vcvtq_s32_f32(_ghigh)));
- int16x8_t _b16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_blow)), vmovn_s32(vcvtq_s32_f32(_bhigh)));
-
- uint8x8x4_t _rgba;
- _rgba.val[0] = vqmovun_s16(_r16);
- _rgba.val[1] = vqmovun_s16(_g16);
- _rgba.val[2] = vqmovun_s16(_b16);
- _rgba.val[3] = _a;
-
- vst4_u8(rgba, _rgba);
-
- rgba += 4*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- }
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- rgba[0] = SATURATE_CAST_UCHAR(*ptr0);
- rgba[1] = SATURATE_CAST_UCHAR(*ptr1);
- rgba[2] = SATURATE_CAST_UCHAR(*ptr2);
- rgba[3] = 255;
-
- rgba += 4;
- ptr0++;
- ptr1++;
- ptr2++;
- }
-
- #undef SATURATE_CAST_UCHAR
- rgba += wgap;
- }
- }
-
- static int from_bgr2gray(const unsigned char* bgr, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- // coeffs for r g b = 0.299f, 0.587f, 0.114f
- const unsigned char Y_shift = 8;//14
- const unsigned char R2Y = 77;
- const unsigned char G2Y = 150;
- const unsigned char B2Y = 29;
-
- m.create(w, h, 1, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w * 3;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr = m;
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- uint8x8_t _R2Y = vdup_n_u8(R2Y);
- uint8x8_t _G2Y = vdup_n_u8(G2Y);
- uint8x8_t _B2Y = vdup_n_u8(B2Y);
- for (; nn>0; nn--)
- {
- uint8x8x3_t _rgb = vld3_u8(bgr);
-
- uint16x8_t _y16 = vmull_u8(_rgb.val[2], _R2Y);
- _y16 = vmlal_u8(_y16, _rgb.val[1], _G2Y);
- _y16 = vmlal_u8(_y16, _rgb.val[0], _B2Y);
- _y16 = vshrq_n_u16(_y16, Y_shift);
-
- float32x4_t _ylow = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_y16)));
- float32x4_t _yhigh = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_y16)));
-
- vst1q_f32(ptr, _ylow);
- vst1q_f32(ptr+4, _yhigh);
-
- bgr += 3*8;
- ptr += 8;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "vdup.u8 d16, %6 \n"
- "vdup.u8 d17, %7 \n"
- "vdup.u8 d18, %8 \n"
- "0: \n"
- "pld [%1, #256] \n"
- "vld3.u8 {d0-d2}, [%1]! \n"
- "vmull.u8 q2, d2, d16 \n"
- "vmlal.u8 q2, d1, d17 \n"
- "vmlal.u8 q2, d0, d18 \n"
- "vshr.u16 q2, q2, #8 \n" // Y_shift
- "vmovl.u16 q0, d4 \n"
- "vmovl.u16 q1, d5 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%2 :128]! \n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(bgr), // %1
- "=r"(ptr) // %2
- : "0"(nn),
- "1"(bgr),
- "2"(ptr),
- "r"(R2Y), // %6
- "r"(G2Y), // %7
- "r"(B2Y) // %8
- : "cc", "memory", "q0", "q1", "q2", "q8", "q9"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr = static_cast<float>((bgr[2] * R2Y + bgr[1] * G2Y + bgr[0] * B2Y) >> Y_shift);
-
- bgr += 3;
- ptr++;
- }
-
- bgr += wgap;
- }
-
- return 0;
- }
-
- static int from_bgr2rgba(const unsigned char* bgr, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 4, 4u, allocator);
- if (m.empty())
- return -100;
-
- Mat rgb_channels = m.channel_range(0, 3);
- from_rgb2bgr(bgr, w, h, stride, rgb_channels, allocator);
-
- Mat alpha_channel = m.channel(3);
- alpha_channel.fill(255.f);
-
- return 0;
- }
-
- static void to_bgr2rgba(const Mat& m, unsigned char* rgba, int stride)
- {
- int w = m.w;
- int h = m.h;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- const float* ptr0 = m.channel(0);
- const float* ptr1 = m.channel(1);
- const float* ptr2 = m.channel(2);
-
- for (int y=0; y<h; y++)
- {
- #define SATURATE_CAST_UCHAR(X) (unsigned char)::std::min(::std::max((int)(X), 0), 255);
-
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- uint8x8_t _a = vdup_n_u8(255);
- for (; nn>0; nn--)
- {
- float32x4_t _rlow = vld1q_f32(ptr2);
- float32x4_t _rhigh = vld1q_f32(ptr2+4);
- float32x4_t _glow = vld1q_f32(ptr1);
- float32x4_t _ghigh = vld1q_f32(ptr1+4);
- float32x4_t _blow = vld1q_f32(ptr0);
- float32x4_t _bhigh = vld1q_f32(ptr0+4);
-
- int16x8_t _r16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_rlow)), vmovn_s32(vcvtq_s32_f32(_rhigh)));
- int16x8_t _g16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_glow)), vmovn_s32(vcvtq_s32_f32(_ghigh)));
- int16x8_t _b16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_blow)), vmovn_s32(vcvtq_s32_f32(_bhigh)));
-
- uint8x8x4_t _rgba;
- _rgba.val[0] = vqmovun_s16(_r16);
- _rgba.val[1] = vqmovun_s16(_g16);
- _rgba.val[2] = vqmovun_s16(_b16);
- _rgba.val[3] = _a;
-
- vst4_u8(rgba, _rgba);
-
- rgba += 4*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- }
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- rgba[0] = SATURATE_CAST_UCHAR(*ptr2);
- rgba[1] = SATURATE_CAST_UCHAR(*ptr1);
- rgba[2] = SATURATE_CAST_UCHAR(*ptr0);
- rgba[3] = 255;
-
- rgba += 4;
- ptr0++;
- ptr1++;
- ptr2++;
- }
-
- #undef SATURATE_CAST_UCHAR
- rgba += wgap;
- }
- }
-
- static int from_gray2rgb(const unsigned char* gray, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 3, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr0 = m.channel(0);
- float* ptr1 = m.channel(1);
- float* ptr2 = m.channel(2);
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 4;
- int remain = w - (nn << 4);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- for (; nn>0; nn--)
- {
- uint8x16_t _gray = vld1q_u8(gray);
- uint16x8_t _gray16_0 = vmovl_u8(vget_low_u8(_gray));
- uint16x8_t _gray16_1 = vmovl_u8(vget_high_u8(_gray));
-
- float32x4_t _graylow_0 = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_gray16_0)));
- float32x4_t _grayhigh_0 = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_gray16_0)));
- float32x4_t _graylow_1 = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_gray16_1)));
- float32x4_t _grayhigh_1 = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_gray16_1)));
-
- vst1q_f32(ptr0, _graylow_0);
- vst1q_f32(ptr0+4, _grayhigh_0);
- vst1q_f32(ptr0+8, _graylow_1);
- vst1q_f32(ptr0+12, _grayhigh_1);
-
- vst1q_f32(ptr1, _graylow_0);
- vst1q_f32(ptr1+4, _grayhigh_0);
- vst1q_f32(ptr1+8, _graylow_1);
- vst1q_f32(ptr1+12, _grayhigh_1);
-
- vst1q_f32(ptr2, _graylow_0);
- vst1q_f32(ptr2+4, _grayhigh_0);
- vst1q_f32(ptr2+8, _graylow_1);
- vst1q_f32(ptr2+12, _grayhigh_1);
-
- gray += 16;
- ptr0 += 16;
- ptr1 += 16;
- ptr2 += 16;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "0: \n"
- "pld [%1, #128] \n"
- "vld1.u8 {d0,d1}, [%1]! \n"
- "vmovl.u8 q8, d0 \n"
- "vmovl.u8 q9, d1 \n"
- "vmovl.u16 q0, d16 \n"
- "vmovl.u16 q1, d17 \n"
- "vmovl.u16 q2, d18 \n"
- "vmovl.u16 q3, d19 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "vcvt.f32.u32 q2, q2 \n"
- "vcvt.f32.u32 q3, q3 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%2 :128]! \n"
- "vst1.f32 {d4-d7}, [%2 :128]! \n"
- "vst1.f32 {d0-d3}, [%3 :128]! \n"
- "vst1.f32 {d4-d7}, [%3 :128]! \n"
- "vst1.f32 {d0-d3}, [%4 :128]! \n"
- "vst1.f32 {d4-d7}, [%4 :128]! \n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(gray), // %1
- "=r"(ptr0), // %2
- "=r"(ptr1), // %3
- "=r"(ptr2) // %4
- : "0"(nn),
- "1"(gray),
- "2"(ptr0),
- "3"(ptr1),
- "4"(ptr2)
- : "cc", "memory", "q0", "q1", "q2", "q3", "q8", "q9"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr0 = *gray;
- *ptr1 = *gray;
- *ptr2 = *gray;
-
- gray++;
- ptr0++;
- ptr1++;
- ptr2++;
- }
-
- gray += wgap;
- }
-
- return 0;
- }
-
- static int from_gray2rgba(const unsigned char* gray, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 4, 4u, allocator);
- if (m.empty())
- return -100;
-
- Mat rgb_channels = m.channel_range(0, 3);
- from_gray2rgb(gray, w, h, stride, rgb_channels, allocator);
-
- Mat alpha_channel = m.channel(3);
- alpha_channel.fill(255.f);
-
- return 0;
- }
-
- static void to_gray2rgba(const Mat& m, unsigned char* rgba, int stride)
- {
- int w = m.w;
- int h = m.h;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- const float* ptr = m;
-
- for (int y=0; y<h; y++)
- {
- #define SATURATE_CAST_UCHAR(X) (unsigned char)::std::min(::std::max((int)(X), 0), 255);
-
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- uint8x8_t _a = vdup_n_u8(255);
- for (; nn>0; nn--)
- {
- float32x4_t _glow = vld1q_f32(ptr);
- float32x4_t _ghigh = vld1q_f32(ptr+4);
-
- int16x8_t _g16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_glow)), vmovn_s32(vcvtq_s32_f32(_ghigh)));
-
- uint8x8_t _gray = vqmovun_s16(_g16);
-
- uint8x8x4_t _rgba;
- _rgba.val[0] = _gray;
- _rgba.val[1] = _gray;
- _rgba.val[2] = _gray;
- _rgba.val[3] = _a;
-
- vst4_u8(rgba, _rgba);
-
- rgba += 4*8;
- ptr += 8;
- }
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- unsigned char gray = SATURATE_CAST_UCHAR(*ptr);
- rgba[0] = gray;
- rgba[1] = gray;
- rgba[2] = gray;
- rgba[3] = 255;
-
- rgba += 4;
- ptr++;
- }
-
- #undef SATURATE_CAST_UCHAR
- rgba += wgap;
- }
- }
-
- static int from_rgba2rgb(const unsigned char* rgba, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 3, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr0 = m.channel(0);
- float* ptr1 = m.channel(1);
- float* ptr2 = m.channel(2);
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- for (; nn>0; nn--)
- {
- uint8x8x4_t _rgba = vld4_u8(rgba);
- int16x8_t _r16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[0]));
- int16x8_t _g16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[1]));
- int16x8_t _b16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[2]));
-
- float32x4_t _rlow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_r16)));
- float32x4_t _rhigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_r16)));
- float32x4_t _glow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_g16)));
- float32x4_t _ghigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_g16)));
- float32x4_t _blow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_b16)));
- float32x4_t _bhigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_b16)));
-
- vst1q_f32(ptr0, _rlow);
- vst1q_f32(ptr0+4, _rhigh);
- vst1q_f32(ptr1, _glow);
- vst1q_f32(ptr1+4, _ghigh);
- vst1q_f32(ptr2, _blow);
- vst1q_f32(ptr2+4, _bhigh);
-
- rgba += 4*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "0: \n"
- "pld [%1, #256] \n"
- "vld4.u8 {d0-d3}, [%1]! \n"
- "vmovl.u8 q8, d0 \n"
- "vmovl.u8 q9, d1 \n"
- "vmovl.u8 q10, d2 \n"
- "vmovl.u16 q0, d16 \n"
- "vmovl.u16 q1, d17 \n"
- "vmovl.u16 q2, d18 \n"
- "vmovl.u16 q3, d19 \n"
- "vmovl.u16 q8, d20 \n"
- "vmovl.u16 q9, d21 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "vcvt.f32.u32 q2, q2 \n"
- "vcvt.f32.u32 q3, q3 \n"
- "vcvt.f32.u32 q8, q8 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%2 :128]! \n"
- "vcvt.f32.u32 q9, q9 \n"
- "vst1.f32 {d4-d7}, [%3 :128]! \n"
- "vst1.f32 {d16-d19}, [%4 :128]!\n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(rgba), // %1
- "=r"(ptr0), // %2
- "=r"(ptr1), // %3
- "=r"(ptr2) // %4
- : "0"(nn),
- "1"(rgba),
- "2"(ptr0),
- "3"(ptr1),
- "4"(ptr2)
- : "cc", "memory", "q0", "q1", "q2", "q3", "q8", "q9"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr0 = rgba[0];
- *ptr1 = rgba[1];
- *ptr2 = rgba[2];
-
- rgba += 4;
- ptr0++;
- ptr1++;
- ptr2++;
- }
-
- rgba += wgap;
- }
-
- return 0;
- }
-
- static int from_rgba2bgr(const unsigned char* rgba, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 3, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr0 = m.channel(0);
- float* ptr1 = m.channel(1);
- float* ptr2 = m.channel(2);
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- for (; nn>0; nn--)
- {
- uint8x8x4_t _rgba = vld4_u8(rgba);
- int16x8_t _r16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[0]));
- int16x8_t _g16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[1]));
- int16x8_t _b16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[2]));
-
- float32x4_t _rlow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_r16)));
- float32x4_t _rhigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_r16)));
- float32x4_t _glow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_g16)));
- float32x4_t _ghigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_g16)));
- float32x4_t _blow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_b16)));
- float32x4_t _bhigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_b16)));
-
- vst1q_f32(ptr2, _rlow);
- vst1q_f32(ptr2+4, _rhigh);
- vst1q_f32(ptr1, _glow);
- vst1q_f32(ptr1+4, _ghigh);
- vst1q_f32(ptr0, _blow);
- vst1q_f32(ptr0+4, _bhigh);
-
- rgba += 4*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "0: \n"
- "pld [%1, #256] \n"
- "vld4.u8 {d0-d3}, [%1]! \n"
- "vmovl.u8 q8, d0 \n"
- "vmovl.u8 q9, d1 \n"
- "vmovl.u8 q10, d2 \n"
- "vmovl.u16 q0, d16 \n"
- "vmovl.u16 q1, d17 \n"
- "vmovl.u16 q2, d18 \n"
- "vmovl.u16 q3, d19 \n"
- "vmovl.u16 q8, d20 \n"
- "vmovl.u16 q9, d21 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "vcvt.f32.u32 q2, q2 \n"
- "vcvt.f32.u32 q3, q3 \n"
- "vcvt.f32.u32 q8, q8 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%4 :128]! \n"
- "vcvt.f32.u32 q9, q9 \n"
- "vst1.f32 {d4-d7}, [%3 :128]! \n"
- "vst1.f32 {d16-d19}, [%2 :128]!\n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(rgba), // %1
- "=r"(ptr0), // %2
- "=r"(ptr1), // %3
- "=r"(ptr2) // %4
- : "0"(nn),
- "1"(rgba),
- "2"(ptr0),
- "3"(ptr1),
- "4"(ptr2)
- : "cc", "memory", "q0", "q1", "q2", "q3", "q8", "q9", "q10"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr0 = rgba[2];
- *ptr1 = rgba[1];
- *ptr2 = rgba[0];
-
- rgba += 4;
- ptr0++;
- ptr1++;
- ptr2++;
- }
-
- rgba += wgap;
- }
-
- return 0;
- }
-
- static int from_rgba2gray(const unsigned char* rgba, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- // coeffs for r g b = 0.299f, 0.587f, 0.114f
- const unsigned char Y_shift = 8;//14
- const unsigned char R2Y = 77;
- const unsigned char G2Y = 150;
- const unsigned char B2Y = 29;
-
- m.create(w, h, 1, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr = m;
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- uint8x8_t _R2Y = vdup_n_u8(R2Y);
- uint8x8_t _G2Y = vdup_n_u8(G2Y);
- uint8x8_t _B2Y = vdup_n_u8(B2Y);
- for (; nn>0; nn--)
- {
- uint8x8x4_t _rgba = vld4_u8(rgba);
-
- uint16x8_t _y16 = vmull_u8(_rgba.val[0], _R2Y);
- _y16 = vmlal_u8(_y16, _rgba.val[1], _G2Y);
- _y16 = vmlal_u8(_y16, _rgba.val[2], _B2Y);
- _y16 = vshrq_n_u16(_y16, Y_shift);
-
- float32x4_t _ylow = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_y16)));
- float32x4_t _yhigh = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_y16)));
-
- vst1q_f32(ptr, _ylow);
- vst1q_f32(ptr+4, _yhigh);
-
- rgba += 4*8;
- ptr += 8;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "vdup.u8 d16, %6 \n"
- "vdup.u8 d17, %7 \n"
- "vdup.u8 d18, %8 \n"
- "0: \n"
- "pld [%1, #256] \n"
- "vld4.u8 {d0-d3}, [%1]! \n"
- "vmull.u8 q2, d0, d16 \n"
- "vmlal.u8 q2, d1, d17 \n"
- "vmlal.u8 q2, d2, d18 \n"
- "vshr.u16 q2, q2, #8 \n" // Y_shift
- "vmovl.u16 q0, d4 \n"
- "vmovl.u16 q1, d5 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%2 :128]! \n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(rgba), // %1
- "=r"(ptr) // %2
- : "0"(nn),
- "1"(rgba),
- "2"(ptr),
- "r"(R2Y), // %6
- "r"(G2Y), // %7
- "r"(B2Y) // %8
- : "cc", "memory", "q0", "q1", "q2", "q8", "q9"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr = static_cast<float>((rgba[0] * R2Y + rgba[1] * G2Y + rgba[2] * B2Y) >> Y_shift);
-
- rgba += 4;
- ptr++;
- }
-
- rgba += wgap;
- }
-
- return 0;
- }
-
- static int from_rgba2bgra(const unsigned char* rgba, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- m.create(w, h, 4, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr0 = m.channel(0);
- float* ptr1 = m.channel(1);
- float* ptr2 = m.channel(2);
- float* ptr3 = m.channel(3);
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- for (; nn>0; nn--)
- {
- uint8x8x4_t _rgba = vld4_u8(rgba);
- int16x8_t _r16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[0]));
- int16x8_t _g16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[1]));
- int16x8_t _b16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[2]));
- int16x8_t _a16 = vreinterpretq_s16_u16(vmovl_u8(_rgba.val[3]));
-
- float32x4_t _rlow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_r16)));
- float32x4_t _rhigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_r16)));
- float32x4_t _glow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_g16)));
- float32x4_t _ghigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_g16)));
- float32x4_t _blow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_b16)));
- float32x4_t _bhigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_b16)));
- float32x4_t _alow = vcvtq_f32_s32(vmovl_s16(vget_low_s16(_a16)));
- float32x4_t _ahigh = vcvtq_f32_s32(vmovl_s16(vget_high_s16(_a16)));
-
- vst1q_f32(ptr2, _rlow);
- vst1q_f32(ptr2+4, _rhigh);
- vst1q_f32(ptr1, _glow);
- vst1q_f32(ptr1+4, _ghigh);
- vst1q_f32(ptr0, _blow);
- vst1q_f32(ptr0+4, _bhigh);
- vst1q_f32(ptr3, _alow);
- vst1q_f32(ptr3+4, _ahigh);
-
- rgba += 4*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- ptr3 += 8;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "0: \n"
- "pld [%1, #256] \n"
- "vld4.u8 {d0-d3}, [%1]! \n"
- "vmovl.u8 q8, d0 \n"
- "vmovl.u8 q9, d1 \n"
- "vmovl.u8 q10, d2 \n"
- "vmovl.u8 q11, d3 \n"
- "vmovl.u16 q0, d16 \n"
- "vmovl.u16 q1, d17 \n"
- "vmovl.u16 q2, d18 \n"
- "vmovl.u16 q3, d19 \n"
- "vmovl.u16 q8, d20 \n"
- "vmovl.u16 q9, d21 \n"
- "vmovl.u16 q10, d22 \n"
- "vmovl.u16 q11, d23 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "vcvt.f32.u32 q2, q2 \n"
- "vcvt.f32.u32 q3, q3 \n"
- "vcvt.f32.u32 q8, q8 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%4 :128]! \n"
- "vcvt.f32.u32 q9, q9 \n"
- "vcvt.f32.u32 q10, q10 \n"
- "vst1.f32 {d4-d7}, [%3 :128]! \n"
- "vcvt.f32.u32 q11, q11 \n"
- "vst1.f32 {d16-d19}, [%2 :128]!\n"
- "vst1.f32 {d20-d23}, [%5 :128]!\n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(rgba), // %1
- "=r"(ptr0), // %2
- "=r"(ptr1), // %3
- "=r"(ptr2), // %4
- "=r"(ptr3) // %5
- : "0"(nn),
- "1"(rgba),
- "2"(ptr0),
- "3"(ptr1),
- "4"(ptr2),
- "5"(ptr3)
- : "cc", "memory", "q0", "q1", "q2", "q3", "q8", "q9", "q10", "q11"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr0 = rgba[2];
- *ptr1 = rgba[1];
- *ptr2 = rgba[0];
- *ptr3 = rgba[3];
-
- rgba += 4;
- ptr0++;
- ptr1++;
- ptr2++;
- ptr3++;
- }
-
- rgba += wgap;
- }
-
- return 0;
- }
-
- static void to_rgba2bgra(const Mat& m, unsigned char* bgra, int stride)
- {
- int w = m.w;
- int h = m.h;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- const float* ptr0 = m.channel(0);
- const float* ptr1 = m.channel(1);
- const float* ptr2 = m.channel(2);
- const float* ptr3 = m.channel(3);
-
- for (int y=0; y<h; y++)
- {
- #define SATURATE_CAST_UCHAR(X) (unsigned char)::std::min(::std::max((int)(X), 0), 255);
-
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- for (; nn>0; nn--)
- {
- float32x4_t _rlow = vld1q_f32(ptr0);
- float32x4_t _rhigh = vld1q_f32(ptr0+4);
- float32x4_t _glow = vld1q_f32(ptr1);
- float32x4_t _ghigh = vld1q_f32(ptr1+4);
- float32x4_t _blow = vld1q_f32(ptr2);
- float32x4_t _bhigh = vld1q_f32(ptr2+4);
- float32x4_t _alow = vld1q_f32(ptr3);
- float32x4_t _ahigh = vld1q_f32(ptr3+4);
-
- int16x8_t _r16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_rlow)), vmovn_s32(vcvtq_s32_f32(_rhigh)));
- int16x8_t _g16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_glow)), vmovn_s32(vcvtq_s32_f32(_ghigh)));
- int16x8_t _b16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_blow)), vmovn_s32(vcvtq_s32_f32(_bhigh)));
- int16x8_t _a16 = vcombine_s16(vmovn_s32(vcvtq_s32_f32(_alow)), vmovn_s32(vcvtq_s32_f32(_ahigh)));
-
- uint8x8x4_t _bgra;
- _bgra.val[0] = vqmovun_s16(_b16);
- _bgra.val[1] = vqmovun_s16(_g16);
- _bgra.val[2] = vqmovun_s16(_r16);
- _bgra.val[3] = vqmovun_s16(_a16);
-
- vst4_u8(bgra, _bgra);
-
- bgra += 4*8;
- ptr0 += 8;
- ptr1 += 8;
- ptr2 += 8;
- ptr3 += 8;
- }
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- bgra[0] = SATURATE_CAST_UCHAR(*ptr2);
- bgra[1] = SATURATE_CAST_UCHAR(*ptr1);
- bgra[2] = SATURATE_CAST_UCHAR(*ptr0);
- bgra[3] = SATURATE_CAST_UCHAR(*ptr3);
-
- bgra += 4;
- ptr0++;
- ptr1++;
- ptr2++;
- ptr3++;
- }
-
- #undef SATURATE_CAST_UCHAR
- bgra += wgap;
- }
- }
-
- static int from_bgra2gray(const unsigned char* bgra, int w, int h, int stride, Mat& m, Allocator* allocator)
- {
- // coeffs for r g b = 0.299f, 0.587f, 0.114f
- const unsigned char Y_shift = 8;//14
- const unsigned char R2Y = 77;
- const unsigned char G2Y = 150;
- const unsigned char B2Y = 29;
-
- m.create(w, h, 1, 4u, allocator);
- if (m.empty())
- return -100;
-
- const int wgap = stride - w * 4;
- if (wgap == 0)
- {
- w = w * h;
- h = 1;
- }
-
- float* ptr = m;
-
- for (int y=0; y<h; y++)
- {
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- uint8x8_t _R2Y = vdup_n_u8(R2Y);
- uint8x8_t _G2Y = vdup_n_u8(G2Y);
- uint8x8_t _B2Y = vdup_n_u8(B2Y);
- for (; nn>0; nn--)
- {
- uint8x8x4_t _bgra = vld4_u8(bgra);
-
- uint16x8_t _y16 = vmull_u8(_bgra.val[2], _R2Y);
- _y16 = vmlal_u8(_y16, _bgra.val[1], _G2Y);
- _y16 = vmlal_u8(_y16, _bgra.val[0], _B2Y);
- _y16 = vshrq_n_u16(_y16, Y_shift);
-
- float32x4_t _ylow = vcvtq_f32_u32(vmovl_u16(vget_low_u16(_y16)));
- float32x4_t _yhigh = vcvtq_f32_u32(vmovl_u16(vget_high_u16(_y16)));
-
- vst1q_f32(ptr, _ylow);
- vst1q_f32(ptr+4, _yhigh);
-
- bgra += 4*8;
- ptr += 8;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "vdup.u8 d16, %6 \n"
- "vdup.u8 d17, %7 \n"
- "vdup.u8 d18, %8 \n"
- "0: \n"
- "pld [%1, #256] \n"
- "vld4.u8 {d0-d3}, [%1]! \n"
- "vmull.u8 q2, d2, d16 \n"
- "vmlal.u8 q2, d1, d17 \n"
- "vmlal.u8 q2, d0, d18 \n"
- "vshr.u16 q2, q2, #8 \n" // Y_shift
- "vmovl.u16 q0, d4 \n"
- "vmovl.u16 q1, d5 \n"
- "vcvt.f32.u32 q0, q0 \n"
- "vcvt.f32.u32 q1, q1 \n"
- "subs %0, #1 \n"
- "vst1.f32 {d0-d3}, [%2 :128]! \n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(bgra), // %1
- "=r"(ptr) // %2
- : "0"(nn),
- "1"(bgra),
- "2"(ptr),
- "r"(R2Y), // %6
- "r"(G2Y), // %7
- "r"(B2Y) // %8
- : "cc", "memory", "q0", "q1", "q2", "q8", "q9"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
- for (; remain>0; remain--)
- {
- *ptr = static_cast<float>((bgra[2] * R2Y + bgra[1] * G2Y + bgra[0] * B2Y) >> Y_shift);
-
- bgra += 4;
- ptr++;
- }
-
- bgra += wgap;
- }
-
- return 0;
- }
-
- void yuv420sp2rgb(const unsigned char* yuv420sp, int w, int h, unsigned char* rgb)
- {
- const unsigned char* yptr = yuv420sp;
- const unsigned char* vuptr = yuv420sp + w * h;
-
- #if __ARM_NEON
- uint8x8_t _v128 = vdup_n_u8(128);
- int8x8_t _v90 = vdup_n_s8(90);
- int8x8_t _v46 = vdup_n_s8(46);
- int8x8_t _v22 = vdup_n_s8(22);
- int8x8_t _v113 = vdup_n_s8(113);
- #endif // __ARM_NEON
-
- for (int y=0; y<h; y+=2)
- {
- const unsigned char* yptr0 = yptr;
- const unsigned char* yptr1 = yptr + w;
- unsigned char* rgb0 = rgb;
- unsigned char* rgb1 = rgb + w*3;
-
- #if __ARM_NEON
- int nn = w >> 3;
- int remain = w - (nn << 3);
- #else
- int remain = w;
- #endif // __ARM_NEON
-
- #if __ARM_NEON
- #if __aarch64__
- for (; nn>0; nn--)
- {
- int16x8_t _yy0 = vreinterpretq_s16_u16(vshll_n_u8(vld1_u8(yptr0), 6));
- int16x8_t _yy1 = vreinterpretq_s16_u16(vshll_n_u8(vld1_u8(yptr1), 6));
-
- int8x8_t _vvuu = vreinterpret_s8_u8(vsub_u8(vld1_u8(vuptr), _v128));
- int8x8x2_t _vvvvuuuu = vtrn_s8(_vvuu, _vvuu);
- int8x8_t _vv = _vvvvuuuu.val[0];
- int8x8_t _uu = _vvvvuuuu.val[1];
-
- int16x8_t _r0 = vmlal_s8(_yy0, _vv, _v90);
- int16x8_t _g0 = vmlsl_s8(_yy0, _vv, _v46);
- _g0 = vmlsl_s8(_g0, _uu, _v22);
- int16x8_t _b0 = vmlal_s8(_yy0, _uu, _v113);
-
- int16x8_t _r1 = vmlal_s8(_yy1, _vv, _v90);
- int16x8_t _g1 = vmlsl_s8(_yy1, _vv, _v46);
- _g1 = vmlsl_s8(_g1, _uu, _v22);
- int16x8_t _b1 = vmlal_s8(_yy1, _uu, _v113);
-
- uint8x8x3_t _rgb0;
- _rgb0.val[0] = vqshrun_n_s16(_r0, 6);
- _rgb0.val[1] = vqshrun_n_s16(_g0, 6);
- _rgb0.val[2] = vqshrun_n_s16(_b0, 6);
-
- uint8x8x3_t _rgb1;
- _rgb1.val[0] = vqshrun_n_s16(_r1, 6);
- _rgb1.val[1] = vqshrun_n_s16(_g1, 6);
- _rgb1.val[2] = vqshrun_n_s16(_b1, 6);
-
- vst3_u8(rgb0, _rgb0);
- vst3_u8(rgb1, _rgb1);
-
- yptr0 += 8;
- yptr1 += 8;
- vuptr += 8;
- rgb0 += 24;
- rgb1 += 24;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "pld [%3, #128] \n"
- "vld1.u8 {d2}, [%3]! \n"
- "vsub.s8 d2, d2, %12 \n"
- "0: \n"
- "pld [%1, #128] \n"
- "vld1.u8 {d0}, [%1]! \n"
- "pld [%2, #128] \n"
- "vld1.u8 {d1}, [%2]! \n"
- "vshll.u8 q2, d0, #6 \n"
- "vorr d3, d2, d2 \n"
- "vshll.u8 q3, d1, #6 \n"
- "vorr q9, q2, q2 \n"
- "vtrn.s8 d2, d3 \n"
- "vorr q11, q3, q3 \n"
- "vmlsl.s8 q9, d2, %14 \n"
- "vorr q8, q2, q2 \n"
- "vmlsl.s8 q11, d2, %14 \n"
- "vorr q10, q3, q3 \n"
- "vmlal.s8 q8, d2, %13 \n"
- "vmlal.s8 q2, d3, %16 \n"
- "vmlal.s8 q10, d2, %13 \n"
- "vmlsl.s8 q9, d3, %15 \n"
- "vmlal.s8 q3, d3, %16 \n"
- "vmlsl.s8 q11, d3, %15 \n"
- "vqshrun.s16 d24, q8, #6 \n"
- "vqshrun.s16 d26, q2, #6 \n"
- "vqshrun.s16 d4, q10, #6 \n"
- "vqshrun.s16 d25, q9, #6 \n"
- "vqshrun.s16 d6, q3, #6 \n"
- "vqshrun.s16 d5, q11, #6 \n"
- "pld [%3, #128] \n"
- "vld1.u8 {d2}, [%3]! \n"
- "subs %0, #1 \n"
- "vst3.u8 {d24-d26}, [%4]! \n"
- "vsub.s8 d2, d2, %12 \n"
- "vst3.u8 {d4-d6}, [%5]! \n"
- "bne 0b \n"
- "sub %3, #8 \n"
- : "=r"(nn), // %0
- "=r"(yptr0), // %1
- "=r"(yptr1), // %2
- "=r"(vuptr), // %3
- "=r"(rgb0), // %4
- "=r"(rgb1) // %5
- : "0"(nn),
- "1"(yptr0),
- "2"(yptr1),
- "3"(vuptr),
- "4"(rgb0),
- "5"(rgb1),
- "w"(_v128), // %12
- "w"(_v90), // %13
- "w"(_v46), // %14
- "w"(_v22), // %15
- "w"(_v113) // %16
- : "cc", "memory", "q0", "q1", "q2", "q3", "q8", "q9", "q10", "q11", "q12", "d26"
- );
- }
- #endif // __aarch64__
- #endif // __ARM_NEON
-
- #define SATURATE_CAST_UCHAR(X) (unsigned char)::std::min(::std::max((int)(X), 0), 255);
- for (; remain>0; remain-=2)
- {
- // R = 1.164 * yy + 1.596 * vv
- // G = 1.164 * yy - 0.813 * vv - 0.391 * uu
- // B = 1.164 * yy + 2.018 * uu
-
- // R = Y + (1.370705 * (V-128))
- // G = Y - (0.698001 * (V-128)) - (0.337633 * (U-128))
- // B = Y + (1.732446 * (U-128))
-
- // R = ((Y << 6) + 87.72512 * (V-128)) >> 6
- // G = ((Y << 6) - 44.672064 * (V-128) - 21.608512 * (U-128)) >> 6
- // B = ((Y << 6) + 110.876544 * (U-128)) >> 6
-
- // R = ((Y << 6) + 90 * (V-128)) >> 6
- // G = ((Y << 6) - 46 * (V-128) - 22 * (U-128)) >> 6
- // B = ((Y << 6) + 113 * (U-128)) >> 6
-
- // R = (yy + 90 * vv) >> 6
- // G = (yy - 46 * vv - 22 * uu) >> 6
- // B = (yy + 113 * uu) >> 6
-
- int v = vuptr[0] - 128;
- int u = vuptr[1] - 128;
-
- int ruv = 90 * v;
- int guv = -46 * v + -22 * u;
- int buv = 113 * u;
-
- int y00 = yptr0[0] << 6;
- rgb0[0] = SATURATE_CAST_UCHAR((y00 + ruv) >> 6);
- rgb0[1] = SATURATE_CAST_UCHAR((y00 + guv) >> 6);
- rgb0[2] = SATURATE_CAST_UCHAR((y00 + buv) >> 6);
-
- int y01 = yptr0[1] << 6;
- rgb0[3] = SATURATE_CAST_UCHAR((y01 + ruv) >> 6);
- rgb0[4] = SATURATE_CAST_UCHAR((y01 + guv) >> 6);
- rgb0[5] = SATURATE_CAST_UCHAR((y01 + buv) >> 6);
-
- int y10 = yptr1[0] << 6;
- rgb1[0] = SATURATE_CAST_UCHAR((y10 + ruv) >> 6);
- rgb1[1] = SATURATE_CAST_UCHAR((y10 + guv) >> 6);
- rgb1[2] = SATURATE_CAST_UCHAR((y10 + buv) >> 6);
-
- int y11 = yptr1[1] << 6;
- rgb1[3] = SATURATE_CAST_UCHAR((y11 + ruv) >> 6);
- rgb1[4] = SATURATE_CAST_UCHAR((y11 + guv) >> 6);
- rgb1[5] = SATURATE_CAST_UCHAR((y11 + buv) >> 6);
-
- yptr0 += 2;
- yptr1 += 2;
- vuptr += 2;
- rgb0 += 6;
- rgb1 += 6;
- }
- #undef SATURATE_CAST_UCHAR
-
- yptr += 2*w;
- rgb += 2*3*w;
- }
- }
-
- Mat Mat::from_pixels(const unsigned char* pixels, int type, int w, int h, Allocator* allocator)
- {
- int type_from = type & PIXEL_FORMAT_MASK;
-
- if (type_from == PIXEL_RGB || type_from == PIXEL_BGR)
- {
- return Mat::from_pixels(pixels, type, w, h, w * 3, allocator);
- }
- else if (type_from == PIXEL_GRAY)
- {
- return Mat::from_pixels(pixels, type, w, h, w * 1, allocator);
- }
- else if (type_from == PIXEL_RGBA || type_from == PIXEL_BGRA)
- {
- return Mat::from_pixels(pixels, type, w, h, w * 4, allocator);
- }
-
- // unknown convert type
- return Mat();
- }
-
- Mat Mat::from_pixels(const unsigned char* pixels, int type, int w, int h, int stride, Allocator* allocator)
- {
- Mat m;
-
- if (type & PIXEL_CONVERT_MASK)
- {
- switch (type)
- {
- case PIXEL_RGB2BGR:
- case PIXEL_BGR2RGB:
- from_rgb2bgr(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_RGB2GRAY:
- from_rgb2gray(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_RGB2RGBA:
- case PIXEL_BGR2BGRA:
- from_rgb2rgba(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_BGR2GRAY:
- from_bgr2gray(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_BGR2RGBA:
- case PIXEL_RGB2BGRA:
- from_bgr2rgba(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_GRAY2RGB:
- case PIXEL_GRAY2BGR:
- from_gray2rgb(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_GRAY2RGBA:
- case PIXEL_GRAY2BGRA:
- from_gray2rgba(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_RGBA2RGB:
- case PIXEL_BGRA2BGR:
- from_rgba2rgb(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_RGBA2BGR:
- case PIXEL_BGRA2RGB:
- from_rgba2bgr(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_RGBA2GRAY:
- from_rgba2gray(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_RGBA2BGRA:
- case PIXEL_BGRA2RGBA:
- from_rgba2bgra(pixels, w, h, stride, m, allocator);
- break;
- case PIXEL_BGRA2GRAY:
- from_bgra2gray(pixels, w, h, stride, m, allocator);
- break;
- default:
- // unimplemented convert type
- break;
- }
- }
- else
- {
- if (type == PIXEL_RGB || type == PIXEL_BGR)
- from_rgb(pixels, w, h, stride, m, allocator);
-
- if (type == PIXEL_GRAY)
- from_gray(pixels, w, h, stride, m, allocator);
-
- if (type == PIXEL_RGBA || type == PIXEL_BGRA)
- from_rgba(pixels, w, h, stride, m, allocator);
- }
-
- return m;
- }
-
- Mat Mat::from_pixels_resize(const unsigned char* pixels, int type, int w, int h, int target_width, int target_height, Allocator* allocator)
- {
- int type_from = type & PIXEL_FORMAT_MASK;
-
- if (type_from == PIXEL_RGB || type_from == PIXEL_BGR)
- {
- return Mat::from_pixels_resize(pixels, type, w, h, w * 3, target_width, target_height, allocator);
- }
- else if (type_from == PIXEL_GRAY)
- {
- return Mat::from_pixels_resize(pixels, type, w, h, w * 1, target_width, target_height, allocator);
- }
- else if (type_from == PIXEL_RGBA || type_from == PIXEL_BGRA)
- {
- return Mat::from_pixels_resize(pixels, type, w, h, w * 4, target_width, target_height, allocator);
- }
-
- // unknown convert type
- return Mat();
- }
-
- Mat Mat::from_pixels_resize(const unsigned char* pixels, int type, int w, int h, int stride, int target_width, int target_height, Allocator* allocator)
- {
- if (w == target_width && h == target_height)
- return Mat::from_pixels(pixels, type, w, h, stride, allocator);
-
- int type_from = type & PIXEL_FORMAT_MASK;
-
- if (type_from == PIXEL_RGB || type_from == PIXEL_BGR)
- {
- Mat dst(target_width, target_height, (size_t)3u, 3);
- resize_bilinear_c3(pixels, w, h, stride, dst, target_width, target_height, target_width * 3);
-
- return Mat::from_pixels(dst, type, target_width, target_height, allocator);
- }
- else if (type_from == PIXEL_GRAY)
- {
- Mat dst(target_width, target_height, (size_t)1u, 1);
- resize_bilinear_c1(pixels, w, h, stride, dst, target_width, target_height, target_width * 1);
-
- return Mat::from_pixels(dst, type, target_width, target_height, allocator);
- }
- else if (type_from == PIXEL_RGBA || type_from == PIXEL_BGRA)
- {
- Mat dst(target_width, target_height, (size_t)4u, 4);
- resize_bilinear_c4(pixels, w, h, stride, dst, target_width, target_height, target_width * 4);
-
- return Mat::from_pixels(dst, type, target_width, target_height, allocator);
- }
-
- // unknown convert type
- return Mat();
- }
-
- void Mat::to_pixels(unsigned char* pixels, int type) const
- {
- int type_to = (type & PIXEL_CONVERT_MASK) ? (type >> PIXEL_CONVERT_SHIFT) : (type & PIXEL_FORMAT_MASK);
-
- if (type_to == PIXEL_RGB || type_to == PIXEL_BGR)
- {
- to_pixels(pixels, type, w * 3);
- }
- else if (type_to == PIXEL_GRAY)
- {
- to_pixels(pixels, type, w * 1);
- }
- else if (type_to == PIXEL_RGBA || type_to == PIXEL_BGRA)
- {
- to_pixels(pixels, type, w * 4);
- }
- }
-
- void Mat::to_pixels(unsigned char* pixels, int type, int stride) const
- {
- if (type & PIXEL_CONVERT_MASK)
- {
- switch (type)
- {
- case PIXEL_RGB2BGR:
- case PIXEL_BGR2RGB:
- to_bgr2rgb(*this, pixels, stride);
- break;
- case PIXEL_RGB2RGBA:
- case PIXEL_BGR2BGRA:
- to_rgb2rgba(*this, pixels, stride);
- break;
- case PIXEL_BGR2RGBA:
- case PIXEL_RGB2BGRA:
- to_bgr2rgba(*this, pixels, stride);
- break;
- case PIXEL_GRAY2RGBA:
- case PIXEL_GRAY2BGRA:
- to_gray2rgba(*this, pixels, stride);
- break;
- case PIXEL_RGBA2BGRA:
- case PIXEL_BGRA2RGBA:
- to_rgba2bgra(*this, pixels, stride);
- break;
- default:
- // unimplemented convert type
- break;
- }
- }
- else
- {
- if (type == PIXEL_RGB || type == PIXEL_BGR)
- to_rgb(*this, pixels, stride);
-
- if (type == PIXEL_GRAY)
- to_gray(*this, pixels, stride);
-
- if (type == PIXEL_RGBA || type == PIXEL_BGRA)
- to_rgba(*this, pixels, stride);
- }
- }
-
- void Mat::to_pixels_resize(unsigned char* pixels, int type, int target_width, int target_height) const
- {
- int type_to = (type & PIXEL_CONVERT_MASK) ? (type >> PIXEL_CONVERT_SHIFT) : (type & PIXEL_FORMAT_MASK);
-
- if (type_to == PIXEL_RGB || type_to == PIXEL_BGR)
- {
- to_pixels_resize(pixels, type, target_width, target_height, target_width * 3);
- }
- else if (type_to == PIXEL_GRAY)
- {
- to_pixels_resize(pixels, type, target_width, target_height, target_width * 1);
- }
- else if (type_to == PIXEL_RGBA || type_to == PIXEL_BGRA)
- {
- to_pixels_resize(pixels, type, target_width, target_height, target_width * 4);
- }
- }
-
- void Mat::to_pixels_resize(unsigned char* pixels, int type, int target_width, int target_height, int target_stride) const
- {
- if (w == target_width && h == target_height)
- return to_pixels(pixels, type);
-
- int type_to = (type & PIXEL_CONVERT_MASK) ? (type >> PIXEL_CONVERT_SHIFT) : (type & PIXEL_FORMAT_MASK);
-
- if (type_to == PIXEL_RGB || type_to == PIXEL_BGR)
- {
- Mat src(w, h, (size_t)3u, 3);
-
- to_pixels(src, type);
-
- resize_bilinear_c3(src, w, h, w * 3, pixels, target_width, target_height, target_stride);
- }
- else if (type_to == PIXEL_GRAY)
- {
- Mat src(w, h, (size_t)1u, 1);
-
- to_pixels(src, type);
-
- resize_bilinear_c1(src, w, h, w * 1, pixels, target_width, target_height, target_stride);
- }
- else if (type_to == PIXEL_RGBA || type_to == PIXEL_BGRA)
- {
- Mat src(w, h, (size_t)4u, 4);
-
- to_pixels(src, type);
-
- resize_bilinear_c4(src, w, h, w * 4, pixels, target_width, target_height, target_stride);
- }
- }
- #endif // NCNN_PIXEL
-
- } // namespace ncnn
|