From 253e3d98505108f652ba875544fde4f58d4714c8 Mon Sep 17 00:00:00 2001 From: Yury Asheshov Date: Tue, 15 Dec 2015 17:18:35 +0000 Subject: Initial commit Signed-off-by: Manuel Bachmann Author: Yury Asheshov --- hvacplugin.cpp | 239 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 239 insertions(+) create mode 100644 hvacplugin.cpp (limited to 'hvacplugin.cpp') diff --git a/hvacplugin.cpp b/hvacplugin.cpp new file mode 100644 index 0000000..d67d9b4 --- /dev/null +++ b/hvacplugin.cpp @@ -0,0 +1,239 @@ +/* + * hvacplugin.cpp - AMB plugin to conttrol HVAC demo hardware for CES 2016 + * + * Copyright (C) 2013-2015 K2L GmbH & Co. KG + * + * 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. + * + * This file is licensed under GPLv2. + */ + +#include +#include + +#include +#include +#include +#include +#include + +#include + +#include "hvacplugin.h" + +static const char* DEFAULT_CAN_IF_NAME = "vcan0"; + +//---------------------------------------------------------------------------- +// K2LHvacPlugin +//---------------------------------------------------------------------------- + +extern "C" void create(AbstractRoutingEngine* routingengine, std::map config) +{ + new K2LHvacPlugin(routingengine, config); +} + +K2LHvacPlugin::K2LHvacPlugin(AbstractRoutingEngine* re, const map& config) + : AbstractSource(re, config) +{ + printf("K2LHvacPlugin: created - 2015-12-08 10:04\n"); + + addPropertySupport(VehicleProperty::TargetTemperature, Zone::FrontLeft | Zone::FrontRight); + + Zone::ZoneList tempartureZones; + tempartureZones.push_back(Zone::FrontLeft); + tempartureZones.push_back(Zone::FrontRight); + + temperatureValues[Zone::FrontLeft] = 21; + temperatureValues[Zone::FrontRight] = 21; + + PropertyInfo tempartureZonesInfo(0, tempartureZones); + propertyInfoMap[VehicleProperty::TargetTemperature] = tempartureZonesInfo; + + addPropertySupport(VehicleProperty::FanSpeed, Zone::None); + + socketId = socket(PF_CAN, SOCK_RAW, CAN_RAW); + printf("Socket: %i\n", socketId); + if (socketId < 0) + { + printf("ERROR: socket could not be created\n"); + } + else + { + struct ifreq ifr; + + strcpy(ifr.ifr_name, "vcan0" ); + if(ioctl(this->socketId, SIOCGIFINDEX, &ifr) < 0) + { + close(socketId); + socketId = -1; + printf("ERROR: ioctl failed\n"); + } + else + { + txAddress.can_family = AF_CAN; + txAddress.can_ifindex = ifr.ifr_ifindex; + + if (bind(this->socketId, (struct sockaddr *)&txAddress, sizeof(txAddress)) < 0) + { + close(socketId); + socketId = -1; + printf("ERROR: bind failed\n"); + } + + txCanFrame.can_id = 0x30; + txCanFrame.can_dlc = 8; + } + } +} + +K2LHvacPlugin::~K2LHvacPlugin() +{ + if(socketId >= 0) + { + close(socketId); + printf("Socket closed\n"); + } +} + +void K2LHvacPlugin::getPropertyAsync(AsyncPropertyReply *reply) +{ + printf("K2LHvacPlugin::getPropertyAsync\n"); + + if(reply->property == VehicleProperty::FanSpeed) + { + printf("VehicleProperty::FanSpeed=OK\n"); + VehicleProperty::FanSpeedType temp(fanSpeedValue); + reply->value = &temp; + reply->success = true; + reply->completed(reply); + } + else if(reply->property == VehicleProperty::TargetTemperature) + { + printf("VehicleProperty::TargetTemperature="); + if(temperatureValues.find(reply->zoneFilter) == temperatureValues.end()) + { + printf("AsyncPropertyReply::ZoneNotSupported\n"); + reply->success = false; + reply->error = AsyncPropertyReply::ZoneNotSupported; + reply->completed(reply); + } + else + { + printf("OK\n"); + VehicleProperty::TargetTemperatureType temp(temperatureValues[reply->zoneFilter]); + reply->success = true; + reply->value = &temp; + reply->completed(reply); + } + } +} + +AsyncPropertyReply *K2LHvacPlugin::setProperty(AsyncSetPropertyRequest request ) +{ + printf("K2LHvacPlugin::setProperty\n"); + AsyncPropertyReply *reply = new AsyncPropertyReply(request); + reply->success = false; + reply->error = AsyncPropertyReply::NoError; + + if(reply->property == VehicleProperty::FanSpeed) + { + printf("VehicleProperty::FanSpeed=OK\n"); + fanSpeedValue = (uint8_t)reply->value->value(); + } + else if(reply->property == VehicleProperty::TargetTemperature) + { + printf("VehicleProperty::TargetTemperature="); + if(temperatureValues.find(reply->zoneFilter) == temperatureValues.end()) + { + printf("AsyncPropertyReply::ZoneNotSupported\n"); + reply->error = AsyncPropertyReply::ZoneNotSupported; + } + else + { + printf("OK\n"); + temperatureValues[reply->zoneFilter] = (uint8_t)reply->value->value(); + } + } + else + { + reply->error = AsyncPropertyReply::InvalidOperation; + } + + if(reply->error == AsyncPropertyReply::NoError) + { + reply->success = true; + + routingEngine->updateProperty(reply->value,uuid()); + + if (socketId >= 0) + { + printf("Send CAN message\n"); + + txCanFrame.data[0] = GetTemperature(temperatureValues[Zone::FrontLeft]); + txCanFrame.data[1] = GetTemperature(temperatureValues[Zone::FrontRight]); + txCanFrame.data[2] = GetTemperature((temperatureValues[Zone::FrontLeft] + + temperatureValues[Zone::FrontRight]) / 2); + txCanFrame.data[3] = 0xF0; + txCanFrame.data[4] = fanSpeedValue; + txCanFrame.data[5] = 0x01; + txCanFrame.data[6] = 0x00; + txCanFrame.data[7] = 0x00; + + sendto(socketId, &txCanFrame, sizeof(struct can_frame), 0, + (struct sockaddr*)&txAddress, sizeof(txAddress)); + } + } + else + { + reply->success = false; + } + + reply->completed(reply); + return reply; +} + +uint8_t K2LHvacPlugin::GetTemperature(uint8_t value) +{ + uint8_t result = ((0xF0 - 0x10) / 15) * value - 16; + if (result < 0x10) + result = 0x10; + if (result > 0xF0) + result = 0xF0; + + return result; +} + +void K2LHvacPlugin::subscribeToPropertyChanges(VehicleProperty::Property property) +{ + mRequests.push_back(property); +} + +PropertyList K2LHvacPlugin::supported() +{ + return mSupported; +} + +void K2LHvacPlugin::unsubscribeToPropertyChanges(VehicleProperty::Property property) +{ + if(contains(mRequests,property)) + removeOne(&mRequests, property); +} + +int K2LHvacPlugin::supportedOperations() +{ + return Get | Set | GetRanged; +} + +void K2LHvacPlugin::addPropertySupport(VehicleProperty::Property property, Zone::Type zone) +{ + mSupported.push_back(property); + + Zone::ZoneList zones; + zones.push_back(zone); + + PropertyInfo info(0, zones); + propertyInfoMap[property] = info; +} -- cgit 1.2.3-korg