This is the code we showed at Uncraftivism

Dependencies:   mbed

SerialBuffered.cpp

Committer:
jarkman
Date:
2009-12-14
Revision:
2:01115080f6da
Parent:
0:57f4fdadc97f

File content as of revision 2:01115080f6da:

#include "stdafx.h"
#include "mbed.h"
#include "SerialBuffered.h"
 

extern Logger pcSerial;
 
SerialBuffered::SerialBuffered( size_t bufferSize, PinName tx, PinName rx ) : Serial(  tx,  rx ) 
{
    m_buffSize = 0;
    m_contentStart = 0;
    m_contentEnd = 0;
    m_timeout = 1.0;
   
    
    attach( this, &SerialBuffered::handleInterrupt );
    
    m_buff = (uint8_t *) malloc( bufferSize );
    if( m_buff == NULL )
    {
        pcSerial.printf("SerialBuffered - failed to alloc buffer size %d\r\n", (int) bufferSize );
    }
    else
    {
        m_buffSize = bufferSize;
    }
}


SerialBuffered::~SerialBuffered()
{
    if( m_buff )
        free( m_buff );
}

void SerialBuffered::setTimeout( float seconds )
{
    m_timeout = seconds;
}
    
size_t SerialBuffered::readBytes( uint8_t *bytes, size_t requested )
{
    int i = 0;

    for( ; i < requested; )
    {
        int c = getc();
        if( c < 0 )
            break;
        bytes[i] = c;
        i++;
    }
    
    return i;
        
}


int SerialBuffered::getc()
{
    m_timer.reset();
    m_timer.start();

#ifdef ON_DESKTOP
	handleInterrupt();
#endif

    while( m_contentStart == m_contentEnd )
    {
     
        wait_ms( 1 );
        if( m_timeout > 0 &&  m_timer.read() > m_timeout )
		{
			pcSerial.printf("SerialBuffered - timeout\r\n");

            return EOF;
		}

#ifdef ON_DESKTOP
		handleInterrupt();
#endif
    }

    m_timer.stop();
   
    uint8_t result = m_buff[m_contentStart++];

    m_contentStart =  m_contentStart % m_buffSize;

   
    return result;    
}


int SerialBuffered::readable()
{
#ifdef ON_DESKTOP
		handleInterrupt();
#endif

    return m_contentStart != m_contentEnd ;
}

void SerialBuffered::handleInterrupt()
{
    
    while( Serial::readable())
    {
        if( m_contentStart == (m_contentEnd +1) % m_buffSize)
        {
           pcSerial.printf("SerialBuffered - buffer overrun, data lost!\r\n" );
           Serial::getc();

        }
        else
        {
          
            m_buff[ m_contentEnd ++ ] = Serial::getc();
			
            m_contentEnd = m_contentEnd % m_buffSize;
            
           
           
        }
    }
}