12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * uvc_configfs.c
- *
- * Configfs support for the uvc function.
- *
- * Copyright (c) 2014 Samsung Electronics Co., Ltd.
- * http://www.samsung.com
- *
- * Author: Andrzej Pietrasiewicz <andrzej.p@samsung.com>
- */
- #include <linux/sort.h>
- #include "u_uvc.h"
- #include "uvc_configfs.h"
- #define UVCG_STREAMING_CONTROL_SIZE 1
- #define UVC_ATTR(prefix, cname, aname) \
- static struct configfs_attribute prefix##attr_##cname = { \
- .ca_name = __stringify(aname), \
- .ca_mode = S_IRUGO | S_IWUGO, \
- .ca_owner = THIS_MODULE, \
- .show = prefix##cname##_show, \
- .store = prefix##cname##_store, \
- }
- #define UVC_ATTR_RO(prefix, cname, aname) \
- static struct configfs_attribute prefix##attr_##cname = { \
- .ca_name = __stringify(aname), \
- .ca_mode = S_IRUGO, \
- .ca_owner = THIS_MODULE, \
- .show = prefix##cname##_show, \
- }
- static int uvcg_config_compare_u32(const void *l, const void *r)
- {
- u32 li = *(const u32 *)l;
- u32 ri = *(const u32 *)r;
- return li < ri ? -1 : li == ri ? 0 : 1;
- }
- static inline struct f_uvc_opts *to_f_uvc_opts(struct config_item *item)
- {
- return container_of(to_config_group(item), struct f_uvc_opts,
- func_inst.group);
- }
- /* control/header/<NAME> */
- DECLARE_UVC_HEADER_DESCRIPTOR(1);
- struct uvcg_control_header {
- struct config_item item;
- struct UVC_HEADER_DESCRIPTOR(1) desc;
- unsigned linked;
- };
- static struct uvcg_control_header *to_uvcg_control_header(struct config_item *item)
- {
- return container_of(item, struct uvcg_control_header, item);
- }
- #define UVCG_CTRL_HDR_ATTR(cname, aname, conv, str2u, uxx, vnoc, limit) \
- static ssize_t uvcg_control_header_##cname##_show( \
- struct config_item *item, char *page) \
- { \
- struct uvcg_control_header *ch = to_uvcg_control_header(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &ch->item.ci_group->cg_subsys->su_mutex;\
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = ch->item.ci_parent->ci_parent->ci_parent; \
- opts = to_f_uvc_opts(opts_item); \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(ch->desc.aname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- return result; \
- } \
- \
- static ssize_t \
- uvcg_control_header_##cname##_store(struct config_item *item, \
- const char *page, size_t len) \
- { \
- struct uvcg_control_header *ch = to_uvcg_control_header(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &ch->item.ci_group->cg_subsys->su_mutex;\
- int ret; \
- uxx num; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = ch->item.ci_parent->ci_parent->ci_parent; \
- opts = to_f_uvc_opts(opts_item); \
- \
- mutex_lock(&opts->lock); \
- if (ch->linked || opts->refcnt) { \
- ret = -EBUSY; \
- goto end; \
- } \
- \
- ret = str2u(page, 0, &num); \
- if (ret) \
- goto end; \
- \
- if (num > limit) { \
- ret = -EINVAL; \
- goto end; \
- } \
- ch->desc.aname = vnoc(num); \
- ret = len; \
- end: \
- mutex_unlock(&opts->lock); \
- mutex_unlock(su_mutex); \
- return ret; \
- } \
- \
- UVC_ATTR(uvcg_control_header_, cname, aname)
- UVCG_CTRL_HDR_ATTR(bcd_uvc, bcdUVC, le16_to_cpu, kstrtou16, u16, cpu_to_le16,
- 0xffff);
- UVCG_CTRL_HDR_ATTR(dw_clock_frequency, dwClockFrequency, le32_to_cpu, kstrtou32,
- u32, cpu_to_le32, 0x7fffffff);
- #undef UVCG_CTRL_HDR_ATTR
- static struct configfs_attribute *uvcg_control_header_attrs[] = {
- &uvcg_control_header_attr_bcd_uvc,
- &uvcg_control_header_attr_dw_clock_frequency,
- NULL,
- };
- static const struct config_item_type uvcg_control_header_type = {
- .ct_attrs = uvcg_control_header_attrs,
- .ct_owner = THIS_MODULE,
- };
- static struct config_item *uvcg_control_header_make(struct config_group *group,
- const char *name)
- {
- struct uvcg_control_header *h;
- h = kzalloc(sizeof(*h), GFP_KERNEL);
- if (!h)
- return ERR_PTR(-ENOMEM);
- h->desc.bLength = UVC_DT_HEADER_SIZE(1);
- h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
- h->desc.bDescriptorSubType = UVC_VC_HEADER;
- h->desc.bcdUVC = cpu_to_le16(0x0100);
- h->desc.dwClockFrequency = cpu_to_le32(48000000);
- config_item_init_type_name(&h->item, name, &uvcg_control_header_type);
- return &h->item;
- }
- static void uvcg_control_header_drop(struct config_group *group,
- struct config_item *item)
- {
- struct uvcg_control_header *h = to_uvcg_control_header(item);
- kfree(h);
- }
- /* control/header */
- static struct uvcg_control_header_grp {
- struct config_group group;
- } uvcg_control_header_grp;
- static struct configfs_group_operations uvcg_control_header_grp_ops = {
- .make_item = uvcg_control_header_make,
- .drop_item = uvcg_control_header_drop,
- };
- static const struct config_item_type uvcg_control_header_grp_type = {
- .ct_group_ops = &uvcg_control_header_grp_ops,
- .ct_owner = THIS_MODULE,
- };
- /* control/processing/default */
- static struct uvcg_default_processing {
- struct config_group group;
- } uvcg_default_processing;
- static inline struct uvcg_default_processing
- *to_uvcg_default_processing(struct config_item *item)
- {
- return container_of(to_config_group(item),
- struct uvcg_default_processing, group);
- }
- #define UVCG_DEFAULT_PROCESSING_ATTR(cname, aname, conv) \
- static ssize_t uvcg_default_processing_##cname##_show( \
- struct config_item *item, char *page) \
- { \
- struct uvcg_default_processing *dp = to_uvcg_default_processing(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &dp->group.cg_subsys->su_mutex; \
- struct uvc_processing_unit_descriptor *pd; \
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = dp->group.cg_item.ci_parent->ci_parent->ci_parent; \
- opts = to_f_uvc_opts(opts_item); \
- pd = &opts->uvc_processing; \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(pd->aname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- return result; \
- } \
- \
- UVC_ATTR_RO(uvcg_default_processing_, cname, aname)
- #define identity_conv(x) (x)
- UVCG_DEFAULT_PROCESSING_ATTR(b_unit_id, bUnitID, identity_conv);
- UVCG_DEFAULT_PROCESSING_ATTR(b_source_id, bSourceID, identity_conv);
- UVCG_DEFAULT_PROCESSING_ATTR(w_max_multiplier, wMaxMultiplier, le16_to_cpu);
- UVCG_DEFAULT_PROCESSING_ATTR(i_processing, iProcessing, identity_conv);
- #undef identity_conv
- #undef UVCG_DEFAULT_PROCESSING_ATTR
- static ssize_t uvcg_default_processing_bm_controls_show(
- struct config_item *item, char *page)
- {
- struct uvcg_default_processing *dp = to_uvcg_default_processing(item);
- struct f_uvc_opts *opts;
- struct config_item *opts_item;
- struct mutex *su_mutex = &dp->group.cg_subsys->su_mutex;
- struct uvc_processing_unit_descriptor *pd;
- int result, i;
- char *pg = page;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- opts_item = dp->group.cg_item.ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- pd = &opts->uvc_processing;
- mutex_lock(&opts->lock);
- for (result = 0, i = 0; i < pd->bControlSize; ++i) {
- result += sprintf(pg, "%d\n", pd->bmControls[i]);
- pg = page + result;
- }
- mutex_unlock(&opts->lock);
- mutex_unlock(su_mutex);
- return result;
- }
- UVC_ATTR_RO(uvcg_default_processing_, bm_controls, bmControls);
- static struct configfs_attribute *uvcg_default_processing_attrs[] = {
- &uvcg_default_processing_attr_b_unit_id,
- &uvcg_default_processing_attr_b_source_id,
- &uvcg_default_processing_attr_w_max_multiplier,
- &uvcg_default_processing_attr_bm_controls,
- &uvcg_default_processing_attr_i_processing,
- NULL,
- };
- static const struct config_item_type uvcg_default_processing_type = {
- .ct_attrs = uvcg_default_processing_attrs,
- .ct_owner = THIS_MODULE,
- };
- /* struct uvcg_processing {}; */
- /* control/processing */
- static struct uvcg_processing_grp {
- struct config_group group;
- } uvcg_processing_grp;
- static const struct config_item_type uvcg_processing_grp_type = {
- .ct_owner = THIS_MODULE,
- };
- /* control/terminal/camera/default */
- static struct uvcg_default_camera {
- struct config_group group;
- } uvcg_default_camera;
- static inline struct uvcg_default_camera
- *to_uvcg_default_camera(struct config_item *item)
- {
- return container_of(to_config_group(item),
- struct uvcg_default_camera, group);
- }
- #define UVCG_DEFAULT_CAMERA_ATTR(cname, aname, conv) \
- static ssize_t uvcg_default_camera_##cname##_show( \
- struct config_item *item, char *page) \
- { \
- struct uvcg_default_camera *dc = to_uvcg_default_camera(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &dc->group.cg_subsys->su_mutex; \
- struct uvc_camera_terminal_descriptor *cd; \
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = dc->group.cg_item.ci_parent->ci_parent->ci_parent-> \
- ci_parent; \
- opts = to_f_uvc_opts(opts_item); \
- cd = &opts->uvc_camera_terminal; \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(cd->aname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- \
- return result; \
- } \
- \
- UVC_ATTR_RO(uvcg_default_camera_, cname, aname)
- #define identity_conv(x) (x)
- UVCG_DEFAULT_CAMERA_ATTR(b_terminal_id, bTerminalID, identity_conv);
- UVCG_DEFAULT_CAMERA_ATTR(w_terminal_type, wTerminalType, le16_to_cpu);
- UVCG_DEFAULT_CAMERA_ATTR(b_assoc_terminal, bAssocTerminal, identity_conv);
- UVCG_DEFAULT_CAMERA_ATTR(i_terminal, iTerminal, identity_conv);
- UVCG_DEFAULT_CAMERA_ATTR(w_objective_focal_length_min, wObjectiveFocalLengthMin,
- le16_to_cpu);
- UVCG_DEFAULT_CAMERA_ATTR(w_objective_focal_length_max, wObjectiveFocalLengthMax,
- le16_to_cpu);
- UVCG_DEFAULT_CAMERA_ATTR(w_ocular_focal_length, wOcularFocalLength,
- le16_to_cpu);
- #undef identity_conv
- #undef UVCG_DEFAULT_CAMERA_ATTR
- static ssize_t uvcg_default_camera_bm_controls_show(
- struct config_item *item, char *page)
- {
- struct uvcg_default_camera *dc = to_uvcg_default_camera(item);
- struct f_uvc_opts *opts;
- struct config_item *opts_item;
- struct mutex *su_mutex = &dc->group.cg_subsys->su_mutex;
- struct uvc_camera_terminal_descriptor *cd;
- int result, i;
- char *pg = page;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- opts_item = dc->group.cg_item.ci_parent->ci_parent->ci_parent->
- ci_parent;
- opts = to_f_uvc_opts(opts_item);
- cd = &opts->uvc_camera_terminal;
- mutex_lock(&opts->lock);
- for (result = 0, i = 0; i < cd->bControlSize; ++i) {
- result += sprintf(pg, "%d\n", cd->bmControls[i]);
- pg = page + result;
- }
- mutex_unlock(&opts->lock);
- mutex_unlock(su_mutex);
- return result;
- }
- UVC_ATTR_RO(uvcg_default_camera_, bm_controls, bmControls);
- static struct configfs_attribute *uvcg_default_camera_attrs[] = {
- &uvcg_default_camera_attr_b_terminal_id,
- &uvcg_default_camera_attr_w_terminal_type,
- &uvcg_default_camera_attr_b_assoc_terminal,
- &uvcg_default_camera_attr_i_terminal,
- &uvcg_default_camera_attr_w_objective_focal_length_min,
- &uvcg_default_camera_attr_w_objective_focal_length_max,
- &uvcg_default_camera_attr_w_ocular_focal_length,
- &uvcg_default_camera_attr_bm_controls,
- NULL,
- };
- static const struct config_item_type uvcg_default_camera_type = {
- .ct_attrs = uvcg_default_camera_attrs,
- .ct_owner = THIS_MODULE,
- };
- /* struct uvcg_camera {}; */
- /* control/terminal/camera */
- static struct uvcg_camera_grp {
- struct config_group group;
- } uvcg_camera_grp;
- static const struct config_item_type uvcg_camera_grp_type = {
- .ct_owner = THIS_MODULE,
- };
- /* control/terminal/output/default */
- static struct uvcg_default_output {
- struct config_group group;
- } uvcg_default_output;
- static inline struct uvcg_default_output
- *to_uvcg_default_output(struct config_item *item)
- {
- return container_of(to_config_group(item),
- struct uvcg_default_output, group);
- }
- #define UVCG_DEFAULT_OUTPUT_ATTR(cname, aname, conv) \
- static ssize_t uvcg_default_output_##cname##_show( \
- struct config_item *item, char *page) \
- { \
- struct uvcg_default_output *dout = to_uvcg_default_output(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &dout->group.cg_subsys->su_mutex; \
- struct uvc_output_terminal_descriptor *cd; \
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = dout->group.cg_item.ci_parent->ci_parent-> \
- ci_parent->ci_parent; \
- opts = to_f_uvc_opts(opts_item); \
- cd = &opts->uvc_output_terminal; \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(cd->aname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- \
- return result; \
- } \
- \
- UVC_ATTR_RO(uvcg_default_output_, cname, aname)
- #define identity_conv(x) (x)
- UVCG_DEFAULT_OUTPUT_ATTR(b_terminal_id, bTerminalID, identity_conv);
- UVCG_DEFAULT_OUTPUT_ATTR(w_terminal_type, wTerminalType, le16_to_cpu);
- UVCG_DEFAULT_OUTPUT_ATTR(b_assoc_terminal, bAssocTerminal, identity_conv);
- UVCG_DEFAULT_OUTPUT_ATTR(b_source_id, bSourceID, identity_conv);
- UVCG_DEFAULT_OUTPUT_ATTR(i_terminal, iTerminal, identity_conv);
- #undef identity_conv
- #undef UVCG_DEFAULT_OUTPUT_ATTR
- static struct configfs_attribute *uvcg_default_output_attrs[] = {
- &uvcg_default_output_attr_b_terminal_id,
- &uvcg_default_output_attr_w_terminal_type,
- &uvcg_default_output_attr_b_assoc_terminal,
- &uvcg_default_output_attr_b_source_id,
- &uvcg_default_output_attr_i_terminal,
- NULL,
- };
- static const struct config_item_type uvcg_default_output_type = {
- .ct_attrs = uvcg_default_output_attrs,
- .ct_owner = THIS_MODULE,
- };
- /* struct uvcg_output {}; */
- /* control/terminal/output */
- static struct uvcg_output_grp {
- struct config_group group;
- } uvcg_output_grp;
- static const struct config_item_type uvcg_output_grp_type = {
- .ct_owner = THIS_MODULE,
- };
- /* control/terminal */
- static struct uvcg_terminal_grp {
- struct config_group group;
- } uvcg_terminal_grp;
- static const struct config_item_type uvcg_terminal_grp_type = {
- .ct_owner = THIS_MODULE,
- };
- /* control/class/{fs} */
- static struct uvcg_control_class {
- struct config_group group;
- } uvcg_control_class_fs, uvcg_control_class_ss;
- static inline struct uvc_descriptor_header
- **uvcg_get_ctl_class_arr(struct config_item *i, struct f_uvc_opts *o)
- {
- struct uvcg_control_class *cl = container_of(to_config_group(i),
- struct uvcg_control_class, group);
- if (cl == &uvcg_control_class_fs)
- return o->uvc_fs_control_cls;
- if (cl == &uvcg_control_class_ss)
- return o->uvc_ss_control_cls;
- return NULL;
- }
- static int uvcg_control_class_allow_link(struct config_item *src,
- struct config_item *target)
- {
- struct config_item *control, *header;
- struct f_uvc_opts *opts;
- struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
- struct uvc_descriptor_header **class_array;
- struct uvcg_control_header *target_hdr;
- int ret = -EINVAL;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- control = src->ci_parent->ci_parent;
- header = config_group_find_item(to_config_group(control), "header");
- if (!header || target->ci_parent != header)
- goto out;
- opts = to_f_uvc_opts(control->ci_parent);
- mutex_lock(&opts->lock);
- class_array = uvcg_get_ctl_class_arr(src, opts);
- if (!class_array)
- goto unlock;
- if (opts->refcnt || class_array[0]) {
- ret = -EBUSY;
- goto unlock;
- }
- target_hdr = to_uvcg_control_header(target);
- ++target_hdr->linked;
- class_array[0] = (struct uvc_descriptor_header *)&target_hdr->desc;
- ret = 0;
- unlock:
- mutex_unlock(&opts->lock);
- out:
- config_item_put(header);
- mutex_unlock(su_mutex);
- return ret;
- }
- static void uvcg_control_class_drop_link(struct config_item *src,
- struct config_item *target)
- {
- struct config_item *control, *header;
- struct f_uvc_opts *opts;
- struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
- struct uvc_descriptor_header **class_array;
- struct uvcg_control_header *target_hdr;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- control = src->ci_parent->ci_parent;
- header = config_group_find_item(to_config_group(control), "header");
- if (!header || target->ci_parent != header)
- goto out;
- opts = to_f_uvc_opts(control->ci_parent);
- mutex_lock(&opts->lock);
- class_array = uvcg_get_ctl_class_arr(src, opts);
- if (!class_array || opts->refcnt)
- goto unlock;
- target_hdr = to_uvcg_control_header(target);
- --target_hdr->linked;
- class_array[0] = NULL;
- unlock:
- mutex_unlock(&opts->lock);
- out:
- config_item_put(header);
- mutex_unlock(su_mutex);
- }
- static struct configfs_item_operations uvcg_control_class_item_ops = {
- .allow_link = uvcg_control_class_allow_link,
- .drop_link = uvcg_control_class_drop_link,
- };
- static const struct config_item_type uvcg_control_class_type = {
- .ct_item_ops = &uvcg_control_class_item_ops,
- .ct_owner = THIS_MODULE,
- };
- /* control/class */
- static struct uvcg_control_class_grp {
- struct config_group group;
- } uvcg_control_class_grp;
- static const struct config_item_type uvcg_control_class_grp_type = {
- .ct_owner = THIS_MODULE,
- };
- /* control */
- static struct uvcg_control_grp {
- struct config_group group;
- } uvcg_control_grp;
- static const struct config_item_type uvcg_control_grp_type = {
- .ct_owner = THIS_MODULE,
- };
- /* streaming/uncompressed */
- static struct uvcg_uncompressed_grp {
- struct config_group group;
- } uvcg_uncompressed_grp;
- /* streaming/mjpeg */
- static struct uvcg_mjpeg_grp {
- struct config_group group;
- } uvcg_mjpeg_grp;
- static struct config_item *fmt_parent[] = {
- &uvcg_uncompressed_grp.group.cg_item,
- &uvcg_mjpeg_grp.group.cg_item,
- };
- enum uvcg_format_type {
- UVCG_UNCOMPRESSED = 0,
- UVCG_MJPEG,
- };
- struct uvcg_format {
- struct config_group group;
- enum uvcg_format_type type;
- unsigned linked;
- unsigned num_frames;
- __u8 bmaControls[UVCG_STREAMING_CONTROL_SIZE];
- };
- static struct uvcg_format *to_uvcg_format(struct config_item *item)
- {
- return container_of(to_config_group(item), struct uvcg_format, group);
- }
- static ssize_t uvcg_format_bma_controls_show(struct uvcg_format *f, char *page)
- {
- struct f_uvc_opts *opts;
- struct config_item *opts_item;
- struct mutex *su_mutex = &f->group.cg_subsys->su_mutex;
- int result, i;
- char *pg = page;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- opts_item = f->group.cg_item.ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- mutex_lock(&opts->lock);
- result = sprintf(pg, "0x");
- pg += result;
- for (i = 0; i < UVCG_STREAMING_CONTROL_SIZE; ++i) {
- result += sprintf(pg, "%x\n", f->bmaControls[i]);
- pg = page + result;
- }
- mutex_unlock(&opts->lock);
- mutex_unlock(su_mutex);
- return result;
- }
- static ssize_t uvcg_format_bma_controls_store(struct uvcg_format *ch,
- const char *page, size_t len)
- {
- struct f_uvc_opts *opts;
- struct config_item *opts_item;
- struct mutex *su_mutex = &ch->group.cg_subsys->su_mutex;
- int ret = -EINVAL;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- opts_item = ch->group.cg_item.ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- mutex_lock(&opts->lock);
- if (ch->linked || opts->refcnt) {
- ret = -EBUSY;
- goto end;
- }
- if (len < 4 || *page != '0' ||
- (*(page + 1) != 'x' && *(page + 1) != 'X'))
- goto end;
- ret = hex2bin(ch->bmaControls, page + 2, 1);
- if (ret < 0)
- goto end;
- ret = len;
- end:
- mutex_unlock(&opts->lock);
- mutex_unlock(su_mutex);
- return ret;
- }
- struct uvcg_format_ptr {
- struct uvcg_format *fmt;
- struct list_head entry;
- };
- /* streaming/header/<NAME> */
- struct uvcg_streaming_header {
- struct config_item item;
- struct uvc_input_header_descriptor desc;
- unsigned linked;
- struct list_head formats;
- unsigned num_fmt;
- };
- static struct uvcg_streaming_header *to_uvcg_streaming_header(struct config_item *item)
- {
- return container_of(item, struct uvcg_streaming_header, item);
- }
- static int uvcg_streaming_header_allow_link(struct config_item *src,
- struct config_item *target)
- {
- struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
- struct config_item *opts_item;
- struct f_uvc_opts *opts;
- struct uvcg_streaming_header *src_hdr;
- struct uvcg_format *target_fmt = NULL;
- struct uvcg_format_ptr *format_ptr;
- int i, ret = -EINVAL;
- src_hdr = to_uvcg_streaming_header(src);
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- opts_item = src->ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- mutex_lock(&opts->lock);
- if (src_hdr->linked) {
- ret = -EBUSY;
- goto out;
- }
- for (i = 0; i < ARRAY_SIZE(fmt_parent); ++i)
- if (target->ci_parent == fmt_parent[i])
- break;
- if (i == ARRAY_SIZE(fmt_parent))
- goto out;
- target_fmt = container_of(to_config_group(target), struct uvcg_format,
- group);
- if (!target_fmt)
- goto out;
- format_ptr = kzalloc(sizeof(*format_ptr), GFP_KERNEL);
- if (!format_ptr) {
- ret = -ENOMEM;
- goto out;
- }
- ret = 0;
- format_ptr->fmt = target_fmt;
- list_add_tail(&format_ptr->entry, &src_hdr->formats);
- ++src_hdr->num_fmt;
- ++target_fmt->linked;
- out:
- mutex_unlock(&opts->lock);
- mutex_unlock(su_mutex);
- return ret;
- }
- static void uvcg_streaming_header_drop_link(struct config_item *src,
- struct config_item *target)
- {
- struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
- struct config_item *opts_item;
- struct f_uvc_opts *opts;
- struct uvcg_streaming_header *src_hdr;
- struct uvcg_format *target_fmt = NULL;
- struct uvcg_format_ptr *format_ptr, *tmp;
- src_hdr = to_uvcg_streaming_header(src);
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- opts_item = src->ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- mutex_lock(&opts->lock);
- target_fmt = container_of(to_config_group(target), struct uvcg_format,
- group);
- if (!target_fmt)
- goto out;
- list_for_each_entry_safe(format_ptr, tmp, &src_hdr->formats, entry)
- if (format_ptr->fmt == target_fmt) {
- list_del(&format_ptr->entry);
- kfree(format_ptr);
- --src_hdr->num_fmt;
- break;
- }
- --target_fmt->linked;
- out:
- mutex_unlock(&opts->lock);
- mutex_unlock(su_mutex);
- }
- static struct configfs_item_operations uvcg_streaming_header_item_ops = {
- .allow_link = uvcg_streaming_header_allow_link,
- .drop_link = uvcg_streaming_header_drop_link,
- };
- #define UVCG_STREAMING_HEADER_ATTR(cname, aname, conv) \
- static ssize_t uvcg_streaming_header_##cname##_show( \
- struct config_item *item, char *page) \
- { \
- struct uvcg_streaming_header *sh = to_uvcg_streaming_header(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &sh->item.ci_group->cg_subsys->su_mutex;\
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = sh->item.ci_parent->ci_parent->ci_parent; \
- opts = to_f_uvc_opts(opts_item); \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(sh->desc.aname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- return result; \
- } \
- \
- UVC_ATTR_RO(uvcg_streaming_header_, cname, aname)
- #define identity_conv(x) (x)
- UVCG_STREAMING_HEADER_ATTR(bm_info, bmInfo, identity_conv);
- UVCG_STREAMING_HEADER_ATTR(b_terminal_link, bTerminalLink, identity_conv);
- UVCG_STREAMING_HEADER_ATTR(b_still_capture_method, bStillCaptureMethod,
- identity_conv);
- UVCG_STREAMING_HEADER_ATTR(b_trigger_support, bTriggerSupport, identity_conv);
- UVCG_STREAMING_HEADER_ATTR(b_trigger_usage, bTriggerUsage, identity_conv);
- #undef identity_conv
- #undef UVCG_STREAMING_HEADER_ATTR
- static struct configfs_attribute *uvcg_streaming_header_attrs[] = {
- &uvcg_streaming_header_attr_bm_info,
- &uvcg_streaming_header_attr_b_terminal_link,
- &uvcg_streaming_header_attr_b_still_capture_method,
- &uvcg_streaming_header_attr_b_trigger_support,
- &uvcg_streaming_header_attr_b_trigger_usage,
- NULL,
- };
- static const struct config_item_type uvcg_streaming_header_type = {
- .ct_item_ops = &uvcg_streaming_header_item_ops,
- .ct_attrs = uvcg_streaming_header_attrs,
- .ct_owner = THIS_MODULE,
- };
- static struct config_item
- *uvcg_streaming_header_make(struct config_group *group, const char *name)
- {
- struct uvcg_streaming_header *h;
- h = kzalloc(sizeof(*h), GFP_KERNEL);
- if (!h)
- return ERR_PTR(-ENOMEM);
- INIT_LIST_HEAD(&h->formats);
- h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
- h->desc.bDescriptorSubType = UVC_VS_INPUT_HEADER;
- h->desc.bTerminalLink = 3;
- h->desc.bControlSize = UVCG_STREAMING_CONTROL_SIZE;
- config_item_init_type_name(&h->item, name, &uvcg_streaming_header_type);
- return &h->item;
- }
- static void uvcg_streaming_header_drop(struct config_group *group,
- struct config_item *item)
- {
- struct uvcg_streaming_header *h = to_uvcg_streaming_header(item);
- kfree(h);
- }
- /* streaming/header */
- static struct uvcg_streaming_header_grp {
- struct config_group group;
- } uvcg_streaming_header_grp;
- static struct configfs_group_operations uvcg_streaming_header_grp_ops = {
- .make_item = uvcg_streaming_header_make,
- .drop_item = uvcg_streaming_header_drop,
- };
- static const struct config_item_type uvcg_streaming_header_grp_type = {
- .ct_group_ops = &uvcg_streaming_header_grp_ops,
- .ct_owner = THIS_MODULE,
- };
- /* streaming/<mode>/<format>/<NAME> */
- struct uvcg_frame {
- struct {
- u8 b_length;
- u8 b_descriptor_type;
- u8 b_descriptor_subtype;
- u8 b_frame_index;
- u8 bm_capabilities;
- u16 w_width;
- u16 w_height;
- u32 dw_min_bit_rate;
- u32 dw_max_bit_rate;
- u32 dw_max_video_frame_buffer_size;
- u32 dw_default_frame_interval;
- u8 b_frame_interval_type;
- } __attribute__((packed)) frame;
- u32 *dw_frame_interval;
- enum uvcg_format_type fmt_type;
- struct config_item item;
- };
- static struct uvcg_frame *to_uvcg_frame(struct config_item *item)
- {
- return container_of(item, struct uvcg_frame, item);
- }
- #define UVCG_FRAME_ATTR(cname, aname, to_cpu_endian, to_little_endian, bits) \
- static ssize_t uvcg_frame_##cname##_show(struct config_item *item, char *page)\
- { \
- struct uvcg_frame *f = to_uvcg_frame(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &f->item.ci_group->cg_subsys->su_mutex;\
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = f->item.ci_parent->ci_parent->ci_parent->ci_parent; \
- opts = to_f_uvc_opts(opts_item); \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", to_cpu_endian(f->frame.cname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- return result; \
- } \
- \
- static ssize_t uvcg_frame_##cname##_store(struct config_item *item, \
- const char *page, size_t len)\
- { \
- struct uvcg_frame *f = to_uvcg_frame(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct uvcg_format *fmt; \
- struct mutex *su_mutex = &f->item.ci_group->cg_subsys->su_mutex;\
- int ret; \
- u##bits num; \
- \
- ret = kstrtou##bits(page, 0, &num); \
- if (ret) \
- return ret; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = f->item.ci_parent->ci_parent->ci_parent->ci_parent; \
- opts = to_f_uvc_opts(opts_item); \
- fmt = to_uvcg_format(f->item.ci_parent); \
- \
- mutex_lock(&opts->lock); \
- if (fmt->linked || opts->refcnt) { \
- ret = -EBUSY; \
- goto end; \
- } \
- \
- f->frame.cname = to_little_endian(num); \
- ret = len; \
- end: \
- mutex_unlock(&opts->lock); \
- mutex_unlock(su_mutex); \
- return ret; \
- } \
- \
- UVC_ATTR(uvcg_frame_, cname, aname);
- #define noop_conversion(x) (x)
- UVCG_FRAME_ATTR(bm_capabilities, bmCapabilities, noop_conversion,
- noop_conversion, 8);
- UVCG_FRAME_ATTR(w_width, wWidth, le16_to_cpu, cpu_to_le16, 16);
- UVCG_FRAME_ATTR(w_height, wHeight, le16_to_cpu, cpu_to_le16, 16);
- UVCG_FRAME_ATTR(dw_min_bit_rate, dwMinBitRate, le32_to_cpu, cpu_to_le32, 32);
- UVCG_FRAME_ATTR(dw_max_bit_rate, dwMaxBitRate, le32_to_cpu, cpu_to_le32, 32);
- UVCG_FRAME_ATTR(dw_max_video_frame_buffer_size, dwMaxVideoFrameBufferSize,
- le32_to_cpu, cpu_to_le32, 32);
- UVCG_FRAME_ATTR(dw_default_frame_interval, dwDefaultFrameInterval,
- le32_to_cpu, cpu_to_le32, 32);
- #undef noop_conversion
- #undef UVCG_FRAME_ATTR
- static ssize_t uvcg_frame_dw_frame_interval_show(struct config_item *item,
- char *page)
- {
- struct uvcg_frame *frm = to_uvcg_frame(item);
- struct f_uvc_opts *opts;
- struct config_item *opts_item;
- struct mutex *su_mutex = &frm->item.ci_group->cg_subsys->su_mutex;
- int result, i;
- char *pg = page;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- opts_item = frm->item.ci_parent->ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- mutex_lock(&opts->lock);
- for (result = 0, i = 0; i < frm->frame.b_frame_interval_type; ++i) {
- result += sprintf(pg, "%d\n",
- le32_to_cpu(frm->dw_frame_interval[i]));
- pg = page + result;
- }
- mutex_unlock(&opts->lock);
- mutex_unlock(su_mutex);
- return result;
- }
- static inline int __uvcg_count_frm_intrv(char *buf, void *priv)
- {
- ++*((int *)priv);
- return 0;
- }
- static inline int __uvcg_fill_frm_intrv(char *buf, void *priv)
- {
- u32 num, **interv;
- int ret;
- ret = kstrtou32(buf, 0, &num);
- if (ret)
- return ret;
- interv = priv;
- **interv = cpu_to_le32(num);
- ++*interv;
- return 0;
- }
- static int __uvcg_iter_frm_intrv(const char *page, size_t len,
- int (*fun)(char *, void *), void *priv)
- {
- /* sign, base 2 representation, newline, terminator */
- char buf[1 + sizeof(u32) * 8 + 1 + 1];
- const char *pg = page;
- int i, ret;
- if (!fun)
- return -EINVAL;
- while (pg - page < len) {
- i = 0;
- while (i < sizeof(buf) && (pg - page < len) &&
- *pg != '\0' && *pg != '\n')
- buf[i++] = *pg++;
- if (i == sizeof(buf))
- return -EINVAL;
- while ((pg - page < len) && (*pg == '\0' || *pg == '\n'))
- ++pg;
- buf[i] = '\0';
- ret = fun(buf, priv);
- if (ret)
- return ret;
- }
- return 0;
- }
- static ssize_t uvcg_frame_dw_frame_interval_store(struct config_item *item,
- const char *page, size_t len)
- {
- struct uvcg_frame *ch = to_uvcg_frame(item);
- struct f_uvc_opts *opts;
- struct config_item *opts_item;
- struct uvcg_format *fmt;
- struct mutex *su_mutex = &ch->item.ci_group->cg_subsys->su_mutex;
- int ret = 0, n = 0;
- u32 *frm_intrv, *tmp;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- opts_item = ch->item.ci_parent->ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- fmt = to_uvcg_format(ch->item.ci_parent);
- mutex_lock(&opts->lock);
- if (fmt->linked || opts->refcnt) {
- ret = -EBUSY;
- goto end;
- }
- ret = __uvcg_iter_frm_intrv(page, len, __uvcg_count_frm_intrv, &n);
- if (ret)
- goto end;
- tmp = frm_intrv = kcalloc(n, sizeof(u32), GFP_KERNEL);
- if (!frm_intrv) {
- ret = -ENOMEM;
- goto end;
- }
- ret = __uvcg_iter_frm_intrv(page, len, __uvcg_fill_frm_intrv, &tmp);
- if (ret) {
- kfree(frm_intrv);
- goto end;
- }
- kfree(ch->dw_frame_interval);
- ch->dw_frame_interval = frm_intrv;
- ch->frame.b_frame_interval_type = n;
- sort(ch->dw_frame_interval, n, sizeof(*ch->dw_frame_interval),
- uvcg_config_compare_u32, NULL);
- ret = len;
- end:
- mutex_unlock(&opts->lock);
- mutex_unlock(su_mutex);
- return ret;
- }
- UVC_ATTR(uvcg_frame_, dw_frame_interval, dwFrameInterval);
- static struct configfs_attribute *uvcg_frame_attrs[] = {
- &uvcg_frame_attr_bm_capabilities,
- &uvcg_frame_attr_w_width,
- &uvcg_frame_attr_w_height,
- &uvcg_frame_attr_dw_min_bit_rate,
- &uvcg_frame_attr_dw_max_bit_rate,
- &uvcg_frame_attr_dw_max_video_frame_buffer_size,
- &uvcg_frame_attr_dw_default_frame_interval,
- &uvcg_frame_attr_dw_frame_interval,
- NULL,
- };
- static const struct config_item_type uvcg_frame_type = {
- .ct_attrs = uvcg_frame_attrs,
- .ct_owner = THIS_MODULE,
- };
- static struct config_item *uvcg_frame_make(struct config_group *group,
- const char *name)
- {
- struct uvcg_frame *h;
- struct uvcg_format *fmt;
- struct f_uvc_opts *opts;
- struct config_item *opts_item;
- h = kzalloc(sizeof(*h), GFP_KERNEL);
- if (!h)
- return ERR_PTR(-ENOMEM);
- h->frame.b_descriptor_type = USB_DT_CS_INTERFACE;
- h->frame.b_frame_index = 1;
- h->frame.w_width = cpu_to_le16(640);
- h->frame.w_height = cpu_to_le16(360);
- h->frame.dw_min_bit_rate = cpu_to_le32(18432000);
- h->frame.dw_max_bit_rate = cpu_to_le32(55296000);
- h->frame.dw_max_video_frame_buffer_size = cpu_to_le32(460800);
- h->frame.dw_default_frame_interval = cpu_to_le32(666666);
- opts_item = group->cg_item.ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- mutex_lock(&opts->lock);
- fmt = to_uvcg_format(&group->cg_item);
- if (fmt->type == UVCG_UNCOMPRESSED) {
- h->frame.b_descriptor_subtype = UVC_VS_FRAME_UNCOMPRESSED;
- h->fmt_type = UVCG_UNCOMPRESSED;
- } else if (fmt->type == UVCG_MJPEG) {
- h->frame.b_descriptor_subtype = UVC_VS_FRAME_MJPEG;
- h->fmt_type = UVCG_MJPEG;
- } else {
- mutex_unlock(&opts->lock);
- kfree(h);
- return ERR_PTR(-EINVAL);
- }
- ++fmt->num_frames;
- mutex_unlock(&opts->lock);
- config_item_init_type_name(&h->item, name, &uvcg_frame_type);
- return &h->item;
- }
- static void uvcg_frame_drop(struct config_group *group, struct config_item *item)
- {
- struct uvcg_frame *h = to_uvcg_frame(item);
- struct uvcg_format *fmt;
- struct f_uvc_opts *opts;
- struct config_item *opts_item;
- opts_item = group->cg_item.ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- mutex_lock(&opts->lock);
- fmt = to_uvcg_format(&group->cg_item);
- --fmt->num_frames;
- kfree(h);
- mutex_unlock(&opts->lock);
- }
- /* streaming/uncompressed/<NAME> */
- struct uvcg_uncompressed {
- struct uvcg_format fmt;
- struct uvc_format_uncompressed desc;
- };
- static struct uvcg_uncompressed *to_uvcg_uncompressed(struct config_item *item)
- {
- return container_of(
- container_of(to_config_group(item), struct uvcg_format, group),
- struct uvcg_uncompressed, fmt);
- }
- static struct configfs_group_operations uvcg_uncompressed_group_ops = {
- .make_item = uvcg_frame_make,
- .drop_item = uvcg_frame_drop,
- };
- static ssize_t uvcg_uncompressed_guid_format_show(struct config_item *item,
- char *page)
- {
- struct uvcg_uncompressed *ch = to_uvcg_uncompressed(item);
- struct f_uvc_opts *opts;
- struct config_item *opts_item;
- struct mutex *su_mutex = &ch->fmt.group.cg_subsys->su_mutex;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- opts_item = ch->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- mutex_lock(&opts->lock);
- memcpy(page, ch->desc.guidFormat, sizeof(ch->desc.guidFormat));
- mutex_unlock(&opts->lock);
- mutex_unlock(su_mutex);
- return sizeof(ch->desc.guidFormat);
- }
- static ssize_t uvcg_uncompressed_guid_format_store(struct config_item *item,
- const char *page, size_t len)
- {
- struct uvcg_uncompressed *ch = to_uvcg_uncompressed(item);
- struct f_uvc_opts *opts;
- struct config_item *opts_item;
- struct mutex *su_mutex = &ch->fmt.group.cg_subsys->su_mutex;
- int ret;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- opts_item = ch->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;
- opts = to_f_uvc_opts(opts_item);
- mutex_lock(&opts->lock);
- if (ch->fmt.linked || opts->refcnt) {
- ret = -EBUSY;
- goto end;
- }
- memcpy(ch->desc.guidFormat, page,
- min(sizeof(ch->desc.guidFormat), len));
- ret = sizeof(ch->desc.guidFormat);
- end:
- mutex_unlock(&opts->lock);
- mutex_unlock(su_mutex);
- return ret;
- }
- UVC_ATTR(uvcg_uncompressed_, guid_format, guidFormat);
- #define UVCG_UNCOMPRESSED_ATTR_RO(cname, aname, conv) \
- static ssize_t uvcg_uncompressed_##cname##_show( \
- struct config_item *item, char *page) \
- { \
- struct uvcg_uncompressed *u = to_uvcg_uncompressed(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
- opts = to_f_uvc_opts(opts_item); \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(u->desc.aname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- return result; \
- } \
- \
- UVC_ATTR_RO(uvcg_uncompressed_, cname, aname);
- #define UVCG_UNCOMPRESSED_ATTR(cname, aname, conv) \
- static ssize_t uvcg_uncompressed_##cname##_show( \
- struct config_item *item, char *page) \
- { \
- struct uvcg_uncompressed *u = to_uvcg_uncompressed(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
- opts = to_f_uvc_opts(opts_item); \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(u->desc.aname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- return result; \
- } \
- \
- static ssize_t \
- uvcg_uncompressed_##cname##_store(struct config_item *item, \
- const char *page, size_t len) \
- { \
- struct uvcg_uncompressed *u = to_uvcg_uncompressed(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
- int ret; \
- u8 num; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
- opts = to_f_uvc_opts(opts_item); \
- \
- mutex_lock(&opts->lock); \
- if (u->fmt.linked || opts->refcnt) { \
- ret = -EBUSY; \
- goto end; \
- } \
- \
- ret = kstrtou8(page, 0, &num); \
- if (ret) \
- goto end; \
- \
- if (num > 255) { \
- ret = -EINVAL; \
- goto end; \
- } \
- u->desc.aname = num; \
- ret = len; \
- end: \
- mutex_unlock(&opts->lock); \
- mutex_unlock(su_mutex); \
- return ret; \
- } \
- \
- UVC_ATTR(uvcg_uncompressed_, cname, aname);
- #define identity_conv(x) (x)
- UVCG_UNCOMPRESSED_ATTR(b_bits_per_pixel, bBitsPerPixel, identity_conv);
- UVCG_UNCOMPRESSED_ATTR(b_default_frame_index, bDefaultFrameIndex,
- identity_conv);
- UVCG_UNCOMPRESSED_ATTR_RO(b_aspect_ratio_x, bAspectRatioX, identity_conv);
- UVCG_UNCOMPRESSED_ATTR_RO(b_aspect_ratio_y, bAspectRatioY, identity_conv);
- UVCG_UNCOMPRESSED_ATTR_RO(bm_interface_flags, bmInterfaceFlags, identity_conv);
- #undef identity_conv
- #undef UVCG_UNCOMPRESSED_ATTR
- #undef UVCG_UNCOMPRESSED_ATTR_RO
- static inline ssize_t
- uvcg_uncompressed_bma_controls_show(struct config_item *item, char *page)
- {
- struct uvcg_uncompressed *unc = to_uvcg_uncompressed(item);
- return uvcg_format_bma_controls_show(&unc->fmt, page);
- }
- static inline ssize_t
- uvcg_uncompressed_bma_controls_store(struct config_item *item,
- const char *page, size_t len)
- {
- struct uvcg_uncompressed *unc = to_uvcg_uncompressed(item);
- return uvcg_format_bma_controls_store(&unc->fmt, page, len);
- }
- UVC_ATTR(uvcg_uncompressed_, bma_controls, bmaControls);
- static struct configfs_attribute *uvcg_uncompressed_attrs[] = {
- &uvcg_uncompressed_attr_guid_format,
- &uvcg_uncompressed_attr_b_bits_per_pixel,
- &uvcg_uncompressed_attr_b_default_frame_index,
- &uvcg_uncompressed_attr_b_aspect_ratio_x,
- &uvcg_uncompressed_attr_b_aspect_ratio_y,
- &uvcg_uncompressed_attr_bm_interface_flags,
- &uvcg_uncompressed_attr_bma_controls,
- NULL,
- };
- static const struct config_item_type uvcg_uncompressed_type = {
- .ct_group_ops = &uvcg_uncompressed_group_ops,
- .ct_attrs = uvcg_uncompressed_attrs,
- .ct_owner = THIS_MODULE,
- };
- static struct config_group *uvcg_uncompressed_make(struct config_group *group,
- const char *name)
- {
- static char guid[] = {
- 'Y', 'U', 'Y', '2', 0x00, 0x00, 0x10, 0x00,
- 0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71
- };
- struct uvcg_uncompressed *h;
- h = kzalloc(sizeof(*h), GFP_KERNEL);
- if (!h)
- return ERR_PTR(-ENOMEM);
- h->desc.bLength = UVC_DT_FORMAT_UNCOMPRESSED_SIZE;
- h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
- h->desc.bDescriptorSubType = UVC_VS_FORMAT_UNCOMPRESSED;
- memcpy(h->desc.guidFormat, guid, sizeof(guid));
- h->desc.bBitsPerPixel = 16;
- h->desc.bDefaultFrameIndex = 1;
- h->desc.bAspectRatioX = 0;
- h->desc.bAspectRatioY = 0;
- h->desc.bmInterfaceFlags = 0;
- h->desc.bCopyProtect = 0;
- h->fmt.type = UVCG_UNCOMPRESSED;
- config_group_init_type_name(&h->fmt.group, name,
- &uvcg_uncompressed_type);
- return &h->fmt.group;
- }
- static void uvcg_uncompressed_drop(struct config_group *group,
- struct config_item *item)
- {
- struct uvcg_uncompressed *h = to_uvcg_uncompressed(item);
- kfree(h);
- }
- static struct configfs_group_operations uvcg_uncompressed_grp_ops = {
- .make_group = uvcg_uncompressed_make,
- .drop_item = uvcg_uncompressed_drop,
- };
- static const struct config_item_type uvcg_uncompressed_grp_type = {
- .ct_group_ops = &uvcg_uncompressed_grp_ops,
- .ct_owner = THIS_MODULE,
- };
- /* streaming/mjpeg/<NAME> */
- struct uvcg_mjpeg {
- struct uvcg_format fmt;
- struct uvc_format_mjpeg desc;
- };
- static struct uvcg_mjpeg *to_uvcg_mjpeg(struct config_item *item)
- {
- return container_of(
- container_of(to_config_group(item), struct uvcg_format, group),
- struct uvcg_mjpeg, fmt);
- }
- static struct configfs_group_operations uvcg_mjpeg_group_ops = {
- .make_item = uvcg_frame_make,
- .drop_item = uvcg_frame_drop,
- };
- #define UVCG_MJPEG_ATTR_RO(cname, aname, conv) \
- static ssize_t uvcg_mjpeg_##cname##_show(struct config_item *item, char *page)\
- { \
- struct uvcg_mjpeg *u = to_uvcg_mjpeg(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
- opts = to_f_uvc_opts(opts_item); \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(u->desc.aname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- return result; \
- } \
- \
- UVC_ATTR_RO(uvcg_mjpeg_, cname, aname)
- #define UVCG_MJPEG_ATTR(cname, aname, conv) \
- static ssize_t uvcg_mjpeg_##cname##_show(struct config_item *item, char *page)\
- { \
- struct uvcg_mjpeg *u = to_uvcg_mjpeg(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
- opts = to_f_uvc_opts(opts_item); \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(u->desc.aname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- return result; \
- } \
- \
- static ssize_t \
- uvcg_mjpeg_##cname##_store(struct config_item *item, \
- const char *page, size_t len) \
- { \
- struct uvcg_mjpeg *u = to_uvcg_mjpeg(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
- int ret; \
- u8 num; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
- opts = to_f_uvc_opts(opts_item); \
- \
- mutex_lock(&opts->lock); \
- if (u->fmt.linked || opts->refcnt) { \
- ret = -EBUSY; \
- goto end; \
- } \
- \
- ret = kstrtou8(page, 0, &num); \
- if (ret) \
- goto end; \
- \
- if (num > 255) { \
- ret = -EINVAL; \
- goto end; \
- } \
- u->desc.aname = num; \
- ret = len; \
- end: \
- mutex_unlock(&opts->lock); \
- mutex_unlock(su_mutex); \
- return ret; \
- } \
- \
- UVC_ATTR(uvcg_mjpeg_, cname, aname)
- #define identity_conv(x) (x)
- UVCG_MJPEG_ATTR(b_default_frame_index, bDefaultFrameIndex,
- identity_conv);
- UVCG_MJPEG_ATTR_RO(bm_flags, bmFlags, identity_conv);
- UVCG_MJPEG_ATTR_RO(b_aspect_ratio_x, bAspectRatioX, identity_conv);
- UVCG_MJPEG_ATTR_RO(b_aspect_ratio_y, bAspectRatioY, identity_conv);
- UVCG_MJPEG_ATTR_RO(bm_interface_flags, bmInterfaceFlags, identity_conv);
- #undef identity_conv
- #undef UVCG_MJPEG_ATTR
- #undef UVCG_MJPEG_ATTR_RO
- static inline ssize_t
- uvcg_mjpeg_bma_controls_show(struct config_item *item, char *page)
- {
- struct uvcg_mjpeg *u = to_uvcg_mjpeg(item);
- return uvcg_format_bma_controls_show(&u->fmt, page);
- }
- static inline ssize_t
- uvcg_mjpeg_bma_controls_store(struct config_item *item,
- const char *page, size_t len)
- {
- struct uvcg_mjpeg *u = to_uvcg_mjpeg(item);
- return uvcg_format_bma_controls_store(&u->fmt, page, len);
- }
- UVC_ATTR(uvcg_mjpeg_, bma_controls, bmaControls);
- static struct configfs_attribute *uvcg_mjpeg_attrs[] = {
- &uvcg_mjpeg_attr_b_default_frame_index,
- &uvcg_mjpeg_attr_bm_flags,
- &uvcg_mjpeg_attr_b_aspect_ratio_x,
- &uvcg_mjpeg_attr_b_aspect_ratio_y,
- &uvcg_mjpeg_attr_bm_interface_flags,
- &uvcg_mjpeg_attr_bma_controls,
- NULL,
- };
- static const struct config_item_type uvcg_mjpeg_type = {
- .ct_group_ops = &uvcg_mjpeg_group_ops,
- .ct_attrs = uvcg_mjpeg_attrs,
- .ct_owner = THIS_MODULE,
- };
- static struct config_group *uvcg_mjpeg_make(struct config_group *group,
- const char *name)
- {
- struct uvcg_mjpeg *h;
- h = kzalloc(sizeof(*h), GFP_KERNEL);
- if (!h)
- return ERR_PTR(-ENOMEM);
- h->desc.bLength = UVC_DT_FORMAT_MJPEG_SIZE;
- h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
- h->desc.bDescriptorSubType = UVC_VS_FORMAT_MJPEG;
- h->desc.bDefaultFrameIndex = 1;
- h->desc.bAspectRatioX = 0;
- h->desc.bAspectRatioY = 0;
- h->desc.bmInterfaceFlags = 0;
- h->desc.bCopyProtect = 0;
- h->fmt.type = UVCG_MJPEG;
- config_group_init_type_name(&h->fmt.group, name,
- &uvcg_mjpeg_type);
- return &h->fmt.group;
- }
- static void uvcg_mjpeg_drop(struct config_group *group,
- struct config_item *item)
- {
- struct uvcg_mjpeg *h = to_uvcg_mjpeg(item);
- kfree(h);
- }
- static struct configfs_group_operations uvcg_mjpeg_grp_ops = {
- .make_group = uvcg_mjpeg_make,
- .drop_item = uvcg_mjpeg_drop,
- };
- static const struct config_item_type uvcg_mjpeg_grp_type = {
- .ct_group_ops = &uvcg_mjpeg_grp_ops,
- .ct_owner = THIS_MODULE,
- };
- /* streaming/color_matching/default */
- static struct uvcg_default_color_matching {
- struct config_group group;
- } uvcg_default_color_matching;
- static inline struct uvcg_default_color_matching
- *to_uvcg_default_color_matching(struct config_item *item)
- {
- return container_of(to_config_group(item),
- struct uvcg_default_color_matching, group);
- }
- #define UVCG_DEFAULT_COLOR_MATCHING_ATTR(cname, aname, conv) \
- static ssize_t uvcg_default_color_matching_##cname##_show( \
- struct config_item *item, char *page) \
- { \
- struct uvcg_default_color_matching *dc = \
- to_uvcg_default_color_matching(item); \
- struct f_uvc_opts *opts; \
- struct config_item *opts_item; \
- struct mutex *su_mutex = &dc->group.cg_subsys->su_mutex; \
- struct uvc_color_matching_descriptor *cd; \
- int result; \
- \
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
- \
- opts_item = dc->group.cg_item.ci_parent->ci_parent->ci_parent; \
- opts = to_f_uvc_opts(opts_item); \
- cd = &opts->uvc_color_matching; \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(cd->aname)); \
- mutex_unlock(&opts->lock); \
- \
- mutex_unlock(su_mutex); \
- return result; \
- } \
- \
- UVC_ATTR_RO(uvcg_default_color_matching_, cname, aname)
- #define identity_conv(x) (x)
- UVCG_DEFAULT_COLOR_MATCHING_ATTR(b_color_primaries, bColorPrimaries,
- identity_conv);
- UVCG_DEFAULT_COLOR_MATCHING_ATTR(b_transfer_characteristics,
- bTransferCharacteristics, identity_conv);
- UVCG_DEFAULT_COLOR_MATCHING_ATTR(b_matrix_coefficients, bMatrixCoefficients,
- identity_conv);
- #undef identity_conv
- #undef UVCG_DEFAULT_COLOR_MATCHING_ATTR
- static struct configfs_attribute *uvcg_default_color_matching_attrs[] = {
- &uvcg_default_color_matching_attr_b_color_primaries,
- &uvcg_default_color_matching_attr_b_transfer_characteristics,
- &uvcg_default_color_matching_attr_b_matrix_coefficients,
- NULL,
- };
- static const struct config_item_type uvcg_default_color_matching_type = {
- .ct_attrs = uvcg_default_color_matching_attrs,
- .ct_owner = THIS_MODULE,
- };
- /* struct uvcg_color_matching {}; */
- /* streaming/color_matching */
- static struct uvcg_color_matching_grp {
- struct config_group group;
- } uvcg_color_matching_grp;
- static const struct config_item_type uvcg_color_matching_grp_type = {
- .ct_owner = THIS_MODULE,
- };
- /* streaming/class/{fs|hs|ss} */
- static struct uvcg_streaming_class {
- struct config_group group;
- } uvcg_streaming_class_fs, uvcg_streaming_class_hs, uvcg_streaming_class_ss;
- static inline struct uvc_descriptor_header
- ***__uvcg_get_stream_class_arr(struct config_item *i, struct f_uvc_opts *o)
- {
- struct uvcg_streaming_class *cl = container_of(to_config_group(i),
- struct uvcg_streaming_class, group);
- if (cl == &uvcg_streaming_class_fs)
- return &o->uvc_fs_streaming_cls;
- if (cl == &uvcg_streaming_class_hs)
- return &o->uvc_hs_streaming_cls;
- if (cl == &uvcg_streaming_class_ss)
- return &o->uvc_ss_streaming_cls;
- return NULL;
- }
- enum uvcg_strm_type {
- UVCG_HEADER = 0,
- UVCG_FORMAT,
- UVCG_FRAME
- };
- /*
- * Iterate over a hierarchy of streaming descriptors' config items.
- * The items are created by the user with configfs.
- *
- * It "processes" the header pointed to by @priv1, then for each format
- * that follows the header "processes" the format itself and then for
- * each frame inside a format "processes" the frame.
- *
- * As a "processing" function the @fun is used.
- *
- * __uvcg_iter_strm_cls() is used in two context: first, to calculate
- * the amount of memory needed for an array of streaming descriptors
- * and second, to actually fill the array.
- *
- * @h: streaming header pointer
- * @priv2: an "inout" parameter (the caller might want to see the changes to it)
- * @priv3: an "inout" parameter (the caller might want to see the changes to it)
- * @fun: callback function for processing each level of the hierarchy
- */
- static int __uvcg_iter_strm_cls(struct uvcg_streaming_header *h,
- void *priv2, void *priv3,
- int (*fun)(void *, void *, void *, int, enum uvcg_strm_type type))
- {
- struct uvcg_format_ptr *f;
- struct config_group *grp;
- struct config_item *item;
- struct uvcg_frame *frm;
- int ret, i, j;
- if (!fun)
- return -EINVAL;
- i = j = 0;
- ret = fun(h, priv2, priv3, 0, UVCG_HEADER);
- if (ret)
- return ret;
- list_for_each_entry(f, &h->formats, entry) {
- ret = fun(f->fmt, priv2, priv3, i++, UVCG_FORMAT);
- if (ret)
- return ret;
- grp = &f->fmt->group;
- list_for_each_entry(item, &grp->cg_children, ci_entry) {
- frm = to_uvcg_frame(item);
- ret = fun(frm, priv2, priv3, j++, UVCG_FRAME);
- if (ret)
- return ret;
- }
- }
- return ret;
- }
- /*
- * Count how many bytes are needed for an array of streaming descriptors.
- *
- * @priv1: pointer to a header, format or frame
- * @priv2: inout parameter, accumulated size of the array
- * @priv3: inout parameter, accumulated number of the array elements
- * @n: unused, this function's prototype must match @fun in __uvcg_iter_strm_cls
- */
- static int __uvcg_cnt_strm(void *priv1, void *priv2, void *priv3, int n,
- enum uvcg_strm_type type)
- {
- size_t *size = priv2;
- size_t *count = priv3;
- switch (type) {
- case UVCG_HEADER: {
- struct uvcg_streaming_header *h = priv1;
- *size += sizeof(h->desc);
- /* bmaControls */
- *size += h->num_fmt * UVCG_STREAMING_CONTROL_SIZE;
- }
- break;
- case UVCG_FORMAT: {
- struct uvcg_format *fmt = priv1;
- if (fmt->type == UVCG_UNCOMPRESSED) {
- struct uvcg_uncompressed *u =
- container_of(fmt, struct uvcg_uncompressed,
- fmt);
- *size += sizeof(u->desc);
- } else if (fmt->type == UVCG_MJPEG) {
- struct uvcg_mjpeg *m =
- container_of(fmt, struct uvcg_mjpeg, fmt);
- *size += sizeof(m->desc);
- } else {
- return -EINVAL;
- }
- }
- break;
- case UVCG_FRAME: {
- struct uvcg_frame *frm = priv1;
- int sz = sizeof(frm->dw_frame_interval);
- *size += sizeof(frm->frame);
- *size += frm->frame.b_frame_interval_type * sz;
- }
- break;
- }
- ++*count;
- return 0;
- }
- /*
- * Fill an array of streaming descriptors.
- *
- * @priv1: pointer to a header, format or frame
- * @priv2: inout parameter, pointer into a block of memory
- * @priv3: inout parameter, pointer to a 2-dimensional array
- */
- static int __uvcg_fill_strm(void *priv1, void *priv2, void *priv3, int n,
- enum uvcg_strm_type type)
- {
- void **dest = priv2;
- struct uvc_descriptor_header ***array = priv3;
- size_t sz;
- **array = *dest;
- ++*array;
- switch (type) {
- case UVCG_HEADER: {
- struct uvc_input_header_descriptor *ihdr = *dest;
- struct uvcg_streaming_header *h = priv1;
- struct uvcg_format_ptr *f;
- memcpy(*dest, &h->desc, sizeof(h->desc));
- *dest += sizeof(h->desc);
- sz = UVCG_STREAMING_CONTROL_SIZE;
- list_for_each_entry(f, &h->formats, entry) {
- memcpy(*dest, f->fmt->bmaControls, sz);
- *dest += sz;
- }
- ihdr->bLength = sizeof(h->desc) + h->num_fmt * sz;
- ihdr->bNumFormats = h->num_fmt;
- }
- break;
- case UVCG_FORMAT: {
- struct uvcg_format *fmt = priv1;
- if (fmt->type == UVCG_UNCOMPRESSED) {
- struct uvc_format_uncompressed *unc = *dest;
- struct uvcg_uncompressed *u =
- container_of(fmt, struct uvcg_uncompressed,
- fmt);
- memcpy(*dest, &u->desc, sizeof(u->desc));
- *dest += sizeof(u->desc);
- unc->bNumFrameDescriptors = fmt->num_frames;
- unc->bFormatIndex = n + 1;
- } else if (fmt->type == UVCG_MJPEG) {
- struct uvc_format_mjpeg *mjp = *dest;
- struct uvcg_mjpeg *m =
- container_of(fmt, struct uvcg_mjpeg, fmt);
- memcpy(*dest, &m->desc, sizeof(m->desc));
- *dest += sizeof(m->desc);
- mjp->bNumFrameDescriptors = fmt->num_frames;
- mjp->bFormatIndex = n + 1;
- } else {
- return -EINVAL;
- }
- }
- break;
- case UVCG_FRAME: {
- struct uvcg_frame *frm = priv1;
- struct uvc_descriptor_header *h = *dest;
- sz = sizeof(frm->frame);
- memcpy(*dest, &frm->frame, sz);
- *dest += sz;
- sz = frm->frame.b_frame_interval_type *
- sizeof(*frm->dw_frame_interval);
- memcpy(*dest, frm->dw_frame_interval, sz);
- *dest += sz;
- if (frm->fmt_type == UVCG_UNCOMPRESSED)
- h->bLength = UVC_DT_FRAME_UNCOMPRESSED_SIZE(
- frm->frame.b_frame_interval_type);
- else if (frm->fmt_type == UVCG_MJPEG)
- h->bLength = UVC_DT_FRAME_MJPEG_SIZE(
- frm->frame.b_frame_interval_type);
- }
- break;
- }
- return 0;
- }
- static int uvcg_streaming_class_allow_link(struct config_item *src,
- struct config_item *target)
- {
- struct config_item *streaming, *header;
- struct f_uvc_opts *opts;
- struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
- struct uvc_descriptor_header ***class_array, **cl_arr;
- struct uvcg_streaming_header *target_hdr;
- void *data, *data_save;
- size_t size = 0, count = 0;
- int ret = -EINVAL;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- streaming = src->ci_parent->ci_parent;
- header = config_group_find_item(to_config_group(streaming), "header");
- if (!header || target->ci_parent != header)
- goto out;
- opts = to_f_uvc_opts(streaming->ci_parent);
- mutex_lock(&opts->lock);
- class_array = __uvcg_get_stream_class_arr(src, opts);
- if (!class_array || *class_array || opts->refcnt) {
- ret = -EBUSY;
- goto unlock;
- }
- target_hdr = to_uvcg_streaming_header(target);
- ret = __uvcg_iter_strm_cls(target_hdr, &size, &count, __uvcg_cnt_strm);
- if (ret)
- goto unlock;
- count += 2; /* color_matching, NULL */
- *class_array = kcalloc(count, sizeof(void *), GFP_KERNEL);
- if (!*class_array) {
- ret = -ENOMEM;
- goto unlock;
- }
- data = data_save = kzalloc(size, GFP_KERNEL);
- if (!data) {
- kfree(*class_array);
- *class_array = NULL;
- ret = -ENOMEM;
- goto unlock;
- }
- cl_arr = *class_array;
- ret = __uvcg_iter_strm_cls(target_hdr, &data, &cl_arr,
- __uvcg_fill_strm);
- if (ret) {
- kfree(*class_array);
- *class_array = NULL;
- /*
- * __uvcg_fill_strm() called from __uvcg_iter_stream_cls()
- * might have advanced the "data", so use a backup copy
- */
- kfree(data_save);
- goto unlock;
- }
- *cl_arr = (struct uvc_descriptor_header *)&opts->uvc_color_matching;
- ++target_hdr->linked;
- ret = 0;
- unlock:
- mutex_unlock(&opts->lock);
- out:
- config_item_put(header);
- mutex_unlock(su_mutex);
- return ret;
- }
- static void uvcg_streaming_class_drop_link(struct config_item *src,
- struct config_item *target)
- {
- struct config_item *streaming, *header;
- struct f_uvc_opts *opts;
- struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
- struct uvc_descriptor_header ***class_array;
- struct uvcg_streaming_header *target_hdr;
- mutex_lock(su_mutex); /* for navigating configfs hierarchy */
- streaming = src->ci_parent->ci_parent;
- header = config_group_find_item(to_config_group(streaming), "header");
- if (!header || target->ci_parent != header)
- goto out;
- opts = to_f_uvc_opts(streaming->ci_parent);
- mutex_lock(&opts->lock);
- class_array = __uvcg_get_stream_class_arr(src, opts);
- if (!class_array || !*class_array)
- goto unlock;
- if (opts->refcnt)
- goto unlock;
- target_hdr = to_uvcg_streaming_header(target);
- --target_hdr->linked;
- kfree(**class_array);
- kfree(*class_array);
- *class_array = NULL;
- unlock:
- mutex_unlock(&opts->lock);
- out:
- config_item_put(header);
- mutex_unlock(su_mutex);
- }
- static struct configfs_item_operations uvcg_streaming_class_item_ops = {
- .allow_link = uvcg_streaming_class_allow_link,
- .drop_link = uvcg_streaming_class_drop_link,
- };
- static const struct config_item_type uvcg_streaming_class_type = {
- .ct_item_ops = &uvcg_streaming_class_item_ops,
- .ct_owner = THIS_MODULE,
- };
- /* streaming/class */
- static struct uvcg_streaming_class_grp {
- struct config_group group;
- } uvcg_streaming_class_grp;
- static const struct config_item_type uvcg_streaming_class_grp_type = {
- .ct_owner = THIS_MODULE,
- };
- /* streaming */
- static struct uvcg_streaming_grp {
- struct config_group group;
- } uvcg_streaming_grp;
- static const struct config_item_type uvcg_streaming_grp_type = {
- .ct_owner = THIS_MODULE,
- };
- static void uvc_attr_release(struct config_item *item)
- {
- struct f_uvc_opts *opts = to_f_uvc_opts(item);
- usb_put_function_instance(&opts->func_inst);
- }
- static struct configfs_item_operations uvc_item_ops = {
- .release = uvc_attr_release,
- };
- #define UVCG_OPTS_ATTR(cname, aname, conv, str2u, uxx, vnoc, limit) \
- static ssize_t f_uvc_opts_##cname##_show( \
- struct config_item *item, char *page) \
- { \
- struct f_uvc_opts *opts = to_f_uvc_opts(item); \
- int result; \
- \
- mutex_lock(&opts->lock); \
- result = sprintf(page, "%d\n", conv(opts->cname)); \
- mutex_unlock(&opts->lock); \
- \
- return result; \
- } \
- \
- static ssize_t \
- f_uvc_opts_##cname##_store(struct config_item *item, \
- const char *page, size_t len) \
- { \
- struct f_uvc_opts *opts = to_f_uvc_opts(item); \
- int ret; \
- uxx num; \
- \
- mutex_lock(&opts->lock); \
- if (opts->refcnt) { \
- ret = -EBUSY; \
- goto end; \
- } \
- \
- ret = str2u(page, 0, &num); \
- if (ret) \
- goto end; \
- \
- if (num > limit) { \
- ret = -EINVAL; \
- goto end; \
- } \
- opts->cname = vnoc(num); \
- ret = len; \
- end: \
- mutex_unlock(&opts->lock); \
- return ret; \
- } \
- \
- UVC_ATTR(f_uvc_opts_, cname, cname)
- #define identity_conv(x) (x)
- UVCG_OPTS_ATTR(streaming_interval, streaming_interval, identity_conv,
- kstrtou8, u8, identity_conv, 16);
- UVCG_OPTS_ATTR(streaming_maxpacket, streaming_maxpacket, le16_to_cpu,
- kstrtou16, u16, le16_to_cpu, 3072);
- UVCG_OPTS_ATTR(streaming_maxburst, streaming_maxburst, identity_conv,
- kstrtou8, u8, identity_conv, 15);
- #undef identity_conv
- #undef UVCG_OPTS_ATTR
- static struct configfs_attribute *uvc_attrs[] = {
- &f_uvc_opts_attr_streaming_interval,
- &f_uvc_opts_attr_streaming_maxpacket,
- &f_uvc_opts_attr_streaming_maxburst,
- NULL,
- };
- static const struct config_item_type uvc_func_type = {
- .ct_item_ops = &uvc_item_ops,
- .ct_attrs = uvc_attrs,
- .ct_owner = THIS_MODULE,
- };
- int uvcg_attach_configfs(struct f_uvc_opts *opts)
- {
- config_group_init_type_name(&uvcg_control_header_grp.group,
- "header",
- &uvcg_control_header_grp_type);
- config_group_init_type_name(&uvcg_default_processing.group,
- "default", &uvcg_default_processing_type);
- config_group_init_type_name(&uvcg_processing_grp.group,
- "processing", &uvcg_processing_grp_type);
- configfs_add_default_group(&uvcg_default_processing.group,
- &uvcg_processing_grp.group);
- config_group_init_type_name(&uvcg_default_camera.group,
- "default", &uvcg_default_camera_type);
- config_group_init_type_name(&uvcg_camera_grp.group,
- "camera", &uvcg_camera_grp_type);
- configfs_add_default_group(&uvcg_default_camera.group,
- &uvcg_camera_grp.group);
- config_group_init_type_name(&uvcg_default_output.group,
- "default", &uvcg_default_output_type);
- config_group_init_type_name(&uvcg_output_grp.group,
- "output", &uvcg_output_grp_type);
- configfs_add_default_group(&uvcg_default_output.group,
- &uvcg_output_grp.group);
- config_group_init_type_name(&uvcg_terminal_grp.group,
- "terminal", &uvcg_terminal_grp_type);
- configfs_add_default_group(&uvcg_camera_grp.group,
- &uvcg_terminal_grp.group);
- configfs_add_default_group(&uvcg_output_grp.group,
- &uvcg_terminal_grp.group);
- config_group_init_type_name(&uvcg_control_class_fs.group,
- "fs", &uvcg_control_class_type);
- config_group_init_type_name(&uvcg_control_class_ss.group,
- "ss", &uvcg_control_class_type);
- config_group_init_type_name(&uvcg_control_class_grp.group,
- "class",
- &uvcg_control_class_grp_type);
- configfs_add_default_group(&uvcg_control_class_fs.group,
- &uvcg_control_class_grp.group);
- configfs_add_default_group(&uvcg_control_class_ss.group,
- &uvcg_control_class_grp.group);
- config_group_init_type_name(&uvcg_control_grp.group,
- "control",
- &uvcg_control_grp_type);
- configfs_add_default_group(&uvcg_control_header_grp.group,
- &uvcg_control_grp.group);
- configfs_add_default_group(&uvcg_processing_grp.group,
- &uvcg_control_grp.group);
- configfs_add_default_group(&uvcg_terminal_grp.group,
- &uvcg_control_grp.group);
- configfs_add_default_group(&uvcg_control_class_grp.group,
- &uvcg_control_grp.group);
- config_group_init_type_name(&uvcg_streaming_header_grp.group,
- "header",
- &uvcg_streaming_header_grp_type);
- config_group_init_type_name(&uvcg_uncompressed_grp.group,
- "uncompressed",
- &uvcg_uncompressed_grp_type);
- config_group_init_type_name(&uvcg_mjpeg_grp.group,
- "mjpeg",
- &uvcg_mjpeg_grp_type);
- config_group_init_type_name(&uvcg_default_color_matching.group,
- "default",
- &uvcg_default_color_matching_type);
- config_group_init_type_name(&uvcg_color_matching_grp.group,
- "color_matching",
- &uvcg_color_matching_grp_type);
- configfs_add_default_group(&uvcg_default_color_matching.group,
- &uvcg_color_matching_grp.group);
- config_group_init_type_name(&uvcg_streaming_class_fs.group,
- "fs", &uvcg_streaming_class_type);
- config_group_init_type_name(&uvcg_streaming_class_hs.group,
- "hs", &uvcg_streaming_class_type);
- config_group_init_type_name(&uvcg_streaming_class_ss.group,
- "ss", &uvcg_streaming_class_type);
- config_group_init_type_name(&uvcg_streaming_class_grp.group,
- "class", &uvcg_streaming_class_grp_type);
- configfs_add_default_group(&uvcg_streaming_class_fs.group,
- &uvcg_streaming_class_grp.group);
- configfs_add_default_group(&uvcg_streaming_class_hs.group,
- &uvcg_streaming_class_grp.group);
- configfs_add_default_group(&uvcg_streaming_class_ss.group,
- &uvcg_streaming_class_grp.group);
- config_group_init_type_name(&uvcg_streaming_grp.group,
- "streaming", &uvcg_streaming_grp_type);
- configfs_add_default_group(&uvcg_streaming_header_grp.group,
- &uvcg_streaming_grp.group);
- configfs_add_default_group(&uvcg_uncompressed_grp.group,
- &uvcg_streaming_grp.group);
- configfs_add_default_group(&uvcg_mjpeg_grp.group,
- &uvcg_streaming_grp.group);
- configfs_add_default_group(&uvcg_color_matching_grp.group,
- &uvcg_streaming_grp.group);
- configfs_add_default_group(&uvcg_streaming_class_grp.group,
- &uvcg_streaming_grp.group);
- config_group_init_type_name(&opts->func_inst.group,
- "",
- &uvc_func_type);
- configfs_add_default_group(&uvcg_control_grp.group,
- &opts->func_inst.group);
- configfs_add_default_group(&uvcg_streaming_grp.group,
- &opts->func_inst.group);
- return 0;
- }
|