예제 #1
0
        void _brickConnection_onValueReceived_EncoderSpeed(object sender, MeasuredValuesEventArgs ev)
        {
#if TRACEDEBUGTICKS
            LogInfo("TrackRoamerBrickPowerService : received EncoderSpeed : left=" + ev.value1 + "   right=" + ev.value2);
#endif // TRACEDEBUGTICKS

            UpdateMotorEncoderSpeed ume = new UpdateMotorEncoderSpeed();
            ume.Body.Timestamp  = new DateTime(ev.timestamp);
            ume.Body.LeftSpeed  = ev.value1;
            ume.Body.RightSpeed = ev.value2;

            _state.MotorEncoderSpeed.LeftSpeed  = ume.Body.LeftSpeed;
            _state.MotorEncoderSpeed.RightSpeed = ume.Body.RightSpeed;
            _state.MotorEncoderSpeed.Timestamp  = ume.Body.Timestamp;
            _state.TimeStamp = DateTime.Now;

            base.SendNotification <UpdateMotorEncoderSpeed>(_subMgrPort, ume);
        }
        void _brickConnection_onValueReceived_EncoderSpeed(object sender, MeasuredValuesEventArgs ev)
		{
#if TRACEDEBUGTICKS
            LogInfo("TrackRoamerBrickPowerService : received EncoderSpeed : left=" + ev.value1 + "   right=" + ev.value2);
#endif // TRACEDEBUGTICKS

            UpdateMotorEncoderSpeed ume = new UpdateMotorEncoderSpeed();
			ume.Body.Timestamp = new DateTime(ev.timestamp);
			ume.Body.LeftSpeed = ev.value1;
			ume.Body.RightSpeed = ev.value2;

            _state.MotorEncoderSpeed.LeftSpeed = ume.Body.LeftSpeed;
            _state.MotorEncoderSpeed.RightSpeed = ume.Body.RightSpeed;
            _state.MotorEncoderSpeed.Timestamp = ume.Body.Timestamp;
            _state.TimeStamp = DateTime.Now;

            base.SendNotification<UpdateMotorEncoderSpeed>(_subMgrPort, ume);
		}