linux-imx

/*

 *  TURBOchannel bus services.

 *

 *  Copyright (c) Harald Koerfgen, 1998

 *  Copyright (c) 2001, 2003, 2005, 2006, 2018  Maciej W. Rozycki

 *  Copyright (c) 2005  James Simmons

 *

 *  This file is subject to the terms and conditions of the GNU

 *  General Public License.  See the file "COPYING" in the main

 *  directory of this archive for more details.

 */

#include <linux/compiler.h>

#include <linux/dma-mapping.h>

#include <linux/errno.h>

#include <linux/init.h>

#include <linux/ioport.h>

#include <linux/kernel.h>

#include <linux/list.h>

#include <linux/module.h>

#include <linux/slab.h>

#include <linux/string.h>

#include <linux/tc.h>

#include <linux/types.h>

​

#include <asm/io.h>

​

static struct tc_bus tc_bus = {

    .name = "TURBOchannel",

};

​

/*

 * Probing for TURBOchannel modules.

 */

static void __init tc_bus_add_devices(struct tc_bus *tbus)

{

    resource_size_t slotsize = tbus->info.slot_size << 20;

    resource_size_t extslotsize = tbus->ext_slot_size;

    resource_size_t slotaddr;

    resource_size_t extslotaddr;

    resource_size_t devsize;

    void __iomem *module;

    struct tc_dev *tdev;

    int i, slot, err;

    u8 pattern[4];

    long offset;

​

    for (slot = 0; slot < tbus->num_tcslots; slot++) {

        slotaddr = tbus->slot_base + slot * slotsize;

        extslotaddr = tbus->ext_slot_base + slot * extslotsize;

        module = ioremap_nocache(slotaddr, slotsize);

        BUG_ON(!module);

​

        offset = TC_OLDCARD;

​

        err = 0;

        err |= tc_preadb(pattern + 0, module + offset + TC_PATTERN0);

        err |= tc_preadb(pattern + 1, module + offset + TC_PATTERN1);

        err |= tc_preadb(pattern + 2, module + offset + TC_PATTERN2);

        err |= tc_preadb(pattern + 3, module + offset + TC_PATTERN3);

        if (err)

            goto out_err;

​

        if (pattern[0] != 0x55 || pattern[1] != 0x00 ||

            pattern[2] != 0xaa || pattern[3] != 0xff) {

            offset = TC_NEWCARD;

​

            err = 0;

            err |= tc_preadb(pattern + 0,

                     module + offset + TC_PATTERN0);

            err |= tc_preadb(pattern + 1,

                     module + offset + TC_PATTERN1);

            err |= tc_preadb(pattern + 2,

                     module + offset + TC_PATTERN2);

            err |= tc_preadb(pattern + 3,

                     module + offset + TC_PATTERN3);

            if (err)

                goto out_err;

        }

​

        if (pattern[0] != 0x55 || pattern[1] != 0x00 ||

            pattern[2] != 0xaa || pattern[3] != 0xff)

            goto out_err;

​

        /* Found a board, allocate it an entry in the list */

        tdev = kzalloc(sizeof(*tdev), GFP_KERNEL);

        if (!tdev) {

            pr_err("tc%x: unable to allocate tc_dev\n", slot);

            goto out_err;

        }

        dev_set_name(&tdev->dev, "tc%x", slot);

        tdev->bus = tbus;

        tdev->dev.parent = &tbus->dev;