gpib_hal.c

Go to the documentation of this file.

 
#include "gpib_hal.h"
#include "gpib.h"
#include "fatfs.h"
#include "posix.h"
#include "defines.h"
#include "debug.h"
 
gpib_t gpib_timer;
 
 
void gpib_timer_init()
{
    if(set_timers(gpib_timer_task,1) == -1)       // Install Clock Task
        printf("GPIB Clock task init failed\n");
 
    gpib_timer_reset();
}
 
 
static uint8_t _ppr_reg;
 
uint8_t reverse_8bits(uint8_t mask)
{
    int8_t i;
    uint8_t rmask = 0;
    for(i=0;i<8;++i)
    {
        rmask <<= 1;
        if(mask & 1)
            rmask |= 1;
        mask >>= 1;
    }
    return(rmask & 0xff);
}
 
 
//
 
void ppr_set(uint8_t mask)
{
#if PPR_REVERSE_BITS == 1
    _ppr_reg = reverse_8bits(mask);
#else
    _ppr_reg = mask;
#endif
    SPI0_TXRX_Byte(_ppr_reg);
 
    GPIB_IO_HI(PPE);
    GPIB_IO_LOW(PPE);
}
 
 
 
uint8_t ppr_reg()
{
#if PPR_REVERSE_BITS == 1
    return(reverse_8bits(_ppr_reg));
#else
    return(_ppr_reg);
#endif
}
 
 
 
void ppr_init()
{
#if SDEBUG
    if(debuglevel & GPIB_PPR)
        printf("[PPR DISABLE ALL]\n");
#endif
    ppr_set(0);
}
 
 
 
void ppr_bit_set(uint8_t bit)
{
    BIT_SET(_ppr_reg,bit);
    ppr_set(_ppr_reg);
}
 
 
 
void ppr_bit_clr(uint8_t bit)
{
    BIT_CLR(_ppr_reg,bit);
    ppr_set(_ppr_reg);
}
 
 
 
FRESULT dbf_open (FIL* fp, const TCHAR* path, BYTE mode)
{
    int rc;
    rc = f_open(fp,path, mode);
    if(rc)
    {
        printf("Open error:[%s] ", path);
        put_rc(rc);
        return (rc);
    }
    return(0);
}
 
 
 
FRESULT dbf_read (FIL* fp, void* buff, UINT btr, UINT* br)
{
    int rc;
    rc = f_read(fp, buff, btr, br);
    if(rc)
    {
        printf("Read error: ");
        put_rc(rc);
        return (rc);
    }
    return(0);
}
 
 
 
FRESULT dbf_write (FIL* fp, const void* buff, UINT btw, UINT* bw)
{
    int rc;
    rc = f_write(fp, buff, btw, bw);
    if(rc)
    {
        printf("Write error: ");
        put_rc(rc);
        return (rc);
    }
    return(0);
}
 
 
 
FRESULT dbf_lseek (FIL* fp, DWORD ofs)
{
    int rc;
    rc = f_lseek(fp, ofs);
    if(rc)
    {
        printf("Seek error: ");
        put_rc(rc);
        return (rc);
    }
    return(0);
}
 
 
 
FRESULT dbf_close (FIL* fp)
{
    int rc;
    rc = f_close(fp);
    if(rc != FR_OK)
    {
        printf("Close error: ");
        put_rc(rc);
        return (rc);
    }
    return(0);
}
 
 
 
int dbf_open_read(char *name, uint32_t pos, void *buff, int size, int *errors)
{
    int rc;
    FIL fp;
    int flags = 0;
    UINT bytes = 0;
 
    rc = dbf_open(&fp, name, FA_OPEN_EXISTING | FA_READ | FA_WRITE);
    if( rc != FR_OK)
    {
        flags |= ERR_DISK;
        flags |= ERR_READ;
        *errors = flags;
        return( -1 );
    }
 
    rc = dbf_lseek(&fp, pos);
    if( rc != FR_OK)
    {
        flags |= ERR_SEEK;
        flags |= ERR_READ;
        *errors = flags;
        dbf_close(&fp);
        return( -1 );
    }
 
    rc = dbf_read(&fp, buff,size,&bytes);
    if( rc != FR_OK || (UINT) size != bytes)
    {
        flags |= ERR_READ;
        *errors = flags;
        dbf_close(&fp);
        return( -1 );
    }
    rc = dbf_close(&fp);
    if( rc != FR_OK)
    {
        flags |= ERR_DISK;
        *errors = flags;
        return( -1 );
    }
 
 
#if 0
// test timeout - this works ok
    delayms(500); 
#endif
 
    return(bytes);
}
 
 
int dbf_open_write(char *name, uint32_t pos, void *buff, int size, int *errors)
{
    int rc;
    FIL fp;
    int flags = 0;
    UINT bytes = 0;
 
    rc = dbf_open(&fp, name, FA_OPEN_EXISTING | FA_READ | FA_WRITE);
    if( rc != FR_OK)
    {
        flags |= ERR_DISK;
        flags |= ERR_WRITE;
        *errors = flags;
        return( -1 );
    }
 
    rc = dbf_lseek(&fp, pos);
    if( rc != FR_OK)
    {
        flags |= ERR_SEEK;
        flags |= ERR_WRITE;
        *errors = flags;
        dbf_close(&fp);
        return( -1 );
    }
 
    rc = dbf_write(&fp, buff,size,&bytes);
    if( rc != FR_OK || (UINT) size != bytes)
    {
        flags |= ERR_WRITE;
        *errors = flags;
        dbf_close(&fp);
        return( -1 );
    }
    rc = dbf_close(&fp);
    if( rc != FR_OK)
    {
        flags |= ERR_DISK;
        *errors = flags;
        return( -1 );
    }
 
#if 0
// test timeout - this causes timeout
    delayms(200); 
#endif
 
    return(bytes);
}