Example #1
0
        public void Fired(IOProxy proxy, List <AbstractProxyEventData> eventData)
        {
            ImuEventData imuEventData = (ImuEventData)eventData.FirstOrDefault(c => c is ImuEventData);

            if (imuEventData != null)
            {
                GyroX.AddDataPoint(imuEventData.Time, imuEventData.GyroX);
                GyroY.AddDataPoint(imuEventData.Time, imuEventData.GyroY);
                GyroZ.AddDataPoint(imuEventData.Time, imuEventData.GyroZ);
                AccX.AddDataPoint(imuEventData.Time, imuEventData.AccelX);
                AccY.AddDataPoint(imuEventData.Time, imuEventData.AccelY);
                AccZ.AddDataPoint(imuEventData.Time, imuEventData.AccelZ);
            }
        }
        public void Fired(IOProxy proxy, List <AbstractProxyEventData> eventData)
        {
            if (_DataWritter != null)
            {
                ImuEventData    imuEventData    = (ImuEventData)eventData.FirstOrDefault(c => c is ImuEventData);
                CameraEventData cameraEventData = (CameraEventData)eventData.FirstOrDefault(c => c is CameraEventData);

                if (imuEventData != null)
                {
                    _DataWritter.AddImu(0, imuEventData.TimeNanoSeconds, imuEventData.GyroX / 180 * Math.PI, imuEventData.GyroY / 180 * Math.PI, imuEventData.GyroZ / 180 * Math.PI, imuEventData.AccelX, imuEventData.AccelY, imuEventData.AccelZ);
                }
                if (cameraEventData != null && imuEventData != null)
                {
                    _DataWritter.AddImage(0, imuEventData.TimeNanoSeconds, cameraEventData.Image.ToPNGBinary(3), cameraEventData.ExposureTime);
                }
                else if (cameraEventData != null)
                {
                    _DataWritter.AddImage(0, -1, cameraEventData.Image.ToPNGBinary(3), cameraEventData.ExposureTime);
                }
            }
        }