1 /* $NetBSD: hdafg_dd.c,v 1.3 2017/09/26 09:24:22 kre Exp $ */
2
3 /*
4 * Copyright (c) 2011 Jared D. McNeill <jmcneill@invisible.ca>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. The name of the author may not be used to endorse or promote products
13 * derived from this software without specific prior written permission.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
20 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
21 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
22 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
23 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25 * SUCH DAMAGE.
26 */
27
28 /*
29 * HD audio Digital Display support
30 */
31
32 #include <sys/cdefs.h>
33 __KERNEL_RCSID(0, "$NetBSD: hdafg_dd.c,v 1.3 2017/09/26 09:24:22 kre Exp $");
34
35 #include <sys/types.h>
36 #include <sys/param.h>
37 #include <sys/systm.h>
38 #include <sys/kernel.h>
39 #include <sys/device.h>
40 #include <sys/conf.h>
41 #include <sys/bus.h>
42
43 #include "hdaudioreg.h"
44 #include "hdaudiovar.h"
45 #include "hdafg_dd.h"
46
47 int
hdafg_dd_parse_info(uint8_t * data,size_t datalen,struct hdafg_dd_info * hdi)48 hdafg_dd_parse_info(uint8_t *data, size_t datalen, struct hdafg_dd_info *hdi)
49 {
50 struct eld_baseline_block *block = &hdi->eld;
51 unsigned int i;
52
53 #ifdef HDAFG_HDMI_DEBUG
54 printf("hdafg_dd_parse_info: datalen=%u\n", (unsigned int)datalen);
55 #endif
56
57 memset(hdi, 0, sizeof(*hdi));
58
59 if (datalen < sizeof(block->header)) {
60 #ifdef HDAFG_HDMI_DEBUG
61 printf(" no room for header\n");
62 #endif
63 return EINVAL;
64 }
65
66 memcpy(&block->header, data, sizeof(block->header));
67 data += sizeof(block->header);
68 datalen -= sizeof(block->header);
69
70 if (datalen < block->header.baseline_eld_len * 4 ||
71 datalen < sizeof(*block) - sizeof(block->header)) {
72 #ifdef HDAFG_HDMI_DEBUG
73 printf(" ack!\n");
74 #endif
75 return EINVAL;
76 }
77
78 datalen = block->header.baseline_eld_len * 4;
79
80 memcpy(&block->flags[0], data, sizeof(*block) - sizeof(block->header));
81 data += sizeof(*block) - sizeof(block->header);
82 datalen -= sizeof(*block) - sizeof(block->header);
83
84 if (datalen < ELD_MNL(block)) {
85 #ifdef HDAFG_HDMI_DEBUG
86 printf(" MNL=%u\n", ELD_MNL(block));
87 #endif
88 return EINVAL;
89 }
90
91 memcpy(hdi->monitor, data, ELD_MNL(block));
92 data += ELD_MNL(block);
93 datalen -= ELD_MNL(block);
94
95 if (datalen < ELD_SAD_COUNT(block) * sizeof(hdi->sad[0])) {
96 #ifdef HDAFG_HDMI_DEBUG
97 printf(" datalen %u sadcount %u sizeof sad %u\n",
98 (unsigned int)datalen,
99 ELD_SAD_COUNT(block),
100 (unsigned int)sizeof(hdi->sad[0]));
101 #endif
102 return EINVAL;
103 }
104 hdi->nsad = ELD_SAD_COUNT(block);
105 for (i = 0; i < hdi->nsad; i++) {
106 memcpy(&hdi->sad[i], data, sizeof(hdi->sad[i]));
107 data += sizeof(hdi->sad[i]);
108 datalen -= sizeof(hdi->sad[i]);
109 }
110
111 #ifdef HDAFG_HDMI_DEBUG
112 printf("hdafg eld padding ignored = %u\n", (unsigned int)datalen);
113 #endif
114 return 0;
115 }
116
117 void
hdafg_dd_hdmi_ai_cksum(struct hdmi_audio_infoframe * hdmi)118 hdafg_dd_hdmi_ai_cksum(struct hdmi_audio_infoframe *hdmi)
119 {
120 uint8_t *dip = (uint8_t *)hdmi, c = 0;
121 int i;
122
123 hdmi->checksum = 0;
124 for (i = 0; i < sizeof(*hdmi); i++)
125 c += dip[i];
126 hdmi->checksum = -c;
127 }
128