Subversion Repositories amber

/*----------------------------------------------------------------

//                                                              //

//  boot-loader-ethmac.c                                        //

//                                                              //

//  This file is part of the Amber project                      //

//  http://www.opencores.org/project,amber                      //

//                                                              //

//  Description                                                 //

//  The main functions for the boot loader application. This    //

//  application is embedded in the FPGA's SRAM and is used      //

//  to load larger applications into the DDR3 memory on         //

//  the development board.                                      //

//                                                              //

//  Author(s):                                                  //

//      - Conor Santifort, csantifort.amber@gmail.com           //

//                                                              //

//////////////////////////////////////////////////////////////////

//                                                              //

// Copyright (C) 2011 Authors and OPENCORES.ORG                 //

//                                                              //

// This source file may be used and distributed without         //

// restriction provided that this copyright statement is not    //

// removed from the file and that any derivative work contains  //

// the original copyright notice and the associated disclaimer. //

//                                                              //

// This source file is free software; you can redistribute it   //

// and/or modify it under the terms of the GNU Lesser General   //

// Public License as published by the Free Software Foundation; //

// either version 2.1 of the License, or (at your option) any   //

// later version.                                               //

//                                                              //

// This source 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 Lesser General Public License for more //

// details.                                                     //

//                                                              //

// You should have received a copy of the GNU Lesser General    //

// Public License along with this source; if not, download it   //

// from http://www.opencores.org/lgpl.shtml                     //

//                                                              //

----------------------------------------------------------------*/

#include "utilities.h"

#include "line-buffer.h"

#include "timer.h"

#include "packet.h"

line_buf_t* init_line_buffer (int size)

{

    line_buf_t* lbuf;

    int i;

    lbuf = malloc(sizeof(line_buf_t));

    lbuf->read_ptr  = 0;

    lbuf->write_ptr = 0;

    lbuf->len_bytes = size;

    lbuf->buf = malloc(size);

    return lbuf;

}

/* Add a single byte to the line buffer */

void put_byte (line_buf_t* telnet_buf, char byte, int last)

{

    /* Need to pass a pointer to a pointer to the location to

       write the character, to that the pointer to the location

       can be incremented by the final output function

    */

    telnet_buf->buf[telnet_buf->write_ptr]   = byte;

    if (last)

        telnet_buf->buf[telnet_buf->write_ptr+1] = 0;

    else

        telnet_buf->buf[telnet_buf->write_ptr+1] = 1;

    telnet_buf->write_ptr++;

    /* Wrap the write pointer */

    if ((telnet_buf->write_ptr + MAX_LINE) >= telnet_buf->len_bytes)

        telnet_buf->write_ptr = 0;

}

/* Add a line to the line buffer */

void put_line (line_buf_t* telnet_buf, const char *fmt, ...)

{

    int len;

    char *buf;

    int i;

    register unsigned long *varg = (unsigned long *)(&fmt);

    *varg++;

    /* Need to pass a pointer to a pointer to the location to

       write the character, to that the pointer to the location

       can be incremented by the final output function

    */

    buf = &telnet_buf->buf[telnet_buf->write_ptr];

    len = print(&buf, fmt, varg);

    buf[len] = 0;

    telnet_buf->write_ptr += len;

    /* Wrap the write pointer */

    if ((telnet_buf->write_ptr + MAX_LINE) >= telnet_buf->len_bytes)

        telnet_buf->write_ptr = 0;

    telnet_buf->buf[telnet_buf->write_ptr] = 0;

}

/* Retrieve the next line from a line buffer.

   return 0 if buffer doesn't have a complete line */

int get_line (line_buf_t* telnet_buf, char** line)

{

    int len = 0;

    // Grab these once at the start in case they are changed by an interrupt

    register int write_ptr   = telnet_buf->write_ptr;

    /* Wrap the read pointer */

    if ((telnet_buf->read_ptr + MAX_LINE) >= telnet_buf->len_bytes)

        telnet_buf->read_ptr = 0;

    *line = telnet_buf->buf + telnet_buf->read_ptr;

    /* Find the length of the next line in the buffer */

    if (telnet_buf->read_ptr != write_ptr) {

        /* Find next 0 */

        while (telnet_buf->read_ptr+len != write_ptr        &&

               telnet_buf->buf[telnet_buf->read_ptr+len]!=0 &&

               telnet_buf->buf[telnet_buf->read_ptr+len]!=1 &&

               len < MAX_LINE)

            len++;

        /* Check if there are some chars from put_char but not a complete line */

        if (telnet_buf->buf[telnet_buf->read_ptr+len]==1)

            return 0;

        else {

            telnet_buf->read_ptr += len;

            return len;

            }

        }

    else

        return 0;

}