uvc_configfs.c 64 KB

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