|
1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818 |
- // 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>
- #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]! \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 __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 __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 __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 __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 __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 __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 __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 __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 __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 __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 __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 __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 __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
|