cec-funcs.h 54 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969
  1. /*
  2. * cec - HDMI Consumer Electronics Control message functions
  3. *
  4. * Copyright 2016 Cisco Systems, Inc. and/or its affiliates. All rights reserved.
  5. *
  6. * This program is free software; you may redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; version 2 of the License.
  9. *
  10. * Alternatively you can redistribute this file under the terms of the
  11. * BSD license as stated below:
  12. *
  13. * Redistribution and use in source and binary forms, with or without
  14. * modification, are permitted provided that the following conditions
  15. * are met:
  16. * 1. Redistributions of source code must retain the above copyright
  17. * notice, this list of conditions and the following disclaimer.
  18. * 2. Redistributions in binary form must reproduce the above copyright
  19. * notice, this list of conditions and the following disclaimer in
  20. * the documentation and/or other materials provided with the
  21. * distribution.
  22. * 3. The names of its contributors may not be used to endorse or promote
  23. * products derived from this software without specific prior written
  24. * permission.
  25. *
  26. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  27. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  28. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  29. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  30. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  31. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  32. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  33. * SOFTWARE.
  34. */
  35. #ifndef _CEC_UAPI_FUNCS_H
  36. #define _CEC_UAPI_FUNCS_H
  37. #include <linux/cec.h>
  38. /* One Touch Play Feature */
  39. static __inline__ void cec_msg_active_source(struct cec_msg *msg, __u16 phys_addr)
  40. {
  41. msg->len = 4;
  42. msg->msg[0] |= 0xf; /* broadcast */
  43. msg->msg[1] = CEC_MSG_ACTIVE_SOURCE;
  44. msg->msg[2] = phys_addr >> 8;
  45. msg->msg[3] = phys_addr & 0xff;
  46. }
  47. static __inline__ void cec_ops_active_source(const struct cec_msg *msg,
  48. __u16 *phys_addr)
  49. {
  50. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  51. }
  52. static __inline__ void cec_msg_image_view_on(struct cec_msg *msg)
  53. {
  54. msg->len = 2;
  55. msg->msg[1] = CEC_MSG_IMAGE_VIEW_ON;
  56. }
  57. static __inline__ void cec_msg_text_view_on(struct cec_msg *msg)
  58. {
  59. msg->len = 2;
  60. msg->msg[1] = CEC_MSG_TEXT_VIEW_ON;
  61. }
  62. /* Routing Control Feature */
  63. static __inline__ void cec_msg_inactive_source(struct cec_msg *msg,
  64. __u16 phys_addr)
  65. {
  66. msg->len = 4;
  67. msg->msg[1] = CEC_MSG_INACTIVE_SOURCE;
  68. msg->msg[2] = phys_addr >> 8;
  69. msg->msg[3] = phys_addr & 0xff;
  70. }
  71. static __inline__ void cec_ops_inactive_source(const struct cec_msg *msg,
  72. __u16 *phys_addr)
  73. {
  74. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  75. }
  76. static __inline__ void cec_msg_request_active_source(struct cec_msg *msg,
  77. int reply)
  78. {
  79. msg->len = 2;
  80. msg->msg[0] |= 0xf; /* broadcast */
  81. msg->msg[1] = CEC_MSG_REQUEST_ACTIVE_SOURCE;
  82. msg->reply = reply ? CEC_MSG_ACTIVE_SOURCE : 0;
  83. }
  84. static __inline__ void cec_msg_routing_information(struct cec_msg *msg,
  85. __u16 phys_addr)
  86. {
  87. msg->len = 4;
  88. msg->msg[0] |= 0xf; /* broadcast */
  89. msg->msg[1] = CEC_MSG_ROUTING_INFORMATION;
  90. msg->msg[2] = phys_addr >> 8;
  91. msg->msg[3] = phys_addr & 0xff;
  92. }
  93. static __inline__ void cec_ops_routing_information(const struct cec_msg *msg,
  94. __u16 *phys_addr)
  95. {
  96. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  97. }
  98. static __inline__ void cec_msg_routing_change(struct cec_msg *msg,
  99. int reply,
  100. __u16 orig_phys_addr,
  101. __u16 new_phys_addr)
  102. {
  103. msg->len = 6;
  104. msg->msg[0] |= 0xf; /* broadcast */
  105. msg->msg[1] = CEC_MSG_ROUTING_CHANGE;
  106. msg->msg[2] = orig_phys_addr >> 8;
  107. msg->msg[3] = orig_phys_addr & 0xff;
  108. msg->msg[4] = new_phys_addr >> 8;
  109. msg->msg[5] = new_phys_addr & 0xff;
  110. msg->reply = reply ? CEC_MSG_ROUTING_INFORMATION : 0;
  111. }
  112. static __inline__ void cec_ops_routing_change(const struct cec_msg *msg,
  113. __u16 *orig_phys_addr,
  114. __u16 *new_phys_addr)
  115. {
  116. *orig_phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  117. *new_phys_addr = (msg->msg[4] << 8) | msg->msg[5];
  118. }
  119. static __inline__ void cec_msg_set_stream_path(struct cec_msg *msg, __u16 phys_addr)
  120. {
  121. msg->len = 4;
  122. msg->msg[0] |= 0xf; /* broadcast */
  123. msg->msg[1] = CEC_MSG_SET_STREAM_PATH;
  124. msg->msg[2] = phys_addr >> 8;
  125. msg->msg[3] = phys_addr & 0xff;
  126. }
  127. static __inline__ void cec_ops_set_stream_path(const struct cec_msg *msg,
  128. __u16 *phys_addr)
  129. {
  130. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  131. }
  132. /* Standby Feature */
  133. static __inline__ void cec_msg_standby(struct cec_msg *msg)
  134. {
  135. msg->len = 2;
  136. msg->msg[1] = CEC_MSG_STANDBY;
  137. }
  138. /* One Touch Record Feature */
  139. static __inline__ void cec_msg_record_off(struct cec_msg *msg, int reply)
  140. {
  141. msg->len = 2;
  142. msg->msg[1] = CEC_MSG_RECORD_OFF;
  143. msg->reply = reply ? CEC_MSG_RECORD_STATUS : 0;
  144. }
  145. struct cec_op_arib_data {
  146. __u16 transport_id;
  147. __u16 service_id;
  148. __u16 orig_network_id;
  149. };
  150. struct cec_op_atsc_data {
  151. __u16 transport_id;
  152. __u16 program_number;
  153. };
  154. struct cec_op_dvb_data {
  155. __u16 transport_id;
  156. __u16 service_id;
  157. __u16 orig_network_id;
  158. };
  159. struct cec_op_channel_data {
  160. __u8 channel_number_fmt;
  161. __u16 major;
  162. __u16 minor;
  163. };
  164. struct cec_op_digital_service_id {
  165. __u8 service_id_method;
  166. __u8 dig_bcast_system;
  167. union {
  168. struct cec_op_arib_data arib;
  169. struct cec_op_atsc_data atsc;
  170. struct cec_op_dvb_data dvb;
  171. struct cec_op_channel_data channel;
  172. };
  173. };
  174. struct cec_op_record_src {
  175. __u8 type;
  176. union {
  177. struct cec_op_digital_service_id digital;
  178. struct {
  179. __u8 ana_bcast_type;
  180. __u16 ana_freq;
  181. __u8 bcast_system;
  182. } analog;
  183. struct {
  184. __u8 plug;
  185. } ext_plug;
  186. struct {
  187. __u16 phys_addr;
  188. } ext_phys_addr;
  189. };
  190. };
  191. static __inline__ void cec_set_digital_service_id(__u8 *msg,
  192. const struct cec_op_digital_service_id *digital)
  193. {
  194. *msg++ = (digital->service_id_method << 7) | digital->dig_bcast_system;
  195. if (digital->service_id_method == CEC_OP_SERVICE_ID_METHOD_BY_CHANNEL) {
  196. *msg++ = (digital->channel.channel_number_fmt << 2) |
  197. (digital->channel.major >> 8);
  198. *msg++ = digital->channel.major & 0xff;
  199. *msg++ = digital->channel.minor >> 8;
  200. *msg++ = digital->channel.minor & 0xff;
  201. *msg++ = 0;
  202. *msg++ = 0;
  203. return;
  204. }
  205. switch (digital->dig_bcast_system) {
  206. case CEC_OP_DIG_SERVICE_BCAST_SYSTEM_ATSC_GEN:
  207. case CEC_OP_DIG_SERVICE_BCAST_SYSTEM_ATSC_CABLE:
  208. case CEC_OP_DIG_SERVICE_BCAST_SYSTEM_ATSC_SAT:
  209. case CEC_OP_DIG_SERVICE_BCAST_SYSTEM_ATSC_T:
  210. *msg++ = digital->atsc.transport_id >> 8;
  211. *msg++ = digital->atsc.transport_id & 0xff;
  212. *msg++ = digital->atsc.program_number >> 8;
  213. *msg++ = digital->atsc.program_number & 0xff;
  214. *msg++ = 0;
  215. *msg++ = 0;
  216. break;
  217. default:
  218. *msg++ = digital->dvb.transport_id >> 8;
  219. *msg++ = digital->dvb.transport_id & 0xff;
  220. *msg++ = digital->dvb.service_id >> 8;
  221. *msg++ = digital->dvb.service_id & 0xff;
  222. *msg++ = digital->dvb.orig_network_id >> 8;
  223. *msg++ = digital->dvb.orig_network_id & 0xff;
  224. break;
  225. }
  226. }
  227. static __inline__ void cec_get_digital_service_id(const __u8 *msg,
  228. struct cec_op_digital_service_id *digital)
  229. {
  230. digital->service_id_method = msg[0] >> 7;
  231. digital->dig_bcast_system = msg[0] & 0x7f;
  232. if (digital->service_id_method == CEC_OP_SERVICE_ID_METHOD_BY_CHANNEL) {
  233. digital->channel.channel_number_fmt = msg[1] >> 2;
  234. digital->channel.major = ((msg[1] & 3) << 6) | msg[2];
  235. digital->channel.minor = (msg[3] << 8) | msg[4];
  236. return;
  237. }
  238. digital->dvb.transport_id = (msg[1] << 8) | msg[2];
  239. digital->dvb.service_id = (msg[3] << 8) | msg[4];
  240. digital->dvb.orig_network_id = (msg[5] << 8) | msg[6];
  241. }
  242. static __inline__ void cec_msg_record_on_own(struct cec_msg *msg)
  243. {
  244. msg->len = 3;
  245. msg->msg[1] = CEC_MSG_RECORD_ON;
  246. msg->msg[2] = CEC_OP_RECORD_SRC_OWN;
  247. }
  248. static __inline__ void cec_msg_record_on_digital(struct cec_msg *msg,
  249. const struct cec_op_digital_service_id *digital)
  250. {
  251. msg->len = 10;
  252. msg->msg[1] = CEC_MSG_RECORD_ON;
  253. msg->msg[2] = CEC_OP_RECORD_SRC_DIGITAL;
  254. cec_set_digital_service_id(msg->msg + 3, digital);
  255. }
  256. static __inline__ void cec_msg_record_on_analog(struct cec_msg *msg,
  257. __u8 ana_bcast_type,
  258. __u16 ana_freq,
  259. __u8 bcast_system)
  260. {
  261. msg->len = 7;
  262. msg->msg[1] = CEC_MSG_RECORD_ON;
  263. msg->msg[2] = CEC_OP_RECORD_SRC_ANALOG;
  264. msg->msg[3] = ana_bcast_type;
  265. msg->msg[4] = ana_freq >> 8;
  266. msg->msg[5] = ana_freq & 0xff;
  267. msg->msg[6] = bcast_system;
  268. }
  269. static __inline__ void cec_msg_record_on_plug(struct cec_msg *msg,
  270. __u8 plug)
  271. {
  272. msg->len = 4;
  273. msg->msg[1] = CEC_MSG_RECORD_ON;
  274. msg->msg[2] = CEC_OP_RECORD_SRC_EXT_PLUG;
  275. msg->msg[3] = plug;
  276. }
  277. static __inline__ void cec_msg_record_on_phys_addr(struct cec_msg *msg,
  278. __u16 phys_addr)
  279. {
  280. msg->len = 5;
  281. msg->msg[1] = CEC_MSG_RECORD_ON;
  282. msg->msg[2] = CEC_OP_RECORD_SRC_EXT_PHYS_ADDR;
  283. msg->msg[3] = phys_addr >> 8;
  284. msg->msg[4] = phys_addr & 0xff;
  285. }
  286. static __inline__ void cec_msg_record_on(struct cec_msg *msg,
  287. int reply,
  288. const struct cec_op_record_src *rec_src)
  289. {
  290. switch (rec_src->type) {
  291. case CEC_OP_RECORD_SRC_OWN:
  292. cec_msg_record_on_own(msg);
  293. break;
  294. case CEC_OP_RECORD_SRC_DIGITAL:
  295. cec_msg_record_on_digital(msg, &rec_src->digital);
  296. break;
  297. case CEC_OP_RECORD_SRC_ANALOG:
  298. cec_msg_record_on_analog(msg,
  299. rec_src->analog.ana_bcast_type,
  300. rec_src->analog.ana_freq,
  301. rec_src->analog.bcast_system);
  302. break;
  303. case CEC_OP_RECORD_SRC_EXT_PLUG:
  304. cec_msg_record_on_plug(msg, rec_src->ext_plug.plug);
  305. break;
  306. case CEC_OP_RECORD_SRC_EXT_PHYS_ADDR:
  307. cec_msg_record_on_phys_addr(msg,
  308. rec_src->ext_phys_addr.phys_addr);
  309. break;
  310. }
  311. msg->reply = reply ? CEC_MSG_RECORD_STATUS : 0;
  312. }
  313. static __inline__ void cec_ops_record_on(const struct cec_msg *msg,
  314. struct cec_op_record_src *rec_src)
  315. {
  316. rec_src->type = msg->msg[2];
  317. switch (rec_src->type) {
  318. case CEC_OP_RECORD_SRC_OWN:
  319. break;
  320. case CEC_OP_RECORD_SRC_DIGITAL:
  321. cec_get_digital_service_id(msg->msg + 3, &rec_src->digital);
  322. break;
  323. case CEC_OP_RECORD_SRC_ANALOG:
  324. rec_src->analog.ana_bcast_type = msg->msg[3];
  325. rec_src->analog.ana_freq =
  326. (msg->msg[4] << 8) | msg->msg[5];
  327. rec_src->analog.bcast_system = msg->msg[6];
  328. break;
  329. case CEC_OP_RECORD_SRC_EXT_PLUG:
  330. rec_src->ext_plug.plug = msg->msg[3];
  331. break;
  332. case CEC_OP_RECORD_SRC_EXT_PHYS_ADDR:
  333. rec_src->ext_phys_addr.phys_addr =
  334. (msg->msg[3] << 8) | msg->msg[4];
  335. break;
  336. }
  337. }
  338. static __inline__ void cec_msg_record_status(struct cec_msg *msg, __u8 rec_status)
  339. {
  340. msg->len = 3;
  341. msg->msg[1] = CEC_MSG_RECORD_STATUS;
  342. msg->msg[2] = rec_status;
  343. }
  344. static __inline__ void cec_ops_record_status(const struct cec_msg *msg,
  345. __u8 *rec_status)
  346. {
  347. *rec_status = msg->msg[2];
  348. }
  349. static __inline__ void cec_msg_record_tv_screen(struct cec_msg *msg,
  350. int reply)
  351. {
  352. msg->len = 2;
  353. msg->msg[1] = CEC_MSG_RECORD_TV_SCREEN;
  354. msg->reply = reply ? CEC_MSG_RECORD_ON : 0;
  355. }
  356. /* Timer Programming Feature */
  357. static __inline__ void cec_msg_timer_status(struct cec_msg *msg,
  358. __u8 timer_overlap_warning,
  359. __u8 media_info,
  360. __u8 prog_info,
  361. __u8 prog_error,
  362. __u8 duration_hr,
  363. __u8 duration_min)
  364. {
  365. msg->len = 3;
  366. msg->msg[1] = CEC_MSG_TIMER_STATUS;
  367. msg->msg[2] = (timer_overlap_warning << 7) |
  368. (media_info << 5) |
  369. (prog_info ? 0x10 : 0) |
  370. (prog_info ? prog_info : prog_error);
  371. if (prog_info == CEC_OP_PROG_INFO_NOT_ENOUGH_SPACE ||
  372. prog_info == CEC_OP_PROG_INFO_MIGHT_NOT_BE_ENOUGH_SPACE ||
  373. prog_error == CEC_OP_PROG_ERROR_DUPLICATE) {
  374. msg->len += 2;
  375. msg->msg[3] = ((duration_hr / 10) << 4) | (duration_hr % 10);
  376. msg->msg[4] = ((duration_min / 10) << 4) | (duration_min % 10);
  377. }
  378. }
  379. static __inline__ void cec_ops_timer_status(const struct cec_msg *msg,
  380. __u8 *timer_overlap_warning,
  381. __u8 *media_info,
  382. __u8 *prog_info,
  383. __u8 *prog_error,
  384. __u8 *duration_hr,
  385. __u8 *duration_min)
  386. {
  387. *timer_overlap_warning = msg->msg[2] >> 7;
  388. *media_info = (msg->msg[2] >> 5) & 3;
  389. if (msg->msg[2] & 0x10) {
  390. *prog_info = msg->msg[2] & 0xf;
  391. *prog_error = 0;
  392. } else {
  393. *prog_info = 0;
  394. *prog_error = msg->msg[2] & 0xf;
  395. }
  396. if (*prog_info == CEC_OP_PROG_INFO_NOT_ENOUGH_SPACE ||
  397. *prog_info == CEC_OP_PROG_INFO_MIGHT_NOT_BE_ENOUGH_SPACE ||
  398. *prog_error == CEC_OP_PROG_ERROR_DUPLICATE) {
  399. *duration_hr = (msg->msg[3] >> 4) * 10 + (msg->msg[3] & 0xf);
  400. *duration_min = (msg->msg[4] >> 4) * 10 + (msg->msg[4] & 0xf);
  401. } else {
  402. *duration_hr = *duration_min = 0;
  403. }
  404. }
  405. static __inline__ void cec_msg_timer_cleared_status(struct cec_msg *msg,
  406. __u8 timer_cleared_status)
  407. {
  408. msg->len = 3;
  409. msg->msg[1] = CEC_MSG_TIMER_CLEARED_STATUS;
  410. msg->msg[2] = timer_cleared_status;
  411. }
  412. static __inline__ void cec_ops_timer_cleared_status(const struct cec_msg *msg,
  413. __u8 *timer_cleared_status)
  414. {
  415. *timer_cleared_status = msg->msg[2];
  416. }
  417. static __inline__ void cec_msg_clear_analogue_timer(struct cec_msg *msg,
  418. int reply,
  419. __u8 day,
  420. __u8 month,
  421. __u8 start_hr,
  422. __u8 start_min,
  423. __u8 duration_hr,
  424. __u8 duration_min,
  425. __u8 recording_seq,
  426. __u8 ana_bcast_type,
  427. __u16 ana_freq,
  428. __u8 bcast_system)
  429. {
  430. msg->len = 13;
  431. msg->msg[1] = CEC_MSG_CLEAR_ANALOGUE_TIMER;
  432. msg->msg[2] = day;
  433. msg->msg[3] = month;
  434. /* Hours and minutes are in BCD format */
  435. msg->msg[4] = ((start_hr / 10) << 4) | (start_hr % 10);
  436. msg->msg[5] = ((start_min / 10) << 4) | (start_min % 10);
  437. msg->msg[6] = ((duration_hr / 10) << 4) | (duration_hr % 10);
  438. msg->msg[7] = ((duration_min / 10) << 4) | (duration_min % 10);
  439. msg->msg[8] = recording_seq;
  440. msg->msg[9] = ana_bcast_type;
  441. msg->msg[10] = ana_freq >> 8;
  442. msg->msg[11] = ana_freq & 0xff;
  443. msg->msg[12] = bcast_system;
  444. msg->reply = reply ? CEC_MSG_TIMER_CLEARED_STATUS : 0;
  445. }
  446. static __inline__ void cec_ops_clear_analogue_timer(const struct cec_msg *msg,
  447. __u8 *day,
  448. __u8 *month,
  449. __u8 *start_hr,
  450. __u8 *start_min,
  451. __u8 *duration_hr,
  452. __u8 *duration_min,
  453. __u8 *recording_seq,
  454. __u8 *ana_bcast_type,
  455. __u16 *ana_freq,
  456. __u8 *bcast_system)
  457. {
  458. *day = msg->msg[2];
  459. *month = msg->msg[3];
  460. /* Hours and minutes are in BCD format */
  461. *start_hr = (msg->msg[4] >> 4) * 10 + (msg->msg[4] & 0xf);
  462. *start_min = (msg->msg[5] >> 4) * 10 + (msg->msg[5] & 0xf);
  463. *duration_hr = (msg->msg[6] >> 4) * 10 + (msg->msg[6] & 0xf);
  464. *duration_min = (msg->msg[7] >> 4) * 10 + (msg->msg[7] & 0xf);
  465. *recording_seq = msg->msg[8];
  466. *ana_bcast_type = msg->msg[9];
  467. *ana_freq = (msg->msg[10] << 8) | msg->msg[11];
  468. *bcast_system = msg->msg[12];
  469. }
  470. static __inline__ void cec_msg_clear_digital_timer(struct cec_msg *msg,
  471. int reply,
  472. __u8 day,
  473. __u8 month,
  474. __u8 start_hr,
  475. __u8 start_min,
  476. __u8 duration_hr,
  477. __u8 duration_min,
  478. __u8 recording_seq,
  479. const struct cec_op_digital_service_id *digital)
  480. {
  481. msg->len = 16;
  482. msg->reply = reply ? CEC_MSG_TIMER_CLEARED_STATUS : 0;
  483. msg->msg[1] = CEC_MSG_CLEAR_DIGITAL_TIMER;
  484. msg->msg[2] = day;
  485. msg->msg[3] = month;
  486. /* Hours and minutes are in BCD format */
  487. msg->msg[4] = ((start_hr / 10) << 4) | (start_hr % 10);
  488. msg->msg[5] = ((start_min / 10) << 4) | (start_min % 10);
  489. msg->msg[6] = ((duration_hr / 10) << 4) | (duration_hr % 10);
  490. msg->msg[7] = ((duration_min / 10) << 4) | (duration_min % 10);
  491. msg->msg[8] = recording_seq;
  492. cec_set_digital_service_id(msg->msg + 9, digital);
  493. }
  494. static __inline__ void cec_ops_clear_digital_timer(const struct cec_msg *msg,
  495. __u8 *day,
  496. __u8 *month,
  497. __u8 *start_hr,
  498. __u8 *start_min,
  499. __u8 *duration_hr,
  500. __u8 *duration_min,
  501. __u8 *recording_seq,
  502. struct cec_op_digital_service_id *digital)
  503. {
  504. *day = msg->msg[2];
  505. *month = msg->msg[3];
  506. /* Hours and minutes are in BCD format */
  507. *start_hr = (msg->msg[4] >> 4) * 10 + (msg->msg[4] & 0xf);
  508. *start_min = (msg->msg[5] >> 4) * 10 + (msg->msg[5] & 0xf);
  509. *duration_hr = (msg->msg[6] >> 4) * 10 + (msg->msg[6] & 0xf);
  510. *duration_min = (msg->msg[7] >> 4) * 10 + (msg->msg[7] & 0xf);
  511. *recording_seq = msg->msg[8];
  512. cec_get_digital_service_id(msg->msg + 9, digital);
  513. }
  514. static __inline__ void cec_msg_clear_ext_timer(struct cec_msg *msg,
  515. int reply,
  516. __u8 day,
  517. __u8 month,
  518. __u8 start_hr,
  519. __u8 start_min,
  520. __u8 duration_hr,
  521. __u8 duration_min,
  522. __u8 recording_seq,
  523. __u8 ext_src_spec,
  524. __u8 plug,
  525. __u16 phys_addr)
  526. {
  527. msg->len = 13;
  528. msg->msg[1] = CEC_MSG_CLEAR_EXT_TIMER;
  529. msg->msg[2] = day;
  530. msg->msg[3] = month;
  531. /* Hours and minutes are in BCD format */
  532. msg->msg[4] = ((start_hr / 10) << 4) | (start_hr % 10);
  533. msg->msg[5] = ((start_min / 10) << 4) | (start_min % 10);
  534. msg->msg[6] = ((duration_hr / 10) << 4) | (duration_hr % 10);
  535. msg->msg[7] = ((duration_min / 10) << 4) | (duration_min % 10);
  536. msg->msg[8] = recording_seq;
  537. msg->msg[9] = ext_src_spec;
  538. msg->msg[10] = plug;
  539. msg->msg[11] = phys_addr >> 8;
  540. msg->msg[12] = phys_addr & 0xff;
  541. msg->reply = reply ? CEC_MSG_TIMER_CLEARED_STATUS : 0;
  542. }
  543. static __inline__ void cec_ops_clear_ext_timer(const struct cec_msg *msg,
  544. __u8 *day,
  545. __u8 *month,
  546. __u8 *start_hr,
  547. __u8 *start_min,
  548. __u8 *duration_hr,
  549. __u8 *duration_min,
  550. __u8 *recording_seq,
  551. __u8 *ext_src_spec,
  552. __u8 *plug,
  553. __u16 *phys_addr)
  554. {
  555. *day = msg->msg[2];
  556. *month = msg->msg[3];
  557. /* Hours and minutes are in BCD format */
  558. *start_hr = (msg->msg[4] >> 4) * 10 + (msg->msg[4] & 0xf);
  559. *start_min = (msg->msg[5] >> 4) * 10 + (msg->msg[5] & 0xf);
  560. *duration_hr = (msg->msg[6] >> 4) * 10 + (msg->msg[6] & 0xf);
  561. *duration_min = (msg->msg[7] >> 4) * 10 + (msg->msg[7] & 0xf);
  562. *recording_seq = msg->msg[8];
  563. *ext_src_spec = msg->msg[9];
  564. *plug = msg->msg[10];
  565. *phys_addr = (msg->msg[11] << 8) | msg->msg[12];
  566. }
  567. static __inline__ void cec_msg_set_analogue_timer(struct cec_msg *msg,
  568. int reply,
  569. __u8 day,
  570. __u8 month,
  571. __u8 start_hr,
  572. __u8 start_min,
  573. __u8 duration_hr,
  574. __u8 duration_min,
  575. __u8 recording_seq,
  576. __u8 ana_bcast_type,
  577. __u16 ana_freq,
  578. __u8 bcast_system)
  579. {
  580. msg->len = 13;
  581. msg->msg[1] = CEC_MSG_SET_ANALOGUE_TIMER;
  582. msg->msg[2] = day;
  583. msg->msg[3] = month;
  584. /* Hours and minutes are in BCD format */
  585. msg->msg[4] = ((start_hr / 10) << 4) | (start_hr % 10);
  586. msg->msg[5] = ((start_min / 10) << 4) | (start_min % 10);
  587. msg->msg[6] = ((duration_hr / 10) << 4) | (duration_hr % 10);
  588. msg->msg[7] = ((duration_min / 10) << 4) | (duration_min % 10);
  589. msg->msg[8] = recording_seq;
  590. msg->msg[9] = ana_bcast_type;
  591. msg->msg[10] = ana_freq >> 8;
  592. msg->msg[11] = ana_freq & 0xff;
  593. msg->msg[12] = bcast_system;
  594. msg->reply = reply ? CEC_MSG_TIMER_STATUS : 0;
  595. }
  596. static __inline__ void cec_ops_set_analogue_timer(const struct cec_msg *msg,
  597. __u8 *day,
  598. __u8 *month,
  599. __u8 *start_hr,
  600. __u8 *start_min,
  601. __u8 *duration_hr,
  602. __u8 *duration_min,
  603. __u8 *recording_seq,
  604. __u8 *ana_bcast_type,
  605. __u16 *ana_freq,
  606. __u8 *bcast_system)
  607. {
  608. *day = msg->msg[2];
  609. *month = msg->msg[3];
  610. /* Hours and minutes are in BCD format */
  611. *start_hr = (msg->msg[4] >> 4) * 10 + (msg->msg[4] & 0xf);
  612. *start_min = (msg->msg[5] >> 4) * 10 + (msg->msg[5] & 0xf);
  613. *duration_hr = (msg->msg[6] >> 4) * 10 + (msg->msg[6] & 0xf);
  614. *duration_min = (msg->msg[7] >> 4) * 10 + (msg->msg[7] & 0xf);
  615. *recording_seq = msg->msg[8];
  616. *ana_bcast_type = msg->msg[9];
  617. *ana_freq = (msg->msg[10] << 8) | msg->msg[11];
  618. *bcast_system = msg->msg[12];
  619. }
  620. static __inline__ void cec_msg_set_digital_timer(struct cec_msg *msg,
  621. int reply,
  622. __u8 day,
  623. __u8 month,
  624. __u8 start_hr,
  625. __u8 start_min,
  626. __u8 duration_hr,
  627. __u8 duration_min,
  628. __u8 recording_seq,
  629. const struct cec_op_digital_service_id *digital)
  630. {
  631. msg->len = 16;
  632. msg->reply = reply ? CEC_MSG_TIMER_STATUS : 0;
  633. msg->msg[1] = CEC_MSG_SET_DIGITAL_TIMER;
  634. msg->msg[2] = day;
  635. msg->msg[3] = month;
  636. /* Hours and minutes are in BCD format */
  637. msg->msg[4] = ((start_hr / 10) << 4) | (start_hr % 10);
  638. msg->msg[5] = ((start_min / 10) << 4) | (start_min % 10);
  639. msg->msg[6] = ((duration_hr / 10) << 4) | (duration_hr % 10);
  640. msg->msg[7] = ((duration_min / 10) << 4) | (duration_min % 10);
  641. msg->msg[8] = recording_seq;
  642. cec_set_digital_service_id(msg->msg + 9, digital);
  643. }
  644. static __inline__ void cec_ops_set_digital_timer(const struct cec_msg *msg,
  645. __u8 *day,
  646. __u8 *month,
  647. __u8 *start_hr,
  648. __u8 *start_min,
  649. __u8 *duration_hr,
  650. __u8 *duration_min,
  651. __u8 *recording_seq,
  652. struct cec_op_digital_service_id *digital)
  653. {
  654. *day = msg->msg[2];
  655. *month = msg->msg[3];
  656. /* Hours and minutes are in BCD format */
  657. *start_hr = (msg->msg[4] >> 4) * 10 + (msg->msg[4] & 0xf);
  658. *start_min = (msg->msg[5] >> 4) * 10 + (msg->msg[5] & 0xf);
  659. *duration_hr = (msg->msg[6] >> 4) * 10 + (msg->msg[6] & 0xf);
  660. *duration_min = (msg->msg[7] >> 4) * 10 + (msg->msg[7] & 0xf);
  661. *recording_seq = msg->msg[8];
  662. cec_get_digital_service_id(msg->msg + 9, digital);
  663. }
  664. static __inline__ void cec_msg_set_ext_timer(struct cec_msg *msg,
  665. int reply,
  666. __u8 day,
  667. __u8 month,
  668. __u8 start_hr,
  669. __u8 start_min,
  670. __u8 duration_hr,
  671. __u8 duration_min,
  672. __u8 recording_seq,
  673. __u8 ext_src_spec,
  674. __u8 plug,
  675. __u16 phys_addr)
  676. {
  677. msg->len = 13;
  678. msg->msg[1] = CEC_MSG_SET_EXT_TIMER;
  679. msg->msg[2] = day;
  680. msg->msg[3] = month;
  681. /* Hours and minutes are in BCD format */
  682. msg->msg[4] = ((start_hr / 10) << 4) | (start_hr % 10);
  683. msg->msg[5] = ((start_min / 10) << 4) | (start_min % 10);
  684. msg->msg[6] = ((duration_hr / 10) << 4) | (duration_hr % 10);
  685. msg->msg[7] = ((duration_min / 10) << 4) | (duration_min % 10);
  686. msg->msg[8] = recording_seq;
  687. msg->msg[9] = ext_src_spec;
  688. msg->msg[10] = plug;
  689. msg->msg[11] = phys_addr >> 8;
  690. msg->msg[12] = phys_addr & 0xff;
  691. msg->reply = reply ? CEC_MSG_TIMER_STATUS : 0;
  692. }
  693. static __inline__ void cec_ops_set_ext_timer(const struct cec_msg *msg,
  694. __u8 *day,
  695. __u8 *month,
  696. __u8 *start_hr,
  697. __u8 *start_min,
  698. __u8 *duration_hr,
  699. __u8 *duration_min,
  700. __u8 *recording_seq,
  701. __u8 *ext_src_spec,
  702. __u8 *plug,
  703. __u16 *phys_addr)
  704. {
  705. *day = msg->msg[2];
  706. *month = msg->msg[3];
  707. /* Hours and minutes are in BCD format */
  708. *start_hr = (msg->msg[4] >> 4) * 10 + (msg->msg[4] & 0xf);
  709. *start_min = (msg->msg[5] >> 4) * 10 + (msg->msg[5] & 0xf);
  710. *duration_hr = (msg->msg[6] >> 4) * 10 + (msg->msg[6] & 0xf);
  711. *duration_min = (msg->msg[7] >> 4) * 10 + (msg->msg[7] & 0xf);
  712. *recording_seq = msg->msg[8];
  713. *ext_src_spec = msg->msg[9];
  714. *plug = msg->msg[10];
  715. *phys_addr = (msg->msg[11] << 8) | msg->msg[12];
  716. }
  717. static __inline__ void cec_msg_set_timer_program_title(struct cec_msg *msg,
  718. const char *prog_title)
  719. {
  720. unsigned int len = strlen(prog_title);
  721. if (len > 14)
  722. len = 14;
  723. msg->len = 2 + len;
  724. msg->msg[1] = CEC_MSG_SET_TIMER_PROGRAM_TITLE;
  725. memcpy(msg->msg + 2, prog_title, len);
  726. }
  727. static __inline__ void cec_ops_set_timer_program_title(const struct cec_msg *msg,
  728. char *prog_title)
  729. {
  730. unsigned int len = msg->len > 2 ? msg->len - 2 : 0;
  731. if (len > 14)
  732. len = 14;
  733. memcpy(prog_title, msg->msg + 2, len);
  734. prog_title[len] = '\0';
  735. }
  736. /* System Information Feature */
  737. static __inline__ void cec_msg_cec_version(struct cec_msg *msg, __u8 cec_version)
  738. {
  739. msg->len = 3;
  740. msg->msg[1] = CEC_MSG_CEC_VERSION;
  741. msg->msg[2] = cec_version;
  742. }
  743. static __inline__ void cec_ops_cec_version(const struct cec_msg *msg,
  744. __u8 *cec_version)
  745. {
  746. *cec_version = msg->msg[2];
  747. }
  748. static __inline__ void cec_msg_get_cec_version(struct cec_msg *msg,
  749. int reply)
  750. {
  751. msg->len = 2;
  752. msg->msg[1] = CEC_MSG_GET_CEC_VERSION;
  753. msg->reply = reply ? CEC_MSG_CEC_VERSION : 0;
  754. }
  755. static __inline__ void cec_msg_report_physical_addr(struct cec_msg *msg,
  756. __u16 phys_addr, __u8 prim_devtype)
  757. {
  758. msg->len = 5;
  759. msg->msg[0] |= 0xf; /* broadcast */
  760. msg->msg[1] = CEC_MSG_REPORT_PHYSICAL_ADDR;
  761. msg->msg[2] = phys_addr >> 8;
  762. msg->msg[3] = phys_addr & 0xff;
  763. msg->msg[4] = prim_devtype;
  764. }
  765. static __inline__ void cec_ops_report_physical_addr(const struct cec_msg *msg,
  766. __u16 *phys_addr, __u8 *prim_devtype)
  767. {
  768. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  769. *prim_devtype = msg->msg[4];
  770. }
  771. static __inline__ void cec_msg_give_physical_addr(struct cec_msg *msg,
  772. int reply)
  773. {
  774. msg->len = 2;
  775. msg->msg[1] = CEC_MSG_GIVE_PHYSICAL_ADDR;
  776. msg->reply = reply ? CEC_MSG_REPORT_PHYSICAL_ADDR : 0;
  777. }
  778. static __inline__ void cec_msg_set_menu_language(struct cec_msg *msg,
  779. const char *language)
  780. {
  781. msg->len = 5;
  782. msg->msg[0] |= 0xf; /* broadcast */
  783. msg->msg[1] = CEC_MSG_SET_MENU_LANGUAGE;
  784. memcpy(msg->msg + 2, language, 3);
  785. }
  786. static __inline__ void cec_ops_set_menu_language(const struct cec_msg *msg,
  787. char *language)
  788. {
  789. memcpy(language, msg->msg + 2, 3);
  790. language[3] = '\0';
  791. }
  792. static __inline__ void cec_msg_get_menu_language(struct cec_msg *msg,
  793. int reply)
  794. {
  795. msg->len = 2;
  796. msg->msg[1] = CEC_MSG_GET_MENU_LANGUAGE;
  797. msg->reply = reply ? CEC_MSG_SET_MENU_LANGUAGE : 0;
  798. }
  799. /*
  800. * Assumes a single RC Profile byte and a single Device Features byte,
  801. * i.e. no extended features are supported by this helper function.
  802. *
  803. * As of CEC 2.0 no extended features are defined, should those be added
  804. * in the future, then this function needs to be adapted or a new function
  805. * should be added.
  806. */
  807. static __inline__ void cec_msg_report_features(struct cec_msg *msg,
  808. __u8 cec_version, __u8 all_device_types,
  809. __u8 rc_profile, __u8 dev_features)
  810. {
  811. msg->len = 6;
  812. msg->msg[0] |= 0xf; /* broadcast */
  813. msg->msg[1] = CEC_MSG_REPORT_FEATURES;
  814. msg->msg[2] = cec_version;
  815. msg->msg[3] = all_device_types;
  816. msg->msg[4] = rc_profile;
  817. msg->msg[5] = dev_features;
  818. }
  819. static __inline__ void cec_ops_report_features(const struct cec_msg *msg,
  820. __u8 *cec_version, __u8 *all_device_types,
  821. const __u8 **rc_profile, const __u8 **dev_features)
  822. {
  823. const __u8 *p = &msg->msg[4];
  824. *cec_version = msg->msg[2];
  825. *all_device_types = msg->msg[3];
  826. *rc_profile = p;
  827. while (p < &msg->msg[14] && (*p & CEC_OP_FEAT_EXT))
  828. p++;
  829. if (!(*p & CEC_OP_FEAT_EXT)) {
  830. *dev_features = p + 1;
  831. while (p < &msg->msg[15] && (*p & CEC_OP_FEAT_EXT))
  832. p++;
  833. }
  834. if (*p & CEC_OP_FEAT_EXT)
  835. *rc_profile = *dev_features = NULL;
  836. }
  837. static __inline__ void cec_msg_give_features(struct cec_msg *msg,
  838. int reply)
  839. {
  840. msg->len = 2;
  841. msg->msg[1] = CEC_MSG_GIVE_FEATURES;
  842. msg->reply = reply ? CEC_MSG_REPORT_FEATURES : 0;
  843. }
  844. /* Deck Control Feature */
  845. static __inline__ void cec_msg_deck_control(struct cec_msg *msg,
  846. __u8 deck_control_mode)
  847. {
  848. msg->len = 3;
  849. msg->msg[1] = CEC_MSG_DECK_CONTROL;
  850. msg->msg[2] = deck_control_mode;
  851. }
  852. static __inline__ void cec_ops_deck_control(const struct cec_msg *msg,
  853. __u8 *deck_control_mode)
  854. {
  855. *deck_control_mode = msg->msg[2];
  856. }
  857. static __inline__ void cec_msg_deck_status(struct cec_msg *msg,
  858. __u8 deck_info)
  859. {
  860. msg->len = 3;
  861. msg->msg[1] = CEC_MSG_DECK_STATUS;
  862. msg->msg[2] = deck_info;
  863. }
  864. static __inline__ void cec_ops_deck_status(const struct cec_msg *msg,
  865. __u8 *deck_info)
  866. {
  867. *deck_info = msg->msg[2];
  868. }
  869. static __inline__ void cec_msg_give_deck_status(struct cec_msg *msg,
  870. int reply,
  871. __u8 status_req)
  872. {
  873. msg->len = 3;
  874. msg->msg[1] = CEC_MSG_GIVE_DECK_STATUS;
  875. msg->msg[2] = status_req;
  876. msg->reply = reply ? CEC_MSG_DECK_STATUS : 0;
  877. }
  878. static __inline__ void cec_ops_give_deck_status(const struct cec_msg *msg,
  879. __u8 *status_req)
  880. {
  881. *status_req = msg->msg[2];
  882. }
  883. static __inline__ void cec_msg_play(struct cec_msg *msg,
  884. __u8 play_mode)
  885. {
  886. msg->len = 3;
  887. msg->msg[1] = CEC_MSG_PLAY;
  888. msg->msg[2] = play_mode;
  889. }
  890. static __inline__ void cec_ops_play(const struct cec_msg *msg,
  891. __u8 *play_mode)
  892. {
  893. *play_mode = msg->msg[2];
  894. }
  895. /* Tuner Control Feature */
  896. struct cec_op_tuner_device_info {
  897. __u8 rec_flag;
  898. __u8 tuner_display_info;
  899. __u8 is_analog;
  900. union {
  901. struct cec_op_digital_service_id digital;
  902. struct {
  903. __u8 ana_bcast_type;
  904. __u16 ana_freq;
  905. __u8 bcast_system;
  906. } analog;
  907. };
  908. };
  909. static __inline__ void cec_msg_tuner_device_status_analog(struct cec_msg *msg,
  910. __u8 rec_flag,
  911. __u8 tuner_display_info,
  912. __u8 ana_bcast_type,
  913. __u16 ana_freq,
  914. __u8 bcast_system)
  915. {
  916. msg->len = 7;
  917. msg->msg[1] = CEC_MSG_TUNER_DEVICE_STATUS;
  918. msg->msg[2] = (rec_flag << 7) | tuner_display_info;
  919. msg->msg[3] = ana_bcast_type;
  920. msg->msg[4] = ana_freq >> 8;
  921. msg->msg[5] = ana_freq & 0xff;
  922. msg->msg[6] = bcast_system;
  923. }
  924. static __inline__ void cec_msg_tuner_device_status_digital(struct cec_msg *msg,
  925. __u8 rec_flag, __u8 tuner_display_info,
  926. const struct cec_op_digital_service_id *digital)
  927. {
  928. msg->len = 10;
  929. msg->msg[1] = CEC_MSG_TUNER_DEVICE_STATUS;
  930. msg->msg[2] = (rec_flag << 7) | tuner_display_info;
  931. cec_set_digital_service_id(msg->msg + 3, digital);
  932. }
  933. static __inline__ void cec_msg_tuner_device_status(struct cec_msg *msg,
  934. const struct cec_op_tuner_device_info *tuner_dev_info)
  935. {
  936. if (tuner_dev_info->is_analog)
  937. cec_msg_tuner_device_status_analog(msg,
  938. tuner_dev_info->rec_flag,
  939. tuner_dev_info->tuner_display_info,
  940. tuner_dev_info->analog.ana_bcast_type,
  941. tuner_dev_info->analog.ana_freq,
  942. tuner_dev_info->analog.bcast_system);
  943. else
  944. cec_msg_tuner_device_status_digital(msg,
  945. tuner_dev_info->rec_flag,
  946. tuner_dev_info->tuner_display_info,
  947. &tuner_dev_info->digital);
  948. }
  949. static __inline__ void cec_ops_tuner_device_status(const struct cec_msg *msg,
  950. struct cec_op_tuner_device_info *tuner_dev_info)
  951. {
  952. tuner_dev_info->is_analog = msg->len < 10;
  953. tuner_dev_info->rec_flag = msg->msg[2] >> 7;
  954. tuner_dev_info->tuner_display_info = msg->msg[2] & 0x7f;
  955. if (tuner_dev_info->is_analog) {
  956. tuner_dev_info->analog.ana_bcast_type = msg->msg[3];
  957. tuner_dev_info->analog.ana_freq = (msg->msg[4] << 8) | msg->msg[5];
  958. tuner_dev_info->analog.bcast_system = msg->msg[6];
  959. return;
  960. }
  961. cec_get_digital_service_id(msg->msg + 3, &tuner_dev_info->digital);
  962. }
  963. static __inline__ void cec_msg_give_tuner_device_status(struct cec_msg *msg,
  964. int reply,
  965. __u8 status_req)
  966. {
  967. msg->len = 3;
  968. msg->msg[1] = CEC_MSG_GIVE_TUNER_DEVICE_STATUS;
  969. msg->msg[2] = status_req;
  970. msg->reply = reply ? CEC_MSG_TUNER_DEVICE_STATUS : 0;
  971. }
  972. static __inline__ void cec_ops_give_tuner_device_status(const struct cec_msg *msg,
  973. __u8 *status_req)
  974. {
  975. *status_req = msg->msg[2];
  976. }
  977. static __inline__ void cec_msg_select_analogue_service(struct cec_msg *msg,
  978. __u8 ana_bcast_type,
  979. __u16 ana_freq,
  980. __u8 bcast_system)
  981. {
  982. msg->len = 6;
  983. msg->msg[1] = CEC_MSG_SELECT_ANALOGUE_SERVICE;
  984. msg->msg[2] = ana_bcast_type;
  985. msg->msg[3] = ana_freq >> 8;
  986. msg->msg[4] = ana_freq & 0xff;
  987. msg->msg[5] = bcast_system;
  988. }
  989. static __inline__ void cec_ops_select_analogue_service(const struct cec_msg *msg,
  990. __u8 *ana_bcast_type,
  991. __u16 *ana_freq,
  992. __u8 *bcast_system)
  993. {
  994. *ana_bcast_type = msg->msg[2];
  995. *ana_freq = (msg->msg[3] << 8) | msg->msg[4];
  996. *bcast_system = msg->msg[5];
  997. }
  998. static __inline__ void cec_msg_select_digital_service(struct cec_msg *msg,
  999. const struct cec_op_digital_service_id *digital)
  1000. {
  1001. msg->len = 9;
  1002. msg->msg[1] = CEC_MSG_SELECT_DIGITAL_SERVICE;
  1003. cec_set_digital_service_id(msg->msg + 2, digital);
  1004. }
  1005. static __inline__ void cec_ops_select_digital_service(const struct cec_msg *msg,
  1006. struct cec_op_digital_service_id *digital)
  1007. {
  1008. cec_get_digital_service_id(msg->msg + 2, digital);
  1009. }
  1010. static __inline__ void cec_msg_tuner_step_decrement(struct cec_msg *msg)
  1011. {
  1012. msg->len = 2;
  1013. msg->msg[1] = CEC_MSG_TUNER_STEP_DECREMENT;
  1014. }
  1015. static __inline__ void cec_msg_tuner_step_increment(struct cec_msg *msg)
  1016. {
  1017. msg->len = 2;
  1018. msg->msg[1] = CEC_MSG_TUNER_STEP_INCREMENT;
  1019. }
  1020. /* Vendor Specific Commands Feature */
  1021. static __inline__ void cec_msg_device_vendor_id(struct cec_msg *msg, __u32 vendor_id)
  1022. {
  1023. msg->len = 5;
  1024. msg->msg[0] |= 0xf; /* broadcast */
  1025. msg->msg[1] = CEC_MSG_DEVICE_VENDOR_ID;
  1026. msg->msg[2] = vendor_id >> 16;
  1027. msg->msg[3] = (vendor_id >> 8) & 0xff;
  1028. msg->msg[4] = vendor_id & 0xff;
  1029. }
  1030. static __inline__ void cec_ops_device_vendor_id(const struct cec_msg *msg,
  1031. __u32 *vendor_id)
  1032. {
  1033. *vendor_id = (msg->msg[2] << 16) | (msg->msg[3] << 8) | msg->msg[4];
  1034. }
  1035. static __inline__ void cec_msg_give_device_vendor_id(struct cec_msg *msg,
  1036. int reply)
  1037. {
  1038. msg->len = 2;
  1039. msg->msg[1] = CEC_MSG_GIVE_DEVICE_VENDOR_ID;
  1040. msg->reply = reply ? CEC_MSG_DEVICE_VENDOR_ID : 0;
  1041. }
  1042. static __inline__ void cec_msg_vendor_command(struct cec_msg *msg,
  1043. __u8 size, const __u8 *vendor_cmd)
  1044. {
  1045. if (size > 14)
  1046. size = 14;
  1047. msg->len = 2 + size;
  1048. msg->msg[1] = CEC_MSG_VENDOR_COMMAND;
  1049. memcpy(msg->msg + 2, vendor_cmd, size);
  1050. }
  1051. static __inline__ void cec_ops_vendor_command(const struct cec_msg *msg,
  1052. __u8 *size,
  1053. const __u8 **vendor_cmd)
  1054. {
  1055. *size = msg->len - 2;
  1056. if (*size > 14)
  1057. *size = 14;
  1058. *vendor_cmd = msg->msg + 2;
  1059. }
  1060. static __inline__ void cec_msg_vendor_command_with_id(struct cec_msg *msg,
  1061. __u32 vendor_id, __u8 size,
  1062. const __u8 *vendor_cmd)
  1063. {
  1064. if (size > 11)
  1065. size = 11;
  1066. msg->len = 5 + size;
  1067. msg->msg[1] = CEC_MSG_VENDOR_COMMAND_WITH_ID;
  1068. msg->msg[2] = vendor_id >> 16;
  1069. msg->msg[3] = (vendor_id >> 8) & 0xff;
  1070. msg->msg[4] = vendor_id & 0xff;
  1071. memcpy(msg->msg + 5, vendor_cmd, size);
  1072. }
  1073. static __inline__ void cec_ops_vendor_command_with_id(const struct cec_msg *msg,
  1074. __u32 *vendor_id, __u8 *size,
  1075. const __u8 **vendor_cmd)
  1076. {
  1077. *size = msg->len - 5;
  1078. if (*size > 11)
  1079. *size = 11;
  1080. *vendor_id = (msg->msg[2] << 16) | (msg->msg[3] << 8) | msg->msg[4];
  1081. *vendor_cmd = msg->msg + 5;
  1082. }
  1083. static __inline__ void cec_msg_vendor_remote_button_down(struct cec_msg *msg,
  1084. __u8 size,
  1085. const __u8 *rc_code)
  1086. {
  1087. if (size > 14)
  1088. size = 14;
  1089. msg->len = 2 + size;
  1090. msg->msg[1] = CEC_MSG_VENDOR_REMOTE_BUTTON_DOWN;
  1091. memcpy(msg->msg + 2, rc_code, size);
  1092. }
  1093. static __inline__ void cec_ops_vendor_remote_button_down(const struct cec_msg *msg,
  1094. __u8 *size,
  1095. const __u8 **rc_code)
  1096. {
  1097. *size = msg->len - 2;
  1098. if (*size > 14)
  1099. *size = 14;
  1100. *rc_code = msg->msg + 2;
  1101. }
  1102. static __inline__ void cec_msg_vendor_remote_button_up(struct cec_msg *msg)
  1103. {
  1104. msg->len = 2;
  1105. msg->msg[1] = CEC_MSG_VENDOR_REMOTE_BUTTON_UP;
  1106. }
  1107. /* OSD Display Feature */
  1108. static __inline__ void cec_msg_set_osd_string(struct cec_msg *msg,
  1109. __u8 disp_ctl,
  1110. const char *osd)
  1111. {
  1112. unsigned int len = strlen(osd);
  1113. if (len > 13)
  1114. len = 13;
  1115. msg->len = 3 + len;
  1116. msg->msg[1] = CEC_MSG_SET_OSD_STRING;
  1117. msg->msg[2] = disp_ctl;
  1118. memcpy(msg->msg + 3, osd, len);
  1119. }
  1120. static __inline__ void cec_ops_set_osd_string(const struct cec_msg *msg,
  1121. __u8 *disp_ctl,
  1122. char *osd)
  1123. {
  1124. unsigned int len = msg->len > 3 ? msg->len - 3 : 0;
  1125. *disp_ctl = msg->msg[2];
  1126. if (len > 13)
  1127. len = 13;
  1128. memcpy(osd, msg->msg + 3, len);
  1129. osd[len] = '\0';
  1130. }
  1131. /* Device OSD Transfer Feature */
  1132. static __inline__ void cec_msg_set_osd_name(struct cec_msg *msg, const char *name)
  1133. {
  1134. unsigned int len = strlen(name);
  1135. if (len > 14)
  1136. len = 14;
  1137. msg->len = 2 + len;
  1138. msg->msg[1] = CEC_MSG_SET_OSD_NAME;
  1139. memcpy(msg->msg + 2, name, len);
  1140. }
  1141. static __inline__ void cec_ops_set_osd_name(const struct cec_msg *msg,
  1142. char *name)
  1143. {
  1144. unsigned int len = msg->len > 2 ? msg->len - 2 : 0;
  1145. if (len > 14)
  1146. len = 14;
  1147. memcpy(name, msg->msg + 2, len);
  1148. name[len] = '\0';
  1149. }
  1150. static __inline__ void cec_msg_give_osd_name(struct cec_msg *msg,
  1151. int reply)
  1152. {
  1153. msg->len = 2;
  1154. msg->msg[1] = CEC_MSG_GIVE_OSD_NAME;
  1155. msg->reply = reply ? CEC_MSG_SET_OSD_NAME : 0;
  1156. }
  1157. /* Device Menu Control Feature */
  1158. static __inline__ void cec_msg_menu_status(struct cec_msg *msg,
  1159. __u8 menu_state)
  1160. {
  1161. msg->len = 3;
  1162. msg->msg[1] = CEC_MSG_MENU_STATUS;
  1163. msg->msg[2] = menu_state;
  1164. }
  1165. static __inline__ void cec_ops_menu_status(const struct cec_msg *msg,
  1166. __u8 *menu_state)
  1167. {
  1168. *menu_state = msg->msg[2];
  1169. }
  1170. static __inline__ void cec_msg_menu_request(struct cec_msg *msg,
  1171. int reply,
  1172. __u8 menu_req)
  1173. {
  1174. msg->len = 3;
  1175. msg->msg[1] = CEC_MSG_MENU_REQUEST;
  1176. msg->msg[2] = menu_req;
  1177. msg->reply = reply ? CEC_MSG_MENU_STATUS : 0;
  1178. }
  1179. static __inline__ void cec_ops_menu_request(const struct cec_msg *msg,
  1180. __u8 *menu_req)
  1181. {
  1182. *menu_req = msg->msg[2];
  1183. }
  1184. struct cec_op_ui_command {
  1185. __u8 ui_cmd;
  1186. __u8 has_opt_arg;
  1187. union {
  1188. struct cec_op_channel_data channel_identifier;
  1189. __u8 ui_broadcast_type;
  1190. __u8 ui_sound_presentation_control;
  1191. __u8 play_mode;
  1192. __u8 ui_function_media;
  1193. __u8 ui_function_select_av_input;
  1194. __u8 ui_function_select_audio_input;
  1195. };
  1196. };
  1197. static __inline__ void cec_msg_user_control_pressed(struct cec_msg *msg,
  1198. const struct cec_op_ui_command *ui_cmd)
  1199. {
  1200. msg->len = 3;
  1201. msg->msg[1] = CEC_MSG_USER_CONTROL_PRESSED;
  1202. msg->msg[2] = ui_cmd->ui_cmd;
  1203. if (!ui_cmd->has_opt_arg)
  1204. return;
  1205. switch (ui_cmd->ui_cmd) {
  1206. case 0x56:
  1207. case 0x57:
  1208. case 0x60:
  1209. case 0x68:
  1210. case 0x69:
  1211. case 0x6a:
  1212. /* The optional operand is one byte for all these ui commands */
  1213. msg->len++;
  1214. msg->msg[3] = ui_cmd->play_mode;
  1215. break;
  1216. case 0x67:
  1217. msg->len += 4;
  1218. msg->msg[3] = (ui_cmd->channel_identifier.channel_number_fmt << 2) |
  1219. (ui_cmd->channel_identifier.major >> 8);
  1220. msg->msg[4] = ui_cmd->channel_identifier.major & 0xff;
  1221. msg->msg[5] = ui_cmd->channel_identifier.minor >> 8;
  1222. msg->msg[6] = ui_cmd->channel_identifier.minor & 0xff;
  1223. break;
  1224. }
  1225. }
  1226. static __inline__ void cec_ops_user_control_pressed(const struct cec_msg *msg,
  1227. struct cec_op_ui_command *ui_cmd)
  1228. {
  1229. ui_cmd->ui_cmd = msg->msg[2];
  1230. ui_cmd->has_opt_arg = 0;
  1231. if (msg->len == 3)
  1232. return;
  1233. switch (ui_cmd->ui_cmd) {
  1234. case 0x56:
  1235. case 0x57:
  1236. case 0x60:
  1237. case 0x68:
  1238. case 0x69:
  1239. case 0x6a:
  1240. /* The optional operand is one byte for all these ui commands */
  1241. ui_cmd->play_mode = msg->msg[3];
  1242. ui_cmd->has_opt_arg = 1;
  1243. break;
  1244. case 0x67:
  1245. if (msg->len < 7)
  1246. break;
  1247. ui_cmd->has_opt_arg = 1;
  1248. ui_cmd->channel_identifier.channel_number_fmt = msg->msg[3] >> 2;
  1249. ui_cmd->channel_identifier.major = ((msg->msg[3] & 3) << 6) | msg->msg[4];
  1250. ui_cmd->channel_identifier.minor = (msg->msg[5] << 8) | msg->msg[6];
  1251. break;
  1252. }
  1253. }
  1254. static __inline__ void cec_msg_user_control_released(struct cec_msg *msg)
  1255. {
  1256. msg->len = 2;
  1257. msg->msg[1] = CEC_MSG_USER_CONTROL_RELEASED;
  1258. }
  1259. /* Remote Control Passthrough Feature */
  1260. /* Power Status Feature */
  1261. static __inline__ void cec_msg_report_power_status(struct cec_msg *msg,
  1262. __u8 pwr_state)
  1263. {
  1264. msg->len = 3;
  1265. msg->msg[1] = CEC_MSG_REPORT_POWER_STATUS;
  1266. msg->msg[2] = pwr_state;
  1267. }
  1268. static __inline__ void cec_ops_report_power_status(const struct cec_msg *msg,
  1269. __u8 *pwr_state)
  1270. {
  1271. *pwr_state = msg->msg[2];
  1272. }
  1273. static __inline__ void cec_msg_give_device_power_status(struct cec_msg *msg,
  1274. int reply)
  1275. {
  1276. msg->len = 2;
  1277. msg->msg[1] = CEC_MSG_GIVE_DEVICE_POWER_STATUS;
  1278. msg->reply = reply ? CEC_MSG_REPORT_POWER_STATUS : 0;
  1279. }
  1280. /* General Protocol Messages */
  1281. static __inline__ void cec_msg_feature_abort(struct cec_msg *msg,
  1282. __u8 abort_msg, __u8 reason)
  1283. {
  1284. msg->len = 4;
  1285. msg->msg[1] = CEC_MSG_FEATURE_ABORT;
  1286. msg->msg[2] = abort_msg;
  1287. msg->msg[3] = reason;
  1288. }
  1289. static __inline__ void cec_ops_feature_abort(const struct cec_msg *msg,
  1290. __u8 *abort_msg, __u8 *reason)
  1291. {
  1292. *abort_msg = msg->msg[2];
  1293. *reason = msg->msg[3];
  1294. }
  1295. /* This changes the current message into a feature abort message */
  1296. static __inline__ void cec_msg_reply_feature_abort(struct cec_msg *msg, __u8 reason)
  1297. {
  1298. cec_msg_set_reply_to(msg, msg);
  1299. msg->len = 4;
  1300. msg->msg[2] = msg->msg[1];
  1301. msg->msg[3] = reason;
  1302. msg->msg[1] = CEC_MSG_FEATURE_ABORT;
  1303. }
  1304. static __inline__ void cec_msg_abort(struct cec_msg *msg)
  1305. {
  1306. msg->len = 2;
  1307. msg->msg[1] = CEC_MSG_ABORT;
  1308. }
  1309. /* System Audio Control Feature */
  1310. static __inline__ void cec_msg_report_audio_status(struct cec_msg *msg,
  1311. __u8 aud_mute_status,
  1312. __u8 aud_vol_status)
  1313. {
  1314. msg->len = 3;
  1315. msg->msg[1] = CEC_MSG_REPORT_AUDIO_STATUS;
  1316. msg->msg[2] = (aud_mute_status << 7) | (aud_vol_status & 0x7f);
  1317. }
  1318. static __inline__ void cec_ops_report_audio_status(const struct cec_msg *msg,
  1319. __u8 *aud_mute_status,
  1320. __u8 *aud_vol_status)
  1321. {
  1322. *aud_mute_status = msg->msg[2] >> 7;
  1323. *aud_vol_status = msg->msg[2] & 0x7f;
  1324. }
  1325. static __inline__ void cec_msg_give_audio_status(struct cec_msg *msg,
  1326. int reply)
  1327. {
  1328. msg->len = 2;
  1329. msg->msg[1] = CEC_MSG_GIVE_AUDIO_STATUS;
  1330. msg->reply = reply ? CEC_MSG_REPORT_AUDIO_STATUS : 0;
  1331. }
  1332. static __inline__ void cec_msg_set_system_audio_mode(struct cec_msg *msg,
  1333. __u8 sys_aud_status)
  1334. {
  1335. msg->len = 3;
  1336. msg->msg[1] = CEC_MSG_SET_SYSTEM_AUDIO_MODE;
  1337. msg->msg[2] = sys_aud_status;
  1338. }
  1339. static __inline__ void cec_ops_set_system_audio_mode(const struct cec_msg *msg,
  1340. __u8 *sys_aud_status)
  1341. {
  1342. *sys_aud_status = msg->msg[2];
  1343. }
  1344. static __inline__ void cec_msg_system_audio_mode_request(struct cec_msg *msg,
  1345. int reply,
  1346. __u16 phys_addr)
  1347. {
  1348. msg->len = phys_addr == 0xffff ? 2 : 4;
  1349. msg->msg[1] = CEC_MSG_SYSTEM_AUDIO_MODE_REQUEST;
  1350. msg->msg[2] = phys_addr >> 8;
  1351. msg->msg[3] = phys_addr & 0xff;
  1352. msg->reply = reply ? CEC_MSG_SET_SYSTEM_AUDIO_MODE : 0;
  1353. }
  1354. static __inline__ void cec_ops_system_audio_mode_request(const struct cec_msg *msg,
  1355. __u16 *phys_addr)
  1356. {
  1357. if (msg->len < 4)
  1358. *phys_addr = 0xffff;
  1359. else
  1360. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1361. }
  1362. static __inline__ void cec_msg_system_audio_mode_status(struct cec_msg *msg,
  1363. __u8 sys_aud_status)
  1364. {
  1365. msg->len = 3;
  1366. msg->msg[1] = CEC_MSG_SYSTEM_AUDIO_MODE_STATUS;
  1367. msg->msg[2] = sys_aud_status;
  1368. }
  1369. static __inline__ void cec_ops_system_audio_mode_status(const struct cec_msg *msg,
  1370. __u8 *sys_aud_status)
  1371. {
  1372. *sys_aud_status = msg->msg[2];
  1373. }
  1374. static __inline__ void cec_msg_give_system_audio_mode_status(struct cec_msg *msg,
  1375. int reply)
  1376. {
  1377. msg->len = 2;
  1378. msg->msg[1] = CEC_MSG_GIVE_SYSTEM_AUDIO_MODE_STATUS;
  1379. msg->reply = reply ? CEC_MSG_SYSTEM_AUDIO_MODE_STATUS : 0;
  1380. }
  1381. static __inline__ void cec_msg_report_short_audio_descriptor(struct cec_msg *msg,
  1382. __u8 num_descriptors,
  1383. const __u32 *descriptors)
  1384. {
  1385. unsigned int i;
  1386. if (num_descriptors > 4)
  1387. num_descriptors = 4;
  1388. msg->len = 2 + num_descriptors * 3;
  1389. msg->msg[1] = CEC_MSG_REPORT_SHORT_AUDIO_DESCRIPTOR;
  1390. for (i = 0; i < num_descriptors; i++) {
  1391. msg->msg[2 + i * 3] = (descriptors[i] >> 16) & 0xff;
  1392. msg->msg[3 + i * 3] = (descriptors[i] >> 8) & 0xff;
  1393. msg->msg[4 + i * 3] = descriptors[i] & 0xff;
  1394. }
  1395. }
  1396. static __inline__ void cec_ops_report_short_audio_descriptor(const struct cec_msg *msg,
  1397. __u8 *num_descriptors,
  1398. __u32 *descriptors)
  1399. {
  1400. unsigned int i;
  1401. *num_descriptors = (msg->len - 2) / 3;
  1402. if (*num_descriptors > 4)
  1403. *num_descriptors = 4;
  1404. for (i = 0; i < *num_descriptors; i++)
  1405. descriptors[i] = (msg->msg[2 + i * 3] << 16) |
  1406. (msg->msg[3 + i * 3] << 8) |
  1407. msg->msg[4 + i * 3];
  1408. }
  1409. static __inline__ void cec_msg_request_short_audio_descriptor(struct cec_msg *msg,
  1410. int reply,
  1411. __u8 num_descriptors,
  1412. const __u8 *audio_format_id,
  1413. const __u8 *audio_format_code)
  1414. {
  1415. unsigned int i;
  1416. if (num_descriptors > 4)
  1417. num_descriptors = 4;
  1418. msg->len = 2 + num_descriptors;
  1419. msg->msg[1] = CEC_MSG_REQUEST_SHORT_AUDIO_DESCRIPTOR;
  1420. msg->reply = reply ? CEC_MSG_REPORT_SHORT_AUDIO_DESCRIPTOR : 0;
  1421. for (i = 0; i < num_descriptors; i++)
  1422. msg->msg[2 + i] = (audio_format_id[i] << 6) |
  1423. (audio_format_code[i] & 0x3f);
  1424. }
  1425. static __inline__ void cec_ops_request_short_audio_descriptor(const struct cec_msg *msg,
  1426. __u8 *num_descriptors,
  1427. __u8 *audio_format_id,
  1428. __u8 *audio_format_code)
  1429. {
  1430. unsigned int i;
  1431. *num_descriptors = msg->len - 2;
  1432. if (*num_descriptors > 4)
  1433. *num_descriptors = 4;
  1434. for (i = 0; i < *num_descriptors; i++) {
  1435. audio_format_id[i] = msg->msg[2 + i] >> 6;
  1436. audio_format_code[i] = msg->msg[2 + i] & 0x3f;
  1437. }
  1438. }
  1439. /* Audio Rate Control Feature */
  1440. static __inline__ void cec_msg_set_audio_rate(struct cec_msg *msg,
  1441. __u8 audio_rate)
  1442. {
  1443. msg->len = 3;
  1444. msg->msg[1] = CEC_MSG_SET_AUDIO_RATE;
  1445. msg->msg[2] = audio_rate;
  1446. }
  1447. static __inline__ void cec_ops_set_audio_rate(const struct cec_msg *msg,
  1448. __u8 *audio_rate)
  1449. {
  1450. *audio_rate = msg->msg[2];
  1451. }
  1452. /* Audio Return Channel Control Feature */
  1453. static __inline__ void cec_msg_report_arc_initiated(struct cec_msg *msg)
  1454. {
  1455. msg->len = 2;
  1456. msg->msg[1] = CEC_MSG_REPORT_ARC_INITIATED;
  1457. }
  1458. static __inline__ void cec_msg_initiate_arc(struct cec_msg *msg,
  1459. int reply)
  1460. {
  1461. msg->len = 2;
  1462. msg->msg[1] = CEC_MSG_INITIATE_ARC;
  1463. msg->reply = reply ? CEC_MSG_REPORT_ARC_INITIATED : 0;
  1464. }
  1465. static __inline__ void cec_msg_request_arc_initiation(struct cec_msg *msg,
  1466. int reply)
  1467. {
  1468. msg->len = 2;
  1469. msg->msg[1] = CEC_MSG_REQUEST_ARC_INITIATION;
  1470. msg->reply = reply ? CEC_MSG_INITIATE_ARC : 0;
  1471. }
  1472. static __inline__ void cec_msg_report_arc_terminated(struct cec_msg *msg)
  1473. {
  1474. msg->len = 2;
  1475. msg->msg[1] = CEC_MSG_REPORT_ARC_TERMINATED;
  1476. }
  1477. static __inline__ void cec_msg_terminate_arc(struct cec_msg *msg,
  1478. int reply)
  1479. {
  1480. msg->len = 2;
  1481. msg->msg[1] = CEC_MSG_TERMINATE_ARC;
  1482. msg->reply = reply ? CEC_MSG_REPORT_ARC_TERMINATED : 0;
  1483. }
  1484. static __inline__ void cec_msg_request_arc_termination(struct cec_msg *msg,
  1485. int reply)
  1486. {
  1487. msg->len = 2;
  1488. msg->msg[1] = CEC_MSG_REQUEST_ARC_TERMINATION;
  1489. msg->reply = reply ? CEC_MSG_TERMINATE_ARC : 0;
  1490. }
  1491. /* Dynamic Audio Lipsync Feature */
  1492. /* Only for CEC 2.0 and up */
  1493. static __inline__ void cec_msg_report_current_latency(struct cec_msg *msg,
  1494. __u16 phys_addr,
  1495. __u8 video_latency,
  1496. __u8 low_latency_mode,
  1497. __u8 audio_out_compensated,
  1498. __u8 audio_out_delay)
  1499. {
  1500. msg->len = 6;
  1501. msg->msg[0] |= 0xf; /* broadcast */
  1502. msg->msg[1] = CEC_MSG_REPORT_CURRENT_LATENCY;
  1503. msg->msg[2] = phys_addr >> 8;
  1504. msg->msg[3] = phys_addr & 0xff;
  1505. msg->msg[4] = video_latency;
  1506. msg->msg[5] = (low_latency_mode << 2) | audio_out_compensated;
  1507. if (audio_out_compensated == 3)
  1508. msg->msg[msg->len++] = audio_out_delay;
  1509. }
  1510. static __inline__ void cec_ops_report_current_latency(const struct cec_msg *msg,
  1511. __u16 *phys_addr,
  1512. __u8 *video_latency,
  1513. __u8 *low_latency_mode,
  1514. __u8 *audio_out_compensated,
  1515. __u8 *audio_out_delay)
  1516. {
  1517. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1518. *video_latency = msg->msg[4];
  1519. *low_latency_mode = (msg->msg[5] >> 2) & 1;
  1520. *audio_out_compensated = msg->msg[5] & 3;
  1521. if (*audio_out_compensated == 3 && msg->len >= 7)
  1522. *audio_out_delay = msg->msg[6];
  1523. else
  1524. *audio_out_delay = 0;
  1525. }
  1526. static __inline__ void cec_msg_request_current_latency(struct cec_msg *msg,
  1527. int reply,
  1528. __u16 phys_addr)
  1529. {
  1530. msg->len = 4;
  1531. msg->msg[0] |= 0xf; /* broadcast */
  1532. msg->msg[1] = CEC_MSG_REQUEST_CURRENT_LATENCY;
  1533. msg->msg[2] = phys_addr >> 8;
  1534. msg->msg[3] = phys_addr & 0xff;
  1535. msg->reply = reply ? CEC_MSG_REPORT_CURRENT_LATENCY : 0;
  1536. }
  1537. static __inline__ void cec_ops_request_current_latency(const struct cec_msg *msg,
  1538. __u16 *phys_addr)
  1539. {
  1540. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1541. }
  1542. /* Capability Discovery and Control Feature */
  1543. static __inline__ void cec_msg_cdc_hec_inquire_state(struct cec_msg *msg,
  1544. __u16 phys_addr1,
  1545. __u16 phys_addr2)
  1546. {
  1547. msg->len = 9;
  1548. msg->msg[0] |= 0xf; /* broadcast */
  1549. msg->msg[1] = CEC_MSG_CDC_MESSAGE;
  1550. /* msg[2] and msg[3] (phys_addr) are filled in by the CEC framework */
  1551. msg->msg[4] = CEC_MSG_CDC_HEC_INQUIRE_STATE;
  1552. msg->msg[5] = phys_addr1 >> 8;
  1553. msg->msg[6] = phys_addr1 & 0xff;
  1554. msg->msg[7] = phys_addr2 >> 8;
  1555. msg->msg[8] = phys_addr2 & 0xff;
  1556. }
  1557. static __inline__ void cec_ops_cdc_hec_inquire_state(const struct cec_msg *msg,
  1558. __u16 *phys_addr,
  1559. __u16 *phys_addr1,
  1560. __u16 *phys_addr2)
  1561. {
  1562. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1563. *phys_addr1 = (msg->msg[5] << 8) | msg->msg[6];
  1564. *phys_addr2 = (msg->msg[7] << 8) | msg->msg[8];
  1565. }
  1566. static __inline__ void cec_msg_cdc_hec_report_state(struct cec_msg *msg,
  1567. __u16 target_phys_addr,
  1568. __u8 hec_func_state,
  1569. __u8 host_func_state,
  1570. __u8 enc_func_state,
  1571. __u8 cdc_errcode,
  1572. __u8 has_field,
  1573. __u16 hec_field)
  1574. {
  1575. msg->len = has_field ? 10 : 8;
  1576. msg->msg[0] |= 0xf; /* broadcast */
  1577. msg->msg[1] = CEC_MSG_CDC_MESSAGE;
  1578. /* msg[2] and msg[3] (phys_addr) are filled in by the CEC framework */
  1579. msg->msg[4] = CEC_MSG_CDC_HEC_REPORT_STATE;
  1580. msg->msg[5] = target_phys_addr >> 8;
  1581. msg->msg[6] = target_phys_addr & 0xff;
  1582. msg->msg[7] = (hec_func_state << 6) |
  1583. (host_func_state << 4) |
  1584. (enc_func_state << 2) |
  1585. cdc_errcode;
  1586. if (has_field) {
  1587. msg->msg[8] = hec_field >> 8;
  1588. msg->msg[9] = hec_field & 0xff;
  1589. }
  1590. }
  1591. static __inline__ void cec_ops_cdc_hec_report_state(const struct cec_msg *msg,
  1592. __u16 *phys_addr,
  1593. __u16 *target_phys_addr,
  1594. __u8 *hec_func_state,
  1595. __u8 *host_func_state,
  1596. __u8 *enc_func_state,
  1597. __u8 *cdc_errcode,
  1598. __u8 *has_field,
  1599. __u16 *hec_field)
  1600. {
  1601. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1602. *target_phys_addr = (msg->msg[5] << 8) | msg->msg[6];
  1603. *hec_func_state = msg->msg[7] >> 6;
  1604. *host_func_state = (msg->msg[7] >> 4) & 3;
  1605. *enc_func_state = (msg->msg[7] >> 4) & 3;
  1606. *cdc_errcode = msg->msg[7] & 3;
  1607. *has_field = msg->len >= 10;
  1608. *hec_field = *has_field ? ((msg->msg[8] << 8) | msg->msg[9]) : 0;
  1609. }
  1610. static __inline__ void cec_msg_cdc_hec_set_state(struct cec_msg *msg,
  1611. __u16 phys_addr1,
  1612. __u16 phys_addr2,
  1613. __u8 hec_set_state,
  1614. __u16 phys_addr3,
  1615. __u16 phys_addr4,
  1616. __u16 phys_addr5)
  1617. {
  1618. msg->len = 10;
  1619. msg->msg[0] |= 0xf; /* broadcast */
  1620. msg->msg[1] = CEC_MSG_CDC_MESSAGE;
  1621. /* msg[2] and msg[3] (phys_addr) are filled in by the CEC framework */
  1622. msg->msg[4] = CEC_MSG_CDC_HEC_INQUIRE_STATE;
  1623. msg->msg[5] = phys_addr1 >> 8;
  1624. msg->msg[6] = phys_addr1 & 0xff;
  1625. msg->msg[7] = phys_addr2 >> 8;
  1626. msg->msg[8] = phys_addr2 & 0xff;
  1627. msg->msg[9] = hec_set_state;
  1628. if (phys_addr3 != CEC_PHYS_ADDR_INVALID) {
  1629. msg->msg[msg->len++] = phys_addr3 >> 8;
  1630. msg->msg[msg->len++] = phys_addr3 & 0xff;
  1631. if (phys_addr4 != CEC_PHYS_ADDR_INVALID) {
  1632. msg->msg[msg->len++] = phys_addr4 >> 8;
  1633. msg->msg[msg->len++] = phys_addr4 & 0xff;
  1634. if (phys_addr5 != CEC_PHYS_ADDR_INVALID) {
  1635. msg->msg[msg->len++] = phys_addr5 >> 8;
  1636. msg->msg[msg->len++] = phys_addr5 & 0xff;
  1637. }
  1638. }
  1639. }
  1640. }
  1641. static __inline__ void cec_ops_cdc_hec_set_state(const struct cec_msg *msg,
  1642. __u16 *phys_addr,
  1643. __u16 *phys_addr1,
  1644. __u16 *phys_addr2,
  1645. __u8 *hec_set_state,
  1646. __u16 *phys_addr3,
  1647. __u16 *phys_addr4,
  1648. __u16 *phys_addr5)
  1649. {
  1650. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1651. *phys_addr1 = (msg->msg[5] << 8) | msg->msg[6];
  1652. *phys_addr2 = (msg->msg[7] << 8) | msg->msg[8];
  1653. *hec_set_state = msg->msg[9];
  1654. *phys_addr3 = *phys_addr4 = *phys_addr5 = CEC_PHYS_ADDR_INVALID;
  1655. if (msg->len >= 12)
  1656. *phys_addr3 = (msg->msg[10] << 8) | msg->msg[11];
  1657. if (msg->len >= 14)
  1658. *phys_addr4 = (msg->msg[12] << 8) | msg->msg[13];
  1659. if (msg->len >= 16)
  1660. *phys_addr5 = (msg->msg[14] << 8) | msg->msg[15];
  1661. }
  1662. static __inline__ void cec_msg_cdc_hec_set_state_adjacent(struct cec_msg *msg,
  1663. __u16 phys_addr1,
  1664. __u8 hec_set_state)
  1665. {
  1666. msg->len = 8;
  1667. msg->msg[0] |= 0xf; /* broadcast */
  1668. msg->msg[1] = CEC_MSG_CDC_MESSAGE;
  1669. /* msg[2] and msg[3] (phys_addr) are filled in by the CEC framework */
  1670. msg->msg[4] = CEC_MSG_CDC_HEC_SET_STATE_ADJACENT;
  1671. msg->msg[5] = phys_addr1 >> 8;
  1672. msg->msg[6] = phys_addr1 & 0xff;
  1673. msg->msg[7] = hec_set_state;
  1674. }
  1675. static __inline__ void cec_ops_cdc_hec_set_state_adjacent(const struct cec_msg *msg,
  1676. __u16 *phys_addr,
  1677. __u16 *phys_addr1,
  1678. __u8 *hec_set_state)
  1679. {
  1680. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1681. *phys_addr1 = (msg->msg[5] << 8) | msg->msg[6];
  1682. *hec_set_state = msg->msg[7];
  1683. }
  1684. static __inline__ void cec_msg_cdc_hec_request_deactivation(struct cec_msg *msg,
  1685. __u16 phys_addr1,
  1686. __u16 phys_addr2,
  1687. __u16 phys_addr3)
  1688. {
  1689. msg->len = 11;
  1690. msg->msg[0] |= 0xf; /* broadcast */
  1691. msg->msg[1] = CEC_MSG_CDC_MESSAGE;
  1692. /* msg[2] and msg[3] (phys_addr) are filled in by the CEC framework */
  1693. msg->msg[4] = CEC_MSG_CDC_HEC_REQUEST_DEACTIVATION;
  1694. msg->msg[5] = phys_addr1 >> 8;
  1695. msg->msg[6] = phys_addr1 & 0xff;
  1696. msg->msg[7] = phys_addr2 >> 8;
  1697. msg->msg[8] = phys_addr2 & 0xff;
  1698. msg->msg[9] = phys_addr3 >> 8;
  1699. msg->msg[10] = phys_addr3 & 0xff;
  1700. }
  1701. static __inline__ void cec_ops_cdc_hec_request_deactivation(const struct cec_msg *msg,
  1702. __u16 *phys_addr,
  1703. __u16 *phys_addr1,
  1704. __u16 *phys_addr2,
  1705. __u16 *phys_addr3)
  1706. {
  1707. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1708. *phys_addr1 = (msg->msg[5] << 8) | msg->msg[6];
  1709. *phys_addr2 = (msg->msg[7] << 8) | msg->msg[8];
  1710. *phys_addr3 = (msg->msg[9] << 8) | msg->msg[10];
  1711. }
  1712. static __inline__ void cec_msg_cdc_hec_notify_alive(struct cec_msg *msg)
  1713. {
  1714. msg->len = 5;
  1715. msg->msg[0] |= 0xf; /* broadcast */
  1716. msg->msg[1] = CEC_MSG_CDC_MESSAGE;
  1717. /* msg[2] and msg[3] (phys_addr) are filled in by the CEC framework */
  1718. msg->msg[4] = CEC_MSG_CDC_HEC_NOTIFY_ALIVE;
  1719. }
  1720. static __inline__ void cec_ops_cdc_hec_notify_alive(const struct cec_msg *msg,
  1721. __u16 *phys_addr)
  1722. {
  1723. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1724. }
  1725. static __inline__ void cec_msg_cdc_hec_discover(struct cec_msg *msg)
  1726. {
  1727. msg->len = 5;
  1728. msg->msg[0] |= 0xf; /* broadcast */
  1729. msg->msg[1] = CEC_MSG_CDC_MESSAGE;
  1730. /* msg[2] and msg[3] (phys_addr) are filled in by the CEC framework */
  1731. msg->msg[4] = CEC_MSG_CDC_HEC_DISCOVER;
  1732. }
  1733. static __inline__ void cec_ops_cdc_hec_discover(const struct cec_msg *msg,
  1734. __u16 *phys_addr)
  1735. {
  1736. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1737. }
  1738. static __inline__ void cec_msg_cdc_hpd_set_state(struct cec_msg *msg,
  1739. __u8 input_port,
  1740. __u8 hpd_state)
  1741. {
  1742. msg->len = 6;
  1743. msg->msg[0] |= 0xf; /* broadcast */
  1744. msg->msg[1] = CEC_MSG_CDC_MESSAGE;
  1745. /* msg[2] and msg[3] (phys_addr) are filled in by the CEC framework */
  1746. msg->msg[4] = CEC_MSG_CDC_HPD_SET_STATE;
  1747. msg->msg[5] = (input_port << 4) | hpd_state;
  1748. }
  1749. static __inline__ void cec_ops_cdc_hpd_set_state(const struct cec_msg *msg,
  1750. __u16 *phys_addr,
  1751. __u8 *input_port,
  1752. __u8 *hpd_state)
  1753. {
  1754. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1755. *input_port = msg->msg[5] >> 4;
  1756. *hpd_state = msg->msg[5] & 0xf;
  1757. }
  1758. static __inline__ void cec_msg_cdc_hpd_report_state(struct cec_msg *msg,
  1759. __u8 hpd_state,
  1760. __u8 hpd_error)
  1761. {
  1762. msg->len = 6;
  1763. msg->msg[0] |= 0xf; /* broadcast */
  1764. msg->msg[1] = CEC_MSG_CDC_MESSAGE;
  1765. /* msg[2] and msg[3] (phys_addr) are filled in by the CEC framework */
  1766. msg->msg[4] = CEC_MSG_CDC_HPD_REPORT_STATE;
  1767. msg->msg[5] = (hpd_state << 4) | hpd_error;
  1768. }
  1769. static __inline__ void cec_ops_cdc_hpd_report_state(const struct cec_msg *msg,
  1770. __u16 *phys_addr,
  1771. __u8 *hpd_state,
  1772. __u8 *hpd_error)
  1773. {
  1774. *phys_addr = (msg->msg[2] << 8) | msg->msg[3];
  1775. *hpd_state = msg->msg[5] >> 4;
  1776. *hpd_error = msg->msg[5] & 0xf;
  1777. }
  1778. #endif