*/
#include "exampleplugin.h"
+#include "timestamp.h"
+#include "listplusplus.h"
#include <iostream>
#include <boost/assert.hpp>
+#include <boost/lexical_cast.hpp>
#include <glib.h>
using namespace std;
#include "debugout.h"
+uint16_t accelerationX = 0;
+Transmission::TransmissionPositions transmissionShiftPostion = Transmission::Neutral;
+uint16_t steeringWheelAngle=0;
+uint16_t throttlePos = 0;
+int engineCoolant = 40;
+bool machineGun = false;
+
+const char* id = "6dd4268a-c605-4a06-9034-59c1e8344c8e";
+
static gboolean timeoutCallback(gpointer data)
{
ExampleSourcePlugin* src = (ExampleSourcePlugin*)data;
-
+
src->randomizeProperties();
-
+
return true;
}
-ExampleSourcePlugin::ExampleSourcePlugin(AbstractRoutingEngine* re)
-:AbstractSource(re), velocity(0), engineSpeed(0)
+ExampleSourcePlugin::ExampleSourcePlugin(AbstractRoutingEngine* re, map<string, string> config)
+:AbstractSource(re, config), velocity(0), engineSpeed(0)
{
- re->setSupported(supported(), this);
-
debugOut("setting timeout");
- g_timeout_add(1000, timeoutCallback, this );
-
+
+ int delay = 1000;
+
+ if(config.find("delay") != config.end())
+ {
+ delay = boost::lexical_cast<int>(config["delay"]);
+ }
+
+ g_timeout_add(delay, timeoutCallback, this );
+
+ addPropertySupport(VehicleProperty::EngineSpeed, Zone::None);
+ addPropertySupport(VehicleProperty::VehicleSpeed, Zone::None);
+ addPropertySupport(VehicleProperty::AccelerationX, Zone::None);
+ addPropertySupport(VehicleProperty::TransmissionShiftPosition, Zone::None);
+ addPropertySupport(VehicleProperty::TransmissionGearPosition, Zone::None);
+ addPropertySupport(VehicleProperty::SteeringWheelAngle, Zone::None);
+ addPropertySupport(VehicleProperty::ThrottlePosition, Zone::None);
+ addPropertySupport(VehicleProperty::EngineCoolantTemperature, Zone::None);
+ addPropertySupport(VehicleProperty::VIN, Zone::None);
+ addPropertySupport(VehicleProperty::WMI, Zone::None);
+ addPropertySupport(VehicleProperty::BatteryVoltage, Zone::None);
+ addPropertySupport(VehicleProperty::MachineGunTurretStatus, Zone::None);
+ addPropertySupport(VehicleProperty::ExteriorBrightness, Zone::None);
+ addPropertySupport(VehicleProperty::DoorsPerRow, Zone::None);
+ addPropertySupport(VehicleProperty::AirbagStatus, Zone::None);
+
+ Zone::ZoneList airbagZones;
+ airbagZones.push_back(Zone::FrontLeft | Zone::FrontSide);
+ airbagZones.push_back(Zone::FrontRight | Zone::FrontSide);
+ airbagZones.push_back(Zone::RearLeft | Zone::LeftSide);
+ airbagZones.push_back(Zone::RearRight | Zone::RightSide);
+
+ airbagStatus[Zone::FrontLeft | Zone::FrontSide] = Airbag::Active;
+ airbagStatus[Zone::FrontRight | Zone::FrontSide] = Airbag::Inactive;
+ airbagStatus[Zone::RearLeft | Zone::LeftSide] = Airbag::Deployed;
+ airbagStatus[Zone::RearRight | Zone::RightSide] = Airbag::Deployed;
+
+ PropertyInfo airbagInfo(0,airbagZones);
+
+ propertyInfoMap[VehicleProperty::AirbagStatus] = airbagInfo;
+
+ addPropertySupport(VehicleProperty::AirConditioning, Zone::None);
+
+ Zone::ZoneList acZones;
+ acZones.push_back(Zone::FrontLeft);
+ acZones.push_back(Zone::Front | Zone::Right);
+
+ acStatus[Zone::Front | Zone::Left] = true;
+ acStatus[Zone::Front | Zone::Right] = false;
+
+ PropertyInfo acInfo(0,acZones);
+ propertyInfoMap[VehicleProperty::AirConditioning] = acInfo;
}
-extern "C" AbstractSource * create(AbstractRoutingEngine* routingengine)
+extern "C" void create(AbstractRoutingEngine* routingengine, map<string, string> config)
{
- return new ExampleSourcePlugin(routingengine);
-
+ new ExampleSourcePlugin(routingengine, config);
}
-string ExampleSourcePlugin::uuid()
+const string ExampleSourcePlugin::uuid()
{
- return "6dd4268a-c605-4a06-9034-59c1e8344c8e";
+ return id;
}
-boost::any ExampleSourcePlugin::getProperty(VehicleProperty::Property property)
+
+void ExampleSourcePlugin::getPropertyAsync(AsyncPropertyReply *reply)
{
- if(property == VehicleProperty::VehicleSpeed)
+ DebugOut()<<"ExampleSource: getPropertyAsync called for property: "<<reply->property<<endl;
+
+ if(reply->property == VehicleProperty::VehicleSpeed)
{
- return velocity;
+ VehicleProperty::VehicleSpeedType temp(velocity);
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
}
- else if(property == VehicleProperty::EngineSpeed)
+ else if(reply->property == VehicleProperty::EngineSpeed)
{
- return engineSpeed;
+ VehicleProperty::EngineSpeedType temp(engineSpeed);
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
}
-}
+ else if(reply->property == VehicleProperty::AccelerationX)
+ {
+ VehicleProperty::AccelerationXType temp(accelerationX);
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::TransmissionShiftPosition)
+ {
+ VehicleProperty::TransmissionShiftPositionType temp(transmissionShiftPostion);
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::TransmissionGearPosition)
+ {
+ VehicleProperty::TransmissionGearPositionType temp(transmissionShiftPostion);
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::SteeringWheelAngle)
+ {
+ VehicleProperty::SteeringWheelAngleType temp(steeringWheelAngle);
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::VIN)
+ {
+ VehicleProperty::VINType temp("ABC00000000000000");
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::WMI)
+ {
+ VehicleProperty::WMIType temp("abc");
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::BatteryVoltage)
+ {
+ VehicleProperty::BatteryVoltageType temp(12.6);
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::ExteriorBrightness)
+ {
+ VehicleProperty::ExteriorBrightnessType temp(1000);
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::DoorsPerRow)
+ {
+ VehicleProperty::DoorsPerRowType temp;
-void ExampleSourcePlugin::getPropertyAsync(AsyncPropertyReply *reply)
-{
- if(reply->property == VehicleProperty::VehicleSpeed)
+ temp.append(2);
+ temp.append(2);
+ temp.append(1);
+
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::AirbagStatus)
+ {
+ if(airbagStatus.find(reply->zoneFilter) == airbagStatus.end())
+ {
+ reply->success = false;
+ reply->error = AsyncPropertyReply::ZoneNotSupported;
+ reply->completed(reply);
+ }
+
+ else
+ {
+
+ VehicleProperty::AirbagStatusType temp;
+ temp.setValue(airbagStatus[reply->zoneFilter]);
+ temp.zone = reply->zoneFilter;
+
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ }
+ else if(reply->property == VehicleProperty::MachineGunTurretStatus)
{
- reply->value = velocity;
+ VehicleProperty::MachineGunTurretStatusType temp(true);
+ reply->value = &temp;
+ reply->success = true;
reply->completed(reply);
}
- else if(reply->property == VehicleProperty::EngineSpeed)
+ else if(reply->property == VehicleProperty::ThrottlePosition)
+ {
+ VehicleProperty::ThrottlePositionType temp(throttlePos);
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::EngineCoolantTemperature)
{
- reply->value = engineSpeed;
+ VehicleProperty::EngineCoolantTemperatureType temp(engineCoolant);
+ reply->value = &temp;
+ reply->success = true;
+ reply->completed(reply);
+ }
+ else if(reply->property == VehicleProperty::AirbagStatus)
+ {
+ if(airbagStatus.find(reply->zoneFilter) == airbagStatus.end())
+ {
+ reply->success = false;
+ reply->error = AsyncPropertyReply::ZoneNotSupported;
+ reply->completed(reply);
+ }
+ else
+ {
+ VehicleProperty::AirbagStatusType temp(airbagStatus[reply->zoneFilter]);
+ reply->success = true;
+ reply->value = &temp;
+ reply->completed(reply);
+ }
+ }
+ else if(reply->property == VehicleProperty::AirConditioning)
+ {
+ if(acStatus.find(reply->zoneFilter) == acStatus.end())
+ {
+ reply->success = false;
+ reply->error = AsyncPropertyReply::ZoneNotSupported;
+ reply->completed(reply);
+ }
+ else
+ {
+ VehicleProperty::AirConditioningType temp(acStatus[reply->zoneFilter]);
+ reply->success = true;
+ reply->value = &temp;
+ reply->completed(reply);
+ }
+ }
+
+ else
+ {
+ reply->success=false;
+ reply->error = AsyncPropertyReply::InvalidOperation;
reply->completed(reply);
}
}
-void ExampleSourcePlugin::setProperty(VehicleProperty::Property , boost::any )
+void ExampleSourcePlugin::getRangePropertyAsync(AsyncRangePropertyReply *reply)
{
}
+AsyncPropertyReply *ExampleSourcePlugin::setProperty(AsyncSetPropertyRequest request )
+{
+ AsyncPropertyReply *reply = new AsyncPropertyReply(request);
+ reply->success = false;
+
+ if(reply->property == VehicleProperty::AirConditioning)
+ {
+ if(acStatus.find(reply->zoneFilter) == acStatus.end())
+ {
+ reply->success = false;
+ reply->error = AsyncPropertyReply::ZoneNotSupported;
+ reply->completed(reply);
+ }
+ else
+ {
+ acStatus[reply->zoneFilter] = reply->value->value<bool>();
+
+ ///we need to update subscribers of this change:
+ routingEngine->updateProperty(reply->value,uuid());
+
+ ///Now reply to the set request:
+ reply->success = true;
+ reply->completed(reply);
+
+ }
+
+ return reply;
+ }
+
+ reply->error = AsyncPropertyReply::InvalidOperation;
+ reply->completed(reply);
+ return reply;
+}
+
void ExampleSourcePlugin::subscribeToPropertyChanges(VehicleProperty::Property property)
{
mRequests.push_back(property);
PropertyList ExampleSourcePlugin::supported()
{
- PropertyList props;
- props.push_back(VehicleProperty::EngineSpeed);
- props.push_back(VehicleProperty::VehicleSpeed);
- props.push_back(VehicleProperty::AccelerationX);
-
- return props;
+ return mSupported;
+}
+
+int ExampleSourcePlugin::supportedOperations()
+{
+ return Get | Set | GetRanged;
}
void ExampleSourcePlugin::unsubscribeToPropertyChanges(VehicleProperty::Property property)
{
- mRequests.remove(property);
+ if(contains(mRequests,property))
+ removeOne(&mRequests, property);
}
void ExampleSourcePlugin::randomizeProperties()
{
velocity = 1 + (255.00 * (rand() / (RAND_MAX + 1.0)));
engineSpeed = 1 + (15000.00 * (rand() / (RAND_MAX + 1.0)));
- int accelerationX = 1 + (15000.00 * (rand() / (RAND_MAX + 1.0)));
-
+ accelerationX = 1 + (15000.00 * (rand() / (RAND_MAX + 1.0)));
+ transmissionShiftPostion = Transmission::TransmissionPositions(1 + (6.00 * (rand() / (RAND_MAX + 1.0))));
+ steeringWheelAngle = 1 + (359.00 * (rand() / (RAND_MAX + 1.0)));
+ throttlePos = 1 + (100.00 * (rand() / (RAND_MAX + 1.0)));
+ engineCoolant = 1 + (40.00 * (rand() / (RAND_MAX + 140.0)));
+
DebugOut()<<"setting velocity to: "<<velocity<<endl;
DebugOut()<<"setting enginespeed to: "<<engineSpeed<<endl;
-
- routingEngine->updateProperty(VehicleProperty::VehicleSpeed, velocity);
- routingEngine->updateProperty(VehicleProperty::EngineSpeed, engineSpeed);
- routingEngine->updateProperty(VehicleProperty::AccelerationX, accelerationX);
+
+ vel.setValue(velocity);
+ vel.sequence++;
+ vel.priority = AbstractPropertyType::High;
+ es.setValue(engineSpeed);
+ es.sequence++;
+ es.priority = AbstractPropertyType::Low;
+ ac.setValue(accelerationX);
+ swa.setValue(steeringWheelAngle);
+ tsp.setValue(transmissionShiftPostion);
+ tgp.setValue(transmissionShiftPostion);
+ tsp.priority = AbstractPropertyType::Low;
+ tp.setValue(throttlePos);
+ ec.setValue(engineCoolant);
+ mgt.setValue(machineGun);
+
+ machineGun = !machineGun;
+
+ routingEngine->updateProperty(&vel, uuid());
+ routingEngine->updateProperty(&es, uuid());
+ routingEngine->updateProperty(&ac, uuid());
+ routingEngine->updateProperty(&swa, uuid());
+ routingEngine->updateProperty(&tsp, uuid());
+ routingEngine->updateProperty(&tp, uuid());
+ routingEngine->updateProperty(&ec, uuid());
+ routingEngine->updateProperty(&tgp, uuid());
+
+}
+
+void ExampleSourcePlugin::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;
+}
+
+int main(int argc, char** argv)
+{
+ ExampleSourcePlugin plugin;
+
+ AsyncPropertyReply request;
+
+ request.property = VehicleProperty::VehicleSpeed;
+ request.completed = [](AsyncPropertyReply* reply)
+ {
+ g_assert(reply->success);
+ };
+
+ plugin.getPropertyAsync(&request);
+
+ GMainLoop* mainLoop = g_main_loop_new(NULL, false);
+
+ g_main_loop_run(mainLoop);
+ return 1;
}