/* * 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 . */ #include #include #include #include namespace f1x { namespace openauto { namespace autoapp { namespace service { SensorService::SensorService(boost::asio::io_service& ioService, aasdk::messenger::IMessenger::Pointer messenger) : strand_(ioService), timer_(ioService), channel_(std::make_shared(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(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; if (SensorService::isNight) { OPENAUTO_LOG(info) << "[SensorService] Mode night triggered"; indication.add_night_mode()->set_is_night(true); } else { OPENAUTO_LOG(info) << "[SensorService] Mode day triggered"; } //if (!std::ifstream("/tmp/night_mode_enabled")) { // OPENAUTO_LOG(error) << "[CS] [SensorService] Mode day triggered"; // indication.add_night_mode()->set_is_night(false); //} else { // indication.add_night_mode()->set_is_night(true); // OPENAUTO_LOG(error) << "[CS] [SensorService] Mode night triggered"; //} 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::nightSensorPolling() { strand_.dispatch([this, self = this->shared_from_this()]() { this->isNight = is_file_exist("/tmp/night_mode_enabled"); if (this->previous != this->isNight) { this->previous = this->isNight; this->sendNightData(); } timer_.expires_from_now(boost::posix_time::seconds(5)); timer_.async_wait(strand_.wrap(std::bind(&SensorService::nightSensorPolling, this->shared_from_this()))); }); } bool SensorService::is_file_exist(const char *fileName) { std::ifstream ifile(fileName, std::ios::in); return ifile.good(); } void SensorService::onChannelError(const aasdk::error::Error& e) { OPENAUTO_LOG(error) << "[SensorService] channel error: " << e.what(); } } } } }