public virtual IEnumerator <ITask> HttpGetInfraredSensorHandler(dssphttp.HttpGet httpGet)
{
infraredarray.Get get = new infraredarray.Get();
this.altPort.Post(get);
yield return(get.ResponsePort.Choice());
infraredarray.InfraredSensorArrayState infraredState = get.ResponsePort;
httpGet.ResponsePort.Post(new dssphttp.HttpResponseType(infraredState));
yield break;
}
/// <summary>
/// Process the Sensor data
/// </summary>
/// <returns>An iterator</returns>
private IEnumerator <ITask> ProcessSensors()
{
if (this.batteryPort == null)
{
WinFormsServicePort.FormInvoke(() => this.dashboardForm.UpdateBatteryLevel(null));
}
DateTime?lastBatteryPoll = null;
while (true)
{
DateTime now = DateTime.Now;
if (this.irsensorArrayPort != null)
{
// Create a request that includes a Diagnostic Header so that it can be picked
// up by selective logging. If no logging is required, the code would just be:
// yield return this.irsensorArrayPort.Get().Choice(
infraredsensorarray.Get getRequest = new infraredsensorarray.Get();
getRequest.AddHeader(new DiagnosticsHeader());
this.irsensorArrayPort.Post(getRequest);
yield return(getRequest.ResponsePort.Choice(
s =>
{
var irValues = new double[Constants.IRSensorCount];
for (var i = 0; i < Constants.IRSensorCount; i++)
{
irValues[Constants.IRSensorCount - i - 1] = s.Sensors[i].DistanceMeasurement * ConvertMetersToCm;
}
WinFormsServicePort.FormInvoke(() => this.dashboardForm.UpdateIRSensors(irValues));
},
LogError));
}
if (this.sonarSensorArrayPort != null)
{
// Create a request that includes a Diagnostic Header so that it can be picked
// up by selective logging. If no logging is required, the code would just be:
// yield return this.sonarSensorArrayPort.Get().Choice(
sonarsensorarray.Get getRequest = new sonarsensorarray.Get();
getRequest.AddHeader(new DiagnosticsHeader());
this.sonarSensorArrayPort.Post(getRequest);
yield return(getRequest.ResponsePort.Choice(
s =>
{
var sonarValues = new double[Constants.SonarSensorCount];
for (int i = 0; i < Constants.SonarSensorCount; i++)
{
sonarValues[Constants.SonarSensorCount - i - 1] = s.Sensors[i].DistanceMeasurement * ConvertMetersToCm;
}
WinFormsServicePort.FormInvoke(() => this.dashboardForm.UpdateSonarSensors(sonarValues));
},
LogError));
}
if (this.drivePort != null)
{
yield return(this.drivePort.Get().Choice(
s => WinFormsServicePort.FormInvoke(() => this.dashboardForm.UpdateWheelState(s)),
this.LogError));
}
// Only poll the battery every minute
if (this.batteryPort != null &&
(!lastBatteryPoll.HasValue ||
DateTime.Now.Subtract(lastBatteryPoll.Value) > TimeSpan.FromMinutes(1)))
{
yield return
(this.batteryPort.Get().Choice(
s => WinFormsServicePort.FormInvoke(() => this.dashboardForm.UpdateBatteryLevel(s)),
this.LogError));
lastBatteryPoll = DateTime.Now;
}
// Just sleep for the remainder of our sensor polling timout
int delay = Math.Max(0, (int)(this.sensorPollingInterval - (DateTime.Now - now).TotalMilliseconds));
yield return(TimeoutPort(delay).Receive());
}
}
public IEnumerator <ITask> GetHandler(infraredarray.Get get)
{
var state = new infraredarray.InfraredSensorArrayState();
state.Sensors = new List <infraredsensor.InfraredState>(this.sensorPorts.Length);
// compose state on the fly by issuing N parallel GET requests to partners
var getSensorState = new analogsensor.Get();
foreach (var port in this.sensorPorts)
{
state.Sensors.Add(null);
port.Post(getSensorState);
}
ICollection <analogsensor.AnalogSensorState> sensorStates = null;
ICollection <Fault> faults = null;
yield return(getSensorState.ResponsePort.MultipleItemReceive(
this.sensorPorts.Length,
(s, f) =>
{
sensorStates = s;
faults = f;
}));
if (faults != null && faults.Count > 0)
{
get.ResponsePort.Post(Fault.FromCodeSubcode(FaultCodes.Receiver, DsspFaultCodes.OperationFailed));
yield break;
}
foreach (var sensorState in sensorStates)
{
PhysicalModel.Proxy.Pose sensorPose;
switch (sensorState.HardwareIdentifier)
{
case 0:
sensorPose = this.LeftIRPose;
break;
case 1:
sensorPose = this.MiddleIRPose;
break;
case 2:
sensorPose = this.RightIRPose;
break;
default:
sensorPose = new PhysicalModel.Proxy.Pose();
break;
}
state.Sensors[sensorState.HardwareIdentifier] = new infraredsensor.InfraredState()
{
DistanceMeasurement = sensorState.RawMeasurement,
HardwareIdentifier = sensorState.HardwareIdentifier,
ManufacturerIdentifier = SimSensorManufacturer,
MaxDistance = int.MaxValue,
MinDistance = 0,
Pose = sensorPose,
TimeStamp = sensorState.TimeStamp
};
}
var stateClone = state.Clone() as infraredarray.InfraredSensorArrayState;
get.ResponsePort.Post(stateClone);
yield break;
}
