uvc_configfs.c 64 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312
  1. /*
  2. * uvc_configfs.c
  3. *
  4. * Configfs support for the uvc function.
  5. *
  6. * Copyright (c) 2014 Samsung Electronics Co., Ltd.
  7. * http://www.samsung.com
  8. *
  9. * Author: Andrzej Pietrasiewicz <andrzej.p@samsung.com>
  10. *
  11. * This program is free software; you can redistribute it and/or modify
  12. * it under the terms of the GNU General Public License version 2 as
  13. * published by the Free Software Foundation.
  14. */
  15. #include "u_uvc.h"
  16. #include "uvc_configfs.h"
  17. #define UVCG_STREAMING_CONTROL_SIZE 1
  18. #define UVC_ATTR(prefix, cname, aname) \
  19. static struct configfs_attribute prefix##attr_##cname = { \
  20. .ca_name = __stringify(aname), \
  21. .ca_mode = S_IRUGO | S_IWUGO, \
  22. .ca_owner = THIS_MODULE, \
  23. .show = prefix##cname##_show, \
  24. .store = prefix##cname##_store, \
  25. }
  26. #define UVC_ATTR_RO(prefix, cname, aname) \
  27. static struct configfs_attribute prefix##attr_##cname = { \
  28. .ca_name = __stringify(aname), \
  29. .ca_mode = S_IRUGO, \
  30. .ca_owner = THIS_MODULE, \
  31. .show = prefix##cname##_show, \
  32. }
  33. static inline struct f_uvc_opts *to_f_uvc_opts(struct config_item *item);
  34. /* control/header/<NAME> */
  35. DECLARE_UVC_HEADER_DESCRIPTOR(1);
  36. struct uvcg_control_header {
  37. struct config_item item;
  38. struct UVC_HEADER_DESCRIPTOR(1) desc;
  39. unsigned linked;
  40. };
  41. static struct uvcg_control_header *to_uvcg_control_header(struct config_item *item)
  42. {
  43. return container_of(item, struct uvcg_control_header, item);
  44. }
  45. #define UVCG_CTRL_HDR_ATTR(cname, aname, conv, str2u, uxx, vnoc, limit) \
  46. static ssize_t uvcg_control_header_##cname##_show( \
  47. struct config_item *item, char *page) \
  48. { \
  49. struct uvcg_control_header *ch = to_uvcg_control_header(item); \
  50. struct f_uvc_opts *opts; \
  51. struct config_item *opts_item; \
  52. struct mutex *su_mutex = &ch->item.ci_group->cg_subsys->su_mutex;\
  53. int result; \
  54. \
  55. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  56. \
  57. opts_item = ch->item.ci_parent->ci_parent->ci_parent; \
  58. opts = to_f_uvc_opts(opts_item); \
  59. \
  60. mutex_lock(&opts->lock); \
  61. result = sprintf(page, "%d\n", conv(ch->desc.aname)); \
  62. mutex_unlock(&opts->lock); \
  63. \
  64. mutex_unlock(su_mutex); \
  65. return result; \
  66. } \
  67. \
  68. static ssize_t \
  69. uvcg_control_header_##cname##_store(struct config_item *item, \
  70. const char *page, size_t len) \
  71. { \
  72. struct uvcg_control_header *ch = to_uvcg_control_header(item); \
  73. struct f_uvc_opts *opts; \
  74. struct config_item *opts_item; \
  75. struct mutex *su_mutex = &ch->item.ci_group->cg_subsys->su_mutex;\
  76. int ret; \
  77. uxx num; \
  78. \
  79. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  80. \
  81. opts_item = ch->item.ci_parent->ci_parent->ci_parent; \
  82. opts = to_f_uvc_opts(opts_item); \
  83. \
  84. mutex_lock(&opts->lock); \
  85. if (ch->linked || opts->refcnt) { \
  86. ret = -EBUSY; \
  87. goto end; \
  88. } \
  89. \
  90. ret = str2u(page, 0, &num); \
  91. if (ret) \
  92. goto end; \
  93. \
  94. if (num > limit) { \
  95. ret = -EINVAL; \
  96. goto end; \
  97. } \
  98. ch->desc.aname = vnoc(num); \
  99. ret = len; \
  100. end: \
  101. mutex_unlock(&opts->lock); \
  102. mutex_unlock(su_mutex); \
  103. return ret; \
  104. } \
  105. \
  106. UVC_ATTR(uvcg_control_header_, cname, aname)
  107. UVCG_CTRL_HDR_ATTR(bcd_uvc, bcdUVC, le16_to_cpu, kstrtou16, u16, cpu_to_le16,
  108. 0xffff);
  109. UVCG_CTRL_HDR_ATTR(dw_clock_frequency, dwClockFrequency, le32_to_cpu, kstrtou32,
  110. u32, cpu_to_le32, 0x7fffffff);
  111. #undef UVCG_CTRL_HDR_ATTR
  112. static struct configfs_attribute *uvcg_control_header_attrs[] = {
  113. &uvcg_control_header_attr_bcd_uvc,
  114. &uvcg_control_header_attr_dw_clock_frequency,
  115. NULL,
  116. };
  117. static struct config_item_type uvcg_control_header_type = {
  118. .ct_attrs = uvcg_control_header_attrs,
  119. .ct_owner = THIS_MODULE,
  120. };
  121. static struct config_item *uvcg_control_header_make(struct config_group *group,
  122. const char *name)
  123. {
  124. struct uvcg_control_header *h;
  125. h = kzalloc(sizeof(*h), GFP_KERNEL);
  126. if (!h)
  127. return ERR_PTR(-ENOMEM);
  128. h->desc.bLength = UVC_DT_HEADER_SIZE(1);
  129. h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  130. h->desc.bDescriptorSubType = UVC_VC_HEADER;
  131. h->desc.bcdUVC = cpu_to_le16(0x0100);
  132. h->desc.dwClockFrequency = cpu_to_le32(48000000);
  133. config_item_init_type_name(&h->item, name, &uvcg_control_header_type);
  134. return &h->item;
  135. }
  136. static void uvcg_control_header_drop(struct config_group *group,
  137. struct config_item *item)
  138. {
  139. struct uvcg_control_header *h = to_uvcg_control_header(item);
  140. kfree(h);
  141. }
  142. /* control/header */
  143. static struct uvcg_control_header_grp {
  144. struct config_group group;
  145. } uvcg_control_header_grp;
  146. static struct configfs_group_operations uvcg_control_header_grp_ops = {
  147. .make_item = uvcg_control_header_make,
  148. .drop_item = uvcg_control_header_drop,
  149. };
  150. static struct config_item_type uvcg_control_header_grp_type = {
  151. .ct_group_ops = &uvcg_control_header_grp_ops,
  152. .ct_owner = THIS_MODULE,
  153. };
  154. /* control/processing/default */
  155. static struct uvcg_default_processing {
  156. struct config_group group;
  157. } uvcg_default_processing;
  158. static inline struct uvcg_default_processing
  159. *to_uvcg_default_processing(struct config_item *item)
  160. {
  161. return container_of(to_config_group(item),
  162. struct uvcg_default_processing, group);
  163. }
  164. #define UVCG_DEFAULT_PROCESSING_ATTR(cname, aname, conv) \
  165. static ssize_t uvcg_default_processing_##cname##_show( \
  166. struct config_item *item, char *page) \
  167. { \
  168. struct uvcg_default_processing *dp = to_uvcg_default_processing(item); \
  169. struct f_uvc_opts *opts; \
  170. struct config_item *opts_item; \
  171. struct mutex *su_mutex = &dp->group.cg_subsys->su_mutex; \
  172. struct uvc_processing_unit_descriptor *pd; \
  173. int result; \
  174. \
  175. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  176. \
  177. opts_item = dp->group.cg_item.ci_parent->ci_parent->ci_parent; \
  178. opts = to_f_uvc_opts(opts_item); \
  179. pd = &opts->uvc_processing; \
  180. \
  181. mutex_lock(&opts->lock); \
  182. result = sprintf(page, "%d\n", conv(pd->aname)); \
  183. mutex_unlock(&opts->lock); \
  184. \
  185. mutex_unlock(su_mutex); \
  186. return result; \
  187. } \
  188. \
  189. UVC_ATTR_RO(uvcg_default_processing_, cname, aname)
  190. #define identity_conv(x) (x)
  191. UVCG_DEFAULT_PROCESSING_ATTR(b_unit_id, bUnitID, identity_conv);
  192. UVCG_DEFAULT_PROCESSING_ATTR(b_source_id, bSourceID, identity_conv);
  193. UVCG_DEFAULT_PROCESSING_ATTR(w_max_multiplier, wMaxMultiplier, le16_to_cpu);
  194. UVCG_DEFAULT_PROCESSING_ATTR(i_processing, iProcessing, identity_conv);
  195. #undef identity_conv
  196. #undef UVCG_DEFAULT_PROCESSING_ATTR
  197. static ssize_t uvcg_default_processing_bm_controls_show(
  198. struct config_item *item, char *page)
  199. {
  200. struct uvcg_default_processing *dp = to_uvcg_default_processing(item);
  201. struct f_uvc_opts *opts;
  202. struct config_item *opts_item;
  203. struct mutex *su_mutex = &dp->group.cg_subsys->su_mutex;
  204. struct uvc_processing_unit_descriptor *pd;
  205. int result, i;
  206. char *pg = page;
  207. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  208. opts_item = dp->group.cg_item.ci_parent->ci_parent->ci_parent;
  209. opts = to_f_uvc_opts(opts_item);
  210. pd = &opts->uvc_processing;
  211. mutex_lock(&opts->lock);
  212. for (result = 0, i = 0; i < pd->bControlSize; ++i) {
  213. result += sprintf(pg, "%d\n", pd->bmControls[i]);
  214. pg = page + result;
  215. }
  216. mutex_unlock(&opts->lock);
  217. mutex_unlock(su_mutex);
  218. return result;
  219. }
  220. UVC_ATTR_RO(uvcg_default_processing_, bm_controls, bmControls);
  221. static struct configfs_attribute *uvcg_default_processing_attrs[] = {
  222. &uvcg_default_processing_attr_b_unit_id,
  223. &uvcg_default_processing_attr_b_source_id,
  224. &uvcg_default_processing_attr_w_max_multiplier,
  225. &uvcg_default_processing_attr_bm_controls,
  226. &uvcg_default_processing_attr_i_processing,
  227. NULL,
  228. };
  229. static struct config_item_type uvcg_default_processing_type = {
  230. .ct_attrs = uvcg_default_processing_attrs,
  231. .ct_owner = THIS_MODULE,
  232. };
  233. /* struct uvcg_processing {}; */
  234. /* control/processing */
  235. static struct uvcg_processing_grp {
  236. struct config_group group;
  237. } uvcg_processing_grp;
  238. static struct config_item_type uvcg_processing_grp_type = {
  239. .ct_owner = THIS_MODULE,
  240. };
  241. /* control/terminal/camera/default */
  242. static struct uvcg_default_camera {
  243. struct config_group group;
  244. } uvcg_default_camera;
  245. static inline struct uvcg_default_camera
  246. *to_uvcg_default_camera(struct config_item *item)
  247. {
  248. return container_of(to_config_group(item),
  249. struct uvcg_default_camera, group);
  250. }
  251. #define UVCG_DEFAULT_CAMERA_ATTR(cname, aname, conv) \
  252. static ssize_t uvcg_default_camera_##cname##_show( \
  253. struct config_item *item, char *page) \
  254. { \
  255. struct uvcg_default_camera *dc = to_uvcg_default_camera(item); \
  256. struct f_uvc_opts *opts; \
  257. struct config_item *opts_item; \
  258. struct mutex *su_mutex = &dc->group.cg_subsys->su_mutex; \
  259. struct uvc_camera_terminal_descriptor *cd; \
  260. int result; \
  261. \
  262. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  263. \
  264. opts_item = dc->group.cg_item.ci_parent->ci_parent->ci_parent-> \
  265. ci_parent; \
  266. opts = to_f_uvc_opts(opts_item); \
  267. cd = &opts->uvc_camera_terminal; \
  268. \
  269. mutex_lock(&opts->lock); \
  270. result = sprintf(page, "%d\n", conv(cd->aname)); \
  271. mutex_unlock(&opts->lock); \
  272. \
  273. mutex_unlock(su_mutex); \
  274. \
  275. return result; \
  276. } \
  277. \
  278. UVC_ATTR_RO(uvcg_default_camera_, cname, aname)
  279. #define identity_conv(x) (x)
  280. UVCG_DEFAULT_CAMERA_ATTR(b_terminal_id, bTerminalID, identity_conv);
  281. UVCG_DEFAULT_CAMERA_ATTR(w_terminal_type, wTerminalType, le16_to_cpu);
  282. UVCG_DEFAULT_CAMERA_ATTR(b_assoc_terminal, bAssocTerminal, identity_conv);
  283. UVCG_DEFAULT_CAMERA_ATTR(i_terminal, iTerminal, identity_conv);
  284. UVCG_DEFAULT_CAMERA_ATTR(w_objective_focal_length_min, wObjectiveFocalLengthMin,
  285. le16_to_cpu);
  286. UVCG_DEFAULT_CAMERA_ATTR(w_objective_focal_length_max, wObjectiveFocalLengthMax,
  287. le16_to_cpu);
  288. UVCG_DEFAULT_CAMERA_ATTR(w_ocular_focal_length, wOcularFocalLength,
  289. le16_to_cpu);
  290. #undef identity_conv
  291. #undef UVCG_DEFAULT_CAMERA_ATTR
  292. static ssize_t uvcg_default_camera_bm_controls_show(
  293. struct config_item *item, char *page)
  294. {
  295. struct uvcg_default_camera *dc = to_uvcg_default_camera(item);
  296. struct f_uvc_opts *opts;
  297. struct config_item *opts_item;
  298. struct mutex *su_mutex = &dc->group.cg_subsys->su_mutex;
  299. struct uvc_camera_terminal_descriptor *cd;
  300. int result, i;
  301. char *pg = page;
  302. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  303. opts_item = dc->group.cg_item.ci_parent->ci_parent->ci_parent->
  304. ci_parent;
  305. opts = to_f_uvc_opts(opts_item);
  306. cd = &opts->uvc_camera_terminal;
  307. mutex_lock(&opts->lock);
  308. for (result = 0, i = 0; i < cd->bControlSize; ++i) {
  309. result += sprintf(pg, "%d\n", cd->bmControls[i]);
  310. pg = page + result;
  311. }
  312. mutex_unlock(&opts->lock);
  313. mutex_unlock(su_mutex);
  314. return result;
  315. }
  316. UVC_ATTR_RO(uvcg_default_camera_, bm_controls, bmControls);
  317. static struct configfs_attribute *uvcg_default_camera_attrs[] = {
  318. &uvcg_default_camera_attr_b_terminal_id,
  319. &uvcg_default_camera_attr_w_terminal_type,
  320. &uvcg_default_camera_attr_b_assoc_terminal,
  321. &uvcg_default_camera_attr_i_terminal,
  322. &uvcg_default_camera_attr_w_objective_focal_length_min,
  323. &uvcg_default_camera_attr_w_objective_focal_length_max,
  324. &uvcg_default_camera_attr_w_ocular_focal_length,
  325. &uvcg_default_camera_attr_bm_controls,
  326. NULL,
  327. };
  328. static struct config_item_type uvcg_default_camera_type = {
  329. .ct_attrs = uvcg_default_camera_attrs,
  330. .ct_owner = THIS_MODULE,
  331. };
  332. /* struct uvcg_camera {}; */
  333. /* control/terminal/camera */
  334. static struct uvcg_camera_grp {
  335. struct config_group group;
  336. } uvcg_camera_grp;
  337. static struct config_item_type uvcg_camera_grp_type = {
  338. .ct_owner = THIS_MODULE,
  339. };
  340. /* control/terminal/output/default */
  341. static struct uvcg_default_output {
  342. struct config_group group;
  343. } uvcg_default_output;
  344. static inline struct uvcg_default_output
  345. *to_uvcg_default_output(struct config_item *item)
  346. {
  347. return container_of(to_config_group(item),
  348. struct uvcg_default_output, group);
  349. }
  350. #define UVCG_DEFAULT_OUTPUT_ATTR(cname, aname, conv) \
  351. static ssize_t uvcg_default_output_##cname##_show( \
  352. struct config_item *item, char *page) \
  353. { \
  354. struct uvcg_default_output *dout = to_uvcg_default_output(item); \
  355. struct f_uvc_opts *opts; \
  356. struct config_item *opts_item; \
  357. struct mutex *su_mutex = &dout->group.cg_subsys->su_mutex; \
  358. struct uvc_output_terminal_descriptor *cd; \
  359. int result; \
  360. \
  361. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  362. \
  363. opts_item = dout->group.cg_item.ci_parent->ci_parent-> \
  364. ci_parent->ci_parent; \
  365. opts = to_f_uvc_opts(opts_item); \
  366. cd = &opts->uvc_output_terminal; \
  367. \
  368. mutex_lock(&opts->lock); \
  369. result = sprintf(page, "%d\n", conv(cd->aname)); \
  370. mutex_unlock(&opts->lock); \
  371. \
  372. mutex_unlock(su_mutex); \
  373. \
  374. return result; \
  375. } \
  376. \
  377. UVC_ATTR_RO(uvcg_default_output_, cname, aname)
  378. #define identity_conv(x) (x)
  379. UVCG_DEFAULT_OUTPUT_ATTR(b_terminal_id, bTerminalID, identity_conv);
  380. UVCG_DEFAULT_OUTPUT_ATTR(w_terminal_type, wTerminalType, le16_to_cpu);
  381. UVCG_DEFAULT_OUTPUT_ATTR(b_assoc_terminal, bAssocTerminal, identity_conv);
  382. UVCG_DEFAULT_OUTPUT_ATTR(b_source_id, bSourceID, identity_conv);
  383. UVCG_DEFAULT_OUTPUT_ATTR(i_terminal, iTerminal, identity_conv);
  384. #undef identity_conv
  385. #undef UVCG_DEFAULT_OUTPUT_ATTR
  386. static struct configfs_attribute *uvcg_default_output_attrs[] = {
  387. &uvcg_default_output_attr_b_terminal_id,
  388. &uvcg_default_output_attr_w_terminal_type,
  389. &uvcg_default_output_attr_b_assoc_terminal,
  390. &uvcg_default_output_attr_b_source_id,
  391. &uvcg_default_output_attr_i_terminal,
  392. NULL,
  393. };
  394. static struct config_item_type uvcg_default_output_type = {
  395. .ct_attrs = uvcg_default_output_attrs,
  396. .ct_owner = THIS_MODULE,
  397. };
  398. /* struct uvcg_output {}; */
  399. /* control/terminal/output */
  400. static struct uvcg_output_grp {
  401. struct config_group group;
  402. } uvcg_output_grp;
  403. static struct config_item_type uvcg_output_grp_type = {
  404. .ct_owner = THIS_MODULE,
  405. };
  406. /* control/terminal */
  407. static struct uvcg_terminal_grp {
  408. struct config_group group;
  409. } uvcg_terminal_grp;
  410. static struct config_item_type uvcg_terminal_grp_type = {
  411. .ct_owner = THIS_MODULE,
  412. };
  413. /* control/class/{fs} */
  414. static struct uvcg_control_class {
  415. struct config_group group;
  416. } uvcg_control_class_fs, uvcg_control_class_ss;
  417. static inline struct uvc_descriptor_header
  418. **uvcg_get_ctl_class_arr(struct config_item *i, struct f_uvc_opts *o)
  419. {
  420. struct uvcg_control_class *cl = container_of(to_config_group(i),
  421. struct uvcg_control_class, group);
  422. if (cl == &uvcg_control_class_fs)
  423. return o->uvc_fs_control_cls;
  424. if (cl == &uvcg_control_class_ss)
  425. return o->uvc_ss_control_cls;
  426. return NULL;
  427. }
  428. static int uvcg_control_class_allow_link(struct config_item *src,
  429. struct config_item *target)
  430. {
  431. struct config_item *control, *header;
  432. struct f_uvc_opts *opts;
  433. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  434. struct uvc_descriptor_header **class_array;
  435. struct uvcg_control_header *target_hdr;
  436. int ret = -EINVAL;
  437. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  438. control = src->ci_parent->ci_parent;
  439. header = config_group_find_item(to_config_group(control), "header");
  440. if (!header || target->ci_parent != header)
  441. goto out;
  442. opts = to_f_uvc_opts(control->ci_parent);
  443. mutex_lock(&opts->lock);
  444. class_array = uvcg_get_ctl_class_arr(src, opts);
  445. if (!class_array)
  446. goto unlock;
  447. if (opts->refcnt || class_array[0]) {
  448. ret = -EBUSY;
  449. goto unlock;
  450. }
  451. target_hdr = to_uvcg_control_header(target);
  452. ++target_hdr->linked;
  453. class_array[0] = (struct uvc_descriptor_header *)&target_hdr->desc;
  454. ret = 0;
  455. unlock:
  456. mutex_unlock(&opts->lock);
  457. out:
  458. mutex_unlock(su_mutex);
  459. return ret;
  460. }
  461. static void uvcg_control_class_drop_link(struct config_item *src,
  462. struct config_item *target)
  463. {
  464. struct config_item *control, *header;
  465. struct f_uvc_opts *opts;
  466. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  467. struct uvc_descriptor_header **class_array;
  468. struct uvcg_control_header *target_hdr;
  469. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  470. control = src->ci_parent->ci_parent;
  471. header = config_group_find_item(to_config_group(control), "header");
  472. if (!header || target->ci_parent != header)
  473. goto out;
  474. opts = to_f_uvc_opts(control->ci_parent);
  475. mutex_lock(&opts->lock);
  476. class_array = uvcg_get_ctl_class_arr(src, opts);
  477. if (!class_array || opts->refcnt)
  478. goto unlock;
  479. target_hdr = to_uvcg_control_header(target);
  480. --target_hdr->linked;
  481. class_array[0] = NULL;
  482. unlock:
  483. mutex_unlock(&opts->lock);
  484. out:
  485. mutex_unlock(su_mutex);
  486. }
  487. static struct configfs_item_operations uvcg_control_class_item_ops = {
  488. .allow_link = uvcg_control_class_allow_link,
  489. .drop_link = uvcg_control_class_drop_link,
  490. };
  491. static struct config_item_type uvcg_control_class_type = {
  492. .ct_item_ops = &uvcg_control_class_item_ops,
  493. .ct_owner = THIS_MODULE,
  494. };
  495. /* control/class */
  496. static struct uvcg_control_class_grp {
  497. struct config_group group;
  498. } uvcg_control_class_grp;
  499. static struct config_item_type uvcg_control_class_grp_type = {
  500. .ct_owner = THIS_MODULE,
  501. };
  502. /* control */
  503. static struct uvcg_control_grp {
  504. struct config_group group;
  505. } uvcg_control_grp;
  506. static struct config_item_type uvcg_control_grp_type = {
  507. .ct_owner = THIS_MODULE,
  508. };
  509. /* streaming/uncompressed */
  510. static struct uvcg_uncompressed_grp {
  511. struct config_group group;
  512. } uvcg_uncompressed_grp;
  513. /* streaming/mjpeg */
  514. static struct uvcg_mjpeg_grp {
  515. struct config_group group;
  516. } uvcg_mjpeg_grp;
  517. static struct config_item *fmt_parent[] = {
  518. &uvcg_uncompressed_grp.group.cg_item,
  519. &uvcg_mjpeg_grp.group.cg_item,
  520. };
  521. enum uvcg_format_type {
  522. UVCG_UNCOMPRESSED = 0,
  523. UVCG_MJPEG,
  524. };
  525. struct uvcg_format {
  526. struct config_group group;
  527. enum uvcg_format_type type;
  528. unsigned linked;
  529. unsigned num_frames;
  530. __u8 bmaControls[UVCG_STREAMING_CONTROL_SIZE];
  531. };
  532. static struct uvcg_format *to_uvcg_format(struct config_item *item)
  533. {
  534. return container_of(to_config_group(item), struct uvcg_format, group);
  535. }
  536. static ssize_t uvcg_format_bma_controls_show(struct uvcg_format *f, char *page)
  537. {
  538. struct f_uvc_opts *opts;
  539. struct config_item *opts_item;
  540. struct mutex *su_mutex = &f->group.cg_subsys->su_mutex;
  541. int result, i;
  542. char *pg = page;
  543. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  544. opts_item = f->group.cg_item.ci_parent->ci_parent->ci_parent;
  545. opts = to_f_uvc_opts(opts_item);
  546. mutex_lock(&opts->lock);
  547. result = sprintf(pg, "0x");
  548. pg += result;
  549. for (i = 0; i < UVCG_STREAMING_CONTROL_SIZE; ++i) {
  550. result += sprintf(pg, "%x\n", f->bmaControls[i]);
  551. pg = page + result;
  552. }
  553. mutex_unlock(&opts->lock);
  554. mutex_unlock(su_mutex);
  555. return result;
  556. }
  557. static ssize_t uvcg_format_bma_controls_store(struct uvcg_format *ch,
  558. const char *page, size_t len)
  559. {
  560. struct f_uvc_opts *opts;
  561. struct config_item *opts_item;
  562. struct mutex *su_mutex = &ch->group.cg_subsys->su_mutex;
  563. int ret = -EINVAL;
  564. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  565. opts_item = ch->group.cg_item.ci_parent->ci_parent->ci_parent;
  566. opts = to_f_uvc_opts(opts_item);
  567. mutex_lock(&opts->lock);
  568. if (ch->linked || opts->refcnt) {
  569. ret = -EBUSY;
  570. goto end;
  571. }
  572. if (len < 4 || *page != '0' ||
  573. (*(page + 1) != 'x' && *(page + 1) != 'X'))
  574. goto end;
  575. ret = hex2bin(ch->bmaControls, page + 2, 1);
  576. if (ret < 0)
  577. goto end;
  578. ret = len;
  579. end:
  580. mutex_unlock(&opts->lock);
  581. mutex_unlock(su_mutex);
  582. return ret;
  583. }
  584. struct uvcg_format_ptr {
  585. struct uvcg_format *fmt;
  586. struct list_head entry;
  587. };
  588. /* streaming/header/<NAME> */
  589. struct uvcg_streaming_header {
  590. struct config_item item;
  591. struct uvc_input_header_descriptor desc;
  592. unsigned linked;
  593. struct list_head formats;
  594. unsigned num_fmt;
  595. };
  596. static struct uvcg_streaming_header *to_uvcg_streaming_header(struct config_item *item)
  597. {
  598. return container_of(item, struct uvcg_streaming_header, item);
  599. }
  600. static int uvcg_streaming_header_allow_link(struct config_item *src,
  601. struct config_item *target)
  602. {
  603. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  604. struct config_item *opts_item;
  605. struct f_uvc_opts *opts;
  606. struct uvcg_streaming_header *src_hdr;
  607. struct uvcg_format *target_fmt = NULL;
  608. struct uvcg_format_ptr *format_ptr;
  609. int i, ret = -EINVAL;
  610. src_hdr = to_uvcg_streaming_header(src);
  611. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  612. opts_item = src->ci_parent->ci_parent->ci_parent;
  613. opts = to_f_uvc_opts(opts_item);
  614. mutex_lock(&opts->lock);
  615. if (src_hdr->linked) {
  616. ret = -EBUSY;
  617. goto out;
  618. }
  619. for (i = 0; i < ARRAY_SIZE(fmt_parent); ++i)
  620. if (target->ci_parent == fmt_parent[i])
  621. break;
  622. if (i == ARRAY_SIZE(fmt_parent))
  623. goto out;
  624. target_fmt = container_of(to_config_group(target), struct uvcg_format,
  625. group);
  626. if (!target_fmt)
  627. goto out;
  628. format_ptr = kzalloc(sizeof(*format_ptr), GFP_KERNEL);
  629. if (!format_ptr) {
  630. ret = -ENOMEM;
  631. goto out;
  632. }
  633. ret = 0;
  634. format_ptr->fmt = target_fmt;
  635. list_add_tail(&format_ptr->entry, &src_hdr->formats);
  636. ++src_hdr->num_fmt;
  637. out:
  638. mutex_unlock(&opts->lock);
  639. mutex_unlock(su_mutex);
  640. return ret;
  641. }
  642. static void uvcg_streaming_header_drop_link(struct config_item *src,
  643. struct config_item *target)
  644. {
  645. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  646. struct config_item *opts_item;
  647. struct f_uvc_opts *opts;
  648. struct uvcg_streaming_header *src_hdr;
  649. struct uvcg_format *target_fmt = NULL;
  650. struct uvcg_format_ptr *format_ptr, *tmp;
  651. src_hdr = to_uvcg_streaming_header(src);
  652. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  653. opts_item = src->ci_parent->ci_parent->ci_parent;
  654. opts = to_f_uvc_opts(opts_item);
  655. mutex_lock(&opts->lock);
  656. target_fmt = container_of(to_config_group(target), struct uvcg_format,
  657. group);
  658. if (!target_fmt)
  659. goto out;
  660. list_for_each_entry_safe(format_ptr, tmp, &src_hdr->formats, entry)
  661. if (format_ptr->fmt == target_fmt) {
  662. list_del(&format_ptr->entry);
  663. kfree(format_ptr);
  664. --src_hdr->num_fmt;
  665. break;
  666. }
  667. out:
  668. mutex_unlock(&opts->lock);
  669. mutex_unlock(su_mutex);
  670. }
  671. static struct configfs_item_operations uvcg_streaming_header_item_ops = {
  672. .allow_link = uvcg_streaming_header_allow_link,
  673. .drop_link = uvcg_streaming_header_drop_link,
  674. };
  675. #define UVCG_STREAMING_HEADER_ATTR(cname, aname, conv) \
  676. static ssize_t uvcg_streaming_header_##cname##_show( \
  677. struct config_item *item, char *page) \
  678. { \
  679. struct uvcg_streaming_header *sh = to_uvcg_streaming_header(item); \
  680. struct f_uvc_opts *opts; \
  681. struct config_item *opts_item; \
  682. struct mutex *su_mutex = &sh->item.ci_group->cg_subsys->su_mutex;\
  683. int result; \
  684. \
  685. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  686. \
  687. opts_item = sh->item.ci_parent->ci_parent->ci_parent; \
  688. opts = to_f_uvc_opts(opts_item); \
  689. \
  690. mutex_lock(&opts->lock); \
  691. result = sprintf(page, "%d\n", conv(sh->desc.aname)); \
  692. mutex_unlock(&opts->lock); \
  693. \
  694. mutex_unlock(su_mutex); \
  695. return result; \
  696. } \
  697. \
  698. UVC_ATTR_RO(uvcg_streaming_header_, cname, aname)
  699. #define identity_conv(x) (x)
  700. UVCG_STREAMING_HEADER_ATTR(bm_info, bmInfo, identity_conv);
  701. UVCG_STREAMING_HEADER_ATTR(b_terminal_link, bTerminalLink, identity_conv);
  702. UVCG_STREAMING_HEADER_ATTR(b_still_capture_method, bStillCaptureMethod,
  703. identity_conv);
  704. UVCG_STREAMING_HEADER_ATTR(b_trigger_support, bTriggerSupport, identity_conv);
  705. UVCG_STREAMING_HEADER_ATTR(b_trigger_usage, bTriggerUsage, identity_conv);
  706. #undef identity_conv
  707. #undef UVCG_STREAMING_HEADER_ATTR
  708. static struct configfs_attribute *uvcg_streaming_header_attrs[] = {
  709. &uvcg_streaming_header_attr_bm_info,
  710. &uvcg_streaming_header_attr_b_terminal_link,
  711. &uvcg_streaming_header_attr_b_still_capture_method,
  712. &uvcg_streaming_header_attr_b_trigger_support,
  713. &uvcg_streaming_header_attr_b_trigger_usage,
  714. NULL,
  715. };
  716. static struct config_item_type uvcg_streaming_header_type = {
  717. .ct_item_ops = &uvcg_streaming_header_item_ops,
  718. .ct_attrs = uvcg_streaming_header_attrs,
  719. .ct_owner = THIS_MODULE,
  720. };
  721. static struct config_item
  722. *uvcg_streaming_header_make(struct config_group *group, const char *name)
  723. {
  724. struct uvcg_streaming_header *h;
  725. h = kzalloc(sizeof(*h), GFP_KERNEL);
  726. if (!h)
  727. return ERR_PTR(-ENOMEM);
  728. INIT_LIST_HEAD(&h->formats);
  729. h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  730. h->desc.bDescriptorSubType = UVC_VS_INPUT_HEADER;
  731. h->desc.bTerminalLink = 3;
  732. h->desc.bControlSize = UVCG_STREAMING_CONTROL_SIZE;
  733. config_item_init_type_name(&h->item, name, &uvcg_streaming_header_type);
  734. return &h->item;
  735. }
  736. static void uvcg_streaming_header_drop(struct config_group *group,
  737. struct config_item *item)
  738. {
  739. struct uvcg_streaming_header *h = to_uvcg_streaming_header(item);
  740. kfree(h);
  741. }
  742. /* streaming/header */
  743. static struct uvcg_streaming_header_grp {
  744. struct config_group group;
  745. } uvcg_streaming_header_grp;
  746. static struct configfs_group_operations uvcg_streaming_header_grp_ops = {
  747. .make_item = uvcg_streaming_header_make,
  748. .drop_item = uvcg_streaming_header_drop,
  749. };
  750. static struct config_item_type uvcg_streaming_header_grp_type = {
  751. .ct_group_ops = &uvcg_streaming_header_grp_ops,
  752. .ct_owner = THIS_MODULE,
  753. };
  754. /* streaming/<mode>/<format>/<NAME> */
  755. struct uvcg_frame {
  756. struct {
  757. u8 b_length;
  758. u8 b_descriptor_type;
  759. u8 b_descriptor_subtype;
  760. u8 b_frame_index;
  761. u8 bm_capabilities;
  762. u16 w_width;
  763. u16 w_height;
  764. u32 dw_min_bit_rate;
  765. u32 dw_max_bit_rate;
  766. u32 dw_max_video_frame_buffer_size;
  767. u32 dw_default_frame_interval;
  768. u8 b_frame_interval_type;
  769. } __attribute__((packed)) frame;
  770. u32 *dw_frame_interval;
  771. enum uvcg_format_type fmt_type;
  772. struct config_item item;
  773. };
  774. static struct uvcg_frame *to_uvcg_frame(struct config_item *item)
  775. {
  776. return container_of(item, struct uvcg_frame, item);
  777. }
  778. #define UVCG_FRAME_ATTR(cname, aname, to_cpu_endian, to_little_endian, bits) \
  779. static ssize_t uvcg_frame_##cname##_show(struct config_item *item, char *page)\
  780. { \
  781. struct uvcg_frame *f = to_uvcg_frame(item); \
  782. struct f_uvc_opts *opts; \
  783. struct config_item *opts_item; \
  784. struct mutex *su_mutex = &f->item.ci_group->cg_subsys->su_mutex;\
  785. int result; \
  786. \
  787. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  788. \
  789. opts_item = f->item.ci_parent->ci_parent->ci_parent->ci_parent; \
  790. opts = to_f_uvc_opts(opts_item); \
  791. \
  792. mutex_lock(&opts->lock); \
  793. result = sprintf(page, "%d\n", to_cpu_endian(f->frame.cname)); \
  794. mutex_unlock(&opts->lock); \
  795. \
  796. mutex_unlock(su_mutex); \
  797. return result; \
  798. } \
  799. \
  800. static ssize_t uvcg_frame_##cname##_store(struct config_item *item, \
  801. const char *page, size_t len)\
  802. { \
  803. struct uvcg_frame *f = to_uvcg_frame(item); \
  804. struct f_uvc_opts *opts; \
  805. struct config_item *opts_item; \
  806. struct uvcg_format *fmt; \
  807. struct mutex *su_mutex = &f->item.ci_group->cg_subsys->su_mutex;\
  808. int ret; \
  809. u##bits num; \
  810. \
  811. ret = kstrtou##bits(page, 0, &num); \
  812. if (ret) \
  813. return ret; \
  814. \
  815. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  816. \
  817. opts_item = f->item.ci_parent->ci_parent->ci_parent->ci_parent; \
  818. opts = to_f_uvc_opts(opts_item); \
  819. fmt = to_uvcg_format(f->item.ci_parent); \
  820. \
  821. mutex_lock(&opts->lock); \
  822. if (fmt->linked || opts->refcnt) { \
  823. ret = -EBUSY; \
  824. goto end; \
  825. } \
  826. \
  827. f->frame.cname = to_little_endian(num); \
  828. ret = len; \
  829. end: \
  830. mutex_unlock(&opts->lock); \
  831. mutex_unlock(su_mutex); \
  832. return ret; \
  833. } \
  834. \
  835. UVC_ATTR(uvcg_frame_, cname, aname);
  836. #define noop_conversion(x) (x)
  837. UVCG_FRAME_ATTR(bm_capabilities, bmCapabilities, noop_conversion,
  838. noop_conversion, 8);
  839. UVCG_FRAME_ATTR(w_width, wWidth, le16_to_cpu, cpu_to_le16, 16);
  840. UVCG_FRAME_ATTR(w_height, wHeight, le16_to_cpu, cpu_to_le16, 16);
  841. UVCG_FRAME_ATTR(dw_min_bit_rate, dwMinBitRate, le32_to_cpu, cpu_to_le32, 32);
  842. UVCG_FRAME_ATTR(dw_max_bit_rate, dwMaxBitRate, le32_to_cpu, cpu_to_le32, 32);
  843. UVCG_FRAME_ATTR(dw_max_video_frame_buffer_size, dwMaxVideoFrameBufferSize,
  844. le32_to_cpu, cpu_to_le32, 32);
  845. UVCG_FRAME_ATTR(dw_default_frame_interval, dwDefaultFrameInterval,
  846. le32_to_cpu, cpu_to_le32, 32);
  847. #undef noop_conversion
  848. #undef UVCG_FRAME_ATTR
  849. static ssize_t uvcg_frame_dw_frame_interval_show(struct config_item *item,
  850. char *page)
  851. {
  852. struct uvcg_frame *frm = to_uvcg_frame(item);
  853. struct f_uvc_opts *opts;
  854. struct config_item *opts_item;
  855. struct mutex *su_mutex = &frm->item.ci_group->cg_subsys->su_mutex;
  856. int result, i;
  857. char *pg = page;
  858. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  859. opts_item = frm->item.ci_parent->ci_parent->ci_parent->ci_parent;
  860. opts = to_f_uvc_opts(opts_item);
  861. mutex_lock(&opts->lock);
  862. for (result = 0, i = 0; i < frm->frame.b_frame_interval_type; ++i) {
  863. result += sprintf(pg, "%d\n",
  864. le32_to_cpu(frm->dw_frame_interval[i]));
  865. pg = page + result;
  866. }
  867. mutex_unlock(&opts->lock);
  868. mutex_unlock(su_mutex);
  869. return result;
  870. }
  871. static inline int __uvcg_count_frm_intrv(char *buf, void *priv)
  872. {
  873. ++*((int *)priv);
  874. return 0;
  875. }
  876. static inline int __uvcg_fill_frm_intrv(char *buf, void *priv)
  877. {
  878. u32 num, **interv;
  879. int ret;
  880. ret = kstrtou32(buf, 0, &num);
  881. if (ret)
  882. return ret;
  883. interv = priv;
  884. **interv = cpu_to_le32(num);
  885. ++*interv;
  886. return 0;
  887. }
  888. static int __uvcg_iter_frm_intrv(const char *page, size_t len,
  889. int (*fun)(char *, void *), void *priv)
  890. {
  891. /* sign, base 2 representation, newline, terminator */
  892. char buf[1 + sizeof(u32) * 8 + 1 + 1];
  893. const char *pg = page;
  894. int i, ret;
  895. if (!fun)
  896. return -EINVAL;
  897. while (pg - page < len) {
  898. i = 0;
  899. while (i < sizeof(buf) && (pg - page < len) &&
  900. *pg != '\0' && *pg != '\n')
  901. buf[i++] = *pg++;
  902. if (i == sizeof(buf))
  903. return -EINVAL;
  904. while ((pg - page < len) && (*pg == '\0' || *pg == '\n'))
  905. ++pg;
  906. buf[i] = '\0';
  907. ret = fun(buf, priv);
  908. if (ret)
  909. return ret;
  910. }
  911. return 0;
  912. }
  913. static ssize_t uvcg_frame_dw_frame_interval_store(struct config_item *item,
  914. const char *page, size_t len)
  915. {
  916. struct uvcg_frame *ch = to_uvcg_frame(item);
  917. struct f_uvc_opts *opts;
  918. struct config_item *opts_item;
  919. struct uvcg_format *fmt;
  920. struct mutex *su_mutex = &ch->item.ci_group->cg_subsys->su_mutex;
  921. int ret = 0, n = 0;
  922. u32 *frm_intrv, *tmp;
  923. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  924. opts_item = ch->item.ci_parent->ci_parent->ci_parent->ci_parent;
  925. opts = to_f_uvc_opts(opts_item);
  926. fmt = to_uvcg_format(ch->item.ci_parent);
  927. mutex_lock(&opts->lock);
  928. if (fmt->linked || opts->refcnt) {
  929. ret = -EBUSY;
  930. goto end;
  931. }
  932. ret = __uvcg_iter_frm_intrv(page, len, __uvcg_count_frm_intrv, &n);
  933. if (ret)
  934. goto end;
  935. tmp = frm_intrv = kcalloc(n, sizeof(u32), GFP_KERNEL);
  936. if (!frm_intrv) {
  937. ret = -ENOMEM;
  938. goto end;
  939. }
  940. ret = __uvcg_iter_frm_intrv(page, len, __uvcg_fill_frm_intrv, &tmp);
  941. if (ret) {
  942. kfree(frm_intrv);
  943. goto end;
  944. }
  945. kfree(ch->dw_frame_interval);
  946. ch->dw_frame_interval = frm_intrv;
  947. ch->frame.b_frame_interval_type = n;
  948. ret = len;
  949. end:
  950. mutex_unlock(&opts->lock);
  951. mutex_unlock(su_mutex);
  952. return ret;
  953. }
  954. UVC_ATTR(uvcg_frame_, dw_frame_interval, dwFrameInterval);
  955. static struct configfs_attribute *uvcg_frame_attrs[] = {
  956. &uvcg_frame_attr_bm_capabilities,
  957. &uvcg_frame_attr_w_width,
  958. &uvcg_frame_attr_w_height,
  959. &uvcg_frame_attr_dw_min_bit_rate,
  960. &uvcg_frame_attr_dw_max_bit_rate,
  961. &uvcg_frame_attr_dw_max_video_frame_buffer_size,
  962. &uvcg_frame_attr_dw_default_frame_interval,
  963. &uvcg_frame_attr_dw_frame_interval,
  964. NULL,
  965. };
  966. static struct config_item_type uvcg_frame_type = {
  967. .ct_attrs = uvcg_frame_attrs,
  968. .ct_owner = THIS_MODULE,
  969. };
  970. static struct config_item *uvcg_frame_make(struct config_group *group,
  971. const char *name)
  972. {
  973. struct uvcg_frame *h;
  974. struct uvcg_format *fmt;
  975. struct f_uvc_opts *opts;
  976. struct config_item *opts_item;
  977. h = kzalloc(sizeof(*h), GFP_KERNEL);
  978. if (!h)
  979. return ERR_PTR(-ENOMEM);
  980. h->frame.b_descriptor_type = USB_DT_CS_INTERFACE;
  981. h->frame.b_frame_index = 1;
  982. h->frame.w_width = cpu_to_le16(640);
  983. h->frame.w_height = cpu_to_le16(360);
  984. h->frame.dw_min_bit_rate = cpu_to_le32(18432000);
  985. h->frame.dw_max_bit_rate = cpu_to_le32(55296000);
  986. h->frame.dw_max_video_frame_buffer_size = cpu_to_le32(460800);
  987. h->frame.dw_default_frame_interval = cpu_to_le32(666666);
  988. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent;
  989. opts = to_f_uvc_opts(opts_item);
  990. mutex_lock(&opts->lock);
  991. fmt = to_uvcg_format(&group->cg_item);
  992. if (fmt->type == UVCG_UNCOMPRESSED) {
  993. h->frame.b_descriptor_subtype = UVC_VS_FRAME_UNCOMPRESSED;
  994. h->fmt_type = UVCG_UNCOMPRESSED;
  995. } else if (fmt->type == UVCG_MJPEG) {
  996. h->frame.b_descriptor_subtype = UVC_VS_FRAME_MJPEG;
  997. h->fmt_type = UVCG_MJPEG;
  998. } else {
  999. mutex_unlock(&opts->lock);
  1000. kfree(h);
  1001. return ERR_PTR(-EINVAL);
  1002. }
  1003. ++fmt->num_frames;
  1004. mutex_unlock(&opts->lock);
  1005. config_item_init_type_name(&h->item, name, &uvcg_frame_type);
  1006. return &h->item;
  1007. }
  1008. static void uvcg_frame_drop(struct config_group *group, struct config_item *item)
  1009. {
  1010. struct uvcg_frame *h = to_uvcg_frame(item);
  1011. struct uvcg_format *fmt;
  1012. struct f_uvc_opts *opts;
  1013. struct config_item *opts_item;
  1014. opts_item = group->cg_item.ci_parent->ci_parent->ci_parent;
  1015. opts = to_f_uvc_opts(opts_item);
  1016. mutex_lock(&opts->lock);
  1017. fmt = to_uvcg_format(&group->cg_item);
  1018. --fmt->num_frames;
  1019. kfree(h);
  1020. mutex_unlock(&opts->lock);
  1021. }
  1022. /* streaming/uncompressed/<NAME> */
  1023. struct uvcg_uncompressed {
  1024. struct uvcg_format fmt;
  1025. struct uvc_format_uncompressed desc;
  1026. };
  1027. static struct uvcg_uncompressed *to_uvcg_uncompressed(struct config_item *item)
  1028. {
  1029. return container_of(
  1030. container_of(to_config_group(item), struct uvcg_format, group),
  1031. struct uvcg_uncompressed, fmt);
  1032. }
  1033. static struct configfs_group_operations uvcg_uncompressed_group_ops = {
  1034. .make_item = uvcg_frame_make,
  1035. .drop_item = uvcg_frame_drop,
  1036. };
  1037. static ssize_t uvcg_uncompressed_guid_format_show(struct config_item *item,
  1038. char *page)
  1039. {
  1040. struct uvcg_uncompressed *ch = to_uvcg_uncompressed(item);
  1041. struct f_uvc_opts *opts;
  1042. struct config_item *opts_item;
  1043. struct mutex *su_mutex = &ch->fmt.group.cg_subsys->su_mutex;
  1044. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1045. opts_item = ch->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;
  1046. opts = to_f_uvc_opts(opts_item);
  1047. mutex_lock(&opts->lock);
  1048. memcpy(page, ch->desc.guidFormat, sizeof(ch->desc.guidFormat));
  1049. mutex_unlock(&opts->lock);
  1050. mutex_unlock(su_mutex);
  1051. return sizeof(ch->desc.guidFormat);
  1052. }
  1053. static ssize_t uvcg_uncompressed_guid_format_store(struct config_item *item,
  1054. const char *page, size_t len)
  1055. {
  1056. struct uvcg_uncompressed *ch = to_uvcg_uncompressed(item);
  1057. struct f_uvc_opts *opts;
  1058. struct config_item *opts_item;
  1059. struct mutex *su_mutex = &ch->fmt.group.cg_subsys->su_mutex;
  1060. int ret;
  1061. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1062. opts_item = ch->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;
  1063. opts = to_f_uvc_opts(opts_item);
  1064. mutex_lock(&opts->lock);
  1065. if (ch->fmt.linked || opts->refcnt) {
  1066. ret = -EBUSY;
  1067. goto end;
  1068. }
  1069. memcpy(ch->desc.guidFormat, page,
  1070. min(sizeof(ch->desc.guidFormat), len));
  1071. ret = sizeof(ch->desc.guidFormat);
  1072. end:
  1073. mutex_unlock(&opts->lock);
  1074. mutex_unlock(su_mutex);
  1075. return ret;
  1076. }
  1077. UVC_ATTR(uvcg_uncompressed_, guid_format, guidFormat);
  1078. #define UVCG_UNCOMPRESSED_ATTR_RO(cname, aname, conv) \
  1079. static ssize_t uvcg_uncompressed_##cname##_show( \
  1080. struct config_item *item, char *page) \
  1081. { \
  1082. struct uvcg_uncompressed *u = to_uvcg_uncompressed(item); \
  1083. struct f_uvc_opts *opts; \
  1084. struct config_item *opts_item; \
  1085. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  1086. int result; \
  1087. \
  1088. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1089. \
  1090. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  1091. opts = to_f_uvc_opts(opts_item); \
  1092. \
  1093. mutex_lock(&opts->lock); \
  1094. result = sprintf(page, "%d\n", conv(u->desc.aname)); \
  1095. mutex_unlock(&opts->lock); \
  1096. \
  1097. mutex_unlock(su_mutex); \
  1098. return result; \
  1099. } \
  1100. \
  1101. UVC_ATTR_RO(uvcg_uncompressed_, cname, aname);
  1102. #define UVCG_UNCOMPRESSED_ATTR(cname, aname, conv) \
  1103. static ssize_t uvcg_uncompressed_##cname##_show( \
  1104. struct config_item *item, char *page) \
  1105. { \
  1106. struct uvcg_uncompressed *u = to_uvcg_uncompressed(item); \
  1107. struct f_uvc_opts *opts; \
  1108. struct config_item *opts_item; \
  1109. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  1110. int result; \
  1111. \
  1112. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1113. \
  1114. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  1115. opts = to_f_uvc_opts(opts_item); \
  1116. \
  1117. mutex_lock(&opts->lock); \
  1118. result = sprintf(page, "%d\n", conv(u->desc.aname)); \
  1119. mutex_unlock(&opts->lock); \
  1120. \
  1121. mutex_unlock(su_mutex); \
  1122. return result; \
  1123. } \
  1124. \
  1125. static ssize_t \
  1126. uvcg_uncompressed_##cname##_store(struct config_item *item, \
  1127. const char *page, size_t len) \
  1128. { \
  1129. struct uvcg_uncompressed *u = to_uvcg_uncompressed(item); \
  1130. struct f_uvc_opts *opts; \
  1131. struct config_item *opts_item; \
  1132. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  1133. int ret; \
  1134. u8 num; \
  1135. \
  1136. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1137. \
  1138. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  1139. opts = to_f_uvc_opts(opts_item); \
  1140. \
  1141. mutex_lock(&opts->lock); \
  1142. if (u->fmt.linked || opts->refcnt) { \
  1143. ret = -EBUSY; \
  1144. goto end; \
  1145. } \
  1146. \
  1147. ret = kstrtou8(page, 0, &num); \
  1148. if (ret) \
  1149. goto end; \
  1150. \
  1151. if (num > 255) { \
  1152. ret = -EINVAL; \
  1153. goto end; \
  1154. } \
  1155. u->desc.aname = num; \
  1156. ret = len; \
  1157. end: \
  1158. mutex_unlock(&opts->lock); \
  1159. mutex_unlock(su_mutex); \
  1160. return ret; \
  1161. } \
  1162. \
  1163. UVC_ATTR(uvcg_uncompressed_, cname, aname);
  1164. #define identity_conv(x) (x)
  1165. UVCG_UNCOMPRESSED_ATTR(b_bits_per_pixel, bBitsPerPixel, identity_conv);
  1166. UVCG_UNCOMPRESSED_ATTR(b_default_frame_index, bDefaultFrameIndex,
  1167. identity_conv);
  1168. UVCG_UNCOMPRESSED_ATTR_RO(b_aspect_ratio_x, bAspectRatioX, identity_conv);
  1169. UVCG_UNCOMPRESSED_ATTR_RO(b_aspect_ratio_y, bAspectRatioY, identity_conv);
  1170. UVCG_UNCOMPRESSED_ATTR_RO(bm_interface_flags, bmInterfaceFlags, identity_conv);
  1171. #undef identity_conv
  1172. #undef UVCG_UNCOMPRESSED_ATTR
  1173. #undef UVCG_UNCOMPRESSED_ATTR_RO
  1174. static inline ssize_t
  1175. uvcg_uncompressed_bma_controls_show(struct config_item *item, char *page)
  1176. {
  1177. struct uvcg_uncompressed *unc = to_uvcg_uncompressed(item);
  1178. return uvcg_format_bma_controls_show(&unc->fmt, page);
  1179. }
  1180. static inline ssize_t
  1181. uvcg_uncompressed_bma_controls_store(struct config_item *item,
  1182. const char *page, size_t len)
  1183. {
  1184. struct uvcg_uncompressed *unc = to_uvcg_uncompressed(item);
  1185. return uvcg_format_bma_controls_store(&unc->fmt, page, len);
  1186. }
  1187. UVC_ATTR(uvcg_uncompressed_, bma_controls, bmaControls);
  1188. static struct configfs_attribute *uvcg_uncompressed_attrs[] = {
  1189. &uvcg_uncompressed_attr_guid_format,
  1190. &uvcg_uncompressed_attr_b_bits_per_pixel,
  1191. &uvcg_uncompressed_attr_b_default_frame_index,
  1192. &uvcg_uncompressed_attr_b_aspect_ratio_x,
  1193. &uvcg_uncompressed_attr_b_aspect_ratio_y,
  1194. &uvcg_uncompressed_attr_bm_interface_flags,
  1195. &uvcg_uncompressed_attr_bma_controls,
  1196. NULL,
  1197. };
  1198. static struct config_item_type uvcg_uncompressed_type = {
  1199. .ct_group_ops = &uvcg_uncompressed_group_ops,
  1200. .ct_attrs = uvcg_uncompressed_attrs,
  1201. .ct_owner = THIS_MODULE,
  1202. };
  1203. static struct config_group *uvcg_uncompressed_make(struct config_group *group,
  1204. const char *name)
  1205. {
  1206. static char guid[] = {
  1207. 'Y', 'U', 'Y', '2', 0x00, 0x00, 0x10, 0x00,
  1208. 0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71
  1209. };
  1210. struct uvcg_uncompressed *h;
  1211. h = kzalloc(sizeof(*h), GFP_KERNEL);
  1212. if (!h)
  1213. return ERR_PTR(-ENOMEM);
  1214. h->desc.bLength = UVC_DT_FORMAT_UNCOMPRESSED_SIZE;
  1215. h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  1216. h->desc.bDescriptorSubType = UVC_VS_FORMAT_UNCOMPRESSED;
  1217. memcpy(h->desc.guidFormat, guid, sizeof(guid));
  1218. h->desc.bBitsPerPixel = 16;
  1219. h->desc.bDefaultFrameIndex = 1;
  1220. h->desc.bAspectRatioX = 0;
  1221. h->desc.bAspectRatioY = 0;
  1222. h->desc.bmInterfaceFlags = 0;
  1223. h->desc.bCopyProtect = 0;
  1224. h->fmt.type = UVCG_UNCOMPRESSED;
  1225. config_group_init_type_name(&h->fmt.group, name,
  1226. &uvcg_uncompressed_type);
  1227. return &h->fmt.group;
  1228. }
  1229. static void uvcg_uncompressed_drop(struct config_group *group,
  1230. struct config_item *item)
  1231. {
  1232. struct uvcg_uncompressed *h = to_uvcg_uncompressed(item);
  1233. kfree(h);
  1234. }
  1235. static struct configfs_group_operations uvcg_uncompressed_grp_ops = {
  1236. .make_group = uvcg_uncompressed_make,
  1237. .drop_item = uvcg_uncompressed_drop,
  1238. };
  1239. static struct config_item_type uvcg_uncompressed_grp_type = {
  1240. .ct_group_ops = &uvcg_uncompressed_grp_ops,
  1241. .ct_owner = THIS_MODULE,
  1242. };
  1243. /* streaming/mjpeg/<NAME> */
  1244. struct uvcg_mjpeg {
  1245. struct uvcg_format fmt;
  1246. struct uvc_format_mjpeg desc;
  1247. };
  1248. static struct uvcg_mjpeg *to_uvcg_mjpeg(struct config_item *item)
  1249. {
  1250. return container_of(
  1251. container_of(to_config_group(item), struct uvcg_format, group),
  1252. struct uvcg_mjpeg, fmt);
  1253. }
  1254. static struct configfs_group_operations uvcg_mjpeg_group_ops = {
  1255. .make_item = uvcg_frame_make,
  1256. .drop_item = uvcg_frame_drop,
  1257. };
  1258. #define UVCG_MJPEG_ATTR_RO(cname, aname, conv) \
  1259. static ssize_t uvcg_mjpeg_##cname##_show(struct config_item *item, char *page)\
  1260. { \
  1261. struct uvcg_mjpeg *u = to_uvcg_mjpeg(item); \
  1262. struct f_uvc_opts *opts; \
  1263. struct config_item *opts_item; \
  1264. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  1265. int result; \
  1266. \
  1267. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1268. \
  1269. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  1270. opts = to_f_uvc_opts(opts_item); \
  1271. \
  1272. mutex_lock(&opts->lock); \
  1273. result = sprintf(page, "%d\n", conv(u->desc.aname)); \
  1274. mutex_unlock(&opts->lock); \
  1275. \
  1276. mutex_unlock(su_mutex); \
  1277. return result; \
  1278. } \
  1279. \
  1280. UVC_ATTR_RO(uvcg_mjpeg_, cname, aname)
  1281. #define UVCG_MJPEG_ATTR(cname, aname, conv) \
  1282. static ssize_t uvcg_mjpeg_##cname##_show(struct config_item *item, char *page)\
  1283. { \
  1284. struct uvcg_mjpeg *u = to_uvcg_mjpeg(item); \
  1285. struct f_uvc_opts *opts; \
  1286. struct config_item *opts_item; \
  1287. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  1288. int result; \
  1289. \
  1290. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1291. \
  1292. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  1293. opts = to_f_uvc_opts(opts_item); \
  1294. \
  1295. mutex_lock(&opts->lock); \
  1296. result = sprintf(page, "%d\n", conv(u->desc.aname)); \
  1297. mutex_unlock(&opts->lock); \
  1298. \
  1299. mutex_unlock(su_mutex); \
  1300. return result; \
  1301. } \
  1302. \
  1303. static ssize_t \
  1304. uvcg_mjpeg_##cname##_store(struct config_item *item, \
  1305. const char *page, size_t len) \
  1306. { \
  1307. struct uvcg_mjpeg *u = to_uvcg_mjpeg(item); \
  1308. struct f_uvc_opts *opts; \
  1309. struct config_item *opts_item; \
  1310. struct mutex *su_mutex = &u->fmt.group.cg_subsys->su_mutex; \
  1311. int ret; \
  1312. u8 num; \
  1313. \
  1314. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1315. \
  1316. opts_item = u->fmt.group.cg_item.ci_parent->ci_parent->ci_parent;\
  1317. opts = to_f_uvc_opts(opts_item); \
  1318. \
  1319. mutex_lock(&opts->lock); \
  1320. if (u->fmt.linked || opts->refcnt) { \
  1321. ret = -EBUSY; \
  1322. goto end; \
  1323. } \
  1324. \
  1325. ret = kstrtou8(page, 0, &num); \
  1326. if (ret) \
  1327. goto end; \
  1328. \
  1329. if (num > 255) { \
  1330. ret = -EINVAL; \
  1331. goto end; \
  1332. } \
  1333. u->desc.aname = num; \
  1334. ret = len; \
  1335. end: \
  1336. mutex_unlock(&opts->lock); \
  1337. mutex_unlock(su_mutex); \
  1338. return ret; \
  1339. } \
  1340. \
  1341. UVC_ATTR(uvcg_mjpeg_, cname, aname)
  1342. #define identity_conv(x) (x)
  1343. UVCG_MJPEG_ATTR(b_default_frame_index, bDefaultFrameIndex,
  1344. identity_conv);
  1345. UVCG_MJPEG_ATTR_RO(bm_flags, bmFlags, identity_conv);
  1346. UVCG_MJPEG_ATTR_RO(b_aspect_ratio_x, bAspectRatioX, identity_conv);
  1347. UVCG_MJPEG_ATTR_RO(b_aspect_ratio_y, bAspectRatioY, identity_conv);
  1348. UVCG_MJPEG_ATTR_RO(bm_interface_flags, bmInterfaceFlags, identity_conv);
  1349. #undef identity_conv
  1350. #undef UVCG_MJPEG_ATTR
  1351. #undef UVCG_MJPEG_ATTR_RO
  1352. static inline ssize_t
  1353. uvcg_mjpeg_bma_controls_show(struct config_item *item, char *page)
  1354. {
  1355. struct uvcg_mjpeg *u = to_uvcg_mjpeg(item);
  1356. return uvcg_format_bma_controls_show(&u->fmt, page);
  1357. }
  1358. static inline ssize_t
  1359. uvcg_mjpeg_bma_controls_store(struct config_item *item,
  1360. const char *page, size_t len)
  1361. {
  1362. struct uvcg_mjpeg *u = to_uvcg_mjpeg(item);
  1363. return uvcg_format_bma_controls_store(&u->fmt, page, len);
  1364. }
  1365. UVC_ATTR(uvcg_mjpeg_, bma_controls, bmaControls);
  1366. static struct configfs_attribute *uvcg_mjpeg_attrs[] = {
  1367. &uvcg_mjpeg_attr_b_default_frame_index,
  1368. &uvcg_mjpeg_attr_bm_flags,
  1369. &uvcg_mjpeg_attr_b_aspect_ratio_x,
  1370. &uvcg_mjpeg_attr_b_aspect_ratio_y,
  1371. &uvcg_mjpeg_attr_bm_interface_flags,
  1372. &uvcg_mjpeg_attr_bma_controls,
  1373. NULL,
  1374. };
  1375. static struct config_item_type uvcg_mjpeg_type = {
  1376. .ct_group_ops = &uvcg_mjpeg_group_ops,
  1377. .ct_attrs = uvcg_mjpeg_attrs,
  1378. .ct_owner = THIS_MODULE,
  1379. };
  1380. static struct config_group *uvcg_mjpeg_make(struct config_group *group,
  1381. const char *name)
  1382. {
  1383. struct uvcg_mjpeg *h;
  1384. h = kzalloc(sizeof(*h), GFP_KERNEL);
  1385. if (!h)
  1386. return ERR_PTR(-ENOMEM);
  1387. h->desc.bLength = UVC_DT_FORMAT_MJPEG_SIZE;
  1388. h->desc.bDescriptorType = USB_DT_CS_INTERFACE;
  1389. h->desc.bDescriptorSubType = UVC_VS_FORMAT_MJPEG;
  1390. h->desc.bDefaultFrameIndex = 1;
  1391. h->desc.bAspectRatioX = 0;
  1392. h->desc.bAspectRatioY = 0;
  1393. h->desc.bmInterfaceFlags = 0;
  1394. h->desc.bCopyProtect = 0;
  1395. h->fmt.type = UVCG_MJPEG;
  1396. config_group_init_type_name(&h->fmt.group, name,
  1397. &uvcg_mjpeg_type);
  1398. return &h->fmt.group;
  1399. }
  1400. static void uvcg_mjpeg_drop(struct config_group *group,
  1401. struct config_item *item)
  1402. {
  1403. struct uvcg_mjpeg *h = to_uvcg_mjpeg(item);
  1404. kfree(h);
  1405. }
  1406. static struct configfs_group_operations uvcg_mjpeg_grp_ops = {
  1407. .make_group = uvcg_mjpeg_make,
  1408. .drop_item = uvcg_mjpeg_drop,
  1409. };
  1410. static struct config_item_type uvcg_mjpeg_grp_type = {
  1411. .ct_group_ops = &uvcg_mjpeg_grp_ops,
  1412. .ct_owner = THIS_MODULE,
  1413. };
  1414. /* streaming/color_matching/default */
  1415. static struct uvcg_default_color_matching {
  1416. struct config_group group;
  1417. } uvcg_default_color_matching;
  1418. static inline struct uvcg_default_color_matching
  1419. *to_uvcg_default_color_matching(struct config_item *item)
  1420. {
  1421. return container_of(to_config_group(item),
  1422. struct uvcg_default_color_matching, group);
  1423. }
  1424. #define UVCG_DEFAULT_COLOR_MATCHING_ATTR(cname, aname, conv) \
  1425. static ssize_t uvcg_default_color_matching_##cname##_show( \
  1426. struct config_item *item, char *page) \
  1427. { \
  1428. struct uvcg_default_color_matching *dc = \
  1429. to_uvcg_default_color_matching(item); \
  1430. struct f_uvc_opts *opts; \
  1431. struct config_item *opts_item; \
  1432. struct mutex *su_mutex = &dc->group.cg_subsys->su_mutex; \
  1433. struct uvc_color_matching_descriptor *cd; \
  1434. int result; \
  1435. \
  1436. mutex_lock(su_mutex); /* for navigating configfs hierarchy */ \
  1437. \
  1438. opts_item = dc->group.cg_item.ci_parent->ci_parent->ci_parent; \
  1439. opts = to_f_uvc_opts(opts_item); \
  1440. cd = &opts->uvc_color_matching; \
  1441. \
  1442. mutex_lock(&opts->lock); \
  1443. result = sprintf(page, "%d\n", conv(cd->aname)); \
  1444. mutex_unlock(&opts->lock); \
  1445. \
  1446. mutex_unlock(su_mutex); \
  1447. return result; \
  1448. } \
  1449. \
  1450. UVC_ATTR_RO(uvcg_default_color_matching_, cname, aname)
  1451. #define identity_conv(x) (x)
  1452. UVCG_DEFAULT_COLOR_MATCHING_ATTR(b_color_primaries, bColorPrimaries,
  1453. identity_conv);
  1454. UVCG_DEFAULT_COLOR_MATCHING_ATTR(b_transfer_characteristics,
  1455. bTransferCharacteristics, identity_conv);
  1456. UVCG_DEFAULT_COLOR_MATCHING_ATTR(b_matrix_coefficients, bMatrixCoefficients,
  1457. identity_conv);
  1458. #undef identity_conv
  1459. #undef UVCG_DEFAULT_COLOR_MATCHING_ATTR
  1460. static struct configfs_attribute *uvcg_default_color_matching_attrs[] = {
  1461. &uvcg_default_color_matching_attr_b_color_primaries,
  1462. &uvcg_default_color_matching_attr_b_transfer_characteristics,
  1463. &uvcg_default_color_matching_attr_b_matrix_coefficients,
  1464. NULL,
  1465. };
  1466. static struct config_item_type uvcg_default_color_matching_type = {
  1467. .ct_attrs = uvcg_default_color_matching_attrs,
  1468. .ct_owner = THIS_MODULE,
  1469. };
  1470. /* struct uvcg_color_matching {}; */
  1471. /* streaming/color_matching */
  1472. static struct uvcg_color_matching_grp {
  1473. struct config_group group;
  1474. } uvcg_color_matching_grp;
  1475. static struct config_item_type uvcg_color_matching_grp_type = {
  1476. .ct_owner = THIS_MODULE,
  1477. };
  1478. /* streaming/class/{fs|hs|ss} */
  1479. static struct uvcg_streaming_class {
  1480. struct config_group group;
  1481. } uvcg_streaming_class_fs, uvcg_streaming_class_hs, uvcg_streaming_class_ss;
  1482. static inline struct uvc_descriptor_header
  1483. ***__uvcg_get_stream_class_arr(struct config_item *i, struct f_uvc_opts *o)
  1484. {
  1485. struct uvcg_streaming_class *cl = container_of(to_config_group(i),
  1486. struct uvcg_streaming_class, group);
  1487. if (cl == &uvcg_streaming_class_fs)
  1488. return &o->uvc_fs_streaming_cls;
  1489. if (cl == &uvcg_streaming_class_hs)
  1490. return &o->uvc_hs_streaming_cls;
  1491. if (cl == &uvcg_streaming_class_ss)
  1492. return &o->uvc_ss_streaming_cls;
  1493. return NULL;
  1494. }
  1495. enum uvcg_strm_type {
  1496. UVCG_HEADER = 0,
  1497. UVCG_FORMAT,
  1498. UVCG_FRAME
  1499. };
  1500. /*
  1501. * Iterate over a hierarchy of streaming descriptors' config items.
  1502. * The items are created by the user with configfs.
  1503. *
  1504. * It "processes" the header pointed to by @priv1, then for each format
  1505. * that follows the header "processes" the format itself and then for
  1506. * each frame inside a format "processes" the frame.
  1507. *
  1508. * As a "processing" function the @fun is used.
  1509. *
  1510. * __uvcg_iter_strm_cls() is used in two context: first, to calculate
  1511. * the amount of memory needed for an array of streaming descriptors
  1512. * and second, to actually fill the array.
  1513. *
  1514. * @h: streaming header pointer
  1515. * @priv2: an "inout" parameter (the caller might want to see the changes to it)
  1516. * @priv3: an "inout" parameter (the caller might want to see the changes to it)
  1517. * @fun: callback function for processing each level of the hierarchy
  1518. */
  1519. static int __uvcg_iter_strm_cls(struct uvcg_streaming_header *h,
  1520. void *priv2, void *priv3,
  1521. int (*fun)(void *, void *, void *, int, enum uvcg_strm_type type))
  1522. {
  1523. struct uvcg_format_ptr *f;
  1524. struct config_group *grp;
  1525. struct config_item *item;
  1526. struct uvcg_frame *frm;
  1527. int ret, i, j;
  1528. if (!fun)
  1529. return -EINVAL;
  1530. i = j = 0;
  1531. ret = fun(h, priv2, priv3, 0, UVCG_HEADER);
  1532. if (ret)
  1533. return ret;
  1534. list_for_each_entry(f, &h->formats, entry) {
  1535. ret = fun(f->fmt, priv2, priv3, i++, UVCG_FORMAT);
  1536. if (ret)
  1537. return ret;
  1538. grp = &f->fmt->group;
  1539. list_for_each_entry(item, &grp->cg_children, ci_entry) {
  1540. frm = to_uvcg_frame(item);
  1541. ret = fun(frm, priv2, priv3, j++, UVCG_FRAME);
  1542. if (ret)
  1543. return ret;
  1544. }
  1545. }
  1546. return ret;
  1547. }
  1548. /*
  1549. * Count how many bytes are needed for an array of streaming descriptors.
  1550. *
  1551. * @priv1: pointer to a header, format or frame
  1552. * @priv2: inout parameter, accumulated size of the array
  1553. * @priv3: inout parameter, accumulated number of the array elements
  1554. * @n: unused, this function's prototype must match @fun in __uvcg_iter_strm_cls
  1555. */
  1556. static int __uvcg_cnt_strm(void *priv1, void *priv2, void *priv3, int n,
  1557. enum uvcg_strm_type type)
  1558. {
  1559. size_t *size = priv2;
  1560. size_t *count = priv3;
  1561. switch (type) {
  1562. case UVCG_HEADER: {
  1563. struct uvcg_streaming_header *h = priv1;
  1564. *size += sizeof(h->desc);
  1565. /* bmaControls */
  1566. *size += h->num_fmt * UVCG_STREAMING_CONTROL_SIZE;
  1567. }
  1568. break;
  1569. case UVCG_FORMAT: {
  1570. struct uvcg_format *fmt = priv1;
  1571. if (fmt->type == UVCG_UNCOMPRESSED) {
  1572. struct uvcg_uncompressed *u =
  1573. container_of(fmt, struct uvcg_uncompressed,
  1574. fmt);
  1575. *size += sizeof(u->desc);
  1576. } else if (fmt->type == UVCG_MJPEG) {
  1577. struct uvcg_mjpeg *m =
  1578. container_of(fmt, struct uvcg_mjpeg, fmt);
  1579. *size += sizeof(m->desc);
  1580. } else {
  1581. return -EINVAL;
  1582. }
  1583. }
  1584. break;
  1585. case UVCG_FRAME: {
  1586. struct uvcg_frame *frm = priv1;
  1587. int sz = sizeof(frm->dw_frame_interval);
  1588. *size += sizeof(frm->frame);
  1589. *size += frm->frame.b_frame_interval_type * sz;
  1590. }
  1591. break;
  1592. }
  1593. ++*count;
  1594. return 0;
  1595. }
  1596. /*
  1597. * Fill an array of streaming descriptors.
  1598. *
  1599. * @priv1: pointer to a header, format or frame
  1600. * @priv2: inout parameter, pointer into a block of memory
  1601. * @priv3: inout parameter, pointer to a 2-dimensional array
  1602. */
  1603. static int __uvcg_fill_strm(void *priv1, void *priv2, void *priv3, int n,
  1604. enum uvcg_strm_type type)
  1605. {
  1606. void **dest = priv2;
  1607. struct uvc_descriptor_header ***array = priv3;
  1608. size_t sz;
  1609. **array = *dest;
  1610. ++*array;
  1611. switch (type) {
  1612. case UVCG_HEADER: {
  1613. struct uvc_input_header_descriptor *ihdr = *dest;
  1614. struct uvcg_streaming_header *h = priv1;
  1615. struct uvcg_format_ptr *f;
  1616. memcpy(*dest, &h->desc, sizeof(h->desc));
  1617. *dest += sizeof(h->desc);
  1618. sz = UVCG_STREAMING_CONTROL_SIZE;
  1619. list_for_each_entry(f, &h->formats, entry) {
  1620. memcpy(*dest, f->fmt->bmaControls, sz);
  1621. *dest += sz;
  1622. }
  1623. ihdr->bLength = sizeof(h->desc) + h->num_fmt * sz;
  1624. ihdr->bNumFormats = h->num_fmt;
  1625. }
  1626. break;
  1627. case UVCG_FORMAT: {
  1628. struct uvcg_format *fmt = priv1;
  1629. if (fmt->type == UVCG_UNCOMPRESSED) {
  1630. struct uvc_format_uncompressed *unc = *dest;
  1631. struct uvcg_uncompressed *u =
  1632. container_of(fmt, struct uvcg_uncompressed,
  1633. fmt);
  1634. memcpy(*dest, &u->desc, sizeof(u->desc));
  1635. *dest += sizeof(u->desc);
  1636. unc->bNumFrameDescriptors = fmt->num_frames;
  1637. unc->bFormatIndex = n + 1;
  1638. } else if (fmt->type == UVCG_MJPEG) {
  1639. struct uvc_format_mjpeg *mjp = *dest;
  1640. struct uvcg_mjpeg *m =
  1641. container_of(fmt, struct uvcg_mjpeg, fmt);
  1642. memcpy(*dest, &m->desc, sizeof(m->desc));
  1643. *dest += sizeof(m->desc);
  1644. mjp->bNumFrameDescriptors = fmt->num_frames;
  1645. mjp->bFormatIndex = n + 1;
  1646. } else {
  1647. return -EINVAL;
  1648. }
  1649. }
  1650. break;
  1651. case UVCG_FRAME: {
  1652. struct uvcg_frame *frm = priv1;
  1653. struct uvc_descriptor_header *h = *dest;
  1654. sz = sizeof(frm->frame);
  1655. memcpy(*dest, &frm->frame, sz);
  1656. *dest += sz;
  1657. sz = frm->frame.b_frame_interval_type *
  1658. sizeof(*frm->dw_frame_interval);
  1659. memcpy(*dest, frm->dw_frame_interval, sz);
  1660. *dest += sz;
  1661. if (frm->fmt_type == UVCG_UNCOMPRESSED)
  1662. h->bLength = UVC_DT_FRAME_UNCOMPRESSED_SIZE(
  1663. frm->frame.b_frame_interval_type);
  1664. else if (frm->fmt_type == UVCG_MJPEG)
  1665. h->bLength = UVC_DT_FRAME_MJPEG_SIZE(
  1666. frm->frame.b_frame_interval_type);
  1667. }
  1668. break;
  1669. }
  1670. return 0;
  1671. }
  1672. static int uvcg_streaming_class_allow_link(struct config_item *src,
  1673. struct config_item *target)
  1674. {
  1675. struct config_item *streaming, *header;
  1676. struct f_uvc_opts *opts;
  1677. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  1678. struct uvc_descriptor_header ***class_array, **cl_arr;
  1679. struct uvcg_streaming_header *target_hdr;
  1680. void *data, *data_save;
  1681. size_t size = 0, count = 0;
  1682. int ret = -EINVAL;
  1683. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1684. streaming = src->ci_parent->ci_parent;
  1685. header = config_group_find_item(to_config_group(streaming), "header");
  1686. if (!header || target->ci_parent != header)
  1687. goto out;
  1688. opts = to_f_uvc_opts(streaming->ci_parent);
  1689. mutex_lock(&opts->lock);
  1690. class_array = __uvcg_get_stream_class_arr(src, opts);
  1691. if (!class_array || *class_array || opts->refcnt) {
  1692. ret = -EBUSY;
  1693. goto unlock;
  1694. }
  1695. target_hdr = to_uvcg_streaming_header(target);
  1696. ret = __uvcg_iter_strm_cls(target_hdr, &size, &count, __uvcg_cnt_strm);
  1697. if (ret)
  1698. goto unlock;
  1699. count += 2; /* color_matching, NULL */
  1700. *class_array = kcalloc(count, sizeof(void *), GFP_KERNEL);
  1701. if (!*class_array) {
  1702. ret = -ENOMEM;
  1703. goto unlock;
  1704. }
  1705. data = data_save = kzalloc(size, GFP_KERNEL);
  1706. if (!data) {
  1707. kfree(*class_array);
  1708. *class_array = NULL;
  1709. ret = -ENOMEM;
  1710. goto unlock;
  1711. }
  1712. cl_arr = *class_array;
  1713. ret = __uvcg_iter_strm_cls(target_hdr, &data, &cl_arr,
  1714. __uvcg_fill_strm);
  1715. if (ret) {
  1716. kfree(*class_array);
  1717. *class_array = NULL;
  1718. /*
  1719. * __uvcg_fill_strm() called from __uvcg_iter_stream_cls()
  1720. * might have advanced the "data", so use a backup copy
  1721. */
  1722. kfree(data_save);
  1723. goto unlock;
  1724. }
  1725. *cl_arr = (struct uvc_descriptor_header *)&opts->uvc_color_matching;
  1726. ++target_hdr->linked;
  1727. ret = 0;
  1728. unlock:
  1729. mutex_unlock(&opts->lock);
  1730. out:
  1731. mutex_unlock(su_mutex);
  1732. return ret;
  1733. }
  1734. static void uvcg_streaming_class_drop_link(struct config_item *src,
  1735. struct config_item *target)
  1736. {
  1737. struct config_item *streaming, *header;
  1738. struct f_uvc_opts *opts;
  1739. struct mutex *su_mutex = &src->ci_group->cg_subsys->su_mutex;
  1740. struct uvc_descriptor_header ***class_array;
  1741. struct uvcg_streaming_header *target_hdr;
  1742. mutex_lock(su_mutex); /* for navigating configfs hierarchy */
  1743. streaming = src->ci_parent->ci_parent;
  1744. header = config_group_find_item(to_config_group(streaming), "header");
  1745. if (!header || target->ci_parent != header)
  1746. goto out;
  1747. opts = to_f_uvc_opts(streaming->ci_parent);
  1748. mutex_lock(&opts->lock);
  1749. class_array = __uvcg_get_stream_class_arr(src, opts);
  1750. if (!class_array || !*class_array)
  1751. goto unlock;
  1752. if (opts->refcnt)
  1753. goto unlock;
  1754. target_hdr = to_uvcg_streaming_header(target);
  1755. --target_hdr->linked;
  1756. kfree(**class_array);
  1757. kfree(*class_array);
  1758. *class_array = NULL;
  1759. unlock:
  1760. mutex_unlock(&opts->lock);
  1761. out:
  1762. mutex_unlock(su_mutex);
  1763. }
  1764. static struct configfs_item_operations uvcg_streaming_class_item_ops = {
  1765. .allow_link = uvcg_streaming_class_allow_link,
  1766. .drop_link = uvcg_streaming_class_drop_link,
  1767. };
  1768. static struct config_item_type uvcg_streaming_class_type = {
  1769. .ct_item_ops = &uvcg_streaming_class_item_ops,
  1770. .ct_owner = THIS_MODULE,
  1771. };
  1772. /* streaming/class */
  1773. static struct uvcg_streaming_class_grp {
  1774. struct config_group group;
  1775. } uvcg_streaming_class_grp;
  1776. static struct config_item_type uvcg_streaming_class_grp_type = {
  1777. .ct_owner = THIS_MODULE,
  1778. };
  1779. /* streaming */
  1780. static struct uvcg_streaming_grp {
  1781. struct config_group group;
  1782. } uvcg_streaming_grp;
  1783. static struct config_item_type uvcg_streaming_grp_type = {
  1784. .ct_owner = THIS_MODULE,
  1785. };
  1786. static inline struct f_uvc_opts *to_f_uvc_opts(struct config_item *item)
  1787. {
  1788. return container_of(to_config_group(item), struct f_uvc_opts,
  1789. func_inst.group);
  1790. }
  1791. static void uvc_attr_release(struct config_item *item)
  1792. {
  1793. struct f_uvc_opts *opts = to_f_uvc_opts(item);
  1794. usb_put_function_instance(&opts->func_inst);
  1795. }
  1796. static struct configfs_item_operations uvc_item_ops = {
  1797. .release = uvc_attr_release,
  1798. };
  1799. #define UVCG_OPTS_ATTR(cname, conv, str2u, uxx, vnoc, limit) \
  1800. static ssize_t f_uvc_opts_##cname##_show( \
  1801. struct config_item *item, char *page) \
  1802. { \
  1803. struct f_uvc_opts *opts = to_f_uvc_opts(item); \
  1804. int result; \
  1805. \
  1806. mutex_lock(&opts->lock); \
  1807. result = sprintf(page, "%d\n", conv(opts->cname)); \
  1808. mutex_unlock(&opts->lock); \
  1809. \
  1810. return result; \
  1811. } \
  1812. \
  1813. static ssize_t \
  1814. f_uvc_opts_##cname##_store(struct config_item *item, \
  1815. const char *page, size_t len) \
  1816. { \
  1817. struct f_uvc_opts *opts = to_f_uvc_opts(item); \
  1818. int ret; \
  1819. uxx num; \
  1820. \
  1821. mutex_lock(&opts->lock); \
  1822. if (opts->refcnt) { \
  1823. ret = -EBUSY; \
  1824. goto end; \
  1825. } \
  1826. \
  1827. ret = str2u(page, 0, &num); \
  1828. if (ret) \
  1829. goto end; \
  1830. \
  1831. if (num > limit) { \
  1832. ret = -EINVAL; \
  1833. goto end; \
  1834. } \
  1835. opts->cname = vnoc(num); \
  1836. ret = len; \
  1837. end: \
  1838. mutex_unlock(&opts->lock); \
  1839. return ret; \
  1840. } \
  1841. \
  1842. UVC_ATTR(f_uvc_opts_, cname, aname)
  1843. #define identity_conv(x) (x)
  1844. UVCG_OPTS_ATTR(streaming_interval, identity_conv, kstrtou8, u8, identity_conv,
  1845. 16);
  1846. UVCG_OPTS_ATTR(streaming_maxpacket, le16_to_cpu, kstrtou16, u16, le16_to_cpu,
  1847. 3072);
  1848. UVCG_OPTS_ATTR(streaming_maxburst, identity_conv, kstrtou8, u8, identity_conv,
  1849. 15);
  1850. #undef identity_conv
  1851. #undef UVCG_OPTS_ATTR
  1852. static struct configfs_attribute *uvc_attrs[] = {
  1853. &f_uvc_opts_attr_streaming_interval,
  1854. &f_uvc_opts_attr_streaming_maxpacket,
  1855. &f_uvc_opts_attr_streaming_maxburst,
  1856. NULL,
  1857. };
  1858. static struct config_item_type uvc_func_type = {
  1859. .ct_item_ops = &uvc_item_ops,
  1860. .ct_attrs = uvc_attrs,
  1861. .ct_owner = THIS_MODULE,
  1862. };
  1863. int uvcg_attach_configfs(struct f_uvc_opts *opts)
  1864. {
  1865. config_group_init_type_name(&uvcg_control_header_grp.group,
  1866. "header",
  1867. &uvcg_control_header_grp_type);
  1868. config_group_init_type_name(&uvcg_default_processing.group,
  1869. "default", &uvcg_default_processing_type);
  1870. config_group_init_type_name(&uvcg_processing_grp.group,
  1871. "processing", &uvcg_processing_grp_type);
  1872. configfs_add_default_group(&uvcg_default_processing.group,
  1873. &uvcg_processing_grp.group);
  1874. config_group_init_type_name(&uvcg_default_camera.group,
  1875. "default", &uvcg_default_camera_type);
  1876. config_group_init_type_name(&uvcg_camera_grp.group,
  1877. "camera", &uvcg_camera_grp_type);
  1878. configfs_add_default_group(&uvcg_default_camera.group,
  1879. &uvcg_camera_grp.group);
  1880. config_group_init_type_name(&uvcg_default_output.group,
  1881. "default", &uvcg_default_output_type);
  1882. config_group_init_type_name(&uvcg_output_grp.group,
  1883. "output", &uvcg_output_grp_type);
  1884. configfs_add_default_group(&uvcg_default_output.group,
  1885. &uvcg_output_grp.group);
  1886. config_group_init_type_name(&uvcg_terminal_grp.group,
  1887. "terminal", &uvcg_terminal_grp_type);
  1888. configfs_add_default_group(&uvcg_camera_grp.group,
  1889. &uvcg_terminal_grp.group);
  1890. configfs_add_default_group(&uvcg_output_grp.group,
  1891. &uvcg_terminal_grp.group);
  1892. config_group_init_type_name(&uvcg_control_class_fs.group,
  1893. "fs", &uvcg_control_class_type);
  1894. config_group_init_type_name(&uvcg_control_class_ss.group,
  1895. "ss", &uvcg_control_class_type);
  1896. config_group_init_type_name(&uvcg_control_class_grp.group,
  1897. "class",
  1898. &uvcg_control_class_grp_type);
  1899. configfs_add_default_group(&uvcg_control_class_fs.group,
  1900. &uvcg_control_class_grp.group);
  1901. configfs_add_default_group(&uvcg_control_class_ss.group,
  1902. &uvcg_control_class_grp.group);
  1903. config_group_init_type_name(&uvcg_control_grp.group,
  1904. "control",
  1905. &uvcg_control_grp_type);
  1906. configfs_add_default_group(&uvcg_control_header_grp.group,
  1907. &uvcg_control_grp.group);
  1908. configfs_add_default_group(&uvcg_processing_grp.group,
  1909. &uvcg_control_grp.group);
  1910. configfs_add_default_group(&uvcg_terminal_grp.group,
  1911. &uvcg_control_grp.group);
  1912. configfs_add_default_group(&uvcg_control_class_grp.group,
  1913. &uvcg_control_grp.group);
  1914. config_group_init_type_name(&uvcg_streaming_header_grp.group,
  1915. "header",
  1916. &uvcg_streaming_header_grp_type);
  1917. config_group_init_type_name(&uvcg_uncompressed_grp.group,
  1918. "uncompressed",
  1919. &uvcg_uncompressed_grp_type);
  1920. config_group_init_type_name(&uvcg_mjpeg_grp.group,
  1921. "mjpeg",
  1922. &uvcg_mjpeg_grp_type);
  1923. config_group_init_type_name(&uvcg_default_color_matching.group,
  1924. "default",
  1925. &uvcg_default_color_matching_type);
  1926. config_group_init_type_name(&uvcg_color_matching_grp.group,
  1927. "color_matching",
  1928. &uvcg_color_matching_grp_type);
  1929. configfs_add_default_group(&uvcg_default_color_matching.group,
  1930. &uvcg_color_matching_grp.group);
  1931. config_group_init_type_name(&uvcg_streaming_class_fs.group,
  1932. "fs", &uvcg_streaming_class_type);
  1933. config_group_init_type_name(&uvcg_streaming_class_hs.group,
  1934. "hs", &uvcg_streaming_class_type);
  1935. config_group_init_type_name(&uvcg_streaming_class_ss.group,
  1936. "ss", &uvcg_streaming_class_type);
  1937. config_group_init_type_name(&uvcg_streaming_class_grp.group,
  1938. "class", &uvcg_streaming_class_grp_type);
  1939. configfs_add_default_group(&uvcg_streaming_class_fs.group,
  1940. &uvcg_streaming_class_grp.group);
  1941. configfs_add_default_group(&uvcg_streaming_class_hs.group,
  1942. &uvcg_streaming_class_grp.group);
  1943. configfs_add_default_group(&uvcg_streaming_class_ss.group,
  1944. &uvcg_streaming_class_grp.group);
  1945. config_group_init_type_name(&uvcg_streaming_grp.group,
  1946. "streaming", &uvcg_streaming_grp_type);
  1947. configfs_add_default_group(&uvcg_streaming_header_grp.group,
  1948. &uvcg_streaming_grp.group);
  1949. configfs_add_default_group(&uvcg_uncompressed_grp.group,
  1950. &uvcg_streaming_grp.group);
  1951. configfs_add_default_group(&uvcg_mjpeg_grp.group,
  1952. &uvcg_streaming_grp.group);
  1953. configfs_add_default_group(&uvcg_color_matching_grp.group,
  1954. &uvcg_streaming_grp.group);
  1955. configfs_add_default_group(&uvcg_streaming_class_grp.group,
  1956. &uvcg_streaming_grp.group);
  1957. config_group_init_type_name(&opts->func_inst.group,
  1958. "",
  1959. &uvc_func_type);
  1960. configfs_add_default_group(&uvcg_control_grp.group,
  1961. &opts->func_inst.group);
  1962. configfs_add_default_group(&uvcg_streaming_grp.group,
  1963. &opts->func_inst.group);
  1964. return 0;
  1965. }