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; }