uvc_configfs.c 92 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * uvc_configfs.c
  4. *
  5. * Configfs support for the uvc function.
  6. *
  7. * Copyright (c) 2014 Samsung Electronics Co., Ltd.
  8. * http://www.samsung.com
  9. *
  10. * Author: Andrzej Pietrasiewicz <andrzejtp2010@gmail.com>
  11. */
  12. #include "uvc_configfs.h"
  13. #include <linux/sort.h>
  14. #include <linux/usb/uvc.h>
  15. #include <linux/usb/video.h>
  16. /* -----------------------------------------------------------------------------
  17. * Global Utility Structures and Macros
  18. */
  19. #define UVC_ATTR(prefix, cname, aname) \
  20. static struct configfs_attribute prefix##attr_##cname = { \
  21. .ca_name = __stringify(aname), \
  22. .ca_mode = S_IRUGO | S_IWUGO, \
  23. .ca_owner = THIS_MODULE, \
  24. .show = prefix##cname##_show, \
  25. .store = prefix##cname##_store, \
  26. }
  27. #define UVC_ATTR_RO(prefix, cname, aname) \
  28. static struct configfs_attribute prefix##attr_##cname = { \
  29. .ca_name = __stringify(aname), \
  30. .ca_mode = S_IRUGO, \
  31. .ca_owner = THIS_MODULE, \
  32. .show = prefix##cname##_show, \
  33. }
  34. #define le8_to_cpu(x) (x)
  35. #define cpu_to_le8(x) (x)
  36. static int uvcg_config_compare_u32(const void *l, const void *r)
  37. {
  38. u32 li = *(const u32 *)l;
  39. u32 ri = *(const u32 *)r;
  40. return li < ri ? -1 : li == ri ? 0 : 1;
  41. }
  42. static inline int __uvcg_count_item_entries(char *buf, void *priv, unsigned int size)
  43. {
  44. ++*((int *)priv);
  45. return 0;
  46. }
  47. static inline int __uvcg_fill_item_entries(char *buf, void *priv, unsigned int size)
  48. {
  49. unsigned int num;
  50. u8 **values;
  51. int ret;
  52. ret = kstrtouint(buf, 0, &num);
  53. if (ret)
  54. return ret;
  55. if (num != (num & GENMASK((size * 8) - 1, 0)))
  56. return -ERANGE;
  57. values = priv;
  58. memcpy(*values, &num, size);
  59. *values += size;
  60. return 0;
  61. }
  62. static int __uvcg_iter_item_entries(const char *page, size_t len,
  63. int (*fun)(char *, void *, unsigned int),
  64. void *priv, unsigned int size)
  65. {
  66. /* sign, base 2 representation, newline, terminator */
  67. unsigned int bufsize = 1 + size * 8 + 1 + 1;
  68. const char *pg = page;
  69. int i, ret = 0;
  70. char *buf;
  71. if (!fun)
  72. return -EINVAL;
  73. buf = kzalloc(bufsize, GFP_KERNEL);
  74. if (!buf)
  75. return -ENOMEM;
  76. while (pg - page < len) {
  77. i = 0;
  78. while (i < bufsize && (pg - page < len) &&
  79. *pg != '\0' && *pg != '\n')
  80. buf[i++] = *pg++;
  81. if (i == bufsize) {
  82. ret = -EINVAL;
  83. goto out_free_buf;
  84. }
  85. while ((pg - page < len) && (*pg == '\0' || *pg == '\n'))
  86. ++pg;
  87. buf[i] = '\0';
  88. ret = fun(buf, priv, size);
  89. if (ret)
  90. goto out_free_buf;
  91. }
  92. out_free_buf:
  93. kfree(buf);
  94. return ret;
  95. }
  96. struct uvcg_config_group_type {
  97. struct config_item_type type;
  98. const char *name;
  99. const struct uvcg_config_group_type **children;
  100. int (*create_children)(struct config_group *group);
  101. };
  102. static void uvcg_config_item_release(struct config_item *item)
  103. {
  104. struct config_group *group = to_config_group(item);
  105. kfree(group);
  106. }
  107. static struct configfs_item_operations uvcg_config_item_ops = {
  108. .release = uvcg_config_item_release,
  109. };
  110. static int uvcg_config_create_group(struct config_group *parent,
  111. const struct uvcg_config_group_type *type);
  112. static int uvcg_config_create_children(struct config_group *group,
  113. const struct uvcg_config_group_type *type)
  114. {
  115. const struct uvcg_config_group_type **child;
  116. int ret;
  117. if (type->create_children)
  118. return type->create_children(group);
  119. for (child = type->children; child && *child; ++child) {
  120. ret = uvcg_config_create_group(group, *child);
  121. if (ret < 0)
  122. return ret;
  123. }
  124. return 0;
  125. }
  126. static int uvcg_config_create_group(struct config_group *parent,
  127. const struct uvcg_config_group_type *type)
  128. {
  129. struct config_group *group;
  130. group = kzalloc(sizeof(*group), GFP_KERNEL);
  131. if (!group)
  132. return -ENOMEM;
  133. config_group_init_type_name(group, type->name, &type->type);
  134. configfs_add_default_group(group, parent);
  135. return uvcg_config_create_children(group, type);
  136. }
  137. static void uvcg_config_remove_children(struct config_group *group)
  138. {
  139. struct config_group *child, *n;
  140. list_for_each_entry_safe(child, n, &group->default_groups, group_entry) {
  141. list_del(&child->group_entry);
  142. uvcg_config_remove_children(child);
  143. config_item_put(&child->cg_item);
  144. }
  145. }
  146. /* -----------------------------------------------------------------------------
  147. * control/header/<NAME>
  148. * control/header
  149. */
  150. #define UVCG_CTRL_HDR_ATTR(cname, aname, bits, limit) \
  151. static ssize_t uvcg_control_header_##cname##_show( \
  152. struct config_item *item, char *page) \
  153. { \
  154. struct uvcg_control_header *ch = to_uvcg_control_header(item); \
  155. struct f_uvc_opts *opts; \
  156. struct config_item *opts_item; \
  157. struct mutex *su_mutex = &ch->item.ci_group->cg_subsys->su_mutex;\
  158. int result; \
  159. \
  160. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  161. \
  162. opts_item = ch->item.ci_parent->ci_parent->ci_parent; \
  163. opts = to_f_uvc_opts(opts_item); \
  164. \
  165. mutex_lock(&opts->lock); \
  166. result = sprintf(page, "%u\n", le##bits##_to_cpu(ch->desc.aname));\
  167. mutex_unlock(&opts->lock); \
  168. \
  169. mutex_unlock(su_mutex); \
  170. return result; \
  171. } \
  172. \
  173. static ssize_t \
  174. uvcg_control_header_##cname##_store(struct config_item *item, \
  175. const char *page, size_t len) \
  176. { \
  177. struct uvcg_control_header *ch = to_uvcg_control_header(item); \
  178. struct f_uvc_opts *opts; \
  179. struct config_item *opts_item; \
  180. struct mutex *su_mutex = &ch->item.ci_group->cg_subsys->su_mutex;\
  181. int ret; \
  182. u##bits num; \
  183. \
  184. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  185. \
  186. opts_item = ch->item.ci_parent->ci_parent->ci_parent; \
  187. opts = to_f_uvc_opts(opts_item); \
  188. \
  189. mutex_lock(&opts->lock); \
  190. if (ch->linked || opts->refcnt) { \
  191. ret = -EBUSY; \
  192. goto end; \
  193. } \
  194. \
  195. ret = kstrtou##bits(page, 0, &num); \
  196. if (ret) \
  197. goto end; \
  198. \
  199. if (num > limit) { \
  200. ret = -EINVAL; \
  201. goto end; \
  202. } \
  203. ch->desc.aname = cpu_to_le##bits(num); \
  204. ret = len; \
  205. end: \
  206. mutex_unlock(&opts->lock); \
  207. mutex_unlock(su_mutex); \
  208. return ret; \
  209. } \
  210. \
  211. UVC_ATTR(uvcg_control_header_, cname, aname)
  212. UVCG_CTRL_HDR_ATTR(bcd_uvc, bcdUVC, 16, 0xffff);
  213. UVCG_CTRL_HDR_ATTR(dw_clock_frequency, dwClockFrequency, 32, 0x7fffffff);
  214. #undef UVCG_CTRL_HDR_ATTR
  215. static struct configfs_attribute *uvcg_control_header_attrs[] = {
  216. &uvcg_control_header_attr_bcd_uvc,
  217. &uvcg_control_header_attr_dw_clock_frequency,
  218. NULL,
  219. };
  220. static const struct config_item_type uvcg_control_header_type = {
  221. .ct_item_ops = &uvcg_config_item_ops,
  222. .ct_attrs = uvcg_control_header_attrs,
  223. .ct_owner = THIS_MODULE,
  224. };
  225. static struct config_item *uvcg_control_header_make(struct config_group *group,
  226. const char *name)
  227. {
  228. struct uvcg_control_header *h;
  229. h = kzalloc(sizeof(*h), GFP_KERNEL);
  230. if (!h)
  231. return ERR_PTR(-ENOMEM);
  232. h->desc.bLength = UVC_DT_HEADER_SIZE(1);
  233. h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  234. h->desc.bDescriptorSubType = UVC_VC_HEADER;
  235. h->desc.bcdUVC = cpu_to_le16(0x0110);
  236. h->desc.dwClockFrequency = cpu_to_le32(48000000);
  237. config_item_init_type_name(&h->item, name, &uvcg_control_header_type);
  238. return &h->item;
  239. }
  240. static struct configfs_group_operations uvcg_control_header_grp_ops = {
  241. .make_item = uvcg_control_header_make,
  242. };
  243. static const struct uvcg_config_group_type uvcg_control_header_grp_type = {
  244. .type = {
  245. .ct_item_ops = &uvcg_config_item_ops,
  246. .ct_group_ops = &uvcg_control_header_grp_ops,
  247. .ct_owner = THIS_MODULE,
  248. },
  249. .name = "header",
  250. };
  251. /* -----------------------------------------------------------------------------
  252. * control/processing/default
  253. */
  254. #define UVCG_DEFAULT_PROCESSING_ATTR(cname, aname, bits) \
  255. static ssize_t uvcg_default_processing_##cname##_show( \
  256. struct config_item *item, char *page) \
  257. { \
  258. struct config_group *group = to_config_group(item); \
  259. struct f_uvc_opts *opts; \
  260. struct config_item *opts_item; \
  261. struct mutex *su_mutex = &group->cg_subsys->su_mutex; \
  262. struct uvc_processing_unit_descriptor *pd; \
  263. int result; \
  264. \
  265. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  266. \
  267. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent; \
  268. opts = to_f_uvc_opts(opts_item); \
  269. pd = &opts->uvc_processing; \
  270. \
  271. mutex_lock(&opts->lock); \
  272. result = sprintf(page, "%u\n", le##bits##_to_cpu(pd->aname)); \
  273. mutex_unlock(&opts->lock); \
  274. \
  275. mutex_unlock(su_mutex); \
  276. return result; \
  277. } \
  278. \
  279. UVC_ATTR_RO(uvcg_default_processing_, cname, aname)
  280. UVCG_DEFAULT_PROCESSING_ATTR(b_unit_id, bUnitID, 8);
  281. UVCG_DEFAULT_PROCESSING_ATTR(b_source_id, bSourceID, 8);
  282. UVCG_DEFAULT_PROCESSING_ATTR(w_max_multiplier, wMaxMultiplier, 16);
  283. UVCG_DEFAULT_PROCESSING_ATTR(i_processing, iProcessing, 8);
  284. #undef UVCG_DEFAULT_PROCESSING_ATTR
  285. static ssize_t uvcg_default_processing_bm_controls_store(
  286. struct config_item *item, const char *page, size_t len)
  287. {
  288. struct config_group *group = to_config_group(item);
  289. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  290. struct uvc_processing_unit_descriptor *pd;
  291. struct config_item *opts_item;
  292. struct f_uvc_opts *opts;
  293. u8 *bm_controls, *tmp;
  294. unsigned int i;
  295. int ret, n = 0;
  296. mutex_lock(su_mutex);
  297. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent;
  298. opts = to_f_uvc_opts(opts_item);
  299. pd = &opts->uvc_processing;
  300. mutex_lock(&opts->lock);
  301. if (opts->refcnt) {
  302. ret = -EBUSY;
  303. goto unlock;
  304. }
  305. ret = __uvcg_iter_item_entries(page, len, __uvcg_count_item_entries, &n,
  306. sizeof(u8));
  307. if (ret)
  308. goto unlock;
  309. if (n > pd->bControlSize) {
  310. ret = -EINVAL;
  311. goto unlock;
  312. }
  313. tmp = bm_controls = kcalloc(n, sizeof(u8), GFP_KERNEL);
  314. if (!bm_controls) {
  315. ret = -ENOMEM;
  316. goto unlock;
  317. }
  318. ret = __uvcg_iter_item_entries(page, len, __uvcg_fill_item_entries, &tmp,
  319. sizeof(u8));
  320. if (ret)
  321. goto free_mem;
  322. for (i = 0; i < n; i++)
  323. pd->bmControls[i] = bm_controls[i];
  324. ret = len;
  325. free_mem:
  326. kfree(bm_controls);
  327. unlock:
  328. mutex_unlock(&opts->lock);
  329. mutex_unlock(su_mutex);
  330. return ret;
  331. }
  332. static ssize_t uvcg_default_processing_bm_controls_show(
  333. struct config_item *item, char *page)
  334. {
  335. struct config_group *group = to_config_group(item);
  336. struct f_uvc_opts *opts;
  337. struct config_item *opts_item;
  338. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  339. struct uvc_processing_unit_descriptor *pd;
  340. int result, i;
  341. char *pg = page;
  342. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  343. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent;
  344. opts = to_f_uvc_opts(opts_item);
  345. pd = &opts->uvc_processing;
  346. mutex_lock(&opts->lock);
  347. for (result = 0, i = 0; i < pd->bControlSize; ++i) {
  348. result += sprintf(pg, "%u\n", pd->bmControls[i]);
  349. pg = page + result;
  350. }
  351. mutex_unlock(&opts->lock);
  352. mutex_unlock(su_mutex);
  353. return result;
  354. }
  355. UVC_ATTR(uvcg_default_processing_, bm_controls, bmControls);
  356. static struct configfs_attribute *uvcg_default_processing_attrs[] = {
  357. &uvcg_default_processing_attr_b_unit_id,
  358. &uvcg_default_processing_attr_b_source_id,
  359. &uvcg_default_processing_attr_w_max_multiplier,
  360. &uvcg_default_processing_attr_bm_controls,
  361. &uvcg_default_processing_attr_i_processing,
  362. NULL,
  363. };
  364. static const struct uvcg_config_group_type uvcg_default_processing_type = {
  365. .type = {
  366. .ct_item_ops = &uvcg_config_item_ops,
  367. .ct_attrs = uvcg_default_processing_attrs,
  368. .ct_owner = THIS_MODULE,
  369. },
  370. .name = "default",
  371. };
  372. /* -----------------------------------------------------------------------------
  373. * control/processing
  374. */
  375. static const struct uvcg_config_group_type uvcg_processing_grp_type = {
  376. .type = {
  377. .ct_item_ops = &uvcg_config_item_ops,
  378. .ct_owner = THIS_MODULE,
  379. },
  380. .name = "processing",
  381. .children = (const struct uvcg_config_group_type*[]) {
  382. &uvcg_default_processing_type,
  383. NULL,
  384. },
  385. };
  386. /* -----------------------------------------------------------------------------
  387. * control/terminal/camera/default
  388. */
  389. #define UVCG_DEFAULT_CAMERA_ATTR(cname, aname, bits) \
  390. static ssize_t uvcg_default_camera_##cname##_show( \
  391. struct config_item *item, char *page) \
  392. { \
  393. struct config_group *group = to_config_group(item); \
  394. struct f_uvc_opts *opts; \
  395. struct config_item *opts_item; \
  396. struct mutex *su_mutex = &group->cg_subsys->su_mutex; \
  397. struct uvc_camera_terminal_descriptor *cd; \
  398. int result; \
  399. \
  400. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  401. \
  402. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent-> \
  403. ci_parent; \
  404. opts = to_f_uvc_opts(opts_item); \
  405. cd = &opts->uvc_camera_terminal; \
  406. \
  407. mutex_lock(&opts->lock); \
  408. result = sprintf(page, "%u\n", le##bits##_to_cpu(cd->aname)); \
  409. mutex_unlock(&opts->lock); \
  410. \
  411. mutex_unlock(su_mutex); \
  412. \
  413. return result; \
  414. } \
  415. \
  416. UVC_ATTR_RO(uvcg_default_camera_, cname, aname)
  417. UVCG_DEFAULT_CAMERA_ATTR(b_terminal_id, bTerminalID, 8);
  418. UVCG_DEFAULT_CAMERA_ATTR(w_terminal_type, wTerminalType, 16);
  419. UVCG_DEFAULT_CAMERA_ATTR(b_assoc_terminal, bAssocTerminal, 8);
  420. UVCG_DEFAULT_CAMERA_ATTR(i_terminal, iTerminal, 8);
  421. UVCG_DEFAULT_CAMERA_ATTR(w_objective_focal_length_min, wObjectiveFocalLengthMin,
  422. 16);
  423. UVCG_DEFAULT_CAMERA_ATTR(w_objective_focal_length_max, wObjectiveFocalLengthMax,
  424. 16);
  425. UVCG_DEFAULT_CAMERA_ATTR(w_ocular_focal_length, wOcularFocalLength,
  426. 16);
  427. #undef UVCG_DEFAULT_CAMERA_ATTR
  428. static ssize_t uvcg_default_camera_bm_controls_store(
  429. struct config_item *item, const char *page, size_t len)
  430. {
  431. struct config_group *group = to_config_group(item);
  432. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  433. struct uvc_camera_terminal_descriptor *cd;
  434. struct config_item *opts_item;
  435. struct f_uvc_opts *opts;
  436. u8 *bm_controls, *tmp;
  437. unsigned int i;
  438. int ret, n = 0;
  439. mutex_lock(su_mutex);
  440. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent->
  441. ci_parent;
  442. opts = to_f_uvc_opts(opts_item);
  443. cd = &opts->uvc_camera_terminal;
  444. mutex_lock(&opts->lock);
  445. if (opts->refcnt) {
  446. ret = -EBUSY;
  447. goto unlock;
  448. }
  449. ret = __uvcg_iter_item_entries(page, len, __uvcg_count_item_entries, &n,
  450. sizeof(u8));
  451. if (ret)
  452. goto unlock;
  453. if (n > cd->bControlSize) {
  454. ret = -EINVAL;
  455. goto unlock;
  456. }
  457. tmp = bm_controls = kcalloc(n, sizeof(u8), GFP_KERNEL);
  458. if (!bm_controls) {
  459. ret = -ENOMEM;
  460. goto unlock;
  461. }
  462. ret = __uvcg_iter_item_entries(page, len, __uvcg_fill_item_entries, &tmp,
  463. sizeof(u8));
  464. if (ret)
  465. goto free_mem;
  466. for (i = 0; i < n; i++)
  467. cd->bmControls[i] = bm_controls[i];
  468. ret = len;
  469. free_mem:
  470. kfree(bm_controls);
  471. unlock:
  472. mutex_unlock(&opts->lock);
  473. mutex_unlock(su_mutex);
  474. return ret;
  475. }
  476. static ssize_t uvcg_default_camera_bm_controls_show(
  477. struct config_item *item, char *page)
  478. {
  479. struct config_group *group = to_config_group(item);
  480. struct f_uvc_opts *opts;
  481. struct config_item *opts_item;
  482. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  483. struct uvc_camera_terminal_descriptor *cd;
  484. int result, i;
  485. char *pg = page;
  486. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  487. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent->
  488. ci_parent;
  489. opts = to_f_uvc_opts(opts_item);
  490. cd = &opts->uvc_camera_terminal;
  491. mutex_lock(&opts->lock);
  492. for (result = 0, i = 0; i < cd->bControlSize; ++i) {
  493. result += sprintf(pg, "%u\n", cd->bmControls[i]);
  494. pg = page + result;
  495. }
  496. mutex_unlock(&opts->lock);
  497. mutex_unlock(su_mutex);
  498. return result;
  499. }
  500. UVC_ATTR(uvcg_default_camera_, bm_controls, bmControls);
  501. static struct configfs_attribute *uvcg_default_camera_attrs[] = {
  502. &uvcg_default_camera_attr_b_terminal_id,
  503. &uvcg_default_camera_attr_w_terminal_type,
  504. &uvcg_default_camera_attr_b_assoc_terminal,
  505. &uvcg_default_camera_attr_i_terminal,
  506. &uvcg_default_camera_attr_w_objective_focal_length_min,
  507. &uvcg_default_camera_attr_w_objective_focal_length_max,
  508. &uvcg_default_camera_attr_w_ocular_focal_length,
  509. &uvcg_default_camera_attr_bm_controls,
  510. NULL,
  511. };
  512. static const struct uvcg_config_group_type uvcg_default_camera_type = {
  513. .type = {
  514. .ct_item_ops = &uvcg_config_item_ops,
  515. .ct_attrs = uvcg_default_camera_attrs,
  516. .ct_owner = THIS_MODULE,
  517. },
  518. .name = "default",
  519. };
  520. /* -----------------------------------------------------------------------------
  521. * control/terminal/camera
  522. */
  523. static const struct uvcg_config_group_type uvcg_camera_grp_type = {
  524. .type = {
  525. .ct_item_ops = &uvcg_config_item_ops,
  526. .ct_owner = THIS_MODULE,
  527. },
  528. .name = "camera",
  529. .children = (const struct uvcg_config_group_type*[]) {
  530. &uvcg_default_camera_type,
  531. NULL,
  532. },
  533. };
  534. /* -----------------------------------------------------------------------------
  535. * control/terminal/output/default
  536. */
  537. #define UVCG_DEFAULT_OUTPUT_ATTR(cname, aname, bits) \
  538. static ssize_t uvcg_default_output_##cname##_show( \
  539. struct config_item *item, char *page) \
  540. { \
  541. struct config_group *group = to_config_group(item); \
  542. struct f_uvc_opts *opts; \
  543. struct config_item *opts_item; \
  544. struct mutex *su_mutex = &group->cg_subsys->su_mutex; \
  545. struct uvc_output_terminal_descriptor *cd; \
  546. int result; \
  547. \
  548. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  549. \
  550. opts_item = group->cg_item.ci_parent->ci_parent-> \
  551. ci_parent->ci_parent; \
  552. opts = to_f_uvc_opts(opts_item); \
  553. cd = &opts->uvc_output_terminal; \
  554. \
  555. mutex_lock(&opts->lock); \
  556. result = sprintf(page, "%u\n", le##bits##_to_cpu(cd->aname)); \
  557. mutex_unlock(&opts->lock); \
  558. \
  559. mutex_unlock(su_mutex); \
  560. \
  561. return result; \
  562. } \
  563. \
  564. UVC_ATTR_RO(uvcg_default_output_, cname, aname)
  565. UVCG_DEFAULT_OUTPUT_ATTR(b_terminal_id, bTerminalID, 8);
  566. UVCG_DEFAULT_OUTPUT_ATTR(w_terminal_type, wTerminalType, 16);
  567. UVCG_DEFAULT_OUTPUT_ATTR(b_assoc_terminal, bAssocTerminal, 8);
  568. UVCG_DEFAULT_OUTPUT_ATTR(i_terminal, iTerminal, 8);
  569. #undef UVCG_DEFAULT_OUTPUT_ATTR
  570. static ssize_t uvcg_default_output_b_source_id_show(struct config_item *item,
  571. char *page)
  572. {
  573. struct config_group *group = to_config_group(item);
  574. struct f_uvc_opts *opts;
  575. struct config_item *opts_item;
  576. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  577. struct uvc_output_terminal_descriptor *cd;
  578. int result;
  579. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  580. opts_item = group->cg_item.ci_parent->ci_parent->
  581. ci_parent->ci_parent;
  582. opts = to_f_uvc_opts(opts_item);
  583. cd = &opts->uvc_output_terminal;
  584. mutex_lock(&opts->lock);
  585. result = sprintf(page, "%u\n", le8_to_cpu(cd->bSourceID));
  586. mutex_unlock(&opts->lock);
  587. mutex_unlock(su_mutex);
  588. return result;
  589. }
  590. static ssize_t uvcg_default_output_b_source_id_store(struct config_item *item,
  591. const char *page, size_t len)
  592. {
  593. struct config_group *group = to_config_group(item);
  594. struct f_uvc_opts *opts;
  595. struct config_item *opts_item;
  596. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  597. struct uvc_output_terminal_descriptor *cd;
  598. int result;
  599. u8 num;
  600. result = kstrtou8(page, 0, &num);
  601. if (result)
  602. return result;
  603. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  604. opts_item = group->cg_item.ci_parent->ci_parent->
  605. ci_parent->ci_parent;
  606. opts = to_f_uvc_opts(opts_item);
  607. cd = &opts->uvc_output_terminal;
  608. mutex_lock(&opts->lock);
  609. cd->bSourceID = num;
  610. mutex_unlock(&opts->lock);
  611. mutex_unlock(su_mutex);
  612. return len;
  613. }
  614. UVC_ATTR(uvcg_default_output_, b_source_id, bSourceID);
  615. static struct configfs_attribute *uvcg_default_output_attrs[] = {
  616. &uvcg_default_output_attr_b_terminal_id,
  617. &uvcg_default_output_attr_w_terminal_type,
  618. &uvcg_default_output_attr_b_assoc_terminal,
  619. &uvcg_default_output_attr_b_source_id,
  620. &uvcg_default_output_attr_i_terminal,
  621. NULL,
  622. };
  623. static const struct uvcg_config_group_type uvcg_default_output_type = {
  624. .type = {
  625. .ct_item_ops = &uvcg_config_item_ops,
  626. .ct_attrs = uvcg_default_output_attrs,
  627. .ct_owner = THIS_MODULE,
  628. },
  629. .name = "default",
  630. };
  631. /* -----------------------------------------------------------------------------
  632. * control/terminal/output
  633. */
  634. static const struct uvcg_config_group_type uvcg_output_grp_type = {
  635. .type = {
  636. .ct_item_ops = &uvcg_config_item_ops,
  637. .ct_owner = THIS_MODULE,
  638. },
  639. .name = "output",
  640. .children = (const struct uvcg_config_group_type*[]) {
  641. &uvcg_default_output_type,
  642. NULL,
  643. },
  644. };
  645. /* -----------------------------------------------------------------------------
  646. * control/terminal
  647. */
  648. static const struct uvcg_config_group_type uvcg_terminal_grp_type = {
  649. .type = {
  650. .ct_item_ops = &uvcg_config_item_ops,
  651. .ct_owner = THIS_MODULE,
  652. },
  653. .name = "terminal",
  654. .children = (const struct uvcg_config_group_type*[]) {
  655. &uvcg_camera_grp_type,
  656. &uvcg_output_grp_type,
  657. NULL,
  658. },
  659. };
  660. /* -----------------------------------------------------------------------------
  661. * control/extensions
  662. */
  663. #define UVCG_EXTENSION_ATTR(cname, aname, ro...) \
  664. static ssize_t uvcg_extension_##cname##_show(struct config_item *item, \
  665. char *page) \
  666. { \
  667. struct config_group *group = to_config_group(item->ci_parent); \
  668. struct mutex *su_mutex = &group->cg_subsys->su_mutex; \
  669. struct uvcg_extension *xu = to_uvcg_extension(item); \
  670. struct config_item *opts_item; \
  671. struct f_uvc_opts *opts; \
  672. int ret; \
  673. \
  674. mutex_lock(su_mutex); \
  675. \
  676. opts_item = item->ci_parent->ci_parent->ci_parent; \
  677. opts = to_f_uvc_opts(opts_item); \
  678. \
  679. mutex_lock(&opts->lock); \
  680. ret = sprintf(page, "%u\n", xu->desc.aname); \
  681. mutex_unlock(&opts->lock); \
  682. \
  683. mutex_unlock(su_mutex); \
  684. \
  685. return ret; \
  686. } \
  687. UVC_ATTR##ro(uvcg_extension_, cname, aname)
  688. UVCG_EXTENSION_ATTR(b_length, bLength, _RO);
  689. UVCG_EXTENSION_ATTR(b_unit_id, bUnitID, _RO);
  690. UVCG_EXTENSION_ATTR(i_extension, iExtension, _RO);
  691. static ssize_t uvcg_extension_b_num_controls_store(struct config_item *item,
  692. const char *page, size_t len)
  693. {
  694. struct config_group *group = to_config_group(item->ci_parent);
  695. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  696. struct uvcg_extension *xu = to_uvcg_extension(item);
  697. struct config_item *opts_item;
  698. struct f_uvc_opts *opts;
  699. int ret;
  700. u8 num;
  701. ret = kstrtou8(page, 0, &num);
  702. if (ret)
  703. return ret;
  704. mutex_lock(su_mutex);
  705. opts_item = item->ci_parent->ci_parent->ci_parent;
  706. opts = to_f_uvc_opts(opts_item);
  707. mutex_lock(&opts->lock);
  708. xu->desc.bNumControls = num;
  709. mutex_unlock(&opts->lock);
  710. mutex_unlock(su_mutex);
  711. return len;
  712. }
  713. UVCG_EXTENSION_ATTR(b_num_controls, bNumControls);
  714. /*
  715. * In addition to storing bNrInPins, this function needs to realloc the
  716. * memory for the baSourceID array and additionally expand bLength.
  717. */
  718. static ssize_t uvcg_extension_b_nr_in_pins_store(struct config_item *item,
  719. const char *page, size_t len)
  720. {
  721. struct config_group *group = to_config_group(item->ci_parent);
  722. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  723. struct uvcg_extension *xu = to_uvcg_extension(item);
  724. struct config_item *opts_item;
  725. struct f_uvc_opts *opts;
  726. void *tmp_buf;
  727. int ret;
  728. u8 num;
  729. ret = kstrtou8(page, 0, &num);
  730. if (ret)
  731. return ret;
  732. mutex_lock(su_mutex);
  733. opts_item = item->ci_parent->ci_parent->ci_parent;
  734. opts = to_f_uvc_opts(opts_item);
  735. mutex_lock(&opts->lock);
  736. if (num == xu->desc.bNrInPins) {
  737. ret = len;
  738. goto unlock;
  739. }
  740. tmp_buf = krealloc_array(xu->desc.baSourceID, num, sizeof(u8),
  741. GFP_KERNEL | __GFP_ZERO);
  742. if (!tmp_buf) {
  743. ret = -ENOMEM;
  744. goto unlock;
  745. }
  746. xu->desc.baSourceID = tmp_buf;
  747. xu->desc.bNrInPins = num;
  748. xu->desc.bLength = UVC_DT_EXTENSION_UNIT_SIZE(xu->desc.bNrInPins,
  749. xu->desc.bControlSize);
  750. ret = len;
  751. unlock:
  752. mutex_unlock(&opts->lock);
  753. mutex_unlock(su_mutex);
  754. return ret;
  755. }
  756. UVCG_EXTENSION_ATTR(b_nr_in_pins, bNrInPins);
  757. /*
  758. * In addition to storing bControlSize, this function needs to realloc the
  759. * memory for the bmControls array and additionally expand bLength.
  760. */
  761. static ssize_t uvcg_extension_b_control_size_store(struct config_item *item,
  762. const char *page, size_t len)
  763. {
  764. struct config_group *group = to_config_group(item->ci_parent);
  765. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  766. struct uvcg_extension *xu = to_uvcg_extension(item);
  767. struct config_item *opts_item;
  768. struct f_uvc_opts *opts;
  769. void *tmp_buf;
  770. int ret;
  771. u8 num;
  772. ret = kstrtou8(page, 0, &num);
  773. if (ret)
  774. return ret;
  775. mutex_lock(su_mutex);
  776. opts_item = item->ci_parent->ci_parent->ci_parent;
  777. opts = to_f_uvc_opts(opts_item);
  778. mutex_lock(&opts->lock);
  779. if (num == xu->desc.bControlSize) {
  780. ret = len;
  781. goto unlock;
  782. }
  783. tmp_buf = krealloc_array(xu->desc.bmControls, num, sizeof(u8),
  784. GFP_KERNEL | __GFP_ZERO);
  785. if (!tmp_buf) {
  786. ret = -ENOMEM;
  787. goto unlock;
  788. }
  789. xu->desc.bmControls = tmp_buf;
  790. xu->desc.bControlSize = num;
  791. xu->desc.bLength = UVC_DT_EXTENSION_UNIT_SIZE(xu->desc.bNrInPins,
  792. xu->desc.bControlSize);
  793. ret = len;
  794. unlock:
  795. mutex_unlock(&opts->lock);
  796. mutex_unlock(su_mutex);
  797. return ret;
  798. }
  799. UVCG_EXTENSION_ATTR(b_control_size, bControlSize);
  800. static ssize_t uvcg_extension_guid_extension_code_show(struct config_item *item,
  801. char *page)
  802. {
  803. struct config_group *group = to_config_group(item->ci_parent);
  804. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  805. struct uvcg_extension *xu = to_uvcg_extension(item);
  806. struct config_item *opts_item;
  807. struct f_uvc_opts *opts;
  808. mutex_lock(su_mutex);
  809. opts_item = item->ci_parent->ci_parent->ci_parent;
  810. opts = to_f_uvc_opts(opts_item);
  811. mutex_lock(&opts->lock);
  812. memcpy(page, xu->desc.guidExtensionCode, sizeof(xu->desc.guidExtensionCode));
  813. mutex_unlock(&opts->lock);
  814. mutex_unlock(su_mutex);
  815. return sizeof(xu->desc.guidExtensionCode);
  816. }
  817. static ssize_t uvcg_extension_guid_extension_code_store(struct config_item *item,
  818. const char *page, size_t len)
  819. {
  820. struct config_group *group = to_config_group(item->ci_parent);
  821. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  822. struct uvcg_extension *xu = to_uvcg_extension(item);
  823. struct config_item *opts_item;
  824. struct f_uvc_opts *opts;
  825. int ret;
  826. mutex_lock(su_mutex);
  827. opts_item = item->ci_parent->ci_parent->ci_parent;
  828. opts = to_f_uvc_opts(opts_item);
  829. mutex_lock(&opts->lock);
  830. memcpy(xu->desc.guidExtensionCode, page,
  831. min(sizeof(xu->desc.guidExtensionCode), len));
  832. mutex_unlock(&opts->lock);
  833. mutex_unlock(su_mutex);
  834. ret = sizeof(xu->desc.guidExtensionCode);
  835. return ret;
  836. }
  837. UVC_ATTR(uvcg_extension_, guid_extension_code, guidExtensionCode);
  838. static ssize_t uvcg_extension_ba_source_id_show(struct config_item *item,
  839. char *page)
  840. {
  841. struct config_group *group = to_config_group(item->ci_parent);
  842. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  843. struct uvcg_extension *xu = to_uvcg_extension(item);
  844. struct config_item *opts_item;
  845. struct f_uvc_opts *opts;
  846. char *pg = page;
  847. int ret, i;
  848. mutex_lock(su_mutex);
  849. opts_item = item->ci_parent->ci_parent->ci_parent;
  850. opts = to_f_uvc_opts(opts_item);
  851. mutex_lock(&opts->lock);
  852. for (ret = 0, i = 0; i < xu->desc.bNrInPins; ++i) {
  853. ret += sprintf(pg, "%u\n", xu->desc.baSourceID[i]);
  854. pg = page + ret;
  855. }
  856. mutex_unlock(&opts->lock);
  857. mutex_unlock(su_mutex);
  858. return ret;
  859. }
  860. static ssize_t uvcg_extension_ba_source_id_store(struct config_item *item,
  861. const char *page, size_t len)
  862. {
  863. struct config_group *group = to_config_group(item->ci_parent);
  864. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  865. struct uvcg_extension *xu = to_uvcg_extension(item);
  866. struct config_item *opts_item;
  867. struct f_uvc_opts *opts;
  868. u8 *source_ids, *iter;
  869. int ret, n = 0;
  870. mutex_lock(su_mutex);
  871. opts_item = item->ci_parent->ci_parent->ci_parent;
  872. opts = to_f_uvc_opts(opts_item);
  873. mutex_lock(&opts->lock);
  874. ret = __uvcg_iter_item_entries(page, len, __uvcg_count_item_entries, &n,
  875. sizeof(u8));
  876. if (ret)
  877. goto unlock;
  878. iter = source_ids = kcalloc(n, sizeof(u8), GFP_KERNEL);
  879. if (!source_ids) {
  880. ret = -ENOMEM;
  881. goto unlock;
  882. }
  883. ret = __uvcg_iter_item_entries(page, len, __uvcg_fill_item_entries, &iter,
  884. sizeof(u8));
  885. if (ret) {
  886. kfree(source_ids);
  887. goto unlock;
  888. }
  889. kfree(xu->desc.baSourceID);
  890. xu->desc.baSourceID = source_ids;
  891. xu->desc.bNrInPins = n;
  892. xu->desc.bLength = UVC_DT_EXTENSION_UNIT_SIZE(xu->desc.bNrInPins,
  893. xu->desc.bControlSize);
  894. ret = len;
  895. unlock:
  896. mutex_unlock(&opts->lock);
  897. mutex_unlock(su_mutex);
  898. return ret;
  899. }
  900. UVC_ATTR(uvcg_extension_, ba_source_id, baSourceID);
  901. static ssize_t uvcg_extension_bm_controls_show(struct config_item *item,
  902. char *page)
  903. {
  904. struct config_group *group = to_config_group(item->ci_parent);
  905. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  906. struct uvcg_extension *xu = to_uvcg_extension(item);
  907. struct config_item *opts_item;
  908. struct f_uvc_opts *opts;
  909. char *pg = page;
  910. int ret, i;
  911. mutex_lock(su_mutex);
  912. opts_item = item->ci_parent->ci_parent->ci_parent;
  913. opts = to_f_uvc_opts(opts_item);
  914. mutex_lock(&opts->lock);
  915. for (ret = 0, i = 0; i < xu->desc.bControlSize; ++i) {
  916. ret += sprintf(pg, "0x%02x\n", xu->desc.bmControls[i]);
  917. pg = page + ret;
  918. }
  919. mutex_unlock(&opts->lock);
  920. mutex_unlock(su_mutex);
  921. return ret;
  922. }
  923. static ssize_t uvcg_extension_bm_controls_store(struct config_item *item,
  924. const char *page, size_t len)
  925. {
  926. struct config_group *group = to_config_group(item->ci_parent);
  927. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  928. struct uvcg_extension *xu = to_uvcg_extension(item);
  929. struct config_item *opts_item;
  930. struct f_uvc_opts *opts;
  931. u8 *bm_controls, *iter;
  932. int ret, n = 0;
  933. mutex_lock(su_mutex);
  934. opts_item = item->ci_parent->ci_parent->ci_parent;
  935. opts = to_f_uvc_opts(opts_item);
  936. mutex_lock(&opts->lock);
  937. ret = __uvcg_iter_item_entries(page, len, __uvcg_count_item_entries, &n,
  938. sizeof(u8));
  939. if (ret)
  940. goto unlock;
  941. iter = bm_controls = kcalloc(n, sizeof(u8), GFP_KERNEL);
  942. if (!bm_controls) {
  943. ret = -ENOMEM;
  944. goto unlock;
  945. }
  946. ret = __uvcg_iter_item_entries(page, len, __uvcg_fill_item_entries, &iter,
  947. sizeof(u8));
  948. if (ret) {
  949. kfree(bm_controls);
  950. goto unlock;
  951. }
  952. kfree(xu->desc.bmControls);
  953. xu->desc.bmControls = bm_controls;
  954. xu->desc.bControlSize = n;
  955. xu->desc.bLength = UVC_DT_EXTENSION_UNIT_SIZE(xu->desc.bNrInPins,
  956. xu->desc.bControlSize);
  957. ret = len;
  958. unlock:
  959. mutex_unlock(&opts->lock);
  960. mutex_unlock(su_mutex);
  961. return ret;
  962. }
  963. UVC_ATTR(uvcg_extension_, bm_controls, bmControls);
  964. static struct configfs_attribute *uvcg_extension_attrs[] = {
  965. &uvcg_extension_attr_b_length,
  966. &uvcg_extension_attr_b_unit_id,
  967. &uvcg_extension_attr_b_num_controls,
  968. &uvcg_extension_attr_b_nr_in_pins,
  969. &uvcg_extension_attr_b_control_size,
  970. &uvcg_extension_attr_guid_extension_code,
  971. &uvcg_extension_attr_ba_source_id,
  972. &uvcg_extension_attr_bm_controls,
  973. &uvcg_extension_attr_i_extension,
  974. NULL,
  975. };
  976. static void uvcg_extension_release(struct config_item *item)
  977. {
  978. struct uvcg_extension *xu = container_of(item, struct uvcg_extension, item);
  979. kfree(xu);
  980. }
  981. static int uvcg_extension_allow_link(struct config_item *src, struct config_item *tgt)
  982. {
  983. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  984. struct uvcg_extension *xu = to_uvcg_extension(src);
  985. struct config_item *gadget_item;
  986. struct gadget_string *string;
  987. struct config_item *strings;
  988. int ret = 0;
  989. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  990. /* Validate that the target of the link is an entry in strings/<langid> */
  991. gadget_item = src->ci_parent->ci_parent->ci_parent->ci_parent->ci_parent;
  992. strings = config_group_find_item(to_config_group(gadget_item), "strings");
  993. if (!strings || tgt->ci_parent->ci_parent != strings) {
  994. ret = -EINVAL;
  995. goto put_strings;
  996. }
  997. string = to_gadget_string(tgt);
  998. xu->string_descriptor_index = string->usb_string.id;
  999. put_strings:
  1000. config_item_put(strings);
  1001. mutex_unlock(su_mutex);
  1002. return ret;
  1003. }
  1004. static void uvcg_extension_drop_link(struct config_item *src, struct config_item *tgt)
  1005. {
  1006. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  1007. struct uvcg_extension *xu = to_uvcg_extension(src);
  1008. struct config_item *opts_item;
  1009. struct f_uvc_opts *opts;
  1010. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1011. opts_item = src->ci_parent->ci_parent->ci_parent;
  1012. opts = to_f_uvc_opts(opts_item);
  1013. mutex_lock(&opts->lock);
  1014. xu->string_descriptor_index = 0;
  1015. mutex_unlock(&opts->lock);
  1016. mutex_unlock(su_mutex);
  1017. }
  1018. static struct configfs_item_operations uvcg_extension_item_ops = {
  1019. .release = uvcg_extension_release,
  1020. .allow_link = uvcg_extension_allow_link,
  1021. .drop_link = uvcg_extension_drop_link,
  1022. };
  1023. static const struct config_item_type uvcg_extension_type = {
  1024. .ct_item_ops = &uvcg_extension_item_ops,
  1025. .ct_attrs = uvcg_extension_attrs,
  1026. .ct_owner = THIS_MODULE,
  1027. };
  1028. static void uvcg_extension_drop(struct config_group *group, struct config_item *item)
  1029. {
  1030. struct uvcg_extension *xu = container_of(item, struct uvcg_extension, item);
  1031. struct config_item *opts_item;
  1032. struct f_uvc_opts *opts;
  1033. opts_item = group->cg_item.ci_parent->ci_parent;
  1034. opts = to_f_uvc_opts(opts_item);
  1035. mutex_lock(&opts->lock);
  1036. config_item_put(item);
  1037. list_del(&xu->list);
  1038. kfree(xu->desc.baSourceID);
  1039. kfree(xu->desc.bmControls);
  1040. mutex_unlock(&opts->lock);
  1041. }
  1042. static struct config_item *uvcg_extension_make(struct config_group *group, const char *name)
  1043. {
  1044. struct config_item *opts_item;
  1045. struct uvcg_extension *xu;
  1046. struct f_uvc_opts *opts;
  1047. opts_item = group->cg_item.ci_parent->ci_parent;
  1048. opts = to_f_uvc_opts(opts_item);
  1049. xu = kzalloc(sizeof(*xu), GFP_KERNEL);
  1050. if (!xu)
  1051. return ERR_PTR(-ENOMEM);
  1052. xu->desc.bLength = UVC_DT_EXTENSION_UNIT_SIZE(0, 0);
  1053. xu->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  1054. xu->desc.bDescriptorSubType = UVC_VC_EXTENSION_UNIT;
  1055. xu->desc.bNumControls = 0;
  1056. xu->desc.bNrInPins = 0;
  1057. xu->desc.baSourceID = NULL;
  1058. xu->desc.bControlSize = 0;
  1059. xu->desc.bmControls = NULL;
  1060. mutex_lock(&opts->lock);
  1061. xu->desc.bUnitID = ++opts->last_unit_id;
  1062. config_item_init_type_name(&xu->item, name, &uvcg_extension_type);
  1063. list_add_tail(&xu->list, &opts->extension_units);
  1064. mutex_unlock(&opts->lock);
  1065. return &xu->item;
  1066. }
  1067. static struct configfs_group_operations uvcg_extensions_grp_ops = {
  1068. .make_item = uvcg_extension_make,
  1069. .drop_item = uvcg_extension_drop,
  1070. };
  1071. static const struct uvcg_config_group_type uvcg_extensions_grp_type = {
  1072. .type = {
  1073. .ct_item_ops = &uvcg_config_item_ops,
  1074. .ct_group_ops = &uvcg_extensions_grp_ops,
  1075. .ct_owner = THIS_MODULE,
  1076. },
  1077. .name = "extensions",
  1078. };
  1079. /* -----------------------------------------------------------------------------
  1080. * control/class/{fs|ss}
  1081. */
  1082. struct uvcg_control_class_group {
  1083. struct config_group group;
  1084. const char *name;
  1085. };
  1086. static inline struct uvc_descriptor_header
  1087. **uvcg_get_ctl_class_arr(struct config_item *i, struct f_uvc_opts *o)
  1088. {
  1089. struct uvcg_control_class_group *group =
  1090. container_of(i, struct uvcg_control_class_group,
  1091. group.cg_item);
  1092. if (!strcmp(group->name, "fs"))
  1093. return o->uvc_fs_control_cls;
  1094. if (!strcmp(group->name, "ss"))
  1095. return o->uvc_ss_control_cls;
  1096. return NULL;
  1097. }
  1098. static int uvcg_control_class_allow_link(struct config_item *src,
  1099. struct config_item *target)
  1100. {
  1101. struct config_item *control, *header;
  1102. struct f_uvc_opts *opts;
  1103. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  1104. struct uvc_descriptor_header **class_array;
  1105. struct uvcg_control_header *target_hdr;
  1106. int ret = -EINVAL;
  1107. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1108. control = src->ci_parent->ci_parent;
  1109. header = config_group_find_item(to_config_group(control), "header");
  1110. if (!header || target->ci_parent != header)
  1111. goto out;
  1112. opts = to_f_uvc_opts(control->ci_parent);
  1113. mutex_lock(&opts->lock);
  1114. class_array = uvcg_get_ctl_class_arr(src, opts);
  1115. if (!class_array)
  1116. goto unlock;
  1117. if (opts->refcnt || class_array[0]) {
  1118. ret = -EBUSY;
  1119. goto unlock;
  1120. }
  1121. target_hdr = to_uvcg_control_header(target);
  1122. ++target_hdr->linked;
  1123. class_array[0] = (struct uvc_descriptor_header *)&target_hdr->desc;
  1124. ret = 0;
  1125. unlock:
  1126. mutex_unlock(&opts->lock);
  1127. out:
  1128. config_item_put(header);
  1129. mutex_unlock(su_mutex);
  1130. return ret;
  1131. }
  1132. static void uvcg_control_class_drop_link(struct config_item *src,
  1133. struct config_item *target)
  1134. {
  1135. struct config_item *control, *header;
  1136. struct f_uvc_opts *opts;
  1137. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  1138. struct uvc_descriptor_header **class_array;
  1139. struct uvcg_control_header *target_hdr;
  1140. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1141. control = src->ci_parent->ci_parent;
  1142. header = config_group_find_item(to_config_group(control), "header");
  1143. if (!header || target->ci_parent != header)
  1144. goto out;
  1145. opts = to_f_uvc_opts(control->ci_parent);
  1146. mutex_lock(&opts->lock);
  1147. class_array = uvcg_get_ctl_class_arr(src, opts);
  1148. if (!class_array || opts->refcnt)
  1149. goto unlock;
  1150. target_hdr = to_uvcg_control_header(target);
  1151. --target_hdr->linked;
  1152. class_array[0] = NULL;
  1153. unlock:
  1154. mutex_unlock(&opts->lock);
  1155. out:
  1156. config_item_put(header);
  1157. mutex_unlock(su_mutex);
  1158. }
  1159. static struct configfs_item_operations uvcg_control_class_item_ops = {
  1160. .release = uvcg_config_item_release,
  1161. .allow_link = uvcg_control_class_allow_link,
  1162. .drop_link = uvcg_control_class_drop_link,
  1163. };
  1164. static const struct config_item_type uvcg_control_class_type = {
  1165. .ct_item_ops = &uvcg_control_class_item_ops,
  1166. .ct_owner = THIS_MODULE,
  1167. };
  1168. /* -----------------------------------------------------------------------------
  1169. * control/class
  1170. */
  1171. static int uvcg_control_class_create_children(struct config_group *parent)
  1172. {
  1173. static const char * const names[] = { "fs", "ss" };
  1174. unsigned int i;
  1175. for (i = 0; i < ARRAY_SIZE(names); ++i) {
  1176. struct uvcg_control_class_group *group;
  1177. group = kzalloc(sizeof(*group), GFP_KERNEL);
  1178. if (!group)
  1179. return -ENOMEM;
  1180. group->name = names[i];
  1181. config_group_init_type_name(&group->group, group->name,
  1182. &uvcg_control_class_type);
  1183. configfs_add_default_group(&group->group, parent);
  1184. }
  1185. return 0;
  1186. }
  1187. static const struct uvcg_config_group_type uvcg_control_class_grp_type = {
  1188. .type = {
  1189. .ct_item_ops = &uvcg_config_item_ops,
  1190. .ct_owner = THIS_MODULE,
  1191. },
  1192. .name = "class",
  1193. .create_children = uvcg_control_class_create_children,
  1194. };
  1195. /* -----------------------------------------------------------------------------
  1196. * control
  1197. */
  1198. static ssize_t uvcg_default_control_b_interface_number_show(
  1199. struct config_item *item, char *page)
  1200. {
  1201. struct config_group *group = to_config_group(item);
  1202. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  1203. struct config_item *opts_item;
  1204. struct f_uvc_opts *opts;
  1205. int result = 0;
  1206. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1207. opts_item = item->ci_parent;
  1208. opts = to_f_uvc_opts(opts_item);
  1209. mutex_lock(&opts->lock);
  1210. result += sprintf(page, "%u\n", opts->control_interface);
  1211. mutex_unlock(&opts->lock);
  1212. mutex_unlock(su_mutex);
  1213. return result;
  1214. }
  1215. UVC_ATTR_RO(uvcg_default_control_, b_interface_number, bInterfaceNumber);
  1216. static ssize_t uvcg_default_control_enable_interrupt_ep_show(
  1217. struct config_item *item, char *page)
  1218. {
  1219. struct config_group *group = to_config_group(item);
  1220. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  1221. struct config_item *opts_item;
  1222. struct f_uvc_opts *opts;
  1223. int result = 0;
  1224. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1225. opts_item = item->ci_parent;
  1226. opts = to_f_uvc_opts(opts_item);
  1227. mutex_lock(&opts->lock);
  1228. result += sprintf(page, "%u\n", opts->enable_interrupt_ep);
  1229. mutex_unlock(&opts->lock);
  1230. mutex_unlock(su_mutex);
  1231. return result;
  1232. }
  1233. static ssize_t uvcg_default_control_enable_interrupt_ep_store(
  1234. struct config_item *item, const char *page, size_t len)
  1235. {
  1236. struct config_group *group = to_config_group(item);
  1237. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  1238. struct config_item *opts_item;
  1239. struct f_uvc_opts *opts;
  1240. ssize_t ret;
  1241. u8 num;
  1242. ret = kstrtou8(page, 0, &num);
  1243. if (ret)
  1244. return ret;
  1245. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1246. opts_item = item->ci_parent;
  1247. opts = to_f_uvc_opts(opts_item);
  1248. mutex_lock(&opts->lock);
  1249. opts->enable_interrupt_ep = num;
  1250. mutex_unlock(&opts->lock);
  1251. mutex_unlock(su_mutex);
  1252. return len;
  1253. }
  1254. UVC_ATTR(uvcg_default_control_, enable_interrupt_ep, enable_interrupt_ep);
  1255. static struct configfs_attribute *uvcg_default_control_attrs[] = {
  1256. &uvcg_default_control_attr_b_interface_number,
  1257. &uvcg_default_control_attr_enable_interrupt_ep,
  1258. NULL,
  1259. };
  1260. static const struct uvcg_config_group_type uvcg_control_grp_type = {
  1261. .type = {
  1262. .ct_item_ops = &uvcg_config_item_ops,
  1263. .ct_attrs = uvcg_default_control_attrs,
  1264. .ct_owner = THIS_MODULE,
  1265. },
  1266. .name = "control",
  1267. .children = (const struct uvcg_config_group_type*[]) {
  1268. &uvcg_control_header_grp_type,
  1269. &uvcg_processing_grp_type,
  1270. &uvcg_terminal_grp_type,
  1271. &uvcg_control_class_grp_type,
  1272. &uvcg_extensions_grp_type,
  1273. NULL,
  1274. },
  1275. };
  1276. /* -----------------------------------------------------------------------------
  1277. * streaming/uncompressed
  1278. * streaming/mjpeg
  1279. */
  1280. static const char * const uvcg_format_names[] = {
  1281. "uncompressed",
  1282. "mjpeg",
  1283. };
  1284. static struct uvcg_color_matching *
  1285. uvcg_format_get_default_color_match(struct config_item *streaming)
  1286. {
  1287. struct config_item *color_matching_item, *cm_default;
  1288. struct uvcg_color_matching *color_match;
  1289. color_matching_item = config_group_find_item(to_config_group(streaming),
  1290. "color_matching");
  1291. if (!color_matching_item)
  1292. return NULL;
  1293. cm_default = config_group_find_item(to_config_group(color_matching_item),
  1294. "default");
  1295. config_item_put(color_matching_item);
  1296. if (!cm_default)
  1297. return NULL;
  1298. color_match = to_uvcg_color_matching(to_config_group(cm_default));
  1299. config_item_put(cm_default);
  1300. return color_match;
  1301. }
  1302. static int uvcg_format_allow_link(struct config_item *src, struct config_item *tgt)
  1303. {
  1304. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  1305. struct uvcg_color_matching *color_matching_desc;
  1306. struct config_item *streaming, *color_matching;
  1307. struct uvcg_format *fmt;
  1308. int ret = 0;
  1309. mutex_lock(su_mutex);
  1310. streaming = src->ci_parent->ci_parent;
  1311. color_matching = config_group_find_item(to_config_group(streaming), "color_matching");
  1312. if (!color_matching || color_matching != tgt->ci_parent) {
  1313. ret = -EINVAL;
  1314. goto out_put_cm;
  1315. }
  1316. fmt = to_uvcg_format(src);
  1317. /*
  1318. * There's always a color matching descriptor associated with the format
  1319. * but without a symlink it should only ever be the default one. If it's
  1320. * not the default, there's already a symlink and we should bail out.
  1321. */
  1322. color_matching_desc = uvcg_format_get_default_color_match(streaming);
  1323. if (fmt->color_matching != color_matching_desc) {
  1324. ret = -EBUSY;
  1325. goto out_put_cm;
  1326. }
  1327. color_matching_desc->refcnt--;
  1328. color_matching_desc = to_uvcg_color_matching(to_config_group(tgt));
  1329. fmt->color_matching = color_matching_desc;
  1330. color_matching_desc->refcnt++;
  1331. out_put_cm:
  1332. config_item_put(color_matching);
  1333. mutex_unlock(su_mutex);
  1334. return ret;
  1335. }
  1336. static void uvcg_format_drop_link(struct config_item *src, struct config_item *tgt)
  1337. {
  1338. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  1339. struct uvcg_color_matching *color_matching_desc;
  1340. struct config_item *streaming;
  1341. struct uvcg_format *fmt;
  1342. mutex_lock(su_mutex);
  1343. color_matching_desc = to_uvcg_color_matching(to_config_group(tgt));
  1344. color_matching_desc->refcnt--;
  1345. streaming = src->ci_parent->ci_parent;
  1346. color_matching_desc = uvcg_format_get_default_color_match(streaming);
  1347. fmt = to_uvcg_format(src);
  1348. fmt->color_matching = color_matching_desc;
  1349. color_matching_desc->refcnt++;
  1350. mutex_unlock(su_mutex);
  1351. }
  1352. static struct configfs_item_operations uvcg_format_item_operations = {
  1353. .release = uvcg_config_item_release,
  1354. .allow_link = uvcg_format_allow_link,
  1355. .drop_link = uvcg_format_drop_link,
  1356. };
  1357. static ssize_t uvcg_format_bma_controls_show(struct uvcg_format *f, char *page)
  1358. {
  1359. struct f_uvc_opts *opts;
  1360. struct config_item *opts_item;
  1361. struct mutex *su_mutex = &f->group.cg_subsys->su_mutex;
  1362. int result, i;
  1363. char *pg = page;
  1364. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1365. opts_item = f->group.cg_item.ci_parent->ci_parent->ci_parent;
  1366. opts = to_f_uvc_opts(opts_item);
  1367. mutex_lock(&opts->lock);
  1368. result = sprintf(pg, "0x");
  1369. pg += result;
  1370. for (i = 0; i < UVCG_STREAMING_CONTROL_SIZE; ++i) {
  1371. result += sprintf(pg, "%x\n", f->bmaControls[i]);
  1372. pg = page + result;
  1373. }
  1374. mutex_unlock(&opts->lock);
  1375. mutex_unlock(su_mutex);
  1376. return result;
  1377. }
  1378. static ssize_t uvcg_format_bma_controls_store(struct uvcg_format *ch,
  1379. const char *page, size_t len)
  1380. {
  1381. struct f_uvc_opts *opts;
  1382. struct config_item *opts_item;
  1383. struct mutex *su_mutex = &ch->group.cg_subsys->su_mutex;
  1384. int ret = -EINVAL;
  1385. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1386. opts_item = ch->group.cg_item.ci_parent->ci_parent->ci_parent;
  1387. opts = to_f_uvc_opts(opts_item);
  1388. mutex_lock(&opts->lock);
  1389. if (ch->linked || opts->refcnt) {
  1390. ret = -EBUSY;
  1391. goto end;
  1392. }
  1393. if (len < 4 || *page != '0' ||
  1394. (*(page + 1) != 'x' && *(page + 1) != 'X'))
  1395. goto end;
  1396. ret = hex2bin(ch->bmaControls, page + 2, 1);
  1397. if (ret < 0)
  1398. goto end;
  1399. ret = len;
  1400. end:
  1401. mutex_unlock(&opts->lock);
  1402. mutex_unlock(su_mutex);
  1403. return ret;
  1404. }
  1405. /* -----------------------------------------------------------------------------
  1406. * streaming/header/<NAME>
  1407. * streaming/header
  1408. */
  1409. static void uvcg_format_set_indices(struct config_group *fmt);
  1410. static int uvcg_streaming_header_allow_link(struct config_item *src,
  1411. struct config_item *target)
  1412. {
  1413. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  1414. struct config_item *opts_item;
  1415. struct f_uvc_opts *opts;
  1416. struct uvcg_streaming_header *src_hdr;
  1417. struct uvcg_format *target_fmt = NULL;
  1418. struct uvcg_format_ptr *format_ptr;
  1419. int i, ret = -EINVAL;
  1420. src_hdr = to_uvcg_streaming_header(src);
  1421. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1422. opts_item = src->ci_parent->ci_parent->ci_parent;
  1423. opts = to_f_uvc_opts(opts_item);
  1424. mutex_lock(&opts->lock);
  1425. if (src_hdr->linked) {
  1426. ret = -EBUSY;
  1427. goto out;
  1428. }
  1429. /*
  1430. * Linking is only allowed to direct children of the format nodes
  1431. * (streaming/uncompressed or streaming/mjpeg nodes). First check that
  1432. * the grand-parent of the target matches the grand-parent of the source
  1433. * (the streaming node), and then verify that the target parent is a
  1434. * format node.
  1435. */
  1436. if (src->ci_parent->ci_parent != target->ci_parent->ci_parent)
  1437. goto out;
  1438. for (i = 0; i < ARRAY_SIZE(uvcg_format_names); ++i) {
  1439. if (!strcmp(target->ci_parent->ci_name, uvcg_format_names[i]))
  1440. break;
  1441. }
  1442. if (i == ARRAY_SIZE(uvcg_format_names))
  1443. goto out;
  1444. target_fmt = container_of(to_config_group(target), struct uvcg_format,
  1445. group);
  1446. uvcg_format_set_indices(to_config_group(target));
  1447. format_ptr = kzalloc(sizeof(*format_ptr), GFP_KERNEL);
  1448. if (!format_ptr) {
  1449. ret = -ENOMEM;
  1450. goto out;
  1451. }
  1452. ret = 0;
  1453. format_ptr->fmt = target_fmt;
  1454. list_add_tail(&format_ptr->entry, &src_hdr->formats);
  1455. ++src_hdr->num_fmt;
  1456. ++target_fmt->linked;
  1457. out:
  1458. mutex_unlock(&opts->lock);
  1459. mutex_unlock(su_mutex);
  1460. return ret;
  1461. }
  1462. static void uvcg_streaming_header_drop_link(struct config_item *src,
  1463. struct config_item *target)
  1464. {
  1465. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  1466. struct config_item *opts_item;
  1467. struct f_uvc_opts *opts;
  1468. struct uvcg_streaming_header *src_hdr;
  1469. struct uvcg_format *target_fmt = NULL;
  1470. struct uvcg_format_ptr *format_ptr, *tmp;
  1471. src_hdr = to_uvcg_streaming_header(src);
  1472. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1473. opts_item = src->ci_parent->ci_parent->ci_parent;
  1474. opts = to_f_uvc_opts(opts_item);
  1475. mutex_lock(&opts->lock);
  1476. target_fmt = container_of(to_config_group(target), struct uvcg_format,
  1477. group);
  1478. list_for_each_entry_safe(format_ptr, tmp, &src_hdr->formats, entry)
  1479. if (format_ptr->fmt == target_fmt) {
  1480. list_del(&format_ptr->entry);
  1481. kfree(format_ptr);
  1482. --src_hdr->num_fmt;
  1483. break;
  1484. }
  1485. --target_fmt->linked;
  1486. mutex_unlock(&opts->lock);
  1487. mutex_unlock(su_mutex);
  1488. }
  1489. static struct configfs_item_operations uvcg_streaming_header_item_ops = {
  1490. .release = uvcg_config_item_release,
  1491. .allow_link = uvcg_streaming_header_allow_link,
  1492. .drop_link = uvcg_streaming_header_drop_link,
  1493. };
  1494. #define UVCG_STREAMING_HEADER_ATTR(cname, aname, bits) \
  1495. static ssize_t uvcg_streaming_header_##cname##_show( \
  1496. struct config_item *item, char *page) \
  1497. { \
  1498. struct uvcg_streaming_header *sh = to_uvcg_streaming_header(item); \
  1499. struct f_uvc_opts *opts; \
  1500. struct config_item *opts_item; \
  1501. struct mutex *su_mutex = &sh->item.ci_group->cg_subsys->su_mutex;\
  1502. int result; \
  1503. \
  1504. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1505. \
  1506. opts_item = sh->item.ci_parent->ci_parent->ci_parent; \
  1507. opts = to_f_uvc_opts(opts_item); \
  1508. \
  1509. mutex_lock(&opts->lock); \
  1510. result = sprintf(page, "%u\n", le##bits##_to_cpu(sh->desc.aname));\
  1511. mutex_unlock(&opts->lock); \
  1512. \
  1513. mutex_unlock(su_mutex); \
  1514. return result; \
  1515. } \
  1516. \
  1517. UVC_ATTR_RO(uvcg_streaming_header_, cname, aname)
  1518. UVCG_STREAMING_HEADER_ATTR(bm_info, bmInfo, 8);
  1519. UVCG_STREAMING_HEADER_ATTR(b_terminal_link, bTerminalLink, 8);
  1520. UVCG_STREAMING_HEADER_ATTR(b_still_capture_method, bStillCaptureMethod, 8);
  1521. UVCG_STREAMING_HEADER_ATTR(b_trigger_support, bTriggerSupport, 8);
  1522. UVCG_STREAMING_HEADER_ATTR(b_trigger_usage, bTriggerUsage, 8);
  1523. #undef UVCG_STREAMING_HEADER_ATTR
  1524. static struct configfs_attribute *uvcg_streaming_header_attrs[] = {
  1525. &uvcg_streaming_header_attr_bm_info,
  1526. &uvcg_streaming_header_attr_b_terminal_link,
  1527. &uvcg_streaming_header_attr_b_still_capture_method,
  1528. &uvcg_streaming_header_attr_b_trigger_support,
  1529. &uvcg_streaming_header_attr_b_trigger_usage,
  1530. NULL,
  1531. };
  1532. static const struct config_item_type uvcg_streaming_header_type = {
  1533. .ct_item_ops = &uvcg_streaming_header_item_ops,
  1534. .ct_attrs = uvcg_streaming_header_attrs,
  1535. .ct_owner = THIS_MODULE,
  1536. };
  1537. static struct config_item
  1538. *uvcg_streaming_header_make(struct config_group *group, const char *name)
  1539. {
  1540. struct uvcg_streaming_header *h;
  1541. h = kzalloc(sizeof(*h), GFP_KERNEL);
  1542. if (!h)
  1543. return ERR_PTR(-ENOMEM);
  1544. INIT_LIST_HEAD(&h->formats);
  1545. h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  1546. h->desc.bDescriptorSubType = UVC_VS_INPUT_HEADER;
  1547. h->desc.bTerminalLink = 3;
  1548. h->desc.bControlSize = UVCG_STREAMING_CONTROL_SIZE;
  1549. config_item_init_type_name(&h->item, name, &uvcg_streaming_header_type);
  1550. return &h->item;
  1551. }
  1552. static struct configfs_group_operations uvcg_streaming_header_grp_ops = {
  1553. .make_item = uvcg_streaming_header_make,
  1554. };
  1555. static const struct uvcg_config_group_type uvcg_streaming_header_grp_type = {
  1556. .type = {
  1557. .ct_item_ops = &uvcg_config_item_ops,
  1558. .ct_group_ops = &uvcg_streaming_header_grp_ops,
  1559. .ct_owner = THIS_MODULE,
  1560. },
  1561. .name = "header",
  1562. };
  1563. /* -----------------------------------------------------------------------------
  1564. * streaming/<mode>/<format>/<NAME>
  1565. */
  1566. #define UVCG_FRAME_ATTR(cname, aname, bits) \
  1567. static ssize_t uvcg_frame_##cname##_show(struct config_item *item, char *page)\
  1568. { \
  1569. struct uvcg_frame *f = to_uvcg_frame(item); \
  1570. struct f_uvc_opts *opts; \
  1571. struct config_item *opts_item; \
  1572. struct mutex *su_mutex = &f->item.ci_group->cg_subsys->su_mutex;\
  1573. int result; \
  1574. \
  1575. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1576. \
  1577. opts_item = f->item.ci_parent->ci_parent->ci_parent->ci_parent; \
  1578. opts = to_f_uvc_opts(opts_item); \
  1579. \
  1580. mutex_lock(&opts->lock); \
  1581. result = sprintf(page, "%u\n", f->frame.cname); \
  1582. mutex_unlock(&opts->lock); \
  1583. \
  1584. mutex_unlock(su_mutex); \
  1585. return result; \
  1586. } \
  1587. \
  1588. static ssize_t uvcg_frame_##cname##_store(struct config_item *item, \
  1589. const char *page, size_t len)\
  1590. { \
  1591. struct uvcg_frame *f = to_uvcg_frame(item); \
  1592. struct f_uvc_opts *opts; \
  1593. struct config_item *opts_item; \
  1594. struct uvcg_format *fmt; \
  1595. struct mutex *su_mutex = &f->item.ci_group->cg_subsys->su_mutex;\
  1596. typeof(f->frame.cname) num; \
  1597. int ret; \
  1598. \
  1599. ret = kstrtou##bits(page, 0, &num); \
  1600. if (ret) \
  1601. return ret; \
  1602. \
  1603. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1604. \
  1605. opts_item = f->item.ci_parent->ci_parent->ci_parent->ci_parent; \
  1606. opts = to_f_uvc_opts(opts_item); \
  1607. fmt = to_uvcg_format(f->item.ci_parent); \
  1608. \
  1609. mutex_lock(&opts->lock); \
  1610. if (fmt->linked || opts->refcnt) { \
  1611. ret = -EBUSY; \
  1612. goto end; \
  1613. } \
  1614. \
  1615. f->frame.cname = num; \
  1616. ret = len; \
  1617. end: \
  1618. mutex_unlock(&opts->lock); \
  1619. mutex_unlock(su_mutex); \
  1620. return ret; \
  1621. } \
  1622. \
  1623. UVC_ATTR(uvcg_frame_, cname, aname);
  1624. static ssize_t uvcg_frame_b_frame_index_show(struct config_item *item,
  1625. char *page)
  1626. {
  1627. struct uvcg_frame *f = to_uvcg_frame(item);
  1628. struct uvcg_format *fmt;
  1629. struct f_uvc_opts *opts;
  1630. struct config_item *opts_item;
  1631. struct config_item *fmt_item;
  1632. struct mutex *su_mutex = &f->item.ci_group->cg_subsys->su_mutex;
  1633. int result;
  1634. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1635. fmt_item = f->item.ci_parent;
  1636. fmt = to_uvcg_format(fmt_item);
  1637. if (!fmt->linked) {
  1638. result = -EBUSY;
  1639. goto out;
  1640. }
  1641. opts_item = fmt_item->ci_parent->ci_parent->ci_parent;
  1642. opts = to_f_uvc_opts(opts_item);
  1643. mutex_lock(&opts->lock);
  1644. result = sprintf(page, "%u\n", f->frame.b_frame_index);
  1645. mutex_unlock(&opts->lock);
  1646. out:
  1647. mutex_unlock(su_mutex);
  1648. return result;
  1649. }
  1650. UVC_ATTR_RO(uvcg_frame_, b_frame_index, bFrameIndex);
  1651. UVCG_FRAME_ATTR(bm_capabilities, bmCapabilities, 8);
  1652. UVCG_FRAME_ATTR(w_width, wWidth, 16);
  1653. UVCG_FRAME_ATTR(w_height, wHeight, 16);
  1654. UVCG_FRAME_ATTR(dw_min_bit_rate, dwMinBitRate, 32);
  1655. UVCG_FRAME_ATTR(dw_max_bit_rate, dwMaxBitRate, 32);
  1656. UVCG_FRAME_ATTR(dw_max_video_frame_buffer_size, dwMaxVideoFrameBufferSize, 32);
  1657. UVCG_FRAME_ATTR(dw_default_frame_interval, dwDefaultFrameInterval, 32);
  1658. #undef UVCG_FRAME_ATTR
  1659. static ssize_t uvcg_frame_dw_frame_interval_show(struct config_item *item,
  1660. char *page)
  1661. {
  1662. struct uvcg_frame *frm = to_uvcg_frame(item);
  1663. struct f_uvc_opts *opts;
  1664. struct config_item *opts_item;
  1665. struct mutex *su_mutex = &frm->item.ci_group->cg_subsys->su_mutex;
  1666. int result, i;
  1667. char *pg = page;
  1668. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1669. opts_item = frm->item.ci_parent->ci_parent->ci_parent->ci_parent;
  1670. opts = to_f_uvc_opts(opts_item);
  1671. mutex_lock(&opts->lock);
  1672. for (result = 0, i = 0; i < frm->frame.b_frame_interval_type; ++i) {
  1673. result += sprintf(pg, "%u\n", frm->dw_frame_interval[i]);
  1674. pg = page + result;
  1675. }
  1676. mutex_unlock(&opts->lock);
  1677. mutex_unlock(su_mutex);
  1678. return result;
  1679. }
  1680. static ssize_t uvcg_frame_dw_frame_interval_store(struct config_item *item,
  1681. const char *page, size_t len)
  1682. {
  1683. struct uvcg_frame *ch = to_uvcg_frame(item);
  1684. struct f_uvc_opts *opts;
  1685. struct config_item *opts_item;
  1686. struct uvcg_format *fmt;
  1687. struct mutex *su_mutex = &ch->item.ci_group->cg_subsys->su_mutex;
  1688. int ret = 0, n = 0;
  1689. u32 *frm_intrv, *tmp;
  1690. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1691. opts_item = ch->item.ci_parent->ci_parent->ci_parent->ci_parent;
  1692. opts = to_f_uvc_opts(opts_item);
  1693. fmt = to_uvcg_format(ch->item.ci_parent);
  1694. mutex_lock(&opts->lock);
  1695. if (fmt->linked || opts->refcnt) {
  1696. ret = -EBUSY;
  1697. goto end;
  1698. }
  1699. ret = __uvcg_iter_item_entries(page, len, __uvcg_count_item_entries, &n, sizeof(u32));
  1700. if (ret)
  1701. goto end;
  1702. tmp = frm_intrv = kcalloc(n, sizeof(u32), GFP_KERNEL);
  1703. if (!frm_intrv) {
  1704. ret = -ENOMEM;
  1705. goto end;
  1706. }
  1707. ret = __uvcg_iter_item_entries(page, len, __uvcg_fill_item_entries, &tmp, sizeof(u32));
  1708. if (ret) {
  1709. kfree(frm_intrv);
  1710. goto end;
  1711. }
  1712. kfree(ch->dw_frame_interval);
  1713. ch->dw_frame_interval = frm_intrv;
  1714. ch->frame.b_frame_interval_type = n;
  1715. sort(ch->dw_frame_interval, n, sizeof(*ch->dw_frame_interval),
  1716. uvcg_config_compare_u32, NULL);
  1717. ret = len;
  1718. end:
  1719. mutex_unlock(&opts->lock);
  1720. mutex_unlock(su_mutex);
  1721. return ret;
  1722. }
  1723. UVC_ATTR(uvcg_frame_, dw_frame_interval, dwFrameInterval);
  1724. static struct configfs_attribute *uvcg_frame_attrs[] = {
  1725. &uvcg_frame_attr_b_frame_index,
  1726. &uvcg_frame_attr_bm_capabilities,
  1727. &uvcg_frame_attr_w_width,
  1728. &uvcg_frame_attr_w_height,
  1729. &uvcg_frame_attr_dw_min_bit_rate,
  1730. &uvcg_frame_attr_dw_max_bit_rate,
  1731. &uvcg_frame_attr_dw_max_video_frame_buffer_size,
  1732. &uvcg_frame_attr_dw_default_frame_interval,
  1733. &uvcg_frame_attr_dw_frame_interval,
  1734. NULL,
  1735. };
  1736. static const struct config_item_type uvcg_frame_type = {
  1737. .ct_item_ops = &uvcg_config_item_ops,
  1738. .ct_attrs = uvcg_frame_attrs,
  1739. .ct_owner = THIS_MODULE,
  1740. };
  1741. static struct config_item *uvcg_frame_make(struct config_group *group,
  1742. const char *name)
  1743. {
  1744. struct uvcg_frame *h;
  1745. struct uvcg_format *fmt;
  1746. struct f_uvc_opts *opts;
  1747. struct config_item *opts_item;
  1748. struct uvcg_frame_ptr *frame_ptr;
  1749. h = kzalloc(sizeof(*h), GFP_KERNEL);
  1750. if (!h)
  1751. return ERR_PTR(-ENOMEM);
  1752. h->frame.b_descriptor_type = USB_DT_CS_INTERFACE;
  1753. h->frame.b_frame_index = 1;
  1754. h->frame.w_width = 640;
  1755. h->frame.w_height = 360;
  1756. h->frame.dw_min_bit_rate = 18432000;
  1757. h->frame.dw_max_bit_rate = 55296000;
  1758. h->frame.dw_max_video_frame_buffer_size = 460800;
  1759. h->frame.dw_default_frame_interval = 666666;
  1760. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent;
  1761. opts = to_f_uvc_opts(opts_item);
  1762. mutex_lock(&opts->lock);
  1763. fmt = to_uvcg_format(&group->cg_item);
  1764. if (fmt->type == UVCG_UNCOMPRESSED) {
  1765. h->frame.b_descriptor_subtype = UVC_VS_FRAME_UNCOMPRESSED;
  1766. h->fmt_type = UVCG_UNCOMPRESSED;
  1767. } else if (fmt->type == UVCG_MJPEG) {
  1768. h->frame.b_descriptor_subtype = UVC_VS_FRAME_MJPEG;
  1769. h->fmt_type = UVCG_MJPEG;
  1770. } else {
  1771. mutex_unlock(&opts->lock);
  1772. kfree(h);
  1773. return ERR_PTR(-EINVAL);
  1774. }
  1775. frame_ptr = kzalloc(sizeof(*frame_ptr), GFP_KERNEL);
  1776. if (!frame_ptr) {
  1777. mutex_unlock(&opts->lock);
  1778. kfree(h);
  1779. return ERR_PTR(-ENOMEM);
  1780. }
  1781. frame_ptr->frm = h;
  1782. list_add_tail(&frame_ptr->entry, &fmt->frames);
  1783. ++fmt->num_frames;
  1784. mutex_unlock(&opts->lock);
  1785. config_item_init_type_name(&h->item, name, &uvcg_frame_type);
  1786. return &h->item;
  1787. }
  1788. static void uvcg_frame_drop(struct config_group *group, struct config_item *item)
  1789. {
  1790. struct uvcg_format *fmt;
  1791. struct f_uvc_opts *opts;
  1792. struct config_item *opts_item;
  1793. struct uvcg_frame *target_frm = NULL;
  1794. struct uvcg_frame_ptr *frame_ptr, *tmp;
  1795. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent;
  1796. opts = to_f_uvc_opts(opts_item);
  1797. mutex_lock(&opts->lock);
  1798. target_frm = container_of(item, struct uvcg_frame, item);
  1799. fmt = to_uvcg_format(&group->cg_item);
  1800. list_for_each_entry_safe(frame_ptr, tmp, &fmt->frames, entry)
  1801. if (frame_ptr->frm == target_frm) {
  1802. list_del(&frame_ptr->entry);
  1803. kfree(frame_ptr);
  1804. --fmt->num_frames;
  1805. break;
  1806. }
  1807. mutex_unlock(&opts->lock);
  1808. config_item_put(item);
  1809. }
  1810. static void uvcg_format_set_indices(struct config_group *fmt)
  1811. {
  1812. struct config_item *ci;
  1813. unsigned int i = 1;
  1814. list_for_each_entry(ci, &fmt->cg_children, ci_entry) {
  1815. struct uvcg_frame *frm;
  1816. if (ci->ci_type != &uvcg_frame_type)
  1817. continue;
  1818. frm = to_uvcg_frame(ci);
  1819. frm->frame.b_frame_index = i++;
  1820. }
  1821. }
  1822. /* -----------------------------------------------------------------------------
  1823. * streaming/uncompressed/<NAME>
  1824. */
  1825. static struct configfs_group_operations uvcg_uncompressed_group_ops = {
  1826. .make_item = uvcg_frame_make,
  1827. .drop_item = uvcg_frame_drop,
  1828. };
  1829. static ssize_t uvcg_uncompressed_guid_format_show(struct config_item *item,
  1830. char *page)
  1831. {
  1832. struct uvcg_uncompressed *ch = to_uvcg_uncompressed(item);
  1833. struct f_uvc_opts *opts;
  1834. struct config_item *opts_item;
  1835. struct mutex *su_mutex = &ch->fmt.group.cg_subsys->su_mutex;
  1836. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1837. opts_item = ch->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;
  1838. opts = to_f_uvc_opts(opts_item);
  1839. mutex_lock(&opts->lock);
  1840. memcpy(page, ch->desc.guidFormat, sizeof(ch->desc.guidFormat));
  1841. mutex_unlock(&opts->lock);
  1842. mutex_unlock(su_mutex);
  1843. return sizeof(ch->desc.guidFormat);
  1844. }
  1845. static ssize_t uvcg_uncompressed_guid_format_store(struct config_item *item,
  1846. const char *page, size_t len)
  1847. {
  1848. struct uvcg_uncompressed *ch = to_uvcg_uncompressed(item);
  1849. struct f_uvc_opts *opts;
  1850. struct config_item *opts_item;
  1851. struct mutex *su_mutex = &ch->fmt.group.cg_subsys->su_mutex;
  1852. const struct uvc_format_desc *format;
  1853. u8 tmpguidFormat[sizeof(ch->desc.guidFormat)];
  1854. int ret;
  1855. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1856. opts_item = ch->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;
  1857. opts = to_f_uvc_opts(opts_item);
  1858. mutex_lock(&opts->lock);
  1859. if (ch->fmt.linked || opts->refcnt) {
  1860. ret = -EBUSY;
  1861. goto end;
  1862. }
  1863. memcpy(tmpguidFormat, page,
  1864. min(sizeof(tmpguidFormat), len));
  1865. format = uvc_format_by_guid(tmpguidFormat);
  1866. if (!format) {
  1867. ret = -EINVAL;
  1868. goto end;
  1869. }
  1870. memcpy(ch->desc.guidFormat, tmpguidFormat,
  1871. min(sizeof(ch->desc.guidFormat), len));
  1872. ret = sizeof(ch->desc.guidFormat);
  1873. end:
  1874. mutex_unlock(&opts->lock);
  1875. mutex_unlock(su_mutex);
  1876. return ret;
  1877. }
  1878. UVC_ATTR(uvcg_uncompressed_, guid_format, guidFormat);
  1879. #define UVCG_UNCOMPRESSED_ATTR_RO(cname, aname, bits) \
  1880. static ssize_t uvcg_uncompressed_##cname##_show( \
  1881. struct config_item *item, char *page) \
  1882. { \
  1883. struct uvcg_uncompressed *u = to_uvcg_uncompressed(item); \
  1884. struct f_uvc_opts *opts; \
  1885. struct config_item *opts_item; \
  1886. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  1887. int result; \
  1888. \
  1889. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1890. \
  1891. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  1892. opts = to_f_uvc_opts(opts_item); \
  1893. \
  1894. mutex_lock(&opts->lock); \
  1895. result = sprintf(page, "%u\n", le##bits##_to_cpu(u->desc.aname));\
  1896. mutex_unlock(&opts->lock); \
  1897. \
  1898. mutex_unlock(su_mutex); \
  1899. return result; \
  1900. } \
  1901. \
  1902. UVC_ATTR_RO(uvcg_uncompressed_, cname, aname);
  1903. #define UVCG_UNCOMPRESSED_ATTR(cname, aname, bits) \
  1904. static ssize_t uvcg_uncompressed_##cname##_show( \
  1905. struct config_item *item, char *page) \
  1906. { \
  1907. struct uvcg_uncompressed *u = to_uvcg_uncompressed(item); \
  1908. struct f_uvc_opts *opts; \
  1909. struct config_item *opts_item; \
  1910. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  1911. int result; \
  1912. \
  1913. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1914. \
  1915. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  1916. opts = to_f_uvc_opts(opts_item); \
  1917. \
  1918. mutex_lock(&opts->lock); \
  1919. result = sprintf(page, "%u\n", le##bits##_to_cpu(u->desc.aname));\
  1920. mutex_unlock(&opts->lock); \
  1921. \
  1922. mutex_unlock(su_mutex); \
  1923. return result; \
  1924. } \
  1925. \
  1926. static ssize_t \
  1927. uvcg_uncompressed_##cname##_store(struct config_item *item, \
  1928. const char *page, size_t len) \
  1929. { \
  1930. struct uvcg_uncompressed *u = to_uvcg_uncompressed(item); \
  1931. struct f_uvc_opts *opts; \
  1932. struct config_item *opts_item; \
  1933. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  1934. int ret; \
  1935. u8 num; \
  1936. \
  1937. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1938. \
  1939. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  1940. opts = to_f_uvc_opts(opts_item); \
  1941. \
  1942. mutex_lock(&opts->lock); \
  1943. if (u->fmt.linked || opts->refcnt) { \
  1944. ret = -EBUSY; \
  1945. goto end; \
  1946. } \
  1947. \
  1948. ret = kstrtou8(page, 0, &num); \
  1949. if (ret) \
  1950. goto end; \
  1951. \
  1952. /* index values in uvc are never 0 */ \
  1953. if (!num) { \
  1954. ret = -EINVAL; \
  1955. goto end; \
  1956. } \
  1957. \
  1958. u->desc.aname = num; \
  1959. ret = len; \
  1960. end: \
  1961. mutex_unlock(&opts->lock); \
  1962. mutex_unlock(su_mutex); \
  1963. return ret; \
  1964. } \
  1965. \
  1966. UVC_ATTR(uvcg_uncompressed_, cname, aname);
  1967. UVCG_UNCOMPRESSED_ATTR_RO(b_format_index, bFormatIndex, 8);
  1968. UVCG_UNCOMPRESSED_ATTR(b_bits_per_pixel, bBitsPerPixel, 8);
  1969. UVCG_UNCOMPRESSED_ATTR(b_default_frame_index, bDefaultFrameIndex, 8);
  1970. UVCG_UNCOMPRESSED_ATTR_RO(b_aspect_ratio_x, bAspectRatioX, 8);
  1971. UVCG_UNCOMPRESSED_ATTR_RO(b_aspect_ratio_y, bAspectRatioY, 8);
  1972. UVCG_UNCOMPRESSED_ATTR_RO(bm_interlace_flags, bmInterlaceFlags, 8);
  1973. #undef UVCG_UNCOMPRESSED_ATTR
  1974. #undef UVCG_UNCOMPRESSED_ATTR_RO
  1975. static inline ssize_t
  1976. uvcg_uncompressed_bma_controls_show(struct config_item *item, char *page)
  1977. {
  1978. struct uvcg_uncompressed *unc = to_uvcg_uncompressed(item);
  1979. return uvcg_format_bma_controls_show(&unc->fmt, page);
  1980. }
  1981. static inline ssize_t
  1982. uvcg_uncompressed_bma_controls_store(struct config_item *item,
  1983. const char *page, size_t len)
  1984. {
  1985. struct uvcg_uncompressed *unc = to_uvcg_uncompressed(item);
  1986. return uvcg_format_bma_controls_store(&unc->fmt, page, len);
  1987. }
  1988. UVC_ATTR(uvcg_uncompressed_, bma_controls, bmaControls);
  1989. static struct configfs_attribute *uvcg_uncompressed_attrs[] = {
  1990. &uvcg_uncompressed_attr_b_format_index,
  1991. &uvcg_uncompressed_attr_guid_format,
  1992. &uvcg_uncompressed_attr_b_bits_per_pixel,
  1993. &uvcg_uncompressed_attr_b_default_frame_index,
  1994. &uvcg_uncompressed_attr_b_aspect_ratio_x,
  1995. &uvcg_uncompressed_attr_b_aspect_ratio_y,
  1996. &uvcg_uncompressed_attr_bm_interlace_flags,
  1997. &uvcg_uncompressed_attr_bma_controls,
  1998. NULL,
  1999. };
  2000. static const struct config_item_type uvcg_uncompressed_type = {
  2001. .ct_item_ops = &uvcg_format_item_operations,
  2002. .ct_group_ops = &uvcg_uncompressed_group_ops,
  2003. .ct_attrs = uvcg_uncompressed_attrs,
  2004. .ct_owner = THIS_MODULE,
  2005. };
  2006. static struct config_group *uvcg_uncompressed_make(struct config_group *group,
  2007. const char *name)
  2008. {
  2009. static char guid[] = {
  2010. 'Y', 'U', 'Y', '2', 0x00, 0x00, 0x10, 0x00,
  2011. 0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71
  2012. };
  2013. struct uvcg_color_matching *color_match;
  2014. struct config_item *streaming;
  2015. struct uvcg_uncompressed *h;
  2016. streaming = group->cg_item.ci_parent;
  2017. color_match = uvcg_format_get_default_color_match(streaming);
  2018. if (!color_match)
  2019. return ERR_PTR(-EINVAL);
  2020. h = kzalloc(sizeof(*h), GFP_KERNEL);
  2021. if (!h)
  2022. return ERR_PTR(-ENOMEM);
  2023. h->desc.bLength = UVC_DT_FORMAT_UNCOMPRESSED_SIZE;
  2024. h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  2025. h->desc.bDescriptorSubType = UVC_VS_FORMAT_UNCOMPRESSED;
  2026. memcpy(h->desc.guidFormat, guid, sizeof(guid));
  2027. h->desc.bBitsPerPixel = 16;
  2028. h->desc.bDefaultFrameIndex = 1;
  2029. h->desc.bAspectRatioX = 0;
  2030. h->desc.bAspectRatioY = 0;
  2031. h->desc.bmInterlaceFlags = 0;
  2032. h->desc.bCopyProtect = 0;
  2033. INIT_LIST_HEAD(&h->fmt.frames);
  2034. h->fmt.type = UVCG_UNCOMPRESSED;
  2035. h->fmt.color_matching = color_match;
  2036. color_match->refcnt++;
  2037. config_group_init_type_name(&h->fmt.group, name,
  2038. &uvcg_uncompressed_type);
  2039. return &h->fmt.group;
  2040. }
  2041. static struct configfs_group_operations uvcg_uncompressed_grp_ops = {
  2042. .make_group = uvcg_uncompressed_make,
  2043. };
  2044. static const struct uvcg_config_group_type uvcg_uncompressed_grp_type = {
  2045. .type = {
  2046. .ct_item_ops = &uvcg_config_item_ops,
  2047. .ct_group_ops = &uvcg_uncompressed_grp_ops,
  2048. .ct_owner = THIS_MODULE,
  2049. },
  2050. .name = "uncompressed",
  2051. };
  2052. /* -----------------------------------------------------------------------------
  2053. * streaming/mjpeg/<NAME>
  2054. */
  2055. static struct configfs_group_operations uvcg_mjpeg_group_ops = {
  2056. .make_item = uvcg_frame_make,
  2057. .drop_item = uvcg_frame_drop,
  2058. };
  2059. #define UVCG_MJPEG_ATTR_RO(cname, aname, bits) \
  2060. static ssize_t uvcg_mjpeg_##cname##_show(struct config_item *item, char *page)\
  2061. { \
  2062. struct uvcg_mjpeg *u = to_uvcg_mjpeg(item); \
  2063. struct f_uvc_opts *opts; \
  2064. struct config_item *opts_item; \
  2065. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  2066. int result; \
  2067. \
  2068. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  2069. \
  2070. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  2071. opts = to_f_uvc_opts(opts_item); \
  2072. \
  2073. mutex_lock(&opts->lock); \
  2074. result = sprintf(page, "%u\n", le##bits##_to_cpu(u->desc.aname));\
  2075. mutex_unlock(&opts->lock); \
  2076. \
  2077. mutex_unlock(su_mutex); \
  2078. return result; \
  2079. } \
  2080. \
  2081. UVC_ATTR_RO(uvcg_mjpeg_, cname, aname)
  2082. #define UVCG_MJPEG_ATTR(cname, aname, bits) \
  2083. static ssize_t uvcg_mjpeg_##cname##_show(struct config_item *item, char *page)\
  2084. { \
  2085. struct uvcg_mjpeg *u = to_uvcg_mjpeg(item); \
  2086. struct f_uvc_opts *opts; \
  2087. struct config_item *opts_item; \
  2088. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  2089. int result; \
  2090. \
  2091. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  2092. \
  2093. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  2094. opts = to_f_uvc_opts(opts_item); \
  2095. \
  2096. mutex_lock(&opts->lock); \
  2097. result = sprintf(page, "%u\n", le##bits##_to_cpu(u->desc.aname));\
  2098. mutex_unlock(&opts->lock); \
  2099. \
  2100. mutex_unlock(su_mutex); \
  2101. return result; \
  2102. } \
  2103. \
  2104. static ssize_t \
  2105. uvcg_mjpeg_##cname##_store(struct config_item *item, \
  2106. const char *page, size_t len) \
  2107. { \
  2108. struct uvcg_mjpeg *u = to_uvcg_mjpeg(item); \
  2109. struct f_uvc_opts *opts; \
  2110. struct config_item *opts_item; \
  2111. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  2112. int ret; \
  2113. u8 num; \
  2114. \
  2115. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  2116. \
  2117. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  2118. opts = to_f_uvc_opts(opts_item); \
  2119. \
  2120. mutex_lock(&opts->lock); \
  2121. if (u->fmt.linked || opts->refcnt) { \
  2122. ret = -EBUSY; \
  2123. goto end; \
  2124. } \
  2125. \
  2126. ret = kstrtou8(page, 0, &num); \
  2127. if (ret) \
  2128. goto end; \
  2129. \
  2130. /* index values in uvc are never 0 */ \
  2131. if (!num) { \
  2132. ret = -EINVAL; \
  2133. goto end; \
  2134. } \
  2135. \
  2136. u->desc.aname = num; \
  2137. ret = len; \
  2138. end: \
  2139. mutex_unlock(&opts->lock); \
  2140. mutex_unlock(su_mutex); \
  2141. return ret; \
  2142. } \
  2143. \
  2144. UVC_ATTR(uvcg_mjpeg_, cname, aname)
  2145. UVCG_MJPEG_ATTR_RO(b_format_index, bFormatIndex, 8);
  2146. UVCG_MJPEG_ATTR(b_default_frame_index, bDefaultFrameIndex, 8);
  2147. UVCG_MJPEG_ATTR_RO(bm_flags, bmFlags, 8);
  2148. UVCG_MJPEG_ATTR_RO(b_aspect_ratio_x, bAspectRatioX, 8);
  2149. UVCG_MJPEG_ATTR_RO(b_aspect_ratio_y, bAspectRatioY, 8);
  2150. UVCG_MJPEG_ATTR_RO(bm_interlace_flags, bmInterlaceFlags, 8);
  2151. #undef UVCG_MJPEG_ATTR
  2152. #undef UVCG_MJPEG_ATTR_RO
  2153. static inline ssize_t
  2154. uvcg_mjpeg_bma_controls_show(struct config_item *item, char *page)
  2155. {
  2156. struct uvcg_mjpeg *u = to_uvcg_mjpeg(item);
  2157. return uvcg_format_bma_controls_show(&u->fmt, page);
  2158. }
  2159. static inline ssize_t
  2160. uvcg_mjpeg_bma_controls_store(struct config_item *item,
  2161. const char *page, size_t len)
  2162. {
  2163. struct uvcg_mjpeg *u = to_uvcg_mjpeg(item);
  2164. return uvcg_format_bma_controls_store(&u->fmt, page, len);
  2165. }
  2166. UVC_ATTR(uvcg_mjpeg_, bma_controls, bmaControls);
  2167. static struct configfs_attribute *uvcg_mjpeg_attrs[] = {
  2168. &uvcg_mjpeg_attr_b_format_index,
  2169. &uvcg_mjpeg_attr_b_default_frame_index,
  2170. &uvcg_mjpeg_attr_bm_flags,
  2171. &uvcg_mjpeg_attr_b_aspect_ratio_x,
  2172. &uvcg_mjpeg_attr_b_aspect_ratio_y,
  2173. &uvcg_mjpeg_attr_bm_interlace_flags,
  2174. &uvcg_mjpeg_attr_bma_controls,
  2175. NULL,
  2176. };
  2177. static const struct config_item_type uvcg_mjpeg_type = {
  2178. .ct_item_ops = &uvcg_format_item_operations,
  2179. .ct_group_ops = &uvcg_mjpeg_group_ops,
  2180. .ct_attrs = uvcg_mjpeg_attrs,
  2181. .ct_owner = THIS_MODULE,
  2182. };
  2183. static struct config_group *uvcg_mjpeg_make(struct config_group *group,
  2184. const char *name)
  2185. {
  2186. struct uvcg_color_matching *color_match;
  2187. struct config_item *streaming;
  2188. struct uvcg_mjpeg *h;
  2189. streaming = group->cg_item.ci_parent;
  2190. color_match = uvcg_format_get_default_color_match(streaming);
  2191. if (!color_match)
  2192. return ERR_PTR(-EINVAL);
  2193. h = kzalloc(sizeof(*h), GFP_KERNEL);
  2194. if (!h)
  2195. return ERR_PTR(-ENOMEM);
  2196. h->desc.bLength = UVC_DT_FORMAT_MJPEG_SIZE;
  2197. h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  2198. h->desc.bDescriptorSubType = UVC_VS_FORMAT_MJPEG;
  2199. h->desc.bDefaultFrameIndex = 1;
  2200. h->desc.bAspectRatioX = 0;
  2201. h->desc.bAspectRatioY = 0;
  2202. h->desc.bmInterlaceFlags = 0;
  2203. h->desc.bCopyProtect = 0;
  2204. INIT_LIST_HEAD(&h->fmt.frames);
  2205. h->fmt.type = UVCG_MJPEG;
  2206. h->fmt.color_matching = color_match;
  2207. color_match->refcnt++;
  2208. config_group_init_type_name(&h->fmt.group, name,
  2209. &uvcg_mjpeg_type);
  2210. return &h->fmt.group;
  2211. }
  2212. static struct configfs_group_operations uvcg_mjpeg_grp_ops = {
  2213. .make_group = uvcg_mjpeg_make,
  2214. };
  2215. static const struct uvcg_config_group_type uvcg_mjpeg_grp_type = {
  2216. .type = {
  2217. .ct_item_ops = &uvcg_config_item_ops,
  2218. .ct_group_ops = &uvcg_mjpeg_grp_ops,
  2219. .ct_owner = THIS_MODULE,
  2220. },
  2221. .name = "mjpeg",
  2222. };
  2223. /* -----------------------------------------------------------------------------
  2224. * streaming/color_matching/default
  2225. */
  2226. #define UVCG_COLOR_MATCHING_ATTR(cname, aname, bits) \
  2227. static ssize_t uvcg_color_matching_##cname##_show( \
  2228. struct config_item *item, char *page) \
  2229. { \
  2230. struct config_group *group = to_config_group(item); \
  2231. struct uvcg_color_matching *color_match = \
  2232. to_uvcg_color_matching(group); \
  2233. struct f_uvc_opts *opts; \
  2234. struct config_item *opts_item; \
  2235. struct mutex *su_mutex = &group->cg_subsys->su_mutex; \
  2236. int result; \
  2237. \
  2238. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  2239. \
  2240. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent; \
  2241. opts = to_f_uvc_opts(opts_item); \
  2242. \
  2243. mutex_lock(&opts->lock); \
  2244. result = sprintf(page, "%u\n", \
  2245. le##bits##_to_cpu(color_match->desc.aname)); \
  2246. mutex_unlock(&opts->lock); \
  2247. \
  2248. mutex_unlock(su_mutex); \
  2249. return result; \
  2250. } \
  2251. \
  2252. static ssize_t uvcg_color_matching_##cname##_store( \
  2253. struct config_item *item, const char *page, size_t len) \
  2254. { \
  2255. struct config_group *group = to_config_group(item); \
  2256. struct mutex *su_mutex = &group->cg_subsys->su_mutex; \
  2257. struct uvcg_color_matching *color_match = \
  2258. to_uvcg_color_matching(group); \
  2259. struct f_uvc_opts *opts; \
  2260. struct config_item *opts_item; \
  2261. int ret; \
  2262. u##bits num; \
  2263. \
  2264. ret = kstrtou##bits(page, 0, &num); \
  2265. if (ret) \
  2266. return ret; \
  2267. \
  2268. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  2269. \
  2270. if (color_match->refcnt) { \
  2271. ret = -EBUSY; \
  2272. goto unlock_su; \
  2273. } \
  2274. \
  2275. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent; \
  2276. opts = to_f_uvc_opts(opts_item); \
  2277. \
  2278. mutex_lock(&opts->lock); \
  2279. \
  2280. color_match->desc.aname = num; \
  2281. ret = len; \
  2282. \
  2283. mutex_unlock(&opts->lock); \
  2284. unlock_su: \
  2285. mutex_unlock(su_mutex); \
  2286. \
  2287. return ret; \
  2288. } \
  2289. UVC_ATTR(uvcg_color_matching_, cname, aname)
  2290. UVCG_COLOR_MATCHING_ATTR(b_color_primaries, bColorPrimaries, 8);
  2291. UVCG_COLOR_MATCHING_ATTR(b_transfer_characteristics, bTransferCharacteristics, 8);
  2292. UVCG_COLOR_MATCHING_ATTR(b_matrix_coefficients, bMatrixCoefficients, 8);
  2293. #undef UVCG_COLOR_MATCHING_ATTR
  2294. static struct configfs_attribute *uvcg_color_matching_attrs[] = {
  2295. &uvcg_color_matching_attr_b_color_primaries,
  2296. &uvcg_color_matching_attr_b_transfer_characteristics,
  2297. &uvcg_color_matching_attr_b_matrix_coefficients,
  2298. NULL,
  2299. };
  2300. static void uvcg_color_matching_release(struct config_item *item)
  2301. {
  2302. struct uvcg_color_matching *color_match =
  2303. to_uvcg_color_matching(to_config_group(item));
  2304. kfree(color_match);
  2305. }
  2306. static struct configfs_item_operations uvcg_color_matching_item_ops = {
  2307. .release = uvcg_color_matching_release,
  2308. };
  2309. static const struct config_item_type uvcg_color_matching_type = {
  2310. .ct_item_ops = &uvcg_color_matching_item_ops,
  2311. .ct_attrs = uvcg_color_matching_attrs,
  2312. .ct_owner = THIS_MODULE,
  2313. };
  2314. /* -----------------------------------------------------------------------------
  2315. * streaming/color_matching
  2316. */
  2317. static struct config_group *uvcg_color_matching_make(struct config_group *group,
  2318. const char *name)
  2319. {
  2320. struct uvcg_color_matching *color_match;
  2321. color_match = kzalloc(sizeof(*color_match), GFP_KERNEL);
  2322. if (!color_match)
  2323. return ERR_PTR(-ENOMEM);
  2324. color_match->desc.bLength = UVC_DT_COLOR_MATCHING_SIZE;
  2325. color_match->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  2326. color_match->desc.bDescriptorSubType = UVC_VS_COLORFORMAT;
  2327. config_group_init_type_name(&color_match->group, name,
  2328. &uvcg_color_matching_type);
  2329. return &color_match->group;
  2330. }
  2331. static struct configfs_group_operations uvcg_color_matching_grp_group_ops = {
  2332. .make_group = uvcg_color_matching_make,
  2333. };
  2334. static int uvcg_color_matching_create_children(struct config_group *parent)
  2335. {
  2336. struct uvcg_color_matching *color_match;
  2337. color_match = kzalloc(sizeof(*color_match), GFP_KERNEL);
  2338. if (!color_match)
  2339. return -ENOMEM;
  2340. color_match->desc.bLength = UVC_DT_COLOR_MATCHING_SIZE;
  2341. color_match->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  2342. color_match->desc.bDescriptorSubType = UVC_VS_COLORFORMAT;
  2343. color_match->desc.bColorPrimaries = UVC_COLOR_PRIMARIES_BT_709_SRGB;
  2344. color_match->desc.bTransferCharacteristics = UVC_TRANSFER_CHARACTERISTICS_BT_709;
  2345. color_match->desc.bMatrixCoefficients = UVC_MATRIX_COEFFICIENTS_SMPTE_170M;
  2346. config_group_init_type_name(&color_match->group, "default",
  2347. &uvcg_color_matching_type);
  2348. configfs_add_default_group(&color_match->group, parent);
  2349. return 0;
  2350. }
  2351. static const struct uvcg_config_group_type uvcg_color_matching_grp_type = {
  2352. .type = {
  2353. .ct_item_ops = &uvcg_config_item_ops,
  2354. .ct_group_ops = &uvcg_color_matching_grp_group_ops,
  2355. .ct_owner = THIS_MODULE,
  2356. },
  2357. .name = "color_matching",
  2358. .create_children = uvcg_color_matching_create_children,
  2359. };
  2360. /* -----------------------------------------------------------------------------
  2361. * streaming/class/{fs|hs|ss}
  2362. */
  2363. struct uvcg_streaming_class_group {
  2364. struct config_group group;
  2365. const char *name;
  2366. };
  2367. static inline struct uvc_descriptor_header
  2368. ***__uvcg_get_stream_class_arr(struct config_item *i, struct f_uvc_opts *o)
  2369. {
  2370. struct uvcg_streaming_class_group *group =
  2371. container_of(i, struct uvcg_streaming_class_group,
  2372. group.cg_item);
  2373. if (!strcmp(group->name, "fs"))
  2374. return &o->uvc_fs_streaming_cls;
  2375. if (!strcmp(group->name, "hs"))
  2376. return &o->uvc_hs_streaming_cls;
  2377. if (!strcmp(group->name, "ss"))
  2378. return &o->uvc_ss_streaming_cls;
  2379. return NULL;
  2380. }
  2381. enum uvcg_strm_type {
  2382. UVCG_HEADER = 0,
  2383. UVCG_FORMAT,
  2384. UVCG_FRAME,
  2385. UVCG_COLOR_MATCHING,
  2386. };
  2387. /*
  2388. * Iterate over a hierarchy of streaming descriptors' config items.
  2389. * The items are created by the user with configfs.
  2390. *
  2391. * It "processes" the header pointed to by @priv1, then for each format
  2392. * that follows the header "processes" the format itself and then for
  2393. * each frame inside a format "processes" the frame.
  2394. *
  2395. * As a "processing" function the @fun is used.
  2396. *
  2397. * __uvcg_iter_strm_cls() is used in two context: first, to calculate
  2398. * the amount of memory needed for an array of streaming descriptors
  2399. * and second, to actually fill the array.
  2400. *
  2401. * @h: streaming header pointer
  2402. * @priv2: an "inout" parameter (the caller might want to see the changes to it)
  2403. * @priv3: an "inout" parameter (the caller might want to see the changes to it)
  2404. * @fun: callback function for processing each level of the hierarchy
  2405. */
  2406. static int __uvcg_iter_strm_cls(struct uvcg_streaming_header *h,
  2407. void *priv2, void *priv3,
  2408. int (*fun)(void *, void *, void *, int, enum uvcg_strm_type type))
  2409. {
  2410. struct uvcg_format_ptr *f;
  2411. struct config_group *grp;
  2412. struct config_item *item;
  2413. struct uvcg_frame *frm;
  2414. int ret, i, j;
  2415. if (!fun)
  2416. return -EINVAL;
  2417. i = j = 0;
  2418. ret = fun(h, priv2, priv3, 0, UVCG_HEADER);
  2419. if (ret)
  2420. return ret;
  2421. list_for_each_entry(f, &h->formats, entry) {
  2422. ret = fun(f->fmt, priv2, priv3, i++, UVCG_FORMAT);
  2423. if (ret)
  2424. return ret;
  2425. grp = &f->fmt->group;
  2426. list_for_each_entry(item, &grp->cg_children, ci_entry) {
  2427. frm = to_uvcg_frame(item);
  2428. ret = fun(frm, priv2, priv3, j++, UVCG_FRAME);
  2429. if (ret)
  2430. return ret;
  2431. }
  2432. ret = fun(f->fmt->color_matching, priv2, priv3, 0,
  2433. UVCG_COLOR_MATCHING);
  2434. if (ret)
  2435. return ret;
  2436. }
  2437. return ret;
  2438. }
  2439. /*
  2440. * Count how many bytes are needed for an array of streaming descriptors.
  2441. *
  2442. * @priv1: pointer to a header, format or frame
  2443. * @priv2: inout parameter, accumulated size of the array
  2444. * @priv3: inout parameter, accumulated number of the array elements
  2445. * @n: unused, this function's prototype must match @fun in __uvcg_iter_strm_cls
  2446. */
  2447. static int __uvcg_cnt_strm(void *priv1, void *priv2, void *priv3, int n,
  2448. enum uvcg_strm_type type)
  2449. {
  2450. size_t *size = priv2;
  2451. size_t *count = priv3;
  2452. switch (type) {
  2453. case UVCG_HEADER: {
  2454. struct uvcg_streaming_header *h = priv1;
  2455. *size += sizeof(h->desc);
  2456. /* bmaControls */
  2457. *size += h->num_fmt * UVCG_STREAMING_CONTROL_SIZE;
  2458. }
  2459. break;
  2460. case UVCG_FORMAT: {
  2461. struct uvcg_format *fmt = priv1;
  2462. if (fmt->type == UVCG_UNCOMPRESSED) {
  2463. struct uvcg_uncompressed *u =
  2464. container_of(fmt, struct uvcg_uncompressed,
  2465. fmt);
  2466. *size += sizeof(u->desc);
  2467. } else if (fmt->type == UVCG_MJPEG) {
  2468. struct uvcg_mjpeg *m =
  2469. container_of(fmt, struct uvcg_mjpeg, fmt);
  2470. *size += sizeof(m->desc);
  2471. } else {
  2472. return -EINVAL;
  2473. }
  2474. }
  2475. break;
  2476. case UVCG_FRAME: {
  2477. struct uvcg_frame *frm = priv1;
  2478. int sz = sizeof(frm->dw_frame_interval);
  2479. *size += sizeof(frm->frame);
  2480. *size += frm->frame.b_frame_interval_type * sz;
  2481. }
  2482. break;
  2483. case UVCG_COLOR_MATCHING: {
  2484. struct uvcg_color_matching *color_match = priv1;
  2485. *size += sizeof(color_match->desc);
  2486. }
  2487. break;
  2488. }
  2489. ++*count;
  2490. return 0;
  2491. }
  2492. /*
  2493. * Fill an array of streaming descriptors.
  2494. *
  2495. * @priv1: pointer to a header, format or frame
  2496. * @priv2: inout parameter, pointer into a block of memory
  2497. * @priv3: inout parameter, pointer to a 2-dimensional array
  2498. */
  2499. static int __uvcg_fill_strm(void *priv1, void *priv2, void *priv3, int n,
  2500. enum uvcg_strm_type type)
  2501. {
  2502. void **dest = priv2;
  2503. struct uvc_descriptor_header ***array = priv3;
  2504. size_t sz;
  2505. **array = *dest;
  2506. ++*array;
  2507. switch (type) {
  2508. case UVCG_HEADER: {
  2509. struct uvc_input_header_descriptor *ihdr = *dest;
  2510. struct uvcg_streaming_header *h = priv1;
  2511. struct uvcg_format_ptr *f;
  2512. memcpy(*dest, &h->desc, sizeof(h->desc));
  2513. *dest += sizeof(h->desc);
  2514. sz = UVCG_STREAMING_CONTROL_SIZE;
  2515. list_for_each_entry(f, &h->formats, entry) {
  2516. memcpy(*dest, f->fmt->bmaControls, sz);
  2517. *dest += sz;
  2518. }
  2519. ihdr->bLength = sizeof(h->desc) + h->num_fmt * sz;
  2520. ihdr->bNumFormats = h->num_fmt;
  2521. }
  2522. break;
  2523. case UVCG_FORMAT: {
  2524. struct uvcg_format *fmt = priv1;
  2525. if (fmt->type == UVCG_UNCOMPRESSED) {
  2526. struct uvcg_uncompressed *u =
  2527. container_of(fmt, struct uvcg_uncompressed,
  2528. fmt);
  2529. u->desc.bFormatIndex = n + 1;
  2530. u->desc.bNumFrameDescriptors = fmt->num_frames;
  2531. memcpy(*dest, &u->desc, sizeof(u->desc));
  2532. *dest += sizeof(u->desc);
  2533. } else if (fmt->type == UVCG_MJPEG) {
  2534. struct uvcg_mjpeg *m =
  2535. container_of(fmt, struct uvcg_mjpeg, fmt);
  2536. m->desc.bFormatIndex = n + 1;
  2537. m->desc.bNumFrameDescriptors = fmt->num_frames;
  2538. memcpy(*dest, &m->desc, sizeof(m->desc));
  2539. *dest += sizeof(m->desc);
  2540. } else {
  2541. return -EINVAL;
  2542. }
  2543. }
  2544. break;
  2545. case UVCG_FRAME: {
  2546. struct uvcg_frame *frm = priv1;
  2547. struct uvc_descriptor_header *h = *dest;
  2548. sz = sizeof(frm->frame);
  2549. memcpy(*dest, &frm->frame, sz);
  2550. *dest += sz;
  2551. sz = frm->frame.b_frame_interval_type *
  2552. sizeof(*frm->dw_frame_interval);
  2553. memcpy(*dest, frm->dw_frame_interval, sz);
  2554. *dest += sz;
  2555. if (frm->fmt_type == UVCG_UNCOMPRESSED)
  2556. h->bLength = UVC_DT_FRAME_UNCOMPRESSED_SIZE(
  2557. frm->frame.b_frame_interval_type);
  2558. else if (frm->fmt_type == UVCG_MJPEG)
  2559. h->bLength = UVC_DT_FRAME_MJPEG_SIZE(
  2560. frm->frame.b_frame_interval_type);
  2561. }
  2562. break;
  2563. case UVCG_COLOR_MATCHING: {
  2564. struct uvcg_color_matching *color_match = priv1;
  2565. memcpy(*dest, &color_match->desc, sizeof(color_match->desc));
  2566. *dest += sizeof(color_match->desc);
  2567. }
  2568. break;
  2569. }
  2570. return 0;
  2571. }
  2572. static int uvcg_streaming_class_allow_link(struct config_item *src,
  2573. struct config_item *target)
  2574. {
  2575. struct config_item *streaming, *header;
  2576. struct f_uvc_opts *opts;
  2577. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  2578. struct uvc_descriptor_header ***class_array, **cl_arr;
  2579. struct uvcg_streaming_header *target_hdr;
  2580. void *data, *data_save;
  2581. size_t size = 0, count = 0;
  2582. int ret = -EINVAL;
  2583. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  2584. streaming = src->ci_parent->ci_parent;
  2585. header = config_group_find_item(to_config_group(streaming), "header");
  2586. if (!header || target->ci_parent != header)
  2587. goto out;
  2588. opts = to_f_uvc_opts(streaming->ci_parent);
  2589. mutex_lock(&opts->lock);
  2590. class_array = __uvcg_get_stream_class_arr(src, opts);
  2591. if (!class_array || *class_array || opts->refcnt) {
  2592. ret = -EBUSY;
  2593. goto unlock;
  2594. }
  2595. target_hdr = to_uvcg_streaming_header(target);
  2596. ret = __uvcg_iter_strm_cls(target_hdr, &size, &count, __uvcg_cnt_strm);
  2597. if (ret)
  2598. goto unlock;
  2599. count += 1; /* NULL */
  2600. *class_array = kcalloc(count, sizeof(void *), GFP_KERNEL);
  2601. if (!*class_array) {
  2602. ret = -ENOMEM;
  2603. goto unlock;
  2604. }
  2605. data = data_save = kzalloc(size, GFP_KERNEL);
  2606. if (!data) {
  2607. kfree(*class_array);
  2608. *class_array = NULL;
  2609. ret = -ENOMEM;
  2610. goto unlock;
  2611. }
  2612. cl_arr = *class_array;
  2613. ret = __uvcg_iter_strm_cls(target_hdr, &data, &cl_arr,
  2614. __uvcg_fill_strm);
  2615. if (ret) {
  2616. kfree(*class_array);
  2617. *class_array = NULL;
  2618. /*
  2619. * __uvcg_fill_strm() called from __uvcg_iter_stream_cls()
  2620. * might have advanced the "data", so use a backup copy
  2621. */
  2622. kfree(data_save);
  2623. goto unlock;
  2624. }
  2625. ++target_hdr->linked;
  2626. ret = 0;
  2627. unlock:
  2628. mutex_unlock(&opts->lock);
  2629. out:
  2630. config_item_put(header);
  2631. mutex_unlock(su_mutex);
  2632. return ret;
  2633. }
  2634. static void uvcg_streaming_class_drop_link(struct config_item *src,
  2635. struct config_item *target)
  2636. {
  2637. struct config_item *streaming, *header;
  2638. struct f_uvc_opts *opts;
  2639. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  2640. struct uvc_descriptor_header ***class_array;
  2641. struct uvcg_streaming_header *target_hdr;
  2642. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  2643. streaming = src->ci_parent->ci_parent;
  2644. header = config_group_find_item(to_config_group(streaming), "header");
  2645. if (!header || target->ci_parent != header)
  2646. goto out;
  2647. opts = to_f_uvc_opts(streaming->ci_parent);
  2648. mutex_lock(&opts->lock);
  2649. class_array = __uvcg_get_stream_class_arr(src, opts);
  2650. if (!class_array || !*class_array)
  2651. goto unlock;
  2652. if (opts->refcnt)
  2653. goto unlock;
  2654. target_hdr = to_uvcg_streaming_header(target);
  2655. --target_hdr->linked;
  2656. kfree(**class_array);
  2657. kfree(*class_array);
  2658. *class_array = NULL;
  2659. unlock:
  2660. mutex_unlock(&opts->lock);
  2661. out:
  2662. config_item_put(header);
  2663. mutex_unlock(su_mutex);
  2664. }
  2665. static struct configfs_item_operations uvcg_streaming_class_item_ops = {
  2666. .release = uvcg_config_item_release,
  2667. .allow_link = uvcg_streaming_class_allow_link,
  2668. .drop_link = uvcg_streaming_class_drop_link,
  2669. };
  2670. static const struct config_item_type uvcg_streaming_class_type = {
  2671. .ct_item_ops = &uvcg_streaming_class_item_ops,
  2672. .ct_owner = THIS_MODULE,
  2673. };
  2674. /* -----------------------------------------------------------------------------
  2675. * streaming/class
  2676. */
  2677. static int uvcg_streaming_class_create_children(struct config_group *parent)
  2678. {
  2679. static const char * const names[] = { "fs", "hs", "ss" };
  2680. unsigned int i;
  2681. for (i = 0; i < ARRAY_SIZE(names); ++i) {
  2682. struct uvcg_streaming_class_group *group;
  2683. group = kzalloc(sizeof(*group), GFP_KERNEL);
  2684. if (!group)
  2685. return -ENOMEM;
  2686. group->name = names[i];
  2687. config_group_init_type_name(&group->group, group->name,
  2688. &uvcg_streaming_class_type);
  2689. configfs_add_default_group(&group->group, parent);
  2690. }
  2691. return 0;
  2692. }
  2693. static const struct uvcg_config_group_type uvcg_streaming_class_grp_type = {
  2694. .type = {
  2695. .ct_item_ops = &uvcg_config_item_ops,
  2696. .ct_owner = THIS_MODULE,
  2697. },
  2698. .name = "class",
  2699. .create_children = uvcg_streaming_class_create_children,
  2700. };
  2701. /* -----------------------------------------------------------------------------
  2702. * streaming
  2703. */
  2704. static ssize_t uvcg_default_streaming_b_interface_number_show(
  2705. struct config_item *item, char *page)
  2706. {
  2707. struct config_group *group = to_config_group(item);
  2708. struct mutex *su_mutex = &group->cg_subsys->su_mutex;
  2709. struct config_item *opts_item;
  2710. struct f_uvc_opts *opts;
  2711. int result = 0;
  2712. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  2713. opts_item = item->ci_parent;
  2714. opts = to_f_uvc_opts(opts_item);
  2715. mutex_lock(&opts->lock);
  2716. result += sprintf(page, "%u\n", opts->streaming_interface);
  2717. mutex_unlock(&opts->lock);
  2718. mutex_unlock(su_mutex);
  2719. return result;
  2720. }
  2721. UVC_ATTR_RO(uvcg_default_streaming_, b_interface_number, bInterfaceNumber);
  2722. static struct configfs_attribute *uvcg_default_streaming_attrs[] = {
  2723. &uvcg_default_streaming_attr_b_interface_number,
  2724. NULL,
  2725. };
  2726. static const struct uvcg_config_group_type uvcg_streaming_grp_type = {
  2727. .type = {
  2728. .ct_item_ops = &uvcg_config_item_ops,
  2729. .ct_attrs = uvcg_default_streaming_attrs,
  2730. .ct_owner = THIS_MODULE,
  2731. },
  2732. .name = "streaming",
  2733. .children = (const struct uvcg_config_group_type*[]) {
  2734. &uvcg_streaming_header_grp_type,
  2735. &uvcg_uncompressed_grp_type,
  2736. &uvcg_mjpeg_grp_type,
  2737. &uvcg_color_matching_grp_type,
  2738. &uvcg_streaming_class_grp_type,
  2739. NULL,
  2740. },
  2741. };
  2742. /* -----------------------------------------------------------------------------
  2743. * UVC function
  2744. */
  2745. static void uvc_func_item_release(struct config_item *item)
  2746. {
  2747. struct f_uvc_opts *opts = to_f_uvc_opts(item);
  2748. uvcg_config_remove_children(to_config_group(item));
  2749. usb_put_function_instance(&opts->func_inst);
  2750. }
  2751. static int uvc_func_allow_link(struct config_item *src, struct config_item *tgt)
  2752. {
  2753. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  2754. struct gadget_string *string;
  2755. struct config_item *strings;
  2756. struct f_uvc_opts *opts;
  2757. int ret = 0;
  2758. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  2759. /* Validate that the target is an entry in strings/<langid> */
  2760. strings = config_group_find_item(to_config_group(src->ci_parent->ci_parent),
  2761. "strings");
  2762. if (!strings || tgt->ci_parent->ci_parent != strings) {
  2763. ret = -EINVAL;
  2764. goto put_strings;
  2765. }
  2766. string = to_gadget_string(tgt);
  2767. opts = to_f_uvc_opts(src);
  2768. mutex_lock(&opts->lock);
  2769. if (!strcmp(tgt->ci_name, "iad_desc"))
  2770. opts->iad_index = string->usb_string.id;
  2771. else if (!strcmp(tgt->ci_name, "vs0_desc"))
  2772. opts->vs0_index = string->usb_string.id;
  2773. else if (!strcmp(tgt->ci_name, "vs1_desc"))
  2774. opts->vs1_index = string->usb_string.id;
  2775. else
  2776. ret = -EINVAL;
  2777. mutex_unlock(&opts->lock);
  2778. put_strings:
  2779. config_item_put(strings);
  2780. mutex_unlock(su_mutex);
  2781. return ret;
  2782. }
  2783. static void uvc_func_drop_link(struct config_item *src, struct config_item *tgt)
  2784. {
  2785. struct f_uvc_opts *opts;
  2786. opts = to_f_uvc_opts(src);
  2787. mutex_lock(&opts->lock);
  2788. if (!strcmp(tgt->ci_name, "iad_desc"))
  2789. opts->iad_index = 0;
  2790. else if (!strcmp(tgt->ci_name, "vs0_desc"))
  2791. opts->vs0_index = 0;
  2792. else if (!strcmp(tgt->ci_name, "vs1_desc"))
  2793. opts->vs1_index = 0;
  2794. mutex_unlock(&opts->lock);
  2795. }
  2796. static struct configfs_item_operations uvc_func_item_ops = {
  2797. .release = uvc_func_item_release,
  2798. .allow_link = uvc_func_allow_link,
  2799. .drop_link = uvc_func_drop_link,
  2800. };
  2801. #define UVCG_OPTS_ATTR(cname, aname, limit) \
  2802. static ssize_t f_uvc_opts_##cname##_show( \
  2803. struct config_item *item, char *page) \
  2804. { \
  2805. struct f_uvc_opts *opts = to_f_uvc_opts(item); \
  2806. int result; \
  2807. \
  2808. mutex_lock(&opts->lock); \
  2809. result = sprintf(page, "%u\n", opts->cname); \
  2810. mutex_unlock(&opts->lock); \
  2811. \
  2812. return result; \
  2813. } \
  2814. \
  2815. static ssize_t \
  2816. f_uvc_opts_##cname##_store(struct config_item *item, \
  2817. const char *page, size_t len) \
  2818. { \
  2819. struct f_uvc_opts *opts = to_f_uvc_opts(item); \
  2820. unsigned int num; \
  2821. int ret; \
  2822. \
  2823. mutex_lock(&opts->lock); \
  2824. if (opts->refcnt) { \
  2825. ret = -EBUSY; \
  2826. goto end; \
  2827. } \
  2828. \
  2829. ret = kstrtouint(page, 0, &num); \
  2830. if (ret) \
  2831. goto end; \
  2832. \
  2833. if (num > limit) { \
  2834. ret = -EINVAL; \
  2835. goto end; \
  2836. } \
  2837. opts->cname = num; \
  2838. ret = len; \
  2839. end: \
  2840. mutex_unlock(&opts->lock); \
  2841. return ret; \
  2842. } \
  2843. \
  2844. UVC_ATTR(f_uvc_opts_, cname, cname)
  2845. UVCG_OPTS_ATTR(streaming_interval, streaming_interval, 16);
  2846. UVCG_OPTS_ATTR(streaming_maxpacket, streaming_maxpacket, 3072);
  2847. UVCG_OPTS_ATTR(streaming_maxburst, streaming_maxburst, 15);
  2848. #undef UVCG_OPTS_ATTR
  2849. #define UVCG_OPTS_STRING_ATTR(cname, aname) \
  2850. static ssize_t f_uvc_opts_string_##cname##_show(struct config_item *item,\
  2851. char *page) \
  2852. { \
  2853. struct f_uvc_opts *opts = to_f_uvc_opts(item); \
  2854. int result; \
  2855. \
  2856. mutex_lock(&opts->lock); \
  2857. result = scnprintf(page, sizeof(opts->aname), "%s", opts->aname);\
  2858. mutex_unlock(&opts->lock); \
  2859. \
  2860. return result; \
  2861. } \
  2862. \
  2863. static ssize_t f_uvc_opts_string_##cname##_store(struct config_item *item,\
  2864. const char *page, size_t len) \
  2865. { \
  2866. struct f_uvc_opts *opts = to_f_uvc_opts(item); \
  2867. int size = min(sizeof(opts->aname), len + 1); \
  2868. int ret = 0; \
  2869. \
  2870. mutex_lock(&opts->lock); \
  2871. if (opts->refcnt) { \
  2872. ret = -EBUSY; \
  2873. goto end; \
  2874. } \
  2875. \
  2876. ret = strscpy(opts->aname, page, size); \
  2877. if (ret == -E2BIG) \
  2878. ret = size - 1; \
  2879. \
  2880. end: \
  2881. mutex_unlock(&opts->lock); \
  2882. return ret; \
  2883. } \
  2884. \
  2885. UVC_ATTR(f_uvc_opts_string_, cname, aname)
  2886. UVCG_OPTS_STRING_ATTR(function_name, function_name);
  2887. #undef UVCG_OPTS_STRING_ATTR
  2888. static struct configfs_attribute *uvc_attrs[] = {
  2889. &f_uvc_opts_attr_streaming_interval,
  2890. &f_uvc_opts_attr_streaming_maxpacket,
  2891. &f_uvc_opts_attr_streaming_maxburst,
  2892. &f_uvc_opts_string_attr_function_name,
  2893. NULL,
  2894. };
  2895. static const struct uvcg_config_group_type uvc_func_type = {
  2896. .type = {
  2897. .ct_item_ops = &uvc_func_item_ops,
  2898. .ct_attrs = uvc_attrs,
  2899. .ct_owner = THIS_MODULE,
  2900. },
  2901. .name = "",
  2902. .children = (const struct uvcg_config_group_type*[]) {
  2903. &uvcg_control_grp_type,
  2904. &uvcg_streaming_grp_type,
  2905. NULL,
  2906. },
  2907. };
  2908. int uvcg_attach_configfs(struct f_uvc_opts *opts)
  2909. {
  2910. int ret;
  2911. config_group_init_type_name(&opts->func_inst.group, uvc_func_type.name,
  2912. &uvc_func_type.type);
  2913. ret = uvcg_config_create_children(&opts->func_inst.group,
  2914. &uvc_func_type);
  2915. if (ret < 0)
  2916. config_group_put(&opts->func_inst.group);
  2917. return ret;
  2918. }