source: svn/newcon3bcm2_21bu/nexus/base/src/nexus_base_mmap.c

/***************************************************************************
*     (c)2008-2010 Broadcom Corporation
*
*  This program is the proprietary software of Broadcom Corporation and/or its licensors,
*  and may only be used, duplicated, modified or distributed pursuant to the terms and
*  conditions of a separate, written license agreement executed between you and Broadcom
*  (an "Authorized License").  Except as set forth in an Authorized License, Broadcom grants
*  no license (express or implied), right to use, or waiver of any kind with respect to the
*  Software, and Broadcom expressly reserves all rights in and to the Software and all
*  intellectual property rights therein.  IF YOU HAVE NO AUTHORIZED LICENSE, THEN YOU
*  HAVE NO RIGHT TO USE THIS SOFTWARE IN ANY WAY, AND SHOULD IMMEDIATELY
*  NOTIFY BROADCOM AND DISCONTINUE ALL USE OF THE SOFTWARE.
*
*  Except as expressly set forth in the Authorized License,
*
*  1.     This program, including its structure, sequence and organization, constitutes the valuable trade
*  secrets of Broadcom, and you shall use all reasonable efforts to protect the confidentiality thereof,
*  and to use this information only in connection with your use of Broadcom integrated circuit products.
*
*  2.     TO THE MAXIMUM EXTENT PERMITTED BY LAW, THE SOFTWARE IS PROVIDED "AS IS"
*  AND WITH ALL FAULTS AND BROADCOM MAKES NO PROMISES, REPRESENTATIONS OR
*  WARRANTIES, EITHER EXPRESS, IMPLIED, STATUTORY, OR OTHERWISE, WITH RESPECT TO
*  THE SOFTWARE.  BROADCOM SPECIFICALLY DISCLAIMS ANY AND ALL IMPLIED WARRANTIES
*  OF TITLE, MERCHANTABILITY, NONINFRINGEMENT, FITNESS FOR A PARTICULAR PURPOSE,
*  LACK OF VIRUSES, ACCURACY OR COMPLETENESS, QUIET ENJOYMENT, QUIET POSSESSION
*  OR CORRESPONDENCE TO DESCRIPTION. YOU ASSUME THE ENTIRE RISK ARISING OUT OF
*  USE OR PERFORMANCE OF THE SOFTWARE.
*
*  3.     TO THE MAXIMUM EXTENT PERMITTED BY LAW, IN NO EVENT SHALL BROADCOM OR ITS
*  LICENSORS BE LIABLE FOR (i) CONSEQUENTIAL, INCIDENTAL, SPECIAL, INDIRECT, OR
*  EXEMPLARY DAMAGES WHATSOEVER ARISING OUT OF OR IN ANY WAY RELATING TO YOUR
*  USE OF OR INABILITY TO USE THE SOFTWARE EVEN IF BROADCOM HAS BEEN ADVISED OF
*  THE POSSIBILITY OF SUCH DAMAGES; OR (ii) ANY AMOUNT IN EXCESS OF THE AMOUNT
*  ACTUALLY PAID FOR THE SOFTWARE ITSELF OR U.S. $1, WHICHEVER IS GREATER. THESE
*  LIMITATIONS SHALL APPLY NOTWITHSTANDING ANY FAILURE OF ESSENTIAL PURPOSE OF
*  ANY LIMITED REMEDY.
*
* $brcm_Workfile: nexus_base_mmap.c $
* $brcm_Revision: 6 $
* $brcm_Date: 12/17/10 4:47p $
*
* API Description:
*
* Revision History:
*
* $brcm_Log: /nexus/base/src/nexus_base_mmap.c $
* 
* 6   12/17/10 4:47p erickson
* SW7422-2: improve check
*
* 5   9/23/10 2:12p erickson
* SW7420-943: refactor for driver/firmware partitioning
*
* 4   6/23/09 9:14a erickson
* PR54881: Provide emulation support in Nexus
*
* 3   8/28/08 12:18p erickson
* PR46284: added MSG
*
* 2   6/5/08 2:15p vsilyaev
* PR 42318: Use 'const void *' for address translation
*
* 1   1/18/08 2:13p jgarrett
* PR 38808: Merging to main branch
*
* Nexus_Devel/3   1/9/08 10:33a vsilyaev
* PR 36199: Fixed math in NEXUS_OffsetTo functions
*
* Nexus_Devel/1   10/23/07 4:13p vsilyaev
* PR 36199: Memory mapper sub-module
*
***************************************************************************/
#include "bstd.h"
#include "bdbg.h"
#include "nexus_base_mmap.h"

BDBG_MODULE(nexus_base_mmap);

typedef struct NEXUS_P_MemoryMap {
    size_t length;
    uint32_t offset;
    void *cached;
    void *uncached;
} NEXUS_P_MemoryMap;

static NEXUS_P_MemoryMap g_NEXUS_P_MemoryMap[16];

NEXUS_Error
NEXUS_P_AddMap(uint32_t offset, void *cached, void *uncached, size_t length)
{
    unsigned i;

#if !NEXUS_BASE_OS_linuxemu
    /* offset==0 is normal in emulation environments */
    if (offset==0) {
        return BERR_TRACE(BERR_INVALID_PARAMETER);
    }
#endif
    if (uncached==NULL && cached==NULL) {
        return BERR_TRACE(BERR_INVALID_PARAMETER);
    }

    for(i=0;i<sizeof(g_NEXUS_P_MemoryMap)/sizeof(*g_NEXUS_P_MemoryMap);i++) {
        if(g_NEXUS_P_MemoryMap[i].length==0) {
            BDBG_MSG(("NEXUS_P_AddMap offset=%d length=%d cached_addr=%p uncached_addr=%p",
                offset, length, cached, uncached));
            g_NEXUS_P_MemoryMap[i].length = length;
            g_NEXUS_P_MemoryMap[i].offset = offset;
            g_NEXUS_P_MemoryMap[i].cached = cached;
            g_NEXUS_P_MemoryMap[i].uncached = uncached;
            return BERR_SUCCESS;
        }
    }
    return BERR_TRACE(NEXUS_UNKNOWN);
}

uint32_t
NEXUS_AddrToOffset(const void *addr)
{
    unsigned i;
    const NEXUS_P_MemoryMap *map = g_NEXUS_P_MemoryMap;
    for(i=0;i<sizeof(g_NEXUS_P_MemoryMap)/sizeof(*g_NEXUS_P_MemoryMap);i++) {
        if(map[i].length==0) {
            break;
        }
        if( (uint8_t *)addr>=(uint8_t *)map[i].cached &&
            (uint8_t *)addr<((uint8_t *)map[i].cached + map[i].length) &&
            map[i].cached != NULL
            ) {
            return map[i].offset + ((uint8_t *)addr - (uint8_t *)map[i].cached);
        }
        if( (uint8_t *)addr>=(uint8_t *)map[i].uncached &&
            (uint8_t *)addr<((uint8_t *)map[i].uncached + map[i].length)) {
            return map[i].offset + ((uint8_t *)addr - (uint8_t *)map[i].uncached);
        }
    }
    BDBG_WRN(("NEXUS_AddrToOffset: unknown address %#lx", (unsigned long)addr));
    return 0;
}

void *
NEXUS_OffsetToCachedAddr(uint32_t offset)
{
    unsigned i;
    const NEXUS_P_MemoryMap *map = g_NEXUS_P_MemoryMap;
    for(i=0;i<sizeof(g_NEXUS_P_MemoryMap)/sizeof(*g_NEXUS_P_MemoryMap);i++) {
        if(map[i].length==0) {
            break;
        }
        if( offset>=map[i].offset &&
            offset<(map[i].offset + map[i].length)) {
            uint8_t *addr;

            if(map[i].cached) {
                addr = map[i].cached;
            } else {
                addr = map[i].uncached;
            }
            return addr + (offset - map[i].offset);
        }
    }
    BDBG_WRN(("NEXUS_OffsetToCachedAddr: unknown address %#lx", (unsigned long)offset));
    return NULL;
}

void *
NEXUS_OffsetToUncachedAddr(uint32_t offset)
{
    unsigned i;
    const NEXUS_P_MemoryMap *map = g_NEXUS_P_MemoryMap;

    for(i=0;i<sizeof(g_NEXUS_P_MemoryMap)/sizeof(*g_NEXUS_P_MemoryMap);i++) {
        if(map[i].length==0) {
            break;
        }
        if( offset>=map[i].offset &&
            offset<(map[i].offset + map[i].length)) {
            return (uint8_t *)map[i].uncached + (offset - map[i].offset);
        }
    }
    BDBG_WRN(("NEXUS_OffsetToUncachedAddr: unknown address %#lx", (unsigned long)offset));
    return NULL;
}

void
NEXUS_P_MapInit(void)
{
    unsigned i;
    NEXUS_P_MemoryMap *map = g_NEXUS_P_MemoryMap;
    for(i=0;i<sizeof(g_NEXUS_P_MemoryMap)/sizeof(*g_NEXUS_P_MemoryMap);i++) {
        map[i].length = 0;
        map[i].offset = 0;
        map[i].cached = NULL;
        map[i].uncached = NULL;
    }
    return ;
}