Subversion Repositories pcie_ds_dma

//---------------------------------------------------------------------------
#include <stdio.h>
#include <stdint.h>
 
#include	"board.h"
//#include	"brderr.h"
//#include	"ctrlstrm.h"
//#include        "ctrlreg.h"
//#include        "useful.h"
//#include	"cl_wbpex.h"
 
#ifndef __PEX_BOARD_H__
    #include "pex_board.h"
#endif
 
#ifndef __BOARD_H__
    #include "board.h"
#endif
 
#include "cl_wbpex.h"
#include "sys/select.h"
//BRD_Handle g_hBrd=0;
 
//!  Инициализация модуля
U32  CL_WBPEX::init( void )
{
    //S32 err;
    //S32 num;
 
    /*
    if( g_hBrd<=0)
    {
        BRDC_fprintf( stderr, _BRDC("\r\nМодуль не найден\r\n") );
        return 1;
    } else {
        BRDC_fprintf( stderr, _BRDC("BRD_open() - Ok\r\n") );
        BRD_getInfo(1, &info );
    }
    */
 
    board *brd = new pex_board();
    m_pBoard = brd;
 
    brd->brd_open( "/dev/pexdrv0" );
    brd->brd_init();
    brd->brd_board_info();
    //brd->brd_pld_info();
 
    // сброс прошивки ПЛИС
    return 0;
}
 
//!  Завершение работы с модулем
void  CL_WBPEX::cleanup( void )
{
    //S32 ret;
    //ret=BRD_cleanup();
 
}
 
 
 
 
// Доступ к регистрам 
 
 
 
CL_WBPEX::CL_WBPEX()
{
 
}
 
 
 
int CL_WBPEX::StreamInit( U32 strm, U32 cnt_buf, U32 size_one_buf_of_bytes, U32 trd, U32 dir, U32 cycle, U32 system, U32 agree_mode )
{
    if( strm>1 )
        return 1;
 
    StreamParam *pStrm= m_streamParam+strm;
    if( pStrm->status!=0 )
        return 1;
 
    pStrm->cnt_buf	= cnt_buf;
    pStrm->size_one_buf_of_bytes =	size_one_buf_of_bytes;
    pStrm->trd		= trd;
    pStrm->cycle	= cycle;
    pStrm->system	= system;
 
    pStrm->indexDma=-1;
    pStrm->indexPc=-1;
    pStrm->agree_mode=agree_mode;
 
    StreamDestroy( strm );
 
 
    //U32 size=cnt_buf*size_one_buf_of_bytes/(1024*1024);
    __int64 size=cnt_buf*(__int64)size_one_buf_of_bytes/(1024*1024);
 
    if( system )
    {
        BRDC_fprintf( stderr, _BRDC("Выделение памяти: \r\n")
                     _BRDC(" Тип блока:    Непрерывный (системная память)\r\n")
                     _BRDC(" Размер блока: %lld МБ\r\n"), size );
    } else
    {
        BRDC_fprintf( stderr, _BRDC("Выделение памяти: \r\n")
                     _BRDC(" Тип блока:    Разрывный (пользовательская память)\r\n")
                     _BRDC(" Размер блока: %lld МБ  (%dx%d МБ)\r\n"), size, cnt_buf, size_one_buf_of_bytes/(1024*1024) );
    }
 
 
 
 
    // Перевод на согласованный режим работы
    if( agree_mode )
    {
    } else
    {
        BRDC_fprintf( stderr, _BRDC("Стрим работает в несогласованном режиме\r\n") );
    }
    BRDC_fprintf( stderr, "\r\n" );
 
/*
    err = BRD_ctrl( pStrm->hStream, 0, BRDctrl_STREAM_CBUF_STOP, NULL);
 
    err = BRD_ctrl( pStrm->hStream, 0, BRDctrl_STREAM_RESETFIFO, NULL );
 
 
    err = BRD_ctrl( pStrm->hStream, 0, BRDctrl_STREAM_RESETFIFO, NULL );
*/
    pStrm->status=1;
 
    return 0;
}
 
int CL_WBPEX::StreamGetNextIndex( U32 strm, U32 index )
{
    if( strm>1 )
        return 0;
 
    StreamParam *pStrm= m_streamParam+strm;
    int n=index+1;
    if( (U32)n>=pStrm->cnt_buf )
        n=0;
    return n;
 
}
 
void CL_WBPEX::StreamDestroy( U32 strm )
{
    S32 err;
 
    if( strm>1 )
        return;
 
    StreamParam *pStrm= m_streamParam+strm;
    if( pStrm->status==0 )
        return;
 
    StreamStop( strm );
 
    if( 1 )
    {
        BRDC_fprintf( stderr, _BRDC("\r\nОсвобождение стрима  %.8X\r\n"), err );
       // pStrm->hStream=0;
    }
    pStrm->status=0;
 
}
 
U32* CL_WBPEX::StreamGetBufByNum( U32 strm, U32 numBuf )
{
    if( strm>1 )
        return NULL;
 
    StreamParam *pStrm= m_streamParam+strm;
    if( pStrm->status!=1 )
        return NULL;
 
    U32 *ptr;
    if( numBuf>=pStrm->cnt_buf )
        return NULL;
    ptr=(U32*)(pStrm->pBlk[numBuf]);
    return ptr;
}
 
void CL_WBPEX::StreamStart( U32 strm )
{
 
    if( strm>1 )
        return;
 
    StreamParam *pStrm= m_streamParam+strm;
    if( pStrm->status!=1 )
        return;
 
    //S32 err;
    //U32 val;
 
    //val=RegPeekInd( pStrm->trd, 0 );
    //err = BRD_ctrl( pStrm->hStream, 0, BRDctrl_STREAM_CBUF_STOP, NULL);
 
 
    pStrm->indexDma=-1;
    pStrm->indexPc=-1;
 
    //val=pStrm->cycle; // 0 - однократный режим, 1 - циклический
    //err = BRD_ctrl( pStrm->hStream, 0, BRDctrl_STREAM_CBUF_START, &val );
}
 
void CL_WBPEX::StreamStop( U32 strm )
{
    if( strm>1 )
        return;
 
    //StreamParam *pStrm= m_streamParam+strm;
 
    //S32 err;
 
    //RegPokeInd( pStrm->trd, 0, 2 );
 
    //err = BRD_ctrl( pStrm->hStream, 0, BRDctrl_STREAM_CBUF_STOP, NULL);
 
    //err = BRD_ctrl( pStrm->hStream, 0, BRDctrl_STREAM_RESETFIFO, NULL );
 
    //RegPokeInd( pStrm->trd, 0, 0 );
 
}
 
int CL_WBPEX::StreamGetBuf( U32 strm, U32** ptr )
{
    U32 *buf;
    int ret=0;
 
    if( strm>1 )
        return 0;
 
    StreamParam *pStrm= m_streamParam+strm;
 
 
    if( pStrm->indexPc==pStrm->indexDma )
    {
        pStrm->indexDma = StreamGetIndexDma( strm );
    }
    if( pStrm->indexPc!=pStrm->indexDma )
    {
        pStrm->indexPc=StreamGetNextIndex( strm, pStrm->indexPc );
        buf = StreamGetBufByNum( strm, pStrm->indexPc );
        *ptr = buf;
        ret=1;
        //StreamGetBufDone( strm );
    }
    return ret;
}
 
int CL_WBPEX::StreamGetIndexDma( U32 strm )
{
    if( strm>1 )
        return -1;
 
    //StreamParam *pStrm= m_streamParam+strm;
 
 
 
//    int ret = pStrm->pStub->lastBlock;
    return 0;
}
 
void CL_WBPEX::StreamGetBufDone( U32 strm )
{
    if( strm>1 )
        return;
 
    StreamParam *pStrm= m_streamParam+strm;
    //S32 err;
    //static U32 err_code=0;
 
    if( pStrm->agree_mode )
    {
    }
}
 
/*
void Sleep( int ms )
{
    struct timeval tv = {0, 0};
    tv.tv_usec = 1000*ms;
 
    select(0,NULL,NULL,NULL,&tv);
 
}
*/
 
 
 
//! Запись в регистр блока на шине WB
void CL_WBPEX::wb_block_write( U32 nb, U32 reg, U32 val )
{
    if( (nb>1) || (reg>31) )
        return;
    m_pBoard->brd_bar1_write( nb*0x2000/4+reg*2, val );
}
 
//! Чтение из регистра блока на шине WB
U32 CL_WBPEX::wb_block_read( U32 nb, U32 reg )
{
    U32 ret;
    if( (nb>1) || (reg>31) )
        return -1;
    ret=m_pBoard->brd_bar1_read( nb*0x2000/4+reg*2 );
    return ret;
}