Subversion Repositories riscv_vhdl

/**

 * @file

 * @copyright  Copyright 2016 GNSS Sensor Ltd. All right reserved.

 * @author     Sergey Khabarov - sergeykhbr@gmail.com

 * @brief      Ringbuffer implementation.

 */

#ifndef __DEBUGGER_RINGBUF_H__

#define __DEBUGGER_RINGBUF_H__

#include <inttypes.h>

#include <string>

namespace debugger {

class RingBufferType {

public:

    explicit RingBufferType(int sz) {

        size_ = sz + 1;

        rdpos_ = buf_ = new uint8_t[2 * size_];

        wrpos_ = rdpos_ + 1;

    }

    ~RingBufferType() {

        delete buf_;

    }

    uint8_t *put(uint8_t *buf, int sz) {

        uint8_t *ret = wrpos_;

        if (&buf_[size_] >= wrpos_ + sz) {

            memcpy(wrpos_, buf, sz);

            memcpy(wrpos_ + size_, buf, sz);

            wrpos_ += sz;

        } else {

            int part = static_cast<int>(&buf_[size_] - wrpos_);

            memcpy(wrpos_, buf, part);

            memcpy(wrpos_ + size_, buf, part);

            int part2 = sz - part;

            memcpy(buf_, &buf[part], part2);

            memcpy(buf_+ size_, &buf[part], part2);

            wrpos_ += (sz - size_);

        }

        return ret;

    }

    int get(uint8_t *obuf, int sz) {

        int ret = sz;

        if (ret > size()) {

            ret = size();

        }

        /// do not modificate rdpos_ pointer before data reading complete.

        if (rdpos_ == &buf_[size_ - 1]) {

            memcpy(obuf, buf_, ret);

        } else {

            memcpy(obuf, rdpos_ + 1, ret);

        }

        rdpos_ += sz;

        if (rdpos_ >= &buf_[size_]) {

            rdpos_ -= size_;

        }

        return ret;

    }

    int size() {

        int t1 = static_cast<int>(wrpos_ - rdpos_) - 1;

        if (t1 < 0) {

            t1 += size_;

        }

        return t1;

    }

private:

    uint8_t *buf_;

    uint8_t *wrpos_;

    uint8_t *rdpos_;

    int size_;

};

}  // namespace debugger

#endif  // __DEBUGGER_RINGBUF_H__