uvc_configfs.c 64 KB

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