linux-imx

#include <linux/types.h>

#include <linux/ioport.h>

#include <linux/slab.h>

#include <linux/export.h>

#include <linux/io.h>

#include <linux/mcb.h>

​

#include "mcb-internal.h"

​

struct mcb_parse_priv {

    phys_addr_t mapbase;

    void __iomem *base;

};

​

#define for_each_chameleon_cell(dtype, p)   \

    for ((dtype) = get_next_dtype((p)); \

         (dtype) != CHAMELEON_DTYPE_END;    \

         (dtype) = get_next_dtype((p)))

​

static inline uint32_t get_next_dtype(void __iomem *p)

{

    uint32_t dtype;

​

    dtype = readl(p);

    return dtype >> 28;

}

​

static int chameleon_parse_bdd(struct mcb_bus *bus,

            struct chameleon_bar *cb,

            void __iomem *base)

{

    return 0;

}

​

static int chameleon_parse_gdd(struct mcb_bus *bus,

            struct chameleon_bar *cb,

            void __iomem *base, int bar_count)

{

    struct chameleon_gdd __iomem *gdd =

        (struct chameleon_gdd __iomem *) base;

    struct mcb_device *mdev;

    u32 dev_mapbase;

    u32 offset;

    u32 size;

    int ret;

    __le32 reg1;

    __le32 reg2;

​

    mdev = mcb_alloc_dev(bus);

    if (!mdev)

        return -ENOMEM;

​

    reg1 = readl(&gdd->reg1);

    reg2 = readl(&gdd->reg2);

    offset = readl(&gdd->offset);

    size = readl(&gdd->size);

​

    mdev->id = GDD_DEV(reg1);

    mdev->rev = GDD_REV(reg1);

    mdev->var = GDD_VAR(reg1);

    mdev->bar = GDD_BAR(reg2);

    mdev->group = GDD_GRP(reg2);

    mdev->inst = GDD_INS(reg2);