public byte GetBatteryLevel(ulong pMacAdress) { IMetaWearBoard board = _mwBoardsManager.GetBoard(pMacAdress); if ((board != null) && !board.InMetaBootMode) { return(board.ReadBatteryLevelAsync().RunSynchronously <byte>()); } return(0); }
private async void OnConnect(object sender, RoutedEventArgs e) { var item = lst.SelectedItem as BLEDevice; if (item != null) { if (m_Metaware == null) { await MbientLab.MetaWear.NetStandard.Application.ClearDeviceCacheAsync(item.Mac); m_Metaware = MbientLab.MetaWear.NetStandard.Application.GetMetaWearBoard(item.Mac); m_Metaware.TimeForResponse = 100000; } if (m_Metaware.IsConnected) { await Disconnect(); } else { try { int retries = 5; do { try { btnConnect.Content = "Connecting..."; btnConnect.IsEnabled = false; m_Metaware.OnUnexpectedDisconnect += OnDisconneted; await m_Metaware.InitializeAsync(); retries = -1; } catch { retries--; } } while (retries > 0); btnConnect.IsEnabled = true; if (m_Metaware.IsConnected) { var batteryLevel = await m_Metaware.ReadBatteryLevelAsync(); var led = m_Metaware.GetModule <ILed>(); led.EditPattern(MbientLab.MetaWear.Peripheral.Led.Color.Green, MbientLab.MetaWear.Peripheral.Led.Pattern.Solid); led.Play(); item.BatteryLevel = batteryLevel; BatteryText.Text = $" Battery:{batteryLevel}"; btnConnect.Content = "Disconnect"; m_Connected = true; //m_Metaware.GetModule<IMagnetometerBmm150>(); //m_Gyro = m_Metaware.GetModule<IGyroBmi160>(); //m_Gyro.Configure(OutputDataRate._100Hz); //m_Accelerometer = m_Metaware.GetModule<IAccelerometer>(); //m_Accelerometer.Configure(odr: 100f, range: 8f); m_SensorFusion = m_Metaware.GetModule <ISensorFusionBosch>(); m_SensorFusion.Configure(); var rout = await m_SensorFusion.EulerAngles.AddRouteAsync(source => { try { source.Stream(async data => { await Dispatcher.InvokeAsync(() => { var value = data.Value <EulerAngles>(); AngleText.Text = value.ToString(); Rotate(-value.Roll, -value.Pitch, -value.Yaw); //Rotate(-value.Pitch, 0 , -value.Yaw); }); }); } catch (Exception ex) { Console.WriteLine(ex.Message); } }); if (!rout.Valid) { MessageBox.Show("rout invalid"); } await m_SensorFusion.Gravity.AddRouteAsync(source => { source.Stream(async data => { await Dispatcher.InvokeAsync(() => { var value = data.Value <Acceleration>(); GravityText.Text = value.ToString(); //Rotate(-value.Roll, -value.Pitch, -value.Yaw); //Rotate(-value.Pitch, 0 , -value.Yaw); }); }); }); //var calib = await m_SensorFusion.ReadCalibrationStateAsync(); m_SensorFusion.Gravity.Start(); m_SensorFusion.EulerAngles.Start(); m_SensorFusion.Start(); //Scanner.Stop(); } else { throw new InvalidOperationException("Could not connect"); } } catch (Exception ex) { MessageBox.Show(ex.Message); btnConnect.Content = "Connect"; m_Connected = false; } } } }