utils/dnp3_src/cpp/libs/src/opendnp3/link/ShiftableBuffer.cpp - master - tisit/OpenPLC_v3

utils/dnp3_src/cpp/libs/src/opendnp3/link/ShiftableBuffer.cpp

88 строк2 KB

thiagoralves

First commit. OpenPLC v3 beta 1

14 июн 2018, 20:43

14 июн 2018, 20:431b10e97

/*
 * Licensed to Green Energy Corp (www.greenenergycorp.com) under one or
 * more contributor license agreements. See the NOTICE file distributed
 * with this work for additional information regarding copyright ownership.
 * Green Energy Corp licenses this file to you under the Apache License,
 * Version 2.0 (the "License"); you may not use this file except in
 * compliance with the License.  You may obtain a copy of the License at
 *
 * http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *
 * This project was forked on 01/01/2013 by Automatak, LLC and modifications
 * may have been made to this file. Automatak, LLC licenses these modifications
 * to you under the terms of the License.
 */
#include "ShiftableBuffer.h"

#include <openpal/Configure.h>
#include <assert.h>
#include <cstring>
#include <iostream>

namespace opendnp3
{


ShiftableBuffer::ShiftableBuffer(uint8_t* pBuffer_, uint32_t size) :
	pBuffer(pBuffer_),
	M_SIZE(size),
	writePos(0),
	readPos(0)
{

}

void ShiftableBuffer::Shift()
{
	auto numRead = this->NumBytesRead();

	//copy all unread data to the front of the buffer
	memmove(pBuffer, pBuffer + readPos, numRead);

	readPos = 0;
	writePos = numRead;
}

void ShiftableBuffer::Reset()
{
	writePos = 0;
	readPos = 0;
}

void ShiftableBuffer::AdvanceRead(uint32_t numBytes)
{
	assert(numBytes <= this->NumBytesRead());
	readPos += numBytes;
}

void ShiftableBuffer::AdvanceWrite(uint32_t aNumBytes)
{
	assert(aNumBytes <= this->NumWriteBytes());
	writePos += aNumBytes;
}

bool ShiftableBuffer::Sync(uint32_t& skipCount)
{
	while (this->NumBytesRead() > 1) // at least 2 bytes
	{
		if (this->ReadBuffer()[0] == 0x05 && this->ReadBuffer()[1] == 0x64)
		{
			return true;
		}
		else
		{
			this->AdvanceRead(1); // skip the first byte
			++skipCount;
		}
	}

	return false;
}

}