drivers/video/imx/hdp/API_Infoframe.c

/******************************************************************************
 *
 * Copyright (C) 2016-2017 Cadence Design Systems, Inc.
 * All rights reserved worldwide.
 *
 * Copyright 2017-2018 NXP
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 * 1. Redistributions of source code must retain the above copyright notice,
 * this list of conditions and the following disclaimer.
 *
 * 2. Redistributions in binary form must reproduce the above copyright notice,
 * this list of conditions and the following disclaimer in the documentation
 * and/or other materials provided with the distribution.
 *
 * 3. Neither the name of the copyright holder nor the names of its contributors
 * may be used to endorse or promote products derived from this software without
 * specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT  (INCLUDING NEGLIGENCE OR
 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. THE SOFTWARE IS PROVIDED "AS IS",
 * WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED
 * TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE
 * FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE
 * OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 *
 ******************************************************************************
 *
 * API_Infoframe.c
 *
 ******************************************************************************
 */

#include "API_Infoframe.h"
#include "address.h"
#include "source_pif.h"
#include "externs.h"
#ifndef __UBOOT__
#include <stdlib.h>
#include <string.h>
#include <stdio.h>
#else
#include <common.h>
#include <asm/io.h>
#endif
#include "util.h"

#define BANK_OFFSET 0x0

/* Redefined because of compiler warnings about 32 bit shift left */
#ifdef F_DATA_WR
#undef F_DATA_WR
#define F_DATA_WR(a_) ((uint32_t)(a_))
#endif

static CDN_API_STATUS infoframeSet(unsigned char entry_id,
				   unsigned char packet_len,
				   unsigned int *packet,
				   unsigned char packet_type,
				   unsigned char active_idle)
{
	unsigned int idx;
	unsigned int activeIdleBit = (0 == active_idle) ? 0 : 0x20000;
	/*invalidate entry */
	if (cdn_apb_write(BANK_OFFSET | ADDR_SOURCE_PIF |
			  (SOURCE_PIF_PKT_ALLOC_REG << 2),
			  activeIdleBit | F_PKT_ALLOC_ADDRESS(entry_id)))
		return CDN_ERR;
	if (cdn_apb_write(BANK_OFFSET | ADDR_SOURCE_PIF |
			  (SOURCE_PIF_PKT_ALLOC_WR_EN << 2),
			  F_PKT_ALLOC_WR_EN(1)))
		return CDN_ERR;

	/*flush fifo 1 */
	if (cdn_apb_write(BANK_OFFSET | ADDR_SOURCE_PIF |
			  (SOURCE_PIF_FIFO1_FLUSH << 2),
			  F_FIFO1_FLUSH(1)))
		return CDN_ERR;

	/*write packet into memory */
	for (idx = 0; idx < packet_len; idx++)
		if (cdn_apb_write(BANK_OFFSET | ADDR_SOURCE_PIF |
				  (SOURCE_PIF_DATA_WR << 2),
				  F_DATA_WR(packet[idx])))
			return CDN_ERR;

	/*write entry id */
	if (cdn_apb_write(BANK_OFFSET | ADDR_SOURCE_PIF |
			  (SOURCE_PIF_WR_ADDR << 2),
			  F_WR_ADDR(entry_id)))
		return CDN_ERR;

	/*write request */
	if (cdn_apb_write(BANK_OFFSET | ADDR_SOURCE_PIF |
			  (SOURCE_PIF_WR_REQ << 2),
			  F_HOST_WR(1)))
		return CDN_ERR;

	/*update entry */
	if (cdn_apb_write(BANK_OFFSET | ADDR_SOURCE_PIF |
			  (SOURCE_PIF_PKT_ALLOC_REG << 2),
			  activeIdleBit | F_TYPE_VALID(1) |
			  F_PACKET_TYPE(packet_type) |
			  F_PKT_ALLOC_ADDRESS(entry_id)))
		return CDN_ERR;
	if (cdn_apb_write(BANK_OFFSET | ADDR_SOURCE_PIF |
			  (SOURCE_PIF_PKT_ALLOC_WR_EN << 2),
			  F_PKT_ALLOC_WR_EN(1)))
		return CDN_ERR;

	return CDN_OK;
}

CDN_API_STATUS cdn_api_infoframeset(unsigned char entry_id,
				    unsigned char packet_len,
				    unsigned int *packet,
				    unsigned char packet_type)
{
	return infoframeSet(entry_id, packet_len, packet, packet_type, 1);
}

CDN_API_STATUS cdn_api_infoframesetnoactiveidle(unsigned char entry_id,
						unsigned char packet_len,
						unsigned int *packet,
						unsigned char packet_type)
{
	return infoframeSet(entry_id, packet_len, packet, packet_type, 0);
}

CDN_API_STATUS cdn_api_infoframeremove(unsigned char entry_id)
{
	/*invalidate entry */
	if (cdn_apb_write(BANK_OFFSET | ADDR_SOURCE_PIF |
			  (SOURCE_PIF_PKT_ALLOC_REG << 2),
			  0x20000 | F_PKT_ALLOC_ADDRESS(entry_id)))
		return CDN_ERR;
	if (cdn_apb_write(BANK_OFFSET | ADDR_SOURCE_PIF |
			  (SOURCE_PIF_PKT_ALLOC_WR_EN << 2),
			  F_PKT_ALLOC_WR_EN(1)))
		return CDN_ERR;

	return CDN_OK;
}