167 lines
5.5 KiB
C
167 lines
5.5 KiB
C
/******************************************************************************
|
|
*
|
|
* Copyright (C) 2016-2017 Cadence Design Systems, Inc.
|
|
* All rights reserved worldwide.
|
|
*
|
|
* 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.
|
|
*
|
|
* Copyright 2017 NXP
|
|
*
|
|
******************************************************************************
|
|
*
|
|
* API_Infoframe.c
|
|
*
|
|
******************************************************************************
|
|
*/
|
|
|
|
#include "API_Infoframe.h"
|
|
#include "address.h"
|
|
#include "source_pif.h"
|
|
#include "util.h"
|
|
|
|
#define BANK_OFFSET 0x0
|
|
|
|
static CDN_API_STATUS infoframeSet(state_struct *state, u8 entry_id,
|
|
u8 packet_len,
|
|
u8 *packet, u8 packet_type, u8 active_idle)
|
|
{
|
|
u32 idx;
|
|
u32 *packet32, len;
|
|
u32 activeIdleBit = (0 == active_idle) ? 0 : 0x20000;
|
|
|
|
/* invalidate entry */
|
|
if (cdn_apb_write
|
|
(state,
|
|
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
|
|
(state,
|
|
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
|
|
(state,
|
|
BANK_OFFSET | ADDR_SOURCE_PIF | (SOURCE_PIF_FIFO1_FLUSH << 2),
|
|
F_FIFO1_FLUSH(1)))
|
|
return CDN_ERR;
|
|
|
|
/* write packet into memory */
|
|
packet32 = (u32 *)packet;
|
|
len = packet_len / 4;
|
|
for (idx = 0; idx < len; idx++)
|
|
if (cdn_apb_write
|
|
(state,
|
|
BANK_OFFSET | ADDR_SOURCE_PIF | (SOURCE_PIF_DATA_WR << 2),
|
|
F_DATA_WR(packet32[idx])))
|
|
return CDN_ERR;
|
|
|
|
/* write entry id */
|
|
if (cdn_apb_write
|
|
(state, BANK_OFFSET | ADDR_SOURCE_PIF | (SOURCE_PIF_WR_ADDR << 2),
|
|
F_WR_ADDR(entry_id)))
|
|
return CDN_ERR;
|
|
|
|
/* write request */
|
|
if (cdn_apb_write
|
|
(state, BANK_OFFSET | ADDR_SOURCE_PIF | (SOURCE_PIF_WR_REQ << 2),
|
|
F_HOST_WR(1)))
|
|
return CDN_ERR;
|
|
|
|
/* update entry */
|
|
if (cdn_apb_write
|
|
(state,
|
|
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
|
|
(state,
|
|
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(state_struct *state, u8 entry_id,
|
|
u8 packet_len, u8 *packet, u8 packet_type)
|
|
{
|
|
return infoframeSet(state, entry_id, packet_len, packet, packet_type,
|
|
1);
|
|
}
|
|
|
|
CDN_API_STATUS CDN_API_InfoframeSetNoActiveIdle(state_struct *state,
|
|
u8 entry_id, u8 packet_len,
|
|
u8 *packet, u8 packet_type)
|
|
{
|
|
return infoframeSet(state, entry_id, packet_len, packet, packet_type,
|
|
0);
|
|
}
|
|
|
|
CDN_API_STATUS CDN_API_InfoframeRemove(state_struct *state, u8 entry_id)
|
|
{
|
|
/* invalidate entry */
|
|
if (cdn_apb_write
|
|
(state,
|
|
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
|
|
(state,
|
|
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_InfoframeRemovePacket(state_struct *state, u8 entry_id, u8 packet_type)
|
|
{
|
|
/* invalidate entry */
|
|
if (cdn_apb_write
|
|
(state,
|
|
BANK_OFFSET | ADDR_SOURCE_PIF | (SOURCE_PIF_PKT_ALLOC_REG << 2),
|
|
0x20000 | F_PKT_ALLOC_ADDRESS(entry_id) | F_PACKET_TYPE(packet_type)))
|
|
return CDN_ERR;
|
|
if (cdn_apb_write
|
|
(state,
|
|
BANK_OFFSET | ADDR_SOURCE_PIF | (SOURCE_PIF_PKT_ALLOC_WR_EN << 2),
|
|
F_PKT_ALLOC_WR_EN(1)))
|
|
return CDN_ERR;
|
|
|
|
return CDN_OK;
|
|
}
|