Home | History | Annotate | Line # | Download | only in hdaudio 
      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 (at) 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
     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
    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