public MainWindow()
 {
     InitializeComponent();
     ModBus.NoConnectionEvent += NoRobotConnection;
     robomaster = new RoboMaster();
     robomaster.SetStandardPose();
     calcmaster = new CalculationMaster();
 }
        public void SetStandardPose_StandardPoseBeingSet_LastKnownPoseIsStandard()
        {
            uut.SetStandardPose();
            var pose = data.GetLastKnownPose();

            Assert.AreEqual(RoboMaster.standard_pose_x, pose.Xpose);
            Assert.AreEqual(RoboMaster.standard_pose_y, pose.Ypose);
            Assert.AreEqual(RoboMaster.standard_pose_z, pose.Zpose);
            Assert.AreEqual(RoboMaster.standard_pose_rx, pose.RXpose);
            Assert.AreEqual(RoboMaster.standard_pose_ry, pose.RYpose);
            Assert.AreEqual(RoboMaster.standard_pose_rz, pose.RZpose);
        }
 protected override void OnClosed(EventArgs e)
 {
     base.OnClosed(e);
     robomaster?.SetStandardPose();
     Application.Current.Shutdown();
 }