|
12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807 |
- // Copyright 2017 Tencent
- // SPDX-License-Identifier: BSD-3-Clause
-
- #include "mat.h"
-
- #include <limits.h>
-
- #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 !NCNN_GNU_INLINE_ASM || __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]! \n"
- "vcvt.f32.u32 q9, q9 \n"
- "vst1.f32 {d4-d7}, [%3]! \n"
- "vst1.f32 {d16-d19}, [%4]! \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 !NCNN_GNU_INLINE_ASM || __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]! \n"
- "vst1.f32 {d4-d7}, [%2]! \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 !NCNN_GNU_INLINE_ASM || __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]! \n"
- "vcvt.f32.u32 q10, q10 \n"
- "vcvt.f32.u32 q11, q11 \n"
- "vst1.f32 {d4-d7}, [%3]! \n"
- "vst1.f32 {d16-d19}, [%4]! \n"
- "vst1.f32 {d20-d23}, [%5]! \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 !NCNN_GNU_INLINE_ASM || __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]! \n"
- "vcvt.f32.u32 q9, q9 \n"
- "vst1.f32 {d4-d7}, [%3]! \n"
- "vst1.f32 {d16-d19}, [%2]! \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 !NCNN_GNU_INLINE_ASM || __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]! \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 !NCNN_GNU_INLINE_ASM || __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]! \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 !NCNN_GNU_INLINE_ASM || __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]! \n"
- "vst1.f32 {d4-d7}, [%2]! \n"
- "vst1.f32 {d0-d3}, [%3]! \n"
- "vst1.f32 {d4-d7}, [%3]! \n"
- "vst1.f32 {d0-d3}, [%4]! \n"
- "vst1.f32 {d4-d7}, [%4]! \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 !NCNN_GNU_INLINE_ASM || __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]! \n"
- "vcvt.f32.u32 q9, q9 \n"
- "vst1.f32 {d4-d7}, [%3]! \n"
- "vst1.f32 {d16-d19}, [%4]! \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 !NCNN_GNU_INLINE_ASM || __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]! \n"
- "vcvt.f32.u32 q9, q9 \n"
- "vst1.f32 {d4-d7}, [%3]! \n"
- "vst1.f32 {d16-d19}, [%2]! \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 !NCNN_GNU_INLINE_ASM || __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]! \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 !NCNN_GNU_INLINE_ASM || __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]! \n"
- "vcvt.f32.u32 q9, q9 \n"
- "vcvt.f32.u32 q10, q10 \n"
- "vst1.f32 {d4-d7}, [%3]! \n"
- "vcvt.f32.u32 q11, q11 \n"
- "vst1.f32 {d16-d19}, [%2]! \n"
- "vst1.f32 {d20-d23}, [%5]! \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 !NCNN_GNU_INLINE_ASM || __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]! \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 !NCNN_GNU_INLINE_ASM || __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(
- "0: \n"
- "pld [%3, #128] \n"
- "vld1.u8 {d2}, [%3]! \n"
- "vsub.s8 d2, d2, %12 \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"
- "subs %0, #1 \n"
- "vst3.u8 {d24-d26}, [%4]! \n"
- "vst3.u8 {d4-d6}, [%5]! \n"
- "bne 0b \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;
- }
- }
-
- void yuv420sp2rgb_nv12(const unsigned char* yuv420sp, int w, int h, unsigned char* rgb)
- {
- const unsigned char* yptr = yuv420sp;
- const unsigned char* uvptr = 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 !NCNN_GNU_INLINE_ASM || __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 _uuvv = vreinterpret_s8_u8(vsub_u8(vld1_u8(uvptr), _v128));
- int8x8x2_t _uuuuvvvv = vtrn_s8(_uuvv, _uuvv);
- int8x8_t _uu = _uuuuvvvv.val[0];
- int8x8_t _vv = _uuuuvvvv.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;
- uvptr += 8;
- rgb0 += 24;
- rgb1 += 24;
- }
- #else
- if (nn > 0)
- {
- asm volatile(
- "0: \n"
- "pld [%3, #128] \n"
- "vld1.u8 {d2}, [%3]! \n"
- "vsub.s8 d2, d2, %12 \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, d3, %14 \n"
- "vorr q8, q2, q2 \n"
- "vmlsl.s8 q11, d3, %14 \n"
- "vorr q10, q3, q3 \n"
- "vmlal.s8 q8, d3, %13 \n"
- "vmlal.s8 q2, d2, %16 \n"
- "vmlal.s8 q10, d3, %13 \n"
- "vmlsl.s8 q9, d2, %15 \n"
- "vmlal.s8 q3, d2, %16 \n"
- "vmlsl.s8 q11, d2, %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"
- "subs %0, #1 \n"
- "vst3.u8 {d24-d26}, [%4]! \n"
- "vst3.u8 {d4-d6}, [%5]! \n"
- "bne 0b \n"
- : "=r"(nn), // %0
- "=r"(yptr0), // %1
- "=r"(yptr1), // %2
- "=r"(uvptr), // %3
- "=r"(rgb0), // %4
- "=r"(rgb1) // %5
- : "0"(nn),
- "1"(yptr0),
- "2"(yptr1),
- "3"(uvptr),
- "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 u = uvptr[0] - 128;
- int v = uvptr[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;
- uvptr += 2;
- rgb0 += 6;
- rgb1 += 6;
- }
- #undef SATURATE_CAST_UCHAR
-
- yptr += 2 * w;
- rgb += 2 * 3 * w;
- }
- }
-
- void yuv420sp2rgb_half(const unsigned char* yuv, int w, int h, unsigned char* rgb)
- {
- const unsigned char* puv = yuv + w * h;
- const unsigned char *py0 = yuv, *py1 = yuv + w;
- const int hstep = h / 2;
- #if __ARM_NEON
- const int wstep = w / 16, tailstep = (w - wstep * 16) / 2;
- uint8x8_t _u128 = vdup_n_u8(128);
- int8x8_t _s90 = vdup_n_s8(90);
- int8x8_t _sn46 = vdup_n_s8(-46);
- int8x8_t _s113 = vdup_n_s8(113);
- int8x8_t _sn22 = vdup_n_s8(-22);
- int16x8_t _s0 = vdupq_n_s16(0);
- int16x8_t _s16320 = vdupq_n_s16(16320); // 255 << 6
- #else
- const int tailstep = w / 2;
- #endif
-
- for (int i = 0; i < hstep; ++i)
- {
- #if __ARM_NEON
- for (int j = 0; j < wstep; ++j)
- {
- uint8x16_t y0 = vld1q_u8(py0);
- uint8x16_t y1 = vld1q_u8(py1);
-
- // first 8 Y
- uint16x8_t low = vaddl_u8(vget_low_u8(y0), vget_low_u8(y1));
- uint16x4_t low_sum = vpadd_u16(vget_low_u16(low), vget_high_u16(low));
-
- // last 8 Y
- uint16x8_t high = vaddl_u8(vget_high_u8(y0), vget_high_u8(y1));
- uint16x4_t high_sum = vpadd_u16(vget_low_u16(high), vget_high_u16(high));
-
- uint16x8_t y8_sum = vcombine_u16(low_sum, high_sum);
- // y8 = (y8_sum >> 2) << 6 = y8_sum << 4;
- int16x8_t y8 = vreinterpretq_s16_u16(vshlq_n_u16(y8_sum, 4));
-
- // prepare uv
- uint8x8x2_t vu = vld2_u8(puv);
- int8x8_t v = vreinterpret_s8_u8(vsub_u8(vu.val[0], _u128));
- int8x8_t u = vreinterpret_s8_u8(vsub_u8(vu.val[1], _u128));
-
- int16x8_t r_acc = vmlal_s8(y8, v, _s90);
- int16x8_t g_acc = vmlal_s8(y8, v, _sn46);
- g_acc = vmlal_s8(g_acc, u, _sn22);
- int16x8_t b_acc = vmlal_s8(y8, u, _s113);
-
- #define SHIFT_6_SATURATE(FROM, TO) \
- FROM = vmaxq_s16(vminq_s16((FROM), _s16320), _s0); \
- uint8x8_t TO = vshrn_n_u16(vreinterpretq_u16_s16((FROM)), 6);
-
- SHIFT_6_SATURATE(b_acc, b_out)
- SHIFT_6_SATURATE(g_acc, g_out)
- SHIFT_6_SATURATE(r_acc, r_out)
- #undef SHIFT_6_SATURATE
-
- uint8x8x3_t _rgb;
- _rgb.val[0] = r_out;
- _rgb.val[1] = g_out;
- _rgb.val[2] = b_out;
- vst3_u8(rgb, _rgb);
-
- rgb += 24;
- py0 += 16;
- py1 += 16;
- puv += 16;
- }
- #endif
-
- for (int idx = 0; idx < tailstep; ++idx)
- {
- int y = (static_cast<int>(py0[0]) + py0[1] + py1[2] + py1[1]) << 4;
- int v = static_cast<int>(puv[0]) - 128;
- int u = static_cast<int>(puv[1]) - 128;
-
- int ruv = 90 * v;
- int guv = -46 * v + -22 * u;
- int buv = 113 * u;
-
- #define SATURATE_CAST_UCHAR(X) (unsigned char)::std::min(::std::max((int)(X), 0), 255);
- rgb[0] = SATURATE_CAST_UCHAR((y + ruv) >> 6);
- rgb[1] = SATURATE_CAST_UCHAR((y + guv) >> 6);
- rgb[2] = SATURATE_CAST_UCHAR((y + buv) >> 6);
- #undef SATURATE_CAST_UCHAR
-
- rgb += 3;
- py0 += 2;
- py1 += 2;
- puv += 2;
- }
- // next two row
- py0 = py1;
- py1 = py0 + 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
- NCNN_LOGE("unknown convert type %d", 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
- NCNN_LOGE("unimplemented convert type %d", 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
- NCNN_LOGE("unknown convert type %d", 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
- NCNN_LOGE("unknown convert type %d", type);
- return Mat();
- }
-
- Mat Mat::from_pixels_roi(const unsigned char* pixels, int type, int w, int h, int roix, int roiy, int roiw, int roih, Allocator* allocator)
- {
- if (roix < 0 || roiy < 0 || roiw <= 0 || roih <= 0 || roix + roiw > w || roiy + roih > h)
- {
- NCNN_LOGE("roi %d %d %d %d out of image %d %d", roix, roiy, roiw, roih, w, h);
- return Mat();
- }
-
- int type_from = type & PIXEL_FORMAT_MASK;
-
- if (type_from == PIXEL_RGB || type_from == PIXEL_BGR)
- {
- return from_pixels(pixels + (roiy * w + roix) * 3, type, roiw, roih, w * 3, allocator);
- }
- else if (type_from == PIXEL_GRAY)
- {
- return from_pixels(pixels + (roiy * w + roix) * 1, type, roiw, roih, w * 1, allocator);
- }
- else if (type_from == PIXEL_RGBA || type_from == PIXEL_BGRA)
- {
- return from_pixels(pixels + (roiy * w + roix) * 4, type, roiw, roih, w * 4, allocator);
- }
-
- // unknown convert type
- NCNN_LOGE("unknown convert type %d", type);
- return Mat();
- }
-
- Mat Mat::from_pixels_roi(const unsigned char* pixels, int type, int w, int h, int stride, int roix, int roiy, int roiw, int roih, Allocator* allocator)
- {
- if (roix < 0 || roiy < 0 || roiw <= 0 || roih <= 0 || roix + roiw > w || roiy + roih > h)
- {
- NCNN_LOGE("roi %d %d %d %d out of image %d %d", roix, roiy, roiw, roih, w, h);
- return Mat();
- }
-
- int type_from = type & PIXEL_FORMAT_MASK;
-
- if (type_from == PIXEL_RGB || type_from == PIXEL_BGR)
- {
- return from_pixels(pixels + roiy * stride + roix * 3, type, roiw, roih, stride, allocator);
- }
- else if (type_from == PIXEL_GRAY)
- {
- return from_pixels(pixels + roiy * stride + roix * 1, type, roiw, roih, stride, allocator);
- }
- else if (type_from == PIXEL_RGBA || type_from == PIXEL_BGRA)
- {
- return from_pixels(pixels + roiy * stride + roix * 4, type, roiw, roih, stride, allocator);
- }
-
- // unknown convert type
- NCNN_LOGE("unknown convert type %d", type);
- return Mat();
- }
-
- Mat Mat::from_pixels_roi_resize(const unsigned char* pixels, int type, int w, int h, int roix, int roiy, int roiw, int roih, int target_width, int target_height, Allocator* allocator)
- {
- if (roix < 0 || roiy < 0 || roiw <= 0 || roih <= 0 || roix + roiw > w || roiy + roih > h)
- {
- NCNN_LOGE("roi %d %d %d %d out of image %d %d", roix, roiy, roiw, roih, w, h);
- return Mat();
- }
-
- int type_from = type & PIXEL_FORMAT_MASK;
-
- if (type_from == PIXEL_RGB || type_from == PIXEL_BGR)
- {
- return from_pixels_resize(pixels + (roiy * w + roix) * 3, type, roiw, roih, w * 3, target_width, target_height, allocator);
- }
- else if (type_from == PIXEL_GRAY)
- {
- return from_pixels_resize(pixels + (roiy * w + roix) * 1, type, roiw, roih, w * 1, target_width, target_height, allocator);
- }
- else if (type_from == PIXEL_RGBA || type_from == PIXEL_BGRA)
- {
- return from_pixels_resize(pixels + (roiy * w + roix) * 4, type, roiw, roih, w * 4, target_width, target_height, allocator);
- }
-
- // unknown convert type
- NCNN_LOGE("unknown convert type %d", type);
- return Mat();
- }
-
- Mat Mat::from_pixels_roi_resize(const unsigned char* pixels, int type, int w, int h, int stride, int roix, int roiy, int roiw, int roih, int target_width, int target_height, Allocator* allocator)
- {
- if (roix < 0 || roiy < 0 || roiw <= 0 || roih <= 0 || roix + roiw > w || roiy + roih > h)
- {
- NCNN_LOGE("roi %d %d %d %d out of image %d %d", roix, roiy, roiw, roih, w, h);
- return Mat();
- }
-
- int type_from = type & PIXEL_FORMAT_MASK;
-
- if (type_from == PIXEL_RGB || type_from == PIXEL_BGR)
- {
- return from_pixels_resize(pixels + roiy * stride + roix * 3, type, roiw, roih, stride, target_width, target_height, allocator);
- }
- else if (type_from == PIXEL_GRAY)
- {
- return from_pixels_resize(pixels + roiy * stride + roix * 1, type, roiw, roih, stride, target_width, target_height, allocator);
- }
- else if (type_from == PIXEL_RGBA || type_from == PIXEL_BGRA)
- {
- return from_pixels_resize(pixels + roiy * stride + roix * 4, type, roiw, roih, stride, target_width, target_height, allocator);
- }
-
- // unknown convert type
- NCNN_LOGE("unknown convert type %d", 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
- NCNN_LOGE("unimplemented convert type %d", 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
|