-
Notifications
You must be signed in to change notification settings - Fork 7
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
- Loading branch information
Showing
6 changed files
with
97 additions
and
6 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
85 changes: 85 additions & 0 deletions
85
common/src/main/java/com/platypii/baseline/bluetooth/Flysight2Protocol.java
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,85 @@ | ||
| package com.platypii.baseline.bluetooth; | ||
|
|
||
| import com.platypii.baseline.location.LocationCheck; | ||
| import com.platypii.baseline.location.NMEAException; | ||
| import com.platypii.baseline.measurements.MLocation; | ||
| import com.platypii.baseline.util.Exceptions; | ||
| import com.platypii.baseline.util.PubSub; | ||
|
|
||
| import android.bluetooth.le.ScanRecord; | ||
| import android.util.Log; | ||
| import androidx.annotation.NonNull; | ||
| import androidx.annotation.Nullable; | ||
| import com.welie.blessed.BluetoothPeripheral; | ||
| import com.welie.blessed.GattStatus; | ||
| import java.nio.ByteBuffer; | ||
| import java.nio.ByteOrder; | ||
| import java.util.UUID; | ||
|
|
||
| public class Flysight2Protocol extends BleProtocol { | ||
| private static final String TAG = "FlysightProtocol"; | ||
| private final PubSub<MLocation> locationUpdates; | ||
|
|
||
| // Flysight services | ||
| private static final UUID flysightService0 = UUID.fromString("00000000-cc7a-482a-984a-7f2ed5b3e58f"); | ||
| private static final UUID flysightService1 = UUID.fromString("00000001-cc7a-482a-984a-7f2ed5b3e58f"); | ||
| private static final UUID flysightService2 = UUID.fromString("00000002-cc7a-482a-984a-7f2ed5b3e58f"); | ||
| // Flysight characteristics | ||
| private static final UUID flysightCharacteristicGNSS = UUID.fromString("00000000-8e22-4541-9d4c-21edae82ed19"); | ||
| private static final UUID flysightCharacteristicTX = UUID.fromString("00000001-8e22-4541-9d4c-21edae82ed19"); | ||
| private static final UUID flysightCharacteristicRX = UUID.fromString("00000002-8e22-4541-9d4c-21edae82ed19"); | ||
|
|
||
| public Flysight2Protocol(@NonNull PubSub<MLocation> locationUpdates) { | ||
| this.locationUpdates = locationUpdates; | ||
| } | ||
|
|
||
| @Override | ||
| public boolean canParse(@NonNull BluetoothPeripheral peripheral, @Nullable ScanRecord record) { | ||
| // TODO: Check address | ||
| return peripheral.getName().equals("FlySight"); | ||
| } | ||
|
|
||
| @Override | ||
| public void onServicesDiscovered(@NonNull BluetoothPeripheral peripheral) { | ||
| Log.i(TAG, "flysight services discovered " + peripheral.getCurrentMtu()); | ||
| peripheral.requestMtu(256); | ||
| } | ||
|
|
||
| @Override | ||
| public void onMtuChanged(@NonNull BluetoothPeripheral peripheral, int mtu, @NonNull GattStatus status) { | ||
| Log.i(TAG, "flysight mtu changed " + mtu); | ||
| // Subscribe to flysight service | ||
| peripheral.setNotify(flysightService1, flysightCharacteristicGNSS, true); | ||
| } | ||
|
|
||
| @Override | ||
| public void processBytes(@NonNull BluetoothPeripheral peripheral, @NonNull byte[] value) { | ||
| try { | ||
| final ByteBuffer buf = ByteBuffer.wrap(value).order(ByteOrder.LITTLE_ENDIAN); | ||
| final int iTow = buf.getInt(0); | ||
| final double lng = buf.getInt(4) * 1e-7; | ||
| final double lat = buf.getInt(8) * 1e-7; | ||
| final double alt = buf.getInt(12) * 1e-3; | ||
| final double vN = buf.getInt(16) * 1e-3; | ||
| final double vE = buf.getInt(20) * 1e-3; | ||
| final double climb = buf.getInt(24) * -1e-3; | ||
| final long millis = System.currentTimeMillis(); // TODO | ||
|
|
||
| final int locationError = LocationCheck.validate(lat, lng); | ||
| if (locationError == LocationCheck.VALID) { | ||
| final MLocation loc = new MLocation( | ||
| millis, lat, lng, alt, climb, vN, vE, | ||
| Float.NaN, Float.NaN, Float.NaN, Float.NaN, -1, -1 | ||
| ); | ||
| Log.i(TAG, "flysight -> app: gps " + loc); | ||
| // Update listeners | ||
| locationUpdates.post(loc); | ||
| } else { | ||
| Log.w(TAG, LocationCheck.message[locationError] + ": " + lat + "," + lng); | ||
| Exceptions.report(new NMEAException(LocationCheck.message[locationError] + ": " + lat + "," + lng)); | ||
| } | ||
| } catch (Exception e) { | ||
| Exceptions.report(e); | ||
| } | ||
| } | ||
| } |