237 lines
6.0 KiB
C
237 lines
6.0 KiB
C
/****************************************************************************
|
|
*
|
|
* The MIT License (MIT)
|
|
*
|
|
* Copyright (c) 2014 - 2019 Vivante Corporation
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a
|
|
* copy of this software and associated documentation files (the "Software"),
|
|
* to deal in the Software without restriction, including without limitation
|
|
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
|
|
* and/or sell copies of the Software, and to permit persons to whom the
|
|
* Software is furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* 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.
|
|
*
|
|
*****************************************************************************
|
|
*
|
|
* The GPL License (GPL)
|
|
*
|
|
* Copyright (C) 2014 - 2019 Vivante Corporation
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* 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.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software Foundation,
|
|
* Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
|
|
*
|
|
*****************************************************************************
|
|
*
|
|
* Note: This software is released under dual MIT and GPL licenses. A
|
|
* recipient may use this file under the terms of either the MIT license or
|
|
* GPL License. If you wish to use only one license not the other, you can
|
|
* indicate your decision by deleting one of the above license notices in your
|
|
* version of this file.
|
|
*
|
|
*****************************************************************************/
|
|
|
|
|
|
#include "gc_hal_kernel_linux.h"
|
|
#include "gc_hal_kernel_device.h"
|
|
|
|
#include <linux/iommu.h>
|
|
#include <linux/platform_device.h>
|
|
|
|
#define _GC_OBJ_ZONE gcvZONE_OS
|
|
|
|
typedef struct _gcsIOMMU
|
|
{
|
|
struct iommu_domain * domain;
|
|
struct device * device;
|
|
}
|
|
gcsIOMMU;
|
|
|
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0)
|
|
static int
|
|
_IOMMU_Fault_Handler(
|
|
struct iommu_domain * Domain,
|
|
struct device * Dev,
|
|
unsigned long DomainAddress,
|
|
int flags,
|
|
void * args
|
|
)
|
|
#else
|
|
static int
|
|
_IOMMU_Fault_Handler(
|
|
struct iommu_domain * Domain,
|
|
struct device * Dev,
|
|
unsigned long DomainAddress,
|
|
int flags
|
|
)
|
|
#endif
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
_FlatMapping(
|
|
IN gckIOMMU Iommu
|
|
)
|
|
{
|
|
gceSTATUS status = gcvSTATUS_OK;
|
|
gctUINT32 physical;
|
|
|
|
gcmkHEADER_ARG("Iommu=%p", Iommu);
|
|
|
|
for (physical = 0; physical < 0x80000000; physical += PAGE_SIZE)
|
|
{
|
|
gcmkTRACE_ZONE(
|
|
gcvLEVEL_INFO, gcvZONE_OS,
|
|
"Map %x => %x bytes = %d",
|
|
physical, physical, PAGE_SIZE
|
|
);
|
|
|
|
gcmkONERROR(gckIOMMU_Map(Iommu, physical, physical, PAGE_SIZE));
|
|
}
|
|
|
|
OnError:
|
|
gcmkFOOTER();
|
|
return status;
|
|
}
|
|
|
|
void
|
|
gckIOMMU_Destory(
|
|
IN gckOS Os,
|
|
IN gckIOMMU Iommu
|
|
)
|
|
{
|
|
gcmkHEADER_ARG("Os=%p Iommu=%p", Os, Iommu);
|
|
|
|
if (Iommu->domain && Iommu->device)
|
|
{
|
|
iommu_attach_device(Iommu->domain, Iommu->device);
|
|
}
|
|
|
|
if (Iommu->domain)
|
|
{
|
|
iommu_domain_free(Iommu->domain);
|
|
}
|
|
|
|
if (Iommu)
|
|
{
|
|
gcmkOS_SAFE_FREE(Os, Iommu);
|
|
}
|
|
|
|
gcmkFOOTER_NO();
|
|
}
|
|
|
|
gceSTATUS
|
|
gckIOMMU_Construct(
|
|
IN gckOS Os,
|
|
OUT gckIOMMU * Iommu
|
|
)
|
|
{
|
|
gceSTATUS status = gcvSTATUS_OK;
|
|
gckIOMMU iommu = gcvNULL;
|
|
struct device *dev;
|
|
|
|
gcmkHEADER_ARG("Os=%p", Os);
|
|
|
|
dev = &Os->device->platform->device->dev;
|
|
|
|
gcmkONERROR(gckOS_Allocate(Os, gcmSIZEOF(gcsIOMMU), (gctPOINTER *)&iommu));
|
|
|
|
gckOS_ZeroMemory(iommu, gcmSIZEOF(gcsIOMMU));
|
|
|
|
iommu->domain = iommu_domain_alloc(&platform_bus_type);
|
|
|
|
if (!iommu->domain)
|
|
{
|
|
gcmkTRACE_ZONE(gcvLEVEL_INFO, gcvZONE_OS, "iommu_domain_alloc() fail");
|
|
gcmkONERROR(gcvSTATUS_NOT_SUPPORTED);
|
|
}
|
|
|
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0)
|
|
iommu_set_fault_handler(iommu->domain, _IOMMU_Fault_Handler, dev);
|
|
#else
|
|
iommu_set_fault_handler(iommu->domain, _IOMMU_Fault_Handler);
|
|
#endif
|
|
|
|
if (iommu_attach_device(iommu->domain, dev))
|
|
{
|
|
gcmkTRACE_ZONE(gcvLEVEL_INFO, gcvZONE_OS, "iommu_attach_device() fail");
|
|
gcmkONERROR(gcvSTATUS_NOT_SUPPORTED);
|
|
}
|
|
|
|
iommu->device = dev;
|
|
|
|
_FlatMapping(iommu);
|
|
|
|
*Iommu = iommu;
|
|
|
|
OnError:
|
|
if (gcmIS_ERROR(status))
|
|
{
|
|
gckIOMMU_Destory(Os, iommu);
|
|
}
|
|
|
|
gcmkFOOTER();
|
|
return status;
|
|
}
|
|
|
|
gceSTATUS
|
|
gckIOMMU_Map(
|
|
IN gckIOMMU Iommu,
|
|
IN gctUINT32 DomainAddress,
|
|
IN gctUINT32 Physical,
|
|
IN gctUINT32 Bytes
|
|
)
|
|
{
|
|
gceSTATUS status = gcvSTATUS_OK;
|
|
|
|
gcmkHEADER_ARG("DomainAddress=%#X, Physical=%#X, Bytes=%d",
|
|
DomainAddress, Physical, Bytes);
|
|
|
|
if (iommu_map(Iommu->domain, DomainAddress, Physical, Bytes, 0))
|
|
{
|
|
gcmkONERROR(gcvSTATUS_NOT_SUPPORTED);
|
|
}
|
|
|
|
OnError:
|
|
gcmkFOOTER();
|
|
return status;
|
|
}
|
|
|
|
gceSTATUS
|
|
gckIOMMU_Unmap(
|
|
IN gckIOMMU Iommu,
|
|
IN gctUINT32 DomainAddress,
|
|
IN gctUINT32 Bytes
|
|
)
|
|
{
|
|
gcmkHEADER();
|
|
|
|
iommu_unmap(Iommu->domain, DomainAddress, Bytes);
|
|
|
|
gcmkFOOTER_NO();
|
|
return gcvSTATUS_OK;
|
|
}
|
|
|