f6b842edd3
BCMSAI 4.3.0.10, 6.5.21 SDK release with enhancements and fixes for vxlan, TD3 MMU, TD4-X9 EA support, etc.
144 lines
3.2 KiB
C
144 lines
3.2 KiB
C
/*! \file ngbde_iio.c
|
|
*
|
|
* API for managing and accessing memory-mapped I/O for interrupt
|
|
* controller registers.
|
|
*
|
|
*/
|
|
/*
|
|
* $Copyright: Copyright 2018-2020 Broadcom. All rights reserved.
|
|
* The term 'Broadcom' refers to Broadcom Inc. and/or its subsidiaries.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* version 2 as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* A copy of the GNU General Public License version 2 (GPLv2) can
|
|
* be found in the LICENSES folder.$
|
|
*/
|
|
|
|
#include <ngbde.h>
|
|
|
|
void *
|
|
ngbde_iio_map(void *devh, phys_addr_t addr, phys_addr_t size)
|
|
{
|
|
struct ngbde_dev_s *sd = (struct ngbde_dev_s *)devh;
|
|
|
|
if (sd->iio_mem) {
|
|
if (addr == sd->iio_win.addr && size == sd->iio_win.size) {
|
|
/* Already mapped */
|
|
return sd->iio_mem;
|
|
}
|
|
ngbde_iio_unmap(devh);
|
|
}
|
|
|
|
sd->iio_mem = ioremap_nocache(addr, size);
|
|
|
|
if (sd->iio_mem) {
|
|
/* Save mapped resources */
|
|
sd->iio_win.addr = addr;
|
|
sd->iio_win.size = size;
|
|
}
|
|
|
|
return sd->iio_mem;
|
|
}
|
|
|
|
void
|
|
ngbde_iio_unmap(void *devh)
|
|
{
|
|
struct ngbde_dev_s *sd = (struct ngbde_dev_s *)devh;
|
|
|
|
if (sd->iio_mem) {
|
|
iounmap(sd->iio_mem);
|
|
sd->iio_mem = NULL;
|
|
}
|
|
}
|
|
|
|
void
|
|
ngbde_iio_cleanup(void)
|
|
{
|
|
struct ngbde_dev_s *swdev, *sd;
|
|
unsigned int num_swdev, idx;
|
|
|
|
ngbde_swdev_get_all(&swdev, &num_swdev);
|
|
|
|
for (idx = 0; idx < num_swdev; idx++) {
|
|
sd = ngbde_swdev_get(idx);
|
|
ngbde_iio_unmap(sd);
|
|
}
|
|
}
|
|
|
|
void
|
|
ngbde_iio_write32(void *devh, uint32_t offs, uint32_t val)
|
|
{
|
|
struct ngbde_dev_s *sd = (struct ngbde_dev_s *)devh;
|
|
|
|
if (sd->iio_mem) {
|
|
NGBDE_IOWRITE32(val, sd->iio_mem + offs);
|
|
}
|
|
}
|
|
|
|
uint32_t
|
|
ngbde_iio_read32(void *devh, uint32_t offs)
|
|
{
|
|
struct ngbde_dev_s *sd = (struct ngbde_dev_s *)devh;
|
|
|
|
if (sd->iio_mem) {
|
|
return NGBDE_IOREAD32(sd->iio_mem + offs);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void *
|
|
ngbde_paxb_map(void *devh, phys_addr_t addr, phys_addr_t size)
|
|
{
|
|
struct ngbde_dev_s *sd = (struct ngbde_dev_s *)devh;
|
|
|
|
if (sd->paxb_mem) {
|
|
if (addr == sd->paxb_win.addr && size == sd->paxb_win.size) {
|
|
/* Already mapped */
|
|
return sd->paxb_mem;
|
|
}
|
|
iounmap(sd->paxb_mem);
|
|
}
|
|
|
|
sd->paxb_mem = ioremap_nocache(addr, size);
|
|
|
|
if (sd->paxb_mem) {
|
|
/* Save mapped resources */
|
|
sd->paxb_win.addr = addr;
|
|
sd->paxb_win.size = size;
|
|
}
|
|
|
|
return sd->paxb_mem;
|
|
}
|
|
|
|
void
|
|
ngbde_paxb_unmap(void *devh)
|
|
{
|
|
struct ngbde_dev_s *sd = (struct ngbde_dev_s *)devh;
|
|
|
|
if (sd->paxb_mem) {
|
|
iounmap(sd->paxb_mem);
|
|
sd->paxb_mem = NULL;
|
|
}
|
|
}
|
|
|
|
void
|
|
ngbde_paxb_cleanup(void)
|
|
{
|
|
struct ngbde_dev_s *swdev, *sd;
|
|
unsigned int num_swdev, idx;
|
|
|
|
ngbde_swdev_get_all(&swdev, &num_swdev);
|
|
|
|
for (idx = 0; idx < num_swdev; idx++) {
|
|
sd = ngbde_swdev_get(idx);
|
|
ngbde_paxb_unmap(sd);
|
|
}
|
|
}
|