linux-imx

/*

 * Copyright (C) 2012 CERN (www.cern.ch)

 * Author: Alessandro Rubini <rubini@gnudd.com>

 *

 * Released according to the GNU GPL, version 2 or any later version.

 *

 * This work is part of the White Rabbit project, a research effort led

 * by CERN, the European Institute for Nuclear Research.

 */

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/slab.h>

#include <linux/init.h>

#include <linux/device.h>

#include <linux/fmc.h>

#include <linux/fmc-sdb.h>

​

#include "fmc-private.h"

​

static int fmc_check_version(unsigned long version, const char *name)

{

    if (__FMC_MAJOR(version) != FMC_MAJOR) {

        pr_err("%s: \"%s\" has wrong major (has %li, expected %i)\n",

               __func__, name, __FMC_MAJOR(version), FMC_MAJOR);

        return -EINVAL;

    }

​

    if (__FMC_MINOR(version) != FMC_MINOR)

        pr_info("%s: \"%s\" has wrong minor (has %li, expected %i)\n",

               __func__, name, __FMC_MINOR(version), FMC_MINOR);

    return 0;

}

​

static int fmc_uevent(struct device *dev, struct kobj_uevent_env *env)

{

    /* struct fmc_device *fdev = to_fmc_device(dev); */

​

    /* FIXME: The MODALIAS */

    add_uevent_var(env, "MODALIAS=%s", "fmc");

    return 0;

}

​

static int fmc_probe(struct device *dev)

{

    struct fmc_driver *fdrv = to_fmc_driver(dev->driver);

    struct fmc_device *fdev = to_fmc_device(dev);

​

    return fdrv->probe(fdev);

}

​

static int fmc_remove(struct device *dev)

{

    struct fmc_driver *fdrv = to_fmc_driver(dev->driver);

    struct fmc_device *fdev = to_fmc_device(dev);

​

    return fdrv->remove(fdev);

}

​

static void fmc_shutdown(struct device *dev)

{

    /* not implemented but mandatory */

}

​

static struct bus_type fmc_bus_type = {

    .name = "fmc",

    .match = fmc_match,

    .uevent = fmc_uevent,

    .probe = fmc_probe,

    .remove = fmc_remove,

    .shutdown = fmc_shutdown,

};

​

static void fmc_release(struct device *dev)

{

    struct fmc_device *fmc = container_of(dev, struct fmc_device, dev);

​

    kfree(fmc);

}

​

/*

 * The eeprom is exported in sysfs, through a binary attribute

 */

​

static ssize_t fmc_read_eeprom(struct file *file, struct kobject *kobj,

               struct bin_attribute *bin_attr,

               char *buf, loff_t off, size_t count)

{

    struct device *dev;

    struct fmc_device *fmc;

    int eelen;

​

    dev = container_of(kobj, struct device, kobj);