29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 1) // SPDX-License-Identifier: GPL-2.0
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 2) /*
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 3) * Driver for FPGA Management Engine (FME) Partial Reconfiguration
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 4) *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 5) * Copyright (C) 2017-2018 Intel Corporation, Inc.
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 6) *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 7) * Authors:
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 8) * Kang Luwei <luwei.kang@intel.com>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 9) * Xiao Guangrong <guangrong.xiao@linux.intel.com>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 10) * Wu Hao <hao.wu@intel.com>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 11) * Joseph Grecco <joe.grecco@intel.com>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 12) * Enno Luebbers <enno.luebbers@intel.com>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 13) * Tim Whisonant <tim.whisonant@intel.com>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 14) * Ananda Ravuri <ananda.ravuri@intel.com>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 15) * Christopher Rauer <christopher.rauer@intel.com>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 16) * Henry Mitchel <henry.mitchel@intel.com>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 17) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 18)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 19) #include <linux/types.h>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 20) #include <linux/device.h>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 21) #include <linux/vmalloc.h>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 22) #include <linux/uaccess.h>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 23) #include <linux/fpga/fpga-mgr.h>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 24) #include <linux/fpga/fpga-bridge.h>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 25) #include <linux/fpga/fpga-region.h>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 26) #include <linux/fpga-dfl.h>
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 27)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 28) #include "dfl.h"
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 29) #include "dfl-fme.h"
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 30) #include "dfl-fme-pr.h"
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 31)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 32) static struct dfl_fme_region *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 33) dfl_fme_region_find_by_port_id(struct dfl_fme *fme, int port_id)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 34) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 35) struct dfl_fme_region *fme_region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 36)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 37) list_for_each_entry(fme_region, &fme->region_list, node)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 38) if (fme_region->port_id == port_id)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 39) return fme_region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 40)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 41) return NULL;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 42) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 43)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 44) static int dfl_fme_region_match(struct device *dev, const void *data)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 45) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 46) return dev->parent == data;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 47) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 48)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 49) static struct fpga_region *dfl_fme_region_find(struct dfl_fme *fme, int port_id)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 50) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 51) struct dfl_fme_region *fme_region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 52) struct fpga_region *region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 53)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 54) fme_region = dfl_fme_region_find_by_port_id(fme, port_id);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 55) if (!fme_region)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 56) return NULL;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 57)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 58) region = fpga_region_class_find(NULL, &fme_region->region->dev,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 59) dfl_fme_region_match);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 60) if (!region)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 61) return NULL;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 62)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 63) return region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 64) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 65)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 66) static int fme_pr(struct platform_device *pdev, unsigned long arg)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 67) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 68) struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 69) void __user *argp = (void __user *)arg;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 70) struct dfl_fpga_fme_port_pr port_pr;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 71) struct fpga_image_info *info;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 72) struct fpga_region *region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 73) void __iomem *fme_hdr;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 74) struct dfl_fme *fme;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 75) unsigned long minsz;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 76) void *buf = NULL;
69416739ee369 (Wu Hao 2019-06-27 17:49:39 -0700 77) size_t length;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 78) int ret = 0;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 79) u64 v;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 80)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 81) minsz = offsetofend(struct dfl_fpga_fme_port_pr, buffer_address);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 82)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 83) if (copy_from_user(&port_pr, argp, minsz))
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 84) return -EFAULT;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 85)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 86) if (port_pr.argsz < minsz || port_pr.flags)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 87) return -EINVAL;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 88)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 89) /* get fme header region */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 90) fme_hdr = dfl_get_feature_ioaddr_by_id(&pdev->dev,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 91) FME_FEATURE_ID_HEADER);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 92)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 93) /* check port id */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 94) v = readq(fme_hdr + FME_HDR_CAP);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 95) if (port_pr.port_id >= FIELD_GET(FME_CAP_NUM_PORTS, v)) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 96) dev_dbg(&pdev->dev, "port number more than maximum\n");
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 97) return -EINVAL;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 98) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 99)
69416739ee369 (Wu Hao 2019-06-27 17:49:39 -0700 100) /*
69416739ee369 (Wu Hao 2019-06-27 17:49:39 -0700 101) * align PR buffer per PR bandwidth, as HW ignores the extra padding
69416739ee369 (Wu Hao 2019-06-27 17:49:39 -0700 102) * data automatically.
69416739ee369 (Wu Hao 2019-06-27 17:49:39 -0700 103) */
69416739ee369 (Wu Hao 2019-06-27 17:49:39 -0700 104) length = ALIGN(port_pr.buffer_size, 4);
69416739ee369 (Wu Hao 2019-06-27 17:49:39 -0700 105)
69416739ee369 (Wu Hao 2019-06-27 17:49:39 -0700 106) buf = vmalloc(length);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 107) if (!buf)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 108) return -ENOMEM;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 109)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 110) if (copy_from_user(buf,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 111) (void __user *)(unsigned long)port_pr.buffer_address,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 112) port_pr.buffer_size)) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 113) ret = -EFAULT;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 114) goto free_exit;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 115) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 116)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 117) /* prepare fpga_image_info for PR */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 118) info = fpga_image_info_alloc(&pdev->dev);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 119) if (!info) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 120) ret = -ENOMEM;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 121) goto free_exit;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 122) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 123)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 124) info->flags |= FPGA_MGR_PARTIAL_RECONFIG;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 125)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 126) mutex_lock(&pdata->lock);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 127) fme = dfl_fpga_pdata_get_private(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 128) /* fme device has been unregistered. */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 129) if (!fme) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 130) ret = -EINVAL;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 131) goto unlock_exit;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 132) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 133)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 134) region = dfl_fme_region_find(fme, port_pr.port_id);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 135) if (!region) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 136) ret = -EINVAL;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 137) goto unlock_exit;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 138) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 139)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 140) fpga_image_info_free(region->info);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 141)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 142) info->buf = buf;
69416739ee369 (Wu Hao 2019-06-27 17:49:39 -0700 143) info->count = length;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 144) info->region_id = port_pr.port_id;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 145) region->info = info;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 146)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 147) ret = fpga_region_program_fpga(region);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 148)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 149) /*
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 150) * it allows userspace to reset the PR region's logic by disabling and
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 151) * reenabling the bridge to clear things out between accleration runs.
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 152) * so no need to hold the bridges after partial reconfiguration.
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 153) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 154) if (region->get_bridges)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 155) fpga_bridges_put(®ion->bridge_list);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 156)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 157) put_device(®ion->dev);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 158) unlock_exit:
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 159) mutex_unlock(&pdata->lock);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 160) free_exit:
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 161) vfree(buf);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 162) return ret;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 163) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 164)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 165) /**
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 166) * dfl_fme_create_mgr - create fpga mgr platform device as child device
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 167) *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 168) * @pdata: fme platform_device's pdata
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 169) *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 170) * Return: mgr platform device if successful, and error code otherwise.
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 171) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 172) static struct platform_device *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 173) dfl_fme_create_mgr(struct dfl_feature_platform_data *pdata,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 174) struct dfl_feature *feature)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 175) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 176) struct platform_device *mgr, *fme = pdata->dev;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 177) struct dfl_fme_mgr_pdata mgr_pdata;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 178) int ret = -ENOMEM;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 179)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 180) if (!feature->ioaddr)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 181) return ERR_PTR(-ENODEV);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 182)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 183) mgr_pdata.ioaddr = feature->ioaddr;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 184)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 185) /*
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 186) * Each FME has only one fpga-mgr, so allocate platform device using
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 187) * the same FME platform device id.
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 188) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 189) mgr = platform_device_alloc(DFL_FPGA_FME_MGR, fme->id);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 190) if (!mgr)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 191) return ERR_PTR(ret);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 192)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 193) mgr->dev.parent = &fme->dev;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 194)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 195) ret = platform_device_add_data(mgr, &mgr_pdata, sizeof(mgr_pdata));
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 196) if (ret)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 197) goto create_mgr_err;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 198)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 199) ret = platform_device_add(mgr);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 200) if (ret)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 201) goto create_mgr_err;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 202)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 203) return mgr;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 204)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 205) create_mgr_err:
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 206) platform_device_put(mgr);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 207) return ERR_PTR(ret);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 208) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 209)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 210) /**
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 211) * dfl_fme_destroy_mgr - destroy fpga mgr platform device
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 212) * @pdata: fme platform device's pdata
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 213) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 214) static void dfl_fme_destroy_mgr(struct dfl_feature_platform_data *pdata)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 215) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 216) struct dfl_fme *priv = dfl_fpga_pdata_get_private(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 217)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 218) platform_device_unregister(priv->mgr);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 219) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 220)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 221) /**
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 222) * dfl_fme_create_bridge - create fme fpga bridge platform device as child
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 223) *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 224) * @pdata: fme platform device's pdata
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 225) * @port_id: port id for the bridge to be created.
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 226) *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 227) * Return: bridge platform device if successful, and error code otherwise.
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 228) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 229) static struct dfl_fme_bridge *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 230) dfl_fme_create_bridge(struct dfl_feature_platform_data *pdata, int port_id)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 231) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 232) struct device *dev = &pdata->dev->dev;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 233) struct dfl_fme_br_pdata br_pdata;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 234) struct dfl_fme_bridge *fme_br;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 235) int ret = -ENOMEM;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 236)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 237) fme_br = devm_kzalloc(dev, sizeof(*fme_br), GFP_KERNEL);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 238) if (!fme_br)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 239) return ERR_PTR(ret);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 240)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 241) br_pdata.cdev = pdata->dfl_cdev;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 242) br_pdata.port_id = port_id;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 243)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 244) fme_br->br = platform_device_alloc(DFL_FPGA_FME_BRIDGE,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 245) PLATFORM_DEVID_AUTO);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 246) if (!fme_br->br)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 247) return ERR_PTR(ret);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 248)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 249) fme_br->br->dev.parent = dev;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 250)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 251) ret = platform_device_add_data(fme_br->br, &br_pdata, sizeof(br_pdata));
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 252) if (ret)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 253) goto create_br_err;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 254)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 255) ret = platform_device_add(fme_br->br);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 256) if (ret)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 257) goto create_br_err;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 258)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 259) return fme_br;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 260)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 261) create_br_err:
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 262) platform_device_put(fme_br->br);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 263) return ERR_PTR(ret);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 264) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 265)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 266) /**
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 267) * dfl_fme_destroy_bridge - destroy fpga bridge platform device
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 268) * @fme_br: fme bridge to destroy
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 269) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 270) static void dfl_fme_destroy_bridge(struct dfl_fme_bridge *fme_br)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 271) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 272) platform_device_unregister(fme_br->br);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 273) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 274)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 275) /**
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 276) * dfl_fme_destroy_bridge - destroy all fpga bridge platform device
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 277) * @pdata: fme platform device's pdata
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 278) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 279) static void dfl_fme_destroy_bridges(struct dfl_feature_platform_data *pdata)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 280) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 281) struct dfl_fme *priv = dfl_fpga_pdata_get_private(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 282) struct dfl_fme_bridge *fbridge, *tmp;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 283)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 284) list_for_each_entry_safe(fbridge, tmp, &priv->bridge_list, node) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 285) list_del(&fbridge->node);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 286) dfl_fme_destroy_bridge(fbridge);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 287) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 288) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 289)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 290) /**
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 291) * dfl_fme_create_region - create fpga region platform device as child
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 292) *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 293) * @pdata: fme platform device's pdata
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 294) * @mgr: mgr platform device needed for region
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 295) * @br: br platform device needed for region
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 296) * @port_id: port id
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 297) *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 298) * Return: fme region if successful, and error code otherwise.
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 299) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 300) static struct dfl_fme_region *
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 301) dfl_fme_create_region(struct dfl_feature_platform_data *pdata,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 302) struct platform_device *mgr,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 303) struct platform_device *br, int port_id)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 304) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 305) struct dfl_fme_region_pdata region_pdata;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 306) struct device *dev = &pdata->dev->dev;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 307) struct dfl_fme_region *fme_region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 308) int ret = -ENOMEM;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 309)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 310) fme_region = devm_kzalloc(dev, sizeof(*fme_region), GFP_KERNEL);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 311) if (!fme_region)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 312) return ERR_PTR(ret);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 313)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 314) region_pdata.mgr = mgr;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 315) region_pdata.br = br;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 316)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 317) /*
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 318) * Each FPGA device may have more than one port, so allocate platform
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 319) * device using the same port platform device id.
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 320) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 321) fme_region->region = platform_device_alloc(DFL_FPGA_FME_REGION, br->id);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 322) if (!fme_region->region)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 323) return ERR_PTR(ret);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 324)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 325) fme_region->region->dev.parent = dev;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 326)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 327) ret = platform_device_add_data(fme_region->region, ®ion_pdata,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 328) sizeof(region_pdata));
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 329) if (ret)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 330) goto create_region_err;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 331)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 332) ret = platform_device_add(fme_region->region);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 333) if (ret)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 334) goto create_region_err;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 335)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 336) fme_region->port_id = port_id;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 337)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 338) return fme_region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 339)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 340) create_region_err:
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 341) platform_device_put(fme_region->region);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 342) return ERR_PTR(ret);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 343) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 344)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 345) /**
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 346) * dfl_fme_destroy_region - destroy fme region
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 347) * @fme_region: fme region to destroy
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 348) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 349) static void dfl_fme_destroy_region(struct dfl_fme_region *fme_region)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 350) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 351) platform_device_unregister(fme_region->region);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 352) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 353)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 354) /**
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 355) * dfl_fme_destroy_regions - destroy all fme regions
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 356) * @pdata: fme platform device's pdata
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 357) */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 358) static void dfl_fme_destroy_regions(struct dfl_feature_platform_data *pdata)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 359) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 360) struct dfl_fme *priv = dfl_fpga_pdata_get_private(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 361) struct dfl_fme_region *fme_region, *tmp;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 362)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 363) list_for_each_entry_safe(fme_region, tmp, &priv->region_list, node) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 364) list_del(&fme_region->node);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 365) dfl_fme_destroy_region(fme_region);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 366) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 367) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 368)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 369) static int pr_mgmt_init(struct platform_device *pdev,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 370) struct dfl_feature *feature)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 371) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 372) struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 373) struct dfl_fme_region *fme_region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 374) struct dfl_fme_bridge *fme_br;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 375) struct platform_device *mgr;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 376) struct dfl_fme *priv;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 377) void __iomem *fme_hdr;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 378) int ret = -ENODEV, i = 0;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 379) u64 fme_cap, port_offset;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 380)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 381) fme_hdr = dfl_get_feature_ioaddr_by_id(&pdev->dev,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 382) FME_FEATURE_ID_HEADER);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 383)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 384) mutex_lock(&pdata->lock);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 385) priv = dfl_fpga_pdata_get_private(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 386)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 387) /* Initialize the region and bridge sub device list */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 388) INIT_LIST_HEAD(&priv->region_list);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 389) INIT_LIST_HEAD(&priv->bridge_list);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 390)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 391) /* Create fpga mgr platform device */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 392) mgr = dfl_fme_create_mgr(pdata, feature);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 393) if (IS_ERR(mgr)) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 394) dev_err(&pdev->dev, "fail to create fpga mgr pdev\n");
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 395) goto unlock;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 396) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 397)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 398) priv->mgr = mgr;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 399)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 400) /* Read capability register to check number of regions and bridges */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 401) fme_cap = readq(fme_hdr + FME_HDR_CAP);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 402) for (; i < FIELD_GET(FME_CAP_NUM_PORTS, fme_cap); i++) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 403) port_offset = readq(fme_hdr + FME_HDR_PORT_OFST(i));
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 404) if (!(port_offset & FME_PORT_OFST_IMP))
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 405) continue;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 406)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 407) /* Create bridge for each port */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 408) fme_br = dfl_fme_create_bridge(pdata, i);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 409) if (IS_ERR(fme_br)) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 410) ret = PTR_ERR(fme_br);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 411) goto destroy_region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 412) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 413)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 414) list_add(&fme_br->node, &priv->bridge_list);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 415)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 416) /* Create region for each port */
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 417) fme_region = dfl_fme_create_region(pdata, mgr,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 418) fme_br->br, i);
029d727b4f5d7 (Wei Yongjun 2018-08-16 14:42:13 -0500 419) if (IS_ERR(fme_region)) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 420) ret = PTR_ERR(fme_region);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 421) goto destroy_region;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 422) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 423)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 424) list_add(&fme_region->node, &priv->region_list);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 425) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 426) mutex_unlock(&pdata->lock);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 427)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 428) return 0;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 429)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 430) destroy_region:
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 431) dfl_fme_destroy_regions(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 432) dfl_fme_destroy_bridges(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 433) dfl_fme_destroy_mgr(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 434) unlock:
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 435) mutex_unlock(&pdata->lock);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 436) return ret;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 437) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 438)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 439) static void pr_mgmt_uinit(struct platform_device *pdev,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 440) struct dfl_feature *feature)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 441) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 442) struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 443)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 444) mutex_lock(&pdata->lock);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 445)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 446) dfl_fme_destroy_regions(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 447) dfl_fme_destroy_bridges(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 448) dfl_fme_destroy_mgr(pdata);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 449) mutex_unlock(&pdata->lock);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 450) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 451)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 452) static long fme_pr_ioctl(struct platform_device *pdev,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 453) struct dfl_feature *feature,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 454) unsigned int cmd, unsigned long arg)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 455) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 456) long ret;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 457)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 458) switch (cmd) {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 459) case DFL_FPGA_FME_PORT_PR:
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 460) ret = fme_pr(pdev, arg);
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 461) break;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 462) default:
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 463) ret = -ENODEV;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 464) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 465)
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 466) return ret;
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 467) }
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 468)
15bbb300fcef4 (Wu Hao 2019-08-04 18:20:15 +0800 469) const struct dfl_feature_id fme_pr_mgmt_id_table[] = {
15bbb300fcef4 (Wu Hao 2019-08-04 18:20:15 +0800 470) {.id = FME_FEATURE_ID_PR_MGMT,},
15bbb300fcef4 (Wu Hao 2019-08-04 18:20:15 +0800 471) {0}
15bbb300fcef4 (Wu Hao 2019-08-04 18:20:15 +0800 472) };
15bbb300fcef4 (Wu Hao 2019-08-04 18:20:15 +0800 473)
15bbb300fcef4 (Wu Hao 2019-08-04 18:20:15 +0800 474) const struct dfl_feature_ops fme_pr_mgmt_ops = {
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 475) .init = pr_mgmt_init,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 476) .uinit = pr_mgmt_uinit,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 477) .ioctl = fme_pr_ioctl,
29de76240e861 (Kang Luwei 2018-06-30 08:53:24 +0800 478) };