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