/*------------------------------------------------------------------------------
--  This file is a part of the LPP VHDL IP LIBRARY
--  Copyright (C) 2009 - 2010, Laboratory of Plasmas Physic - CNRS
--
--  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 3 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 
-------------------------------------------------------------------------------*/
/*--                  Author : Alexis Jeandet
--                     Mail : alexis.jeandet@lpp.polytechnique.fr
----------------------------------------------------------------------------*/
#include "lpp_apb_functions.h"
#include <stdio.h>



int* apbgetdevice(int PID,int VID,int count)
{
    struct apbPnPreg* dev = (struct apbPnPreg*)(APB_TBL_HEAD + sizeof(struct apbPnPreg));
    int id;
    id = (PID<<12) | (VID<<24);
    while(dev != (struct apbPnPreg*)(APB_TBL_HEAD|0xFFF))
        {
            if((dev->idReg & 0xFFFFF000) == id)
            {
                if(count == 0)
                {
                    return (int*) (APB_BASE_ADDRS | (dev->bar&0xFFF00000)>>12);
                }
                count-=1;
            }
            dev += 1;
        }
    return NULL;
}


void apbgetdeviceinfofromdevptr(const struct apbPnPreg* dev,struct apbdevinfo* devinfo)
{

    devinfo->productID = (dev->idReg>>12) & 0xFFF;
    devinfo->vendorID = (dev->idReg>>24) & 0xFF;
    devinfo->address = ((dev->bar>>12) & 0xFFF00)|APB_BASE_ADDRS;
    devinfo->irq = dev->idReg & 0x1F;
    devinfo->mask = (dev->bar>>4)&0xFFF;
    devinfo->version = (dev->idReg>>5)&0x1F;
}

void apbgetdeviceinfofromid(int PID,int VID,int count,struct apbdevinfo* devinfo)
{
    struct apbPnPreg* dev = (struct apbPnPreg*)(APB_TBL_HEAD + sizeof(struct apbPnPreg));
    int id;
    id = (PID<<12) | (VID<<24);
    while(dev != (struct apbPnPreg*)(APB_TBL_HEAD|0xFFF))
        {
            if((dev->idReg & 0xFFFFF000) == id)
            {
                if(count == 0)
                {
                    devinfo->productID = PID;
                    devinfo->vendorID = VID;
                    devinfo->address = ((dev->bar>>12) & 0xFFF00)|APB_BASE_ADDRS;
                    devinfo->irq = dev->idReg & 0x1F;
                    devinfo->mask = (dev->bar>>4)&0xFFF;
                    devinfo->version = (dev->idReg>>5)&0x1F;
                    return;
                }
                count-=1;
            }
            dev += 1;
        }
}



void apbprintdeviceinfo(struct apbdevinfo devinfo)
{
    printf("Vendor ID = 0x%x\n",devinfo.vendorID);
    printf("Product ID = 0x%x\n",devinfo.productID);
    printf("Device address = 0x%x\n",devinfo.address);
    printf("Device Irq = %d\n",devinfo.irq);
    printf("Device mask = 0x%x\n",devinfo.mask);
    printf("Device Version = %d\n",devinfo.version);
}


void apbprintdeviceslist()
{
    struct apbdevinfo devinfo;
    struct apbPnPreg* dev = (struct apbPnPreg*)(APB_TBL_HEAD );//+ sizeof(struct apbPnPreg));
    int i =0;
    int fisrtBAR;
    while((dev->idReg == 0) && (i<APB_MAX_DEVICES))
    {
        dev += 1;
        i+=1;
    }
    fisrtBAR = dev->bar;
    for(i=i;i<APB_MAX_DEVICES;i++)
        {
            if((dev->idReg != 0 ))
            {
                apbgetdeviceinfofromdevptr(dev,&devinfo);
                printf("\n\n======= new device found========\n");
                apbprintdeviceinfo(devinfo);
            }
            dev += 1;
            if(dev->bar == fisrtBAR)
                break;
        }
}