297 lines
7.4 KiB
C
297 lines
7.4 KiB
C
|
// SPDX-License-Identifier: GPL-2.0+
|
||
|
|
// Copyright 2017 IBM Corp.
|
||
|
|
#include <linux/sched/mm.h>
|
||
|
|
#include "trace.h"
|
||
|
|
#include "ocxl_internal.h"
|
||
|
|
|
||
|
|
int ocxl_context_alloc(struct ocxl_context **context, struct ocxl_afu *afu,
|
||
|
|
struct address_space *mapping)
|
||
|
|
{
|
||
|
|
int pasid;
|
||
|
|
struct ocxl_context *ctx;
|
||
|
|
|
||
|
|
ctx = kzalloc(sizeof(*ctx), GFP_KERNEL);
|
||
|
|
if (!ctx)
|
||
|
|
return -ENOMEM;
|
||
|
|
|
||
|
|
ctx->afu = afu;
|
||
|
|
mutex_lock(&afu->contexts_lock);
|
||
|
|
pasid = idr_alloc(&afu->contexts_idr, ctx, afu->pasid_base,
|
||
|
|
afu->pasid_base + afu->pasid_max, GFP_KERNEL);
|
||
|
|
if (pasid < 0) {
|
||
|
|
mutex_unlock(&afu->contexts_lock);
|
||
|
|
kfree(ctx);
|
||
|
|
return pasid;
|
||
|
|
}
|
||
|
|
afu->pasid_count++;
|
||
|
|
mutex_unlock(&afu->contexts_lock);
|
||
|
|
|
||
|
|
ctx->pasid = pasid;
|
||
|
|
ctx->status = OPENED;
|
||
|
|
mutex_init(&ctx->status_mutex);
|
||
|
|
ctx->mapping = mapping;
|
||
|
|
mutex_init(&ctx->mapping_lock);
|
||
|
|
init_waitqueue_head(&ctx->events_wq);
|
||
|
|
mutex_init(&ctx->xsl_error_lock);
|
||
|
|
mutex_init(&ctx->irq_lock);
|
||
|
|
idr_init(&ctx->irq_idr);
|
||
|
|
ctx->tidr = 0;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Keep a reference on the AFU to make sure it's valid for the
|
||
|
|
* duration of the life of the context
|
||
|
|
*/
|
||
|
|
ocxl_afu_get(afu);
|
||
|
|
*context = ctx;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(ocxl_context_alloc);
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Callback for when a translation fault triggers an error
|
||
|
|
* data: a pointer to the context which triggered the fault
|
||
|
|
* addr: the address that triggered the error
|
||
|
|
* dsisr: the value of the PPC64 dsisr register
|
||
|
|
*/
|
||
|
|
static void xsl_fault_error(void *data, u64 addr, u64 dsisr)
|
||
|
|
{
|
||
|
|
struct ocxl_context *ctx = (struct ocxl_context *) data;
|
||
|
|
|
||
|
|
mutex_lock(&ctx->xsl_error_lock);
|
||
|
|
ctx->xsl_error.addr = addr;
|
||
|
|
ctx->xsl_error.dsisr = dsisr;
|
||
|
|
ctx->xsl_error.count++;
|
||
|
|
mutex_unlock(&ctx->xsl_error_lock);
|
||
|
|
|
||
|
|
wake_up_all(&ctx->events_wq);
|
||
|
|
}
|
||
|
|
|
||
|
|
int ocxl_context_attach(struct ocxl_context *ctx, u64 amr, struct mm_struct *mm)
|
||
|
|
{
|
||
|
|
int rc;
|
||
|
|
unsigned long pidr = 0;
|
||
|
|
struct pci_dev *dev;
|
||
|
|
|
||
|
|
// Locks both status & tidr
|
||
|
|
mutex_lock(&ctx->status_mutex);
|
||
|
|
if (ctx->status != OPENED) {
|
||
|
|
rc = -EIO;
|
||
|
|
goto out;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (mm)
|
||
|
|
pidr = mm->context.id;
|
||
|
|
|
||
|
|
dev = to_pci_dev(ctx->afu->fn->dev.parent);
|
||
|
|
rc = ocxl_link_add_pe(ctx->afu->fn->link, ctx->pasid, pidr, ctx->tidr,
|
||
|
|
amr, pci_dev_id(dev), mm, xsl_fault_error, ctx);
|
||
|
|
if (rc)
|
||
|
|
goto out;
|
||
|
|
|
||
|
|
ctx->status = ATTACHED;
|
||
|
|
out:
|
||
|
|
mutex_unlock(&ctx->status_mutex);
|
||
|
|
return rc;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(ocxl_context_attach);
|
||
|
|
|
||
|
|
static vm_fault_t map_afu_irq(struct vm_area_struct *vma, unsigned long address,
|
||
|
|
u64 offset, struct ocxl_context *ctx)
|
||
|
|
{
|
||
|
|
u64 trigger_addr;
|
||
|
|
int irq_id = ocxl_irq_offset_to_id(ctx, offset);
|
||
|
|
|
||
|
|
trigger_addr = ocxl_afu_irq_get_addr(ctx, irq_id);
|
||
|
|
if (!trigger_addr)
|
||
|
|
return VM_FAULT_SIGBUS;
|
||
|
|
|
||
|
|
return vmf_insert_pfn(vma, address, trigger_addr >> PAGE_SHIFT);
|
||
|
|
}
|
||
|
|
|
||
|
|
static vm_fault_t map_pp_mmio(struct vm_area_struct *vma, unsigned long address,
|
||
|
|
u64 offset, struct ocxl_context *ctx)
|
||
|
|
{
|
||
|
|
u64 pp_mmio_addr;
|
||
|
|
int pasid_off;
|
||
|
|
vm_fault_t ret;
|
||
|
|
|
||
|
|
if (offset >= ctx->afu->config.pp_mmio_stride)
|
||
|
|
return VM_FAULT_SIGBUS;
|
||
|
|
|
||
|
|
mutex_lock(&ctx->status_mutex);
|
||
|
|
if (ctx->status != ATTACHED) {
|
||
|
|
mutex_unlock(&ctx->status_mutex);
|
||
|
|
pr_debug("%s: Context not attached, failing mmio mmap\n",
|
||
|
|
__func__);
|
||
|
|
return VM_FAULT_SIGBUS;
|
||
|
|
}
|
||
|
|
|
||
|
|
pasid_off = ctx->pasid - ctx->afu->pasid_base;
|
||
|
|
pp_mmio_addr = ctx->afu->pp_mmio_start +
|
||
|
|
pasid_off * ctx->afu->config.pp_mmio_stride +
|
||
|
|
offset;
|
||
|
|
|
||
|
|
ret = vmf_insert_pfn(vma, address, pp_mmio_addr >> PAGE_SHIFT);
|
||
|
|
mutex_unlock(&ctx->status_mutex);
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static vm_fault_t ocxl_mmap_fault(struct vm_fault *vmf)
|
||
|
|
{
|
||
|
|
struct vm_area_struct *vma = vmf->vma;
|
||
|
|
struct ocxl_context *ctx = vma->vm_file->private_data;
|
||
|
|
u64 offset;
|
||
|
|
vm_fault_t ret;
|
||
|
|
|
||
|
|
offset = vmf->pgoff << PAGE_SHIFT;
|
||
|
|
pr_debug("%s: pasid %d address 0x%lx offset 0x%llx\n", __func__,
|
||
|
|
ctx->pasid, vmf->address, offset);
|
||
|
|
|
||
|
|
if (offset < ctx->afu->irq_base_offset)
|
||
|
|
ret = map_pp_mmio(vma, vmf->address, offset, ctx);
|
||
|
|
else
|
||
|
|
ret = map_afu_irq(vma, vmf->address, offset, ctx);
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct vm_operations_struct ocxl_vmops = {
|
||
|
|
.fault = ocxl_mmap_fault,
|
||
|
|
};
|
||
|
|
|
||
|
|
static int check_mmap_afu_irq(struct ocxl_context *ctx,
|
||
|
|
struct vm_area_struct *vma)
|
||
|
|
{
|
||
|
|
int irq_id = ocxl_irq_offset_to_id(ctx, vma->vm_pgoff << PAGE_SHIFT);
|
||
|
|
|
||
|
|
/* only one page */
|
||
|
|
if (vma_pages(vma) != 1)
|
||
|
|
return -EINVAL;
|
||
|
|
|
||
|
|
/* check offset validty */
|
||
|
|
if (!ocxl_afu_irq_get_addr(ctx, irq_id))
|
||
|
|
return -EINVAL;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* trigger page should only be accessible in write mode.
|
||
|
|
*
|
||
|
|
* It's a bit theoretical, as a page mmaped with only
|
||
|
|
* PROT_WRITE is currently readable, but it doesn't hurt.
|
||
|
|
*/
|
||
|
|
if ((vma->vm_flags & VM_READ) || (vma->vm_flags & VM_EXEC) ||
|
||
|
|
!(vma->vm_flags & VM_WRITE))
|
||
|
|
return -EINVAL;
|
||
|
|
vma->vm_flags &= ~(VM_MAYREAD | VM_MAYEXEC);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int check_mmap_mmio(struct ocxl_context *ctx,
|
||
|
|
struct vm_area_struct *vma)
|
||
|
|
{
|
||
|
|
if ((vma_pages(vma) + vma->vm_pgoff) >
|
||
|
|
(ctx->afu->config.pp_mmio_stride >> PAGE_SHIFT))
|
||
|
|
return -EINVAL;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int ocxl_context_mmap(struct ocxl_context *ctx, struct vm_area_struct *vma)
|
||
|
|
{
|
||
|
|
int rc;
|
||
|
|
|
||
|
|
if ((vma->vm_pgoff << PAGE_SHIFT) < ctx->afu->irq_base_offset)
|
||
|
|
rc = check_mmap_mmio(ctx, vma);
|
||
|
|
else
|
||
|
|
rc = check_mmap_afu_irq(ctx, vma);
|
||
|
|
if (rc)
|
||
|
|
return rc;
|
||
|
|
|
||
|
|
vma->vm_flags |= VM_IO | VM_PFNMAP;
|
||
|
|
vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
|
||
|
|
vma->vm_ops = &ocxl_vmops;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int ocxl_context_detach(struct ocxl_context *ctx)
|
||
|
|
{
|
||
|
|
struct pci_dev *dev;
|
||
|
|
int afu_control_pos;
|
||
|
|
enum ocxl_context_status status;
|
||
|
|
int rc;
|
||
|
|
|
||
|
|
mutex_lock(&ctx->status_mutex);
|
||
|
|
status = ctx->status;
|
||
|
|
ctx->status = CLOSED;
|
||
|
|
mutex_unlock(&ctx->status_mutex);
|
||
|
|
if (status != ATTACHED)
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
dev = to_pci_dev(ctx->afu->fn->dev.parent);
|
||
|
|
afu_control_pos = ctx->afu->config.dvsec_afu_control_pos;
|
||
|
|
|
||
|
|
mutex_lock(&ctx->afu->afu_control_lock);
|
||
|
|
rc = ocxl_config_terminate_pasid(dev, afu_control_pos, ctx->pasid);
|
||
|
|
mutex_unlock(&ctx->afu->afu_control_lock);
|
||
|
|
trace_ocxl_terminate_pasid(ctx->pasid, rc);
|
||
|
|
if (rc) {
|
||
|
|
/*
|
||
|
|
* If we timeout waiting for the AFU to terminate the
|
||
|
|
* pasid, then it's dangerous to clean up the Process
|
||
|
|
* Element entry in the SPA, as it may be referenced
|
||
|
|
* in the future by the AFU. In which case, we would
|
||
|
|
* checkstop because of an invalid PE access (FIR
|
||
|
|
* register 2, bit 42). So leave the PE
|
||
|
|
* defined. Caller shouldn't free the context so that
|
||
|
|
* PASID remains allocated.
|
||
|
|
*
|
||
|
|
* A link reset will be required to cleanup the AFU
|
||
|
|
* and the SPA.
|
||
|
|
*/
|
||
|
|
if (rc == -EBUSY)
|
||
|
|
return rc;
|
||
|
|
}
|
||
|
|
rc = ocxl_link_remove_pe(ctx->afu->fn->link, ctx->pasid);
|
||
|
|
if (rc) {
|
||
|
|
dev_warn(&dev->dev,
|
||
|
|
"Couldn't remove PE entry cleanly: %d\n", rc);
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(ocxl_context_detach);
|
||
|
|
|
||
|
|
void ocxl_context_detach_all(struct ocxl_afu *afu)
|
||
|
|
{
|
||
|
|
struct ocxl_context *ctx;
|
||
|
|
int tmp;
|
||
|
|
|
||
|
|
mutex_lock(&afu->contexts_lock);
|
||
|
|
idr_for_each_entry(&afu->contexts_idr, ctx, tmp) {
|
||
|
|
ocxl_context_detach(ctx);
|
||
|
|
/*
|
||
|
|
* We are force detaching - remove any active mmio
|
||
|
|
* mappings so userspace cannot interfere with the
|
||
|
|
* card if it comes back. Easiest way to exercise
|
||
|
|
* this is to unbind and rebind the driver via sysfs
|
||
|
|
* while it is in use.
|
||
|
|
*/
|
||
|
|
mutex_lock(&ctx->mapping_lock);
|
||
|
|
if (ctx->mapping)
|
||
|
|
unmap_mapping_range(ctx->mapping, 0, 0, 1);
|
||
|
|
mutex_unlock(&ctx->mapping_lock);
|
||
|
|
}
|
||
|
|
mutex_unlock(&afu->contexts_lock);
|
||
|
|
}
|
||
|
|
|
||
|
|
void ocxl_context_free(struct ocxl_context *ctx)
|
||
|
|
{
|
||
|
|
mutex_lock(&ctx->afu->contexts_lock);
|
||
|
|
ctx->afu->pasid_count--;
|
||
|
|
idr_remove(&ctx->afu->contexts_idr, ctx->pasid);
|
||
|
|
mutex_unlock(&ctx->afu->contexts_lock);
|
||
|
|
|
||
|
|
ocxl_afu_irq_free_all(ctx);
|
||
|
|
idr_destroy(&ctx->irq_idr);
|
||
|
|
/* reference to the AFU taken in ocxl_context_alloc() */
|
||
|
|
ocxl_afu_put(ctx->afu);
|
||
|
|
kfree(ctx);
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(ocxl_context_free);
|