|
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140 |
- ///-------------------------------------------------------------------------------------------------
- ///
- /// \file ovpCBoxAlgorithmTactiloController.cpp
- /// \brief Functions of the Box Tactilo Controller.
- /// \author Tobias Baumann (TH-Nürnberg).
- /// \version 1.0.
- /// \date Mon Feb 21 14:59:56 2022.
- /// \copyright <a href="https://choosealicense.com/licenses/agpl-3.0/">GNU Affero General Public License v3.0</a>.
- ///
- ///-------------------------------------------------------------------------------------------------
-
- //includes
- #include "ovpCBoxAlgorithmTactiloController.h"
-
- using namespace OpenViBE;
- using namespace /*OpenViBE::*/Kernel;
- using namespace /*OpenViBE::*/Plugins;
- using namespace /*OpenViBE::Plugins::*/Tactilebci;
-
- /*******************************************************************************/
-
- bool CBoxAlgorithmTactiloController::initialize()
- {
- m_StimDecoder.initialize(*this, 0);
- m_StimEncoder.initialize(*this, 0);
-
- //get Box Settings
- m_PortName = FSettingValueAutoCast(*this->getBoxAlgorithmContext(), 0);
- m_RowBase = FSettingValueAutoCast(*this->getBoxAlgorithmContext(), 1);
- m_nTactilos = FSettingValueAutoCast(*this->getBoxAlgorithmContext(), 2);
-
- //set m_nTactilos to 2 if lower than 2
- if(m_nTactilos < 2)
- {
- m_nTactilos = 2;
- }
- //set m_nTactilos to MAX if greater than MAX_TACTILOS
- if(m_nTactilos > MAX_TACTILOS)
- {
- m_nTactilos = MAX_TACTILOS;
- }
-
- //open serial port and set baudrate to 115200
- m_Port.open(m_PortName.toASCIIString());
- m_Port.set_option(boost::asio::serial_port::baud_rate(115200));
-
- if(m_Port.is_open())
- {
- this->getLogManager() << LogLevel_Info << "Connected to Serial Port: " << m_PortName << "\n";
- m_Port.write_some(boost::asio::buffer("b"));
- }
-
- return true;
- }
-
- /*******************************************************************************/
-
- bool CBoxAlgorithmTactiloController::uninitialize()
- {
- this->getLogManager() << LogLevel_Info << "Disconnect from Serial Port: " << m_PortName << "\n";
- m_Port.write_some(boost::asio::buffer("e"));
- m_Port.close();
-
- m_StimDecoder.uninitialize();
- m_StimEncoder.uninitialize();
-
- return true;
- }
-
- /*******************************************************************************/
-
- bool CBoxAlgorithmTactiloController::processInput(const size_t index)
- {
- // some pre-processing code if needed...
-
- // ready to process !
- getBoxAlgorithmContext()->markAlgorithmAsReadyToProcess();
-
- return true;
- }
-
- /*******************************************************************************/
- bool CBoxAlgorithmTactiloController::process()
- {
-
- // the static box context describes the box inputs, outputs, settings structures
- const IBox& staticBoxContext = this->getStaticBoxContext();
- // the dynamic box context describes the current state of the box inputs and outputs (i.e. the chunks)
- IBoxIO& boxContext = this->getDynamicBoxContext();
-
- uint64_t ChunkStartTime = 0;
- uint64_t ChunkEndTime = 0;
- uint64_t Size = 0;
- const uint8_t* Buffer = nullptr;
-
- //iterate over all chunk on input 0
- for (uint64_t i = 0; i < boxContext.getInputChunkCount(0); ++i)
- {
- // decode the chunk i
- m_StimDecoder.decode(i);
-
- if(m_StimDecoder.isBufferReceived())
- {
- //check received stimulations
- CStimulationSet* StimSet = m_StimDecoder.getOutputStimulationSet();
- for(uint64_t j=0; j<StimSet->size(); j++)
- {
- uint64_t StimulationID = StimSet->getId(j);
-
- if(StimulationID >= m_RowBase && StimulationID < (m_RowBase + m_nTactilos))
- {
- m_currTactiloID = StimulationID-m_RowBase;
- }
- if(StimulationID == OVTK_StimulationId_VisualStimulationStart || StimulationID == OVTK_StimulationId_VisualStimulationStop)
- {
- boost::asio::async_write(m_Port, boost::asio::buffer(std::to_string(m_currTactiloID), 1), boost::bind(&CBoxAlgorithmTactiloController::handler, this, boost::asio::placeholders::error, boost::asio::placeholders::bytes_transferred));
- }
- }
- }
-
- // forward input chunks
- boxContext.getInputChunk(0, i, ChunkStartTime, ChunkEndTime, Size, Buffer);
- boxContext.appendOutputChunkData(0, Buffer, Size);
- boxContext.markOutputAsReadyToSend(0, ChunkStartTime, ChunkEndTime);
- boxContext.markInputAsDeprecated(0, i);
-
- }
-
- return true;
- }
-
- /*******************************************************************************/
-
- void CBoxAlgorithmTactiloController::handler(const boost::system::error_code& error, std::size_t bytes_transferred)
- {
- if(error)
- {
- this->getLogManager() << LogLevel_Warning << error.message() << "\n";
- }
- }
|