Skip to content

F
FPGA Configuration Space
Commit 4bd92d04 authored by Manohar Vanga's avatar Manohar Vanga
Browse files
Options

Added spec driver (with firmware loading) 

Signed-off-by: 's avatarManohar Vanga <manohar.vanga@gmail.com>
parent bfbd61f7
Hide whitespace changes
Inline Side-by-side
Showing with 82 additions and 3 deletions
spec/fakespec.c
View file @ 4bd92d04
#include <linux/module.h>
#include <linux/init.h>
#include <linux/pci.h>
#include <linux/firmware.h>
#include "../wishbone/wb.h"
#define SPEC_VENDOR 0xbabe
#define SPEC_DEVICE 0xbabe
struct wb_header {
__u32 vendor;
__u16 device;
__u16 subdevice;
__u32 flags;
};
int ndev;
struct wb_device **wbdev;
static int fake_spec_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
{
int i = -1;
int j = 0;
struct wb_header *header;
const struct firmware *wb_fw;
/* load wishbone address map firmware */
if (request_firmware(&wb_fw, "wb_map", &pdev->dev)) {
printk(KERN_ERR "failed to load firmware\n");
return -1;
}
if (wb_fw->size % 1024)
printk(KERN_DEBUG "not aligned to 1024 bytes. skipping extra\n");
ndev = wb_fw->size / 1024;
if (!ndev) {
printk(KERN_DEBUG "no devices in memory map\n");
goto nodev;
}
wbdev = kzalloc(sizeof(struct wb_device *) * ndev, GFP_KERNEL);
if (!wbdev)
goto arr_alloc_fail;
/* register wishbone devices */
while (++i < ndev) {
header = (struct wb_header *)&wb_fw->data[i * 1024];
if (!header->vendor)
continue;
wbdev[j] = kzalloc(sizeof(struct wb_device), GFP_KERNEL);
if (!wbdev[j])
goto alloc_fail;
wbdev[j]->vendor = header->vendor;
wbdev[j]->device = header->device;
wbdev[j]->subdevice = header->subdevice;
wbdev[j]->flags = header->flags;
if (wb_register_device(wbdev[j]) < 0)
goto register_fail;
j++;
}
ndev = j;
return 0;
nodev:
release_firmware(wb_fw);
return 0;
register_fail:
kfree(wbdev[j]);
alloc_fail:
while (--j >= 0) {
wb_unregister_device(wbdev[j]);
kfree(wbdev[j]);
}
kfree(wbdev);
arr_alloc_fail:
release_firmware(wb_fw);
return -1;
}
static void fake_spec_remove(struct pci_dev *pdev)
{
int i;
for (i = 0; i < ndev; i++) {
wb_unregister_device(wbdev[i]);
kfree(wbdev[i]);
}
kfree(wbdev);
}
struct pci_device_id fake_spec_pci_tbl[] = {
......
wishbone/wb.c
View file @ 4bd92d04
......@@ -35,7 +35,15 @@ int wb_register_device(struct wb_device *wbdev)
dev_set_name(&wbdev->dev, "wb%d", devno++);
return device_register(&wbdev->dev);
}
//EXPORT_SYMBOL(wb_register_device);
EXPORT_SYMBOL(wb_register_device);
void wb_unregister_device(struct wb_device *wbdev)
{
if (!wbdev)
return;
device_unregister(&wbdev->dev);
}
EXPORT_SYMBOL(wb_unregister_device);
/*
* Register a Wishbone driver
......
wishbone/wb.h
View file @ 4bd92d04
......@@ -33,14 +33,16 @@ struct wb_device {
unsigned int vendor;
unsigned short device;
unsigned short subdevice;
unsigned int flags; /* LSB to MSB: 4 bits priority, 12 bits class,
unsigned int flags; /* MSB to LSB: 4 bits priority, 12 bits class,
16 bits version */
struct wb_driver *driver;
struct device dev;
};
#define to_wb_device(dev) container_of(dev, struct wb_device, dev);
//int wb_register_device(struct wb_device *wbdev); /* not public */
int wb_register_device(struct wb_device *wbdev);
void wb_unregister_device(struct wb_device *wbdev);
int wb_register_driver(struct wb_driver *driver);
void wb_unregister_driver(struct wb_driver *driver);
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment