linux-imx

/*

 * Incremental bus scan, based on bus topology

 *

 * Copyright (C) 2004-2006 Kristian Hoegsberg <krh@bitplanet.net>

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License as published by

 * the Free Software Foundation; either version 2 of the License, or

 * (at your option) any later version.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software Foundation,

 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.

 */

​

#include <linux/bug.h>

#include <linux/errno.h>

#include <linux/firewire.h>

#include <linux/firewire-constants.h>

#include <linux/jiffies.h>

#include <linux/kernel.h>

#include <linux/list.h>

#include <linux/module.h>

#include <linux/slab.h>

#include <linux/spinlock.h>

​

#include <linux/atomic.h>

#include <asm/byteorder.h>

​

#include "core.h"

​

#define SELF_ID_PHY_ID(q)       (((q) >> 24) & 0x3f)

#define SELF_ID_EXTENDED(q)     (((q) >> 23) & 0x01)

#define SELF_ID_LINK_ON(q)      (((q) >> 22) & 0x01)

#define SELF_ID_GAP_COUNT(q)        (((q) >> 16) & 0x3f)

#define SELF_ID_PHY_SPEED(q)        (((q) >> 14) & 0x03)

#define SELF_ID_CONTENDER(q)        (((q) >> 11) & 0x01)

#define SELF_ID_PHY_INITIATOR(q)    (((q) >>  1) & 0x01)

#define SELF_ID_MORE_PACKETS(q)     (((q) >>  0) & 0x01)

​

#define SELF_ID_EXT_SEQUENCE(q)     (((q) >> 20) & 0x07)

​

#define SELFID_PORT_CHILD   0x3

#define SELFID_PORT_PARENT  0x2

#define SELFID_PORT_NCONN   0x1

#define SELFID_PORT_NONE    0x0

​

static u32 *count_ports(u32 *sid, int *total_port_count, int *child_port_count)

{

    u32 q;

    int port_type, shift, seq;

​

    *total_port_count = 0;

    *child_port_count = 0;

​

    shift = 6;

    q = *sid;

    seq = 0;

​

    while (1) {

        port_type = (q >> shift) & 0x03;

        switch (port_type) {

        case SELFID_PORT_CHILD:

            (*child_port_count)++;

        case SELFID_PORT_PARENT:

        case SELFID_PORT_NCONN:

            (*total_port_count)++;

        case SELFID_PORT_NONE:

            break;

        }

​

        shift -= 2;

        if (shift == 0) {

            if (!SELF_ID_MORE_PACKETS(q))

                return sid + 1;

​

            shift = 16;

            sid++;

            q = *sid;

​

            /*

             * Check that the extra packets actually are

             * extended self ID packets and that the

             * sequence numbers in the extended self ID

             * packets increase as expected.

             */

​