mirror of https://github.com/f1xpl/openauto.git
140 lines
5.2 KiB
C++
140 lines
5.2 KiB
C++
/*
|
|
* This file is part of openauto project.
|
|
* Copyright (C) 2018 f1x.studio (Michal Szwaj)
|
|
*
|
|
* openauto 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.
|
|
|
|
* openauto 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 openauto. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <aasdk_proto/DrivingStatusEnum.pb.h>
|
|
#include <f1x/openauto/Common/Log.hpp>
|
|
#include <f1x/openauto/autoapp/Service/SensorService.hpp>
|
|
|
|
namespace f1x
|
|
{
|
|
namespace openauto
|
|
{
|
|
namespace autoapp
|
|
{
|
|
namespace service
|
|
{
|
|
|
|
SensorService::SensorService(boost::asio::io_service& ioService, aasdk::messenger::IMessenger::Pointer messenger)
|
|
: strand_(ioService)
|
|
, channel_(std::make_shared<aasdk::channel::sensor::SensorServiceChannel>(strand_, std::move(messenger)))
|
|
{
|
|
|
|
}
|
|
|
|
void SensorService::start()
|
|
{
|
|
strand_.dispatch([this, self = this->shared_from_this()]() {
|
|
OPENAUTO_LOG(info) << "[SensorService] start.";
|
|
channel_->receive(this->shared_from_this());
|
|
});
|
|
}
|
|
|
|
void SensorService::stop()
|
|
{
|
|
strand_.dispatch([this, self = this->shared_from_this()]() {
|
|
OPENAUTO_LOG(info) << "[SensorService] stop.";
|
|
});
|
|
}
|
|
|
|
void SensorService::fillFeatures(aasdk::proto::messages::ServiceDiscoveryResponse& response)
|
|
{
|
|
OPENAUTO_LOG(info) << "[SensorService] fill features.";
|
|
|
|
auto* channelDescriptor = response.add_channels();
|
|
channelDescriptor->set_channel_id(static_cast<uint32_t>(channel_->getId()));
|
|
|
|
auto* sensorChannel = channelDescriptor->mutable_sensor_channel();
|
|
sensorChannel->add_sensors()->set_type(aasdk::proto::enums::SensorType::DRIVING_STATUS);
|
|
//sensorChannel->add_sensors()->set_type(aasdk::proto::enums::SensorType::LOCATION);
|
|
sensorChannel->add_sensors()->set_type(aasdk::proto::enums::SensorType::NIGHT_DATA);
|
|
}
|
|
|
|
void SensorService::onChannelOpenRequest(const aasdk::proto::messages::ChannelOpenRequest& request)
|
|
{
|
|
OPENAUTO_LOG(info) << "[SensorService] open request, priority: " << request.priority();
|
|
const aasdk::proto::enums::Status::Enum status = aasdk::proto::enums::Status::OK;
|
|
OPENAUTO_LOG(info) << "[SensorService] open status: " << status;
|
|
|
|
aasdk::proto::messages::ChannelOpenResponse response;
|
|
response.set_status(status);
|
|
|
|
auto promise = aasdk::channel::SendPromise::defer(strand_);
|
|
promise->then([]() {}, std::bind(&SensorService::onChannelError, this->shared_from_this(), std::placeholders::_1));
|
|
channel_->sendChannelOpenResponse(response, std::move(promise));
|
|
|
|
channel_->receive(this->shared_from_this());
|
|
}
|
|
|
|
void SensorService::onSensorStartRequest(const aasdk::proto::messages::SensorStartRequestMessage& request)
|
|
{
|
|
OPENAUTO_LOG(info) << "[SensorService] sensor start request, type: " << request.sensor_type();
|
|
|
|
aasdk::proto::messages::SensorStartResponseMessage response;
|
|
response.set_status(aasdk::proto::enums::Status::OK);
|
|
|
|
auto promise = aasdk::channel::SendPromise::defer(strand_);
|
|
|
|
if(request.sensor_type() == aasdk::proto::enums::SensorType::DRIVING_STATUS)
|
|
{
|
|
promise->then(std::bind(&SensorService::sendDrivingStatusUnrestricted, this->shared_from_this()),
|
|
std::bind(&SensorService::onChannelError, this->shared_from_this(), std::placeholders::_1));
|
|
}
|
|
else if(request.sensor_type() == aasdk::proto::enums::SensorType::NIGHT_DATA)
|
|
{
|
|
promise->then(std::bind(&SensorService::sendNightData, this->shared_from_this()),
|
|
std::bind(&SensorService::onChannelError, this->shared_from_this(), std::placeholders::_1));
|
|
}
|
|
else
|
|
{
|
|
promise->then([]() {}, std::bind(&SensorService::onChannelError, this->shared_from_this(), std::placeholders::_1));
|
|
}
|
|
|
|
channel_->sendSensorStartResponse(response, std::move(promise));
|
|
channel_->receive(this->shared_from_this());
|
|
}
|
|
|
|
void SensorService::sendDrivingStatusUnrestricted()
|
|
{
|
|
aasdk::proto::messages::SensorEventIndication indication;
|
|
indication.add_driving_status()->set_status(aasdk::proto::enums::DrivingStatus::UNRESTRICTED);
|
|
|
|
auto promise = aasdk::channel::SendPromise::defer(strand_);
|
|
promise->then([]() {}, std::bind(&SensorService::onChannelError, this->shared_from_this(), std::placeholders::_1));
|
|
channel_->sendSensorEventIndication(indication, std::move(promise));
|
|
}
|
|
|
|
void SensorService::sendNightData()
|
|
{
|
|
aasdk::proto::messages::SensorEventIndication indication;
|
|
indication.add_night_mode()->set_is_night(false);
|
|
|
|
auto promise = aasdk::channel::SendPromise::defer(strand_);
|
|
promise->then([]() {}, std::bind(&SensorService::onChannelError, this->shared_from_this(), std::placeholders::_1));
|
|
channel_->sendSensorEventIndication(indication, std::move(promise));
|
|
}
|
|
|
|
void SensorService::onChannelError(const aasdk::error::Error& e)
|
|
{
|
|
OPENAUTO_LOG(error) << "[SensorService] channel error: " << e.what();
|
|
}
|
|
|
|
}
|
|
}
|
|
}
|
|
}
|