#include <linux/align.h>
#include <linux/errno.h>
#include <linux/io.h>
#include <linux/kernel.h>
#include <linux/types.h>
#include "fdma_pci.h"
#define FDMA_PCI_ATU_OB_START 0x10000000
#define FDMA_PCI_ATU_OB_END 0x1fffffff
#define FDMA_PCI_ATU_ADDR 0x300000
#define FDMA_PCI_ATU_IDX_SIZE 0x200
#define FDMA_PCI_ATU_ENA_REG 0x4
#define FDMA_PCI_ATU_ENA_BIT BIT(31)
#define FDMA_PCI_ATU_LWR_BASE_ADDR 0x8
#define FDMA_PCI_ATU_UPP_BASE_ADDR 0xc
#define FDMA_PCI_ATU_LIMIT_ADDR 0x10
#define FDMA_PCI_ATU_LWR_TARGET_ADDR 0x14
#define FDMA_PCI_ATU_UPP_TARGET_ADDR 0x18
static u32 fdma_pci_atu_region_size(void)
{
return round_down((FDMA_PCI_ATU_OB_END - FDMA_PCI_ATU_OB_START) /
FDMA_PCI_ATU_REGION_MAX, FDMA_PCI_ATU_REGION_ALIGN);
}
static void __iomem *fdma_pci_atu_addr_get(void __iomem *addr, int offset,
int idx)
{
return addr + FDMA_PCI_ATU_ADDR + FDMA_PCI_ATU_IDX_SIZE * idx + offset;
}
static void fdma_pci_atu_region_enable(struct fdma_pci_atu_region *region)
{
writel(FDMA_PCI_ATU_ENA_BIT,
fdma_pci_atu_addr_get(region->atu->addr, FDMA_PCI_ATU_ENA_REG,
region->idx));
}
static void fdma_pci_atu_region_disable(struct fdma_pci_atu_region *region)
{
writel(0, fdma_pci_atu_addr_get(region->atu->addr, FDMA_PCI_ATU_ENA_REG,
region->idx));
}
static void
fdma_pci_atu_configure_translation(struct fdma_pci_atu_region *region)
{
struct fdma_pci_atu *atu = region->atu;
int idx = region->idx;
writel(lower_32_bits(region->base_addr),
fdma_pci_atu_addr_get(atu->addr,
FDMA_PCI_ATU_LWR_BASE_ADDR, idx));
writel(upper_32_bits(region->base_addr),
fdma_pci_atu_addr_get(atu->addr,
FDMA_PCI_ATU_UPP_BASE_ADDR, idx));
writel(region->limit_addr,
fdma_pci_atu_addr_get(atu->addr, FDMA_PCI_ATU_LIMIT_ADDR, idx));
writel(lower_32_bits(region->target_addr),
fdma_pci_atu_addr_get(atu->addr,
FDMA_PCI_ATU_LWR_TARGET_ADDR, idx));
writel(upper_32_bits(region->target_addr),
fdma_pci_atu_addr_get(atu->addr,
FDMA_PCI_ATU_UPP_TARGET_ADDR, idx));
}
static struct fdma_pci_atu_region *
fdma_pci_atu_region_get_free(struct fdma_pci_atu *atu)
{
struct fdma_pci_atu_region *regions = atu->regions;
for (int i = 0; i < FDMA_PCI_ATU_REGION_MAX; i++) {
if (regions[i].in_use)
continue;
return ®ions[i];
}
return ERR_PTR(-ENOSPC);
}
void fdma_pci_atu_region_unmap(struct fdma_pci_atu_region *region)
{
if (IS_ERR_OR_NULL(region))
return;
mutex_lock(®ion->atu->lock);
region->target_addr = 0;
region->in_use = false;
fdma_pci_atu_region_disable(region);
fdma_pci_atu_configure_translation(region);
mutex_unlock(®ion->atu->lock);
}
EXPORT_SYMBOL_GPL(fdma_pci_atu_region_unmap);
struct fdma_pci_atu_region *
fdma_pci_atu_region_map(struct fdma_pci_atu *atu, u64 target_addr, int size)
{
struct fdma_pci_atu_region *region;
if (!atu)
return ERR_PTR(-EINVAL);
if (size <= 0)
return ERR_PTR(-EINVAL);
if (size > fdma_pci_atu_region_size())
return ERR_PTR(-ERANGE);
if (!IS_ALIGNED(target_addr, FDMA_PCI_ATU_REGION_ALIGN))
return ERR_PTR(-EINVAL);
mutex_lock(&atu->lock);
region = fdma_pci_atu_region_get_free(atu);
if (IS_ERR(region)) {
mutex_unlock(&atu->lock);
return region;
}
region->target_addr = target_addr;
region->limit_addr = region->base_addr + size - 1;
region->in_use = true;
fdma_pci_atu_configure_translation(region);
fdma_pci_atu_region_enable(region);
mutex_unlock(&atu->lock);
return region;
}
EXPORT_SYMBOL_GPL(fdma_pci_atu_region_map);
u64 fdma_pci_atu_translate_addr(struct fdma_pci_atu_region *region, u64 addr)
{
return region->base_addr + (addr - region->target_addr);
}
EXPORT_SYMBOL_GPL(fdma_pci_atu_translate_addr);
void fdma_pci_atu_init(struct fdma_pci_atu *atu, void __iomem *addr)
{
struct fdma_pci_atu_region *regions = atu->regions;
u32 region_size = fdma_pci_atu_region_size();
atu->addr = addr;
mutex_init(&atu->lock);
for (int i = 0; i < FDMA_PCI_ATU_REGION_MAX; i++) {
regions[i].base_addr =
FDMA_PCI_ATU_OB_START + (i * region_size);
regions[i].limit_addr = 0;
regions[i].target_addr = 0;
regions[i].idx = i;
regions[i].atu = atu;
regions[i].in_use = false;
fdma_pci_atu_region_disable(®ions[i]);
}
}
EXPORT_SYMBOL_GPL