ringbuffer.h

/*
Part of prius3charger_buck
Copyright (c) 2020 Perttu "celeron55" Ahola

This program is free software: you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation, either version 3 of the License, or
(at your option) any later version.

This program 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 General Public License for more details.

You should have received a copy of the GNU General Public License
along with this program.  If not, see <https://www.gnu.org/licenses/>.
*/

#pragma once

template<typename T, size_t S>
struct RingBuffer2
{
	T data[S];
	size_t start = 0;
	size_t end = 0;
	size_t size_ = 0;

	void push(const T &v) {
		if(end == S)
			end = 0;
		data[end++] = v;
		if(size_ == S){
			start++;
			if(start == S)
				start = 0;
		} else {
			size_++;
		}
	}

	T pop(){
		if(size_ == 0)
			return 0;
		T v = data[start++];
		if(start == S)
			start = 0;
		size_--;
		return v;
	}

	T& operator[] (size_t i){
		i += start;
		if(i >= S)
			i -= S;
		return data[i];
	}

	bool full() const {
		return size_ == S;
	}

	size_t size() const {
		return size_;
	}

	void reset(){
		start = 0;
		end = 0;
		size_ = 0;
	}
};