Kalibrierung und Einbaulage gehören in den Sensor, nicht in die Apps

Die Kalibrier-Nullpunkte lagen schon immer im ESP und wurden dort auch
abgezogen – nur verriet die Firmware sie niemandem. Die Einbaulage lag
dagegen in jeder App einzeln, und damit stand sie bei drei Endgeräten
dreimal da, im Zweifel dreimal verschieden. Sie beschreibt aber den
Einbau und nicht das Telefon.

Zwei neue Charakteristiken:

    ...3426  Nullpunkte, zwei Floats, nur lesen
    ...3428  Einbaulage, acht Byte, lesen und schreiben

        0      Version, 1 = gültig gesetzt, 0 = nie geschrieben
        1      Längsachse: 0 = Pitch des Sensors, 1 = Roll
        2      längs umgekehrt (0/1)
        3      quer umgekehrt (0/1)
        4..7   Verdrehung um die Hochachse, float32, Grad

Das Versionsbyte löst die Umstellung: Steht dort 0, hat nie jemand
geschrieben – dann gilt weiter, was die App örtlich gespeichert hat, und
beim nächsten Bestimmen wandert sie hinauf. Mit älterer Firmware ohne die
Charakteristik passiert schlicht nichts.

Angewandt wird die Lage weiterhin in den Apps. Der Sensor verwahrt sie
nur: Meldete er die Winkel bereits umgerechnet, rechnete jede ältere App
die Korrektur ein zweites Mal ein.

Beim Verbinden liest jede App die Lage und übernimmt sie; nach dem
Einbaulage-Assistenten schreibt sie sie hinauf. Die Uhr braucht das
iPhone dafür nicht mehr – sie holt sie sich selbst. Die Android-App
bekommt dabei auch die Verdrehung, die ihrer Fassung bisher ganz fehlte:
Modell, Erkennung und Persistenz nachgezogen.

Geprüft: Firmware übersetzt, im erzeugten Code stehen beide
Charakteristiken mit den richtigen Rechten und der Schreib-Handler;
iPhone- und Watch-Ziel bauen; sieben neue Prüfungen in run-tests.sh
nageln das Byte-Format fest, samt Rundlauf und der Bedeutung von
Version 0. Nicht geprüft ist die Android-Fassung: Auf dieser Maschine
liegt nur Java 8, Gradle verlangt mindestens 11.

Co-Authored-By: Claude Opus 5 <noreply@anthropic.com>
This commit is contained in:
BiasF
2026-08-31 20:50:23 +02:00
co-authored by Claude Opus 5
parent 0761706d98
commit f0df433421
13 changed files with 470 additions and 20 deletions
@@ -372,6 +372,11 @@ class BluetoothManager(
onUpdate = { record(it) }, onUpdate = { record(it) },
onStateChange = { handleLinkState(device, it) }, onStateChange = { handleLinkState(device, it) },
onLevelState = { state -> publish { levelStates[device.id] = state } }, onLevelState = { state -> publish { levelStates[device.id] = state } },
onDeviceOrientation = { orientation ->
// Im Gerät steht, wie der Sensor eingebaut ist für alle
// Clients dasselbe. Also übernehmen statt überschreiben.
adoptOrientation(orientation, device.id)
},
) )
session.orientation = device.sensorOrientation session.orientation = device.sensorOrientation
levelSessions[device.address] = session levelSessions[device.address] = session
@@ -642,8 +647,32 @@ class BluetoothManager(
// MARK: - Neigungsmesser // MARK: - Neigungsmesser
/**
* Nach einer Änderung der Einbaulage aufrufen.
*
* Die Lage wandert zusätzlich ins Gerät. Dort gehört sie hin: Sie
* beschreibt den Einbau, und iPhone wie Uhr finden sie dann vor, ohne dass
* jemand sie ein zweites Mal bestimmen muss.
*/
fun updateSensorOrientation(device: ConfiguredDevice) { fun updateSensorOrientation(device: ConfiguredDevice) {
handler.post { levelSessions[device.address]?.orientation = device.sensorOrientation } handler.post {
val session = levelSessions[device.address] ?: return@post
session.orientation = device.sensorOrientation
session.storeOrientation(device.sensorOrientation)
}
}
/**
* Übernimmt die Einbaulage, die das Gerät meldet.
*
* Steht dort noch nichts, meldet das Gerät nichts dann bleibt es bei der
* örtlich gespeicherten Fassung, und die wird beim nächsten Bestimmen
* hinaufgeschrieben.
*/
private fun adoptOrientation(orientation: SensorOrientation, deviceID: UUID) {
val device = store.devices.firstOrNull { it.id == deviceID } ?: return
if (device.sensorOrientation == orientation) return
store.update(device.copy(sensorOrientation = orientation))
} }
fun calibrateLevel(deviceID: UUID) { fun calibrateLevel(deviceID: UUID) {
@@ -30,6 +30,12 @@ class LevelSession(
private val onUpdate: (DeviceSnapshot) -> Unit, private val onUpdate: (DeviceSnapshot) -> Unit,
private val onStateChange: (DeviceLinkState) -> Unit, private val onStateChange: (DeviceLinkState) -> Unit,
private val onLevelState: (LevelState) -> Unit, private val onLevelState: (LevelState) -> Unit,
/**
* Meldet die Einbaulage, die im Gerät steht. Sie gilt vor der örtlich
* gespeicherten: dort steht, wie der Sensor eingebaut ist, und das ist für
* alle Clients dasselbe.
*/
private val onDeviceOrientation: (SensorOrientation) -> Unit = {},
) { ) {
private companion object { private companion object {
val SERVICE: UUID = UUID.fromString(VanAlignProtocol.SERVICE_UUID) val SERVICE: UUID = UUID.fromString(VanAlignProtocol.SERVICE_UUID)
@@ -37,6 +43,7 @@ class LevelSession(
val ROLL: UUID = UUID.fromString(VanAlignProtocol.ROLL_UUID) val ROLL: UUID = UUID.fromString(VanAlignProtocol.ROLL_UUID)
val OFFSETS: UUID = UUID.fromString(VanAlignProtocol.OFFSETS_UUID) val OFFSETS: UUID = UUID.fromString(VanAlignProtocol.OFFSETS_UUID)
val CALIBRATE: UUID = UUID.fromString(VanAlignProtocol.CALIBRATE_UUID) val CALIBRATE: UUID = UUID.fromString(VanAlignProtocol.CALIBRATE_UUID)
val ORIENTATION: UUID = UUID.fromString(VanAlignProtocol.ORIENTATION_UUID)
val CLIENT_CONFIG: UUID = UUID.fromString("00002902-0000-1000-8000-00805F9B34FB") val CLIENT_CONFIG: UUID = UUID.fromString("00002902-0000-1000-8000-00805F9B34FB")
const val POLL_INTERVAL_MS = 1_000L const val POLL_INTERVAL_MS = 1_000L
} }
@@ -53,6 +60,7 @@ class LevelSession(
private var rollCharacteristic: BluetoothGattCharacteristic? = null private var rollCharacteristic: BluetoothGattCharacteristic? = null
private var offsetsCharacteristic: BluetoothGattCharacteristic? = null private var offsetsCharacteristic: BluetoothGattCharacteristic? = null
private var calibrateCharacteristic: BluetoothGattCharacteristic? = null private var calibrateCharacteristic: BluetoothGattCharacteristic? = null
private var orientationCharacteristic: BluetoothGattCharacteristic? = null
/** Ob die Firmware die Werte von sich aus meldet. */ /** Ob die Firmware die Werte von sich aus meldet. */
private var needsPolling = true private var needsPolling = true
@@ -84,6 +92,7 @@ class LevelSession(
rollCharacteristic = null rollCharacteristic = null
offsetsCharacteristic = null offsetsCharacteristic = null
calibrateCharacteristic = null calibrateCharacteristic = null
orientationCharacteristic = null
} }
/** Setzt die aktuelle Lage als neue Null. */ /** Setzt die aktuelle Lage als neue Null. */
@@ -107,6 +116,22 @@ class LevelSession(
handler.postDelayed({ readOffsets() }, 400) handler.postDelayed({ readOffsets() }, 400)
} }
/**
* Schreibt die Einbaulage ins Gerät, damit alle Clients dieselbe sehen.
*
* Ältere Firmware hat die Charakteristik nicht; dann bleibt es bei der
* örtlich gespeicherten Fassung, und es passiert schlicht nichts.
*/
fun storeOrientation(value: SensorOrientation) {
val characteristic = orientationCharacteristic ?: return
val g = gatt ?: return
characteristic.writeType = BluetoothGattCharacteristic.WRITE_TYPE_DEFAULT
characteristic.value = VanAlignProtocol.encoded(value)
g.writeCharacteristic(characteristic)
// Zurücklesen, damit gilt, was wirklich im Gerät steht.
handler.postDelayed({ gatt?.readCharacteristic(characteristic) }, 300)
}
private fun readOffsets() { private fun readOffsets() {
val characteristic = offsetsCharacteristic ?: return val characteristic = offsetsCharacteristic ?: return
gatt?.readCharacteristic(characteristic) gatt?.readCharacteristic(characteristic)
@@ -169,6 +194,7 @@ class LevelSession(
rollCharacteristic = service.getCharacteristic(ROLL) rollCharacteristic = service.getCharacteristic(ROLL)
offsetsCharacteristic = service.getCharacteristic(OFFSETS) offsetsCharacteristic = service.getCharacteristic(OFFSETS)
calibrateCharacteristic = service.getCharacteristic(CALIBRATE) calibrateCharacteristic = service.getCharacteristic(CALIBRATE)
orientationCharacteristic = service.getCharacteristic(ORIENTATION)
val canNotify = pitchCharacteristic?.let { val canNotify = pitchCharacteristic?.let {
it.properties and BluetoothGattCharacteristic.PROPERTY_NOTIFY != 0 it.properties and BluetoothGattCharacteristic.PROPERTY_NOTIFY != 0
@@ -267,6 +293,26 @@ class LevelSession(
state = state.copy(pitchOffset = pitch, rollOffset = roll) state = state.copy(pitchOffset = pitch, rollOffset = roll)
} }
publish() publish()
// Android lässt nur eine Abfrage gleichzeitig zu, deshalb der
// Reihe nach: erst die Offsets, dann die Einbaulage, dann der
// Takt. Fehlt die Charakteristik ältere Firmware , geht es
// sofort weiter.
val characteristic = orientationCharacteristic
if (characteristic != null) {
gatt?.readCharacteristic(characteristic)
} else {
startPollingIfNeeded()
}
}
ORIENTATION -> {
// Was im Gerät steht, gilt. Steht dort nichts (Version 0),
// bleibt es bei der örtlichen Fassung, und der Aufrufer
// schreibt sie hinauf.
VanAlignProtocol.orientation(value)?.let { stored ->
if (stored != orientation) orientation = stored
onDeviceOrientation(stored)
}
startPollingIfNeeded() startPollingIfNeeded()
} }
} }
@@ -206,6 +206,7 @@ class DeviceStore(context: Context) {
put("orientationSource", device.sensorOrientation.longitudinalSource.name) put("orientationSource", device.sensorOrientation.longitudinalSource.name)
put("invertLongitudinal", device.sensorOrientation.invertLongitudinal) put("invertLongitudinal", device.sensorOrientation.invertLongitudinal)
put("invertLateral", device.sensorOrientation.invertLateral) put("invertLateral", device.sensorOrientation.invertLateral)
put("twist", device.sensorOrientation.twist)
} }
private fun deviceFrom(json: JSONObject): ConfiguredDevice? { private fun deviceFrom(json: JSONObject): ConfiguredDevice? {
@@ -227,6 +228,9 @@ class DeviceStore(context: Context) {
}.getOrDefault(SensorOrientation.Source.PITCH), }.getOrDefault(SensorOrientation.Source.PITCH),
invertLongitudinal = json.optBoolean("invertLongitudinal", false), invertLongitudinal = json.optBoolean("invertLongitudinal", false),
invertLateral = json.optBoolean("invertLateral", false), invertLateral = json.optBoolean("invertLateral", false),
// Fehlt der Wert, ist er null so überleben Einrichtungen aus
// der Zeit vor der Verdrehung.
twist = json.optDouble("twist", 0.0),
), ),
) )
} }
@@ -1,6 +1,9 @@
package de.fritob.campermonitor.protocol package de.fritob.campermonitor.protocol
import kotlin.math.abs import kotlin.math.abs
import kotlin.math.atan2
import kotlin.math.cos
import kotlin.math.sin
/** /**
* Wie der Neigungsmesser im Fahrzeug sitzt. * Wie der Neigungsmesser im Fahrzeug sitzt.
@@ -21,18 +24,42 @@ data class SensorOrientation(
val longitudinalSource: Source = Source.PITCH, val longitudinalSource: Source = Source.PITCH,
val invertLongitudinal: Boolean = false, val invertLongitudinal: Boolean = false,
val invertLateral: Boolean = false, val invertLateral: Boolean = false,
/**
* Verdrehung des Sensors um die Hochachse, in Grad der Rest, den der
* Achsentausch nicht abdeckt.
*
* Sitzt der Sensor schräg im Fahrzeug, verteilt sich eine reine
* Querneigung auf beide Sensorachsen: Das Fahrzeug kippt zur Seite, die
* Anzeige meldet zusätzlich Längsneigung. Achsentausch und Vorzeichen
* helfen dagegen nicht, die springen in 90°-Schritten.
*/
val twist: Double = 0.0,
) { ) {
/** Welche Achse des Sensors die Längsneigung des Fahrzeugs liefert. */ /** Welche Achse des Sensors die Längsneigung des Fahrzeugs liefert. */
enum class Source { PITCH, ROLL } enum class Source { PITCH, ROLL }
val isIdentity: Boolean get() = this == IDENTITY val isIdentity: Boolean get() = this == IDENTITY
/** Rechnet Sensorwerte in Fahrzeugwerte um. */ /**
* Rechnet Sensorwerte in Fahrzeugwerte um.
*
* Zwei Schritte, in dieser Reihenfolge: erst die grobe Zuordnung der
* Achsen samt Vorzeichen, dann die Verdrehung zurückdrehen. Für kleine
* Winkel verhält sich das Wertepaar wie ein Vektor in der Ebene genau
* deshalb lässt sich die Verdrehung überhaupt herausrechnen.
*/
fun apply(pitch: Double?, roll: Double?): Pair<Double?, Double?> { fun apply(pitch: Double?, roll: Double?): Pair<Double?, Double?> {
val longitudinal = if (longitudinalSource == Source.PITCH) pitch else roll val longitudinal = if (longitudinalSource == Source.PITCH) pitch else roll
val lateral = if (longitudinalSource == Source.PITCH) roll else pitch val lateral = if (longitudinalSource == Source.PITCH) roll else pitch
return longitudinal?.let { if (invertLongitudinal) -it else it } to val mappedLongitudinal = longitudinal?.let { if (invertLongitudinal) -it else it }
lateral?.let { if (invertLateral) -it else it } val mappedLateral = lateral?.let { if (invertLateral) -it else it }
if (twist == 0.0 || mappedLongitudinal == null || mappedLateral == null) {
return mappedLongitudinal to mappedLateral
}
val angle = Math.toRadians(twist)
return (mappedLongitudinal * cos(angle) + mappedLateral * sin(angle)) to
(-mappedLongitudinal * sin(angle) + mappedLateral * cos(angle))
} }
val summary: String val summary: String
@@ -42,6 +69,7 @@ data class SensorOrientation(
if (longitudinalSource == Source.ROLL) parts.add("Achsen getauscht") if (longitudinalSource == Source.ROLL) parts.add("Achsen getauscht")
if (invertLongitudinal) parts.add("längs umgekehrt") if (invertLongitudinal) parts.add("längs umgekehrt")
if (invertLateral) parts.add("quer umgekehrt") if (invertLateral) parts.add("quer umgekehrt")
if (twist != 0.0) parts.add("um %.0f° verdreht".format(twist))
return parts.joinToString(", ") return parts.joinToString(", ")
} }
@@ -68,6 +96,9 @@ object OrientationDetection {
/** Soviel deutlicher muss die gewinnende Deutung sein als die andere. */ /** Soviel deutlicher muss die gewinnende Deutung sein als die andere. */
const val AMBIGUITY_MARGIN = 1.3 const val AMBIGUITY_MARGIN = 1.3
/** Ab hier gilt eine Verdrehung als echt und nicht als Wackeln der Hand. */
const val MINIMUM_TWIST = 2.0
data class Reading(val pitch: Double, val roll: Double) { data class Reading(val pitch: Double, val roll: Double) {
operator fun minus(other: Reading) = Reading(pitch - other.pitch, roll - other.roll) operator fun minus(other: Reading) = Reading(pitch - other.pitch, roll - other.roll)
} }
@@ -131,16 +162,31 @@ object OrientationDetection {
if (abs(longitudinal) < MINIMUM_TILT || abs(lateral) < MINIMUM_TILT) { if (abs(longitudinal) < MINIMUM_TILT || abs(lateral) < MINIMUM_TILT) {
return Result.Error(Failure.TOO_LITTLE_MOVEMENT) return Result.Error(Failure.TOO_LITTLE_MOVEMENT)
} }
val coarse = SensorOrientation(
longitudinalSource = source,
// Front nach unten heisst: das Heck steht höher, die
// Längsneigung des Fahrzeugs ist also positiv.
invertLongitudinal = longitudinal < 0,
// Linke Seite nach unten heisst: rechts steht höher, die
// Querneigung ist positiv.
invertLateral = lateral < 0,
)
// Was nach dem Achsentausch noch übrig ist, ist die Verdrehung um die
// Hochachse. Beim Kippen der Front nach unten dürfte sich nur die
// Längsneigung ändern; wandert die Querneigung mit, sitzt der Sensor
// schräg und zwar um genau diesen Winkel.
val (correctedLong, correctedLat) = coarse.apply(nose.pitch, nose.roll)
val residual = if (correctedLong != null && correctedLat != null) {
Math.toDegrees(atan2(correctedLat, correctedLong))
} else {
0.0
}
// Unter zwei Grad ist es Messrauschen. Zwei Kippbewegungen von Hand
// sind nicht genauer, und eine erfundene Verdrehung wäre schlimmer
// als keine.
return Result.Success( return Result.Success(
SensorOrientation( coarse.copy(twist = if (abs(residual) >= MINIMUM_TWIST) residual else 0.0)
longitudinalSource = source,
// Front nach unten heisst: das Heck steht höher, die
// Längsneigung des Fahrzeugs ist also positiv.
invertLongitudinal = longitudinal < 0,
// Linke Seite nach unten heisst: rechts steht höher, die
// Querneigung ist positiv.
invertLateral = lateral < 0,
)
) )
} }
} }
@@ -24,6 +24,9 @@ object VanAlignProtocol {
/** Ein Byte: 0 setzt zurück, alles andere kalibriert auf die aktuelle Lage. */ /** Ein Byte: 0 setzt zurück, alles andere kalibriert auf die aktuelle Lage. */
const val CALIBRATE_UUID = "CAD48E28-7FBE-41CF-BAE9-D77A6C233427" const val CALIBRATE_UUID = "CAD48E28-7FBE-41CF-BAE9-D77A6C233427"
/** Acht Byte: die Einbaulage, lesbar und schreibbar. Siehe [orientation]. */
const val ORIENTATION_UUID = "CAD48E28-7FBE-41CF-BAE9-D77A6C233428"
val calibrateCommand = byteArrayOf(0x01) val calibrateCommand = byteArrayOf(0x01)
val resetCommand = byteArrayOf(0x00) val resetCommand = byteArrayOf(0x00)
@@ -50,6 +53,55 @@ object VanAlignProtocol {
return value.toDouble() return value.toDouble()
} }
/**
* Die Einbaulage, wie sie im Gerät liegt.
*
* Acht Byte:
*
* 0 Version, 1 = gültig gesetzt, 0 = nie geschrieben
* 1 Längsachse: 0 = Pitch des Sensors, 1 = Roll des Sensors
* 2 längs umgekehrt (0/1)
* 3 quer umgekehrt (0/1)
* 4..7 Verdrehung um die Hochachse, float32, Grad
*
* Sie gehört ins Gerät, weil sie den Einbau beschreibt und nicht das
* Telefon: iPhone, Uhr und Android sollen dieselbe sehen, ohne sie je
* einzeln zu bestimmen. Gerechnet wird trotzdem in den Apps das Gerät
* verwahrt sie nur, sonst rechnete ein älterer Client die Korrektur ein
* zweites Mal ein.
*
* Version 0 heisst „hier stand noch nie etwas" und ergibt null; dann gilt,
* was die App örtlich gespeichert hat, und sie schreibt es hinauf.
*/
fun orientation(data: ByteArray): SensorOrientation? {
if (data.size < 8 || data.u(0) != 1) return null
val twist = angle(data, 4) ?: return null
return SensorOrientation(
longitudinalSource = if (data.u(1) == 1) {
SensorOrientation.Source.ROLL
} else {
SensorOrientation.Source.PITCH
},
invertLongitudinal = data.u(2) != 0,
invertLateral = data.u(3) != 0,
twist = twist,
)
}
/** Dieselben acht Byte in die andere Richtung. */
fun encoded(orientation: SensorOrientation): ByteArray {
val bytes = ByteArray(8)
bytes[0] = 1
bytes[1] = if (orientation.longitudinalSource == SensorOrientation.Source.ROLL) 1 else 0
bytes[2] = if (orientation.invertLongitudinal) 1 else 0
bytes[3] = if (orientation.invertLateral) 1 else 0
val raw = orientation.twist.toFloat().toRawBits()
for (index in 0 until 4) {
bytes[4 + index] = ((raw shr (8 * index)) and 0xFF).toByte()
}
return bytes
}
/** Die beiden gespeicherten Offsets. */ /** Die beiden gespeicherten Offsets. */
fun offsets(data: ByteArray): Pair<Double, Double>? { fun offsets(data: ByteArray): Pair<Double, Double>? {
if (data.size < 8) return null if (data.size < 8) return null
@@ -381,14 +381,31 @@ final class BluetoothManager: NSObject {
} }
/// Nach einer Änderung der Einbaulage aufrufen. /// Nach einer Änderung der Einbaulage aufrufen.
///
/// Die Lage wandert zusätzlich ins Gerät. Dort gehört sie hin: Sie
/// beschreibt den Einbau, und Uhr wie Android-App finden sie dann vor,
/// ohne dass jemand sie ein zweites Mal bestimmen muss.
func updateSensorOrientation(for device: ConfiguredDevice) { func updateSensorOrientation(for device: ConfiguredDevice) {
let deviceID = device.id, orientation = device.sensorOrientation let deviceID = device.id, orientation = device.sensorOrientation
queue.async { queue.async {
guard let session = self.levelSession(for: deviceID) else { return } guard let session = self.levelSession(for: deviceID) else { return }
session.orientation = orientation session.orientation = orientation
session.storeOrientation(orientation)
} }
} }
/// Übernimmt die Einbaulage, die das Gerät meldet.
///
/// Steht dort noch nichts, meldet das Gerät nichts dann bleibt es bei der
/// örtlich gespeicherten Fassung, und die wird beim nächsten Bestimmen
/// hinaufgeschrieben.
private func adoptOrientation(_ orientation: SensorOrientation, for deviceID: UUID) {
guard var device = store.devices.first(where: { $0.id == deviceID }),
device.sensorOrientation != orientation else { return }
device.sensorOrientation = orientation
store.update(device)
}
/// Setzt die aktuelle Lage des Fahrzeugs als neue Null. /// Setzt die aktuelle Lage des Fahrzeugs als neue Null.
func calibrateLevel(for deviceID: UUID) { func calibrateLevel(for deviceID: UUID) {
queue.async { self.levelSession(for: deviceID)?.calibrate() } queue.async { self.levelSession(for: deviceID)?.calibrate() }
@@ -742,6 +759,11 @@ extension BluetoothManager: CBCentralManagerDelegate {
}, },
onLevelState: { [weak self] state in onLevelState: { [weak self] state in
self?.publish { self?.levelStates[device.id] = state } self?.publish { self?.levelStates[device.id] = state }
},
onDeviceOrientation: { [weak self] orientation in
// Im Gerät steht, wie der Sensor eingebaut ist für alle
// Clients dasselbe. Also übernehmen statt überschreiben.
self?.publish { self?.adoptOrientation(orientation, for: device.id) }
} }
) )
session.orientation = device.sensorOrientation session.orientation = device.sensorOrientation
+5 -3
View File
@@ -30,10 +30,12 @@ struct CamperWatchApp: App {
// die App einmal im Hintergrund war. // die App einmal im Hintergrund war.
link.setLive(true) link.setLive(true)
} }
// Die Einbaulage wird am iPhone bestimmt; die Uhr übernimmt sie // Die Einbaulage kommt bevorzugt aus dem Sensor selbst. Nur
// und behält sie, damit sie auch allein richtig rechnet. // falls dort noch nichts steht ältere Firmware, oder nie
// bestimmt , gilt, was das iPhone meldet.
.onChange(of: link.payload?.levelDevice?.orientation) { _, orientation in .onChange(of: link.payload?.levelDevice?.orientation) { _, orientation in
if let orientation { radio.orientation = orientation } guard let orientation, !radio.hasDeviceOrientation else { return }
radio.orientation = orientation
} }
} }
.onChange(of: scenePhase) { _, phase in .onChange(of: scenePhase) { _, phase in
+15 -1
View File
@@ -28,7 +28,13 @@ final class WatchLevelRadio: NSObject {
private(set) var updatedAt: Date? private(set) var updatedAt: Date?
private(set) var statusText = "Bluetooth wird gestartet…" private(set) var statusText = "Bluetooth wird gestartet…"
/// Die Einbaulage des Sensors. Kommt vom iPhone und wird hier behalten, /// Ob die Einbaulage aus dem Gerät selbst stammt. Dann hat sie Vorrang vor
/// dem, was das iPhone meldet im Gerät steht, wie der Sensor eingebaut
/// ist, und das ist für alle Clients dasselbe.
private(set) var hasDeviceOrientation = false
/// Die Einbaulage des Sensors. Kommt vom Gerät oder vom iPhone und wird
/// hier behalten,
/// damit die Uhr auch ohne Telefon richtig rechnet ohne sie stünden /// damit die Uhr auch ohne Telefon richtig rechnet ohne sie stünden
/// längs und quer je nach Einbau vertauscht oder mit falschem Vorzeichen. /// längs und quer je nach Einbau vertauscht oder mit falschem Vorzeichen.
var orientation = SensorOrientation.identity { var orientation = SensorOrientation.identity {
@@ -207,6 +213,14 @@ extension WatchLevelRadio: CBCentralManagerDelegate {
self.updatedAt = now self.updatedAt = now
self.statusText = "Direkt am Sensor" self.statusText = "Direkt am Sensor"
} }
},
onDeviceOrientation: { [weak self] orientation in
guard let self else { return }
Self.store(orientation)
self.publish {
self.hasDeviceOrientation = true
self.orientation = orientation
}
}) })
session.orientation = orientation session.orientation = orientation
self.session = session self.session = session
+27
View File
@@ -188,6 +188,33 @@ um die Hochachse steckt darin nicht eben sieht in jeder Verdrehung gleich
aus. Dafür braucht es zwei Kippbewegungen in bekannte Richtungen, und genau die aus. Dafür braucht es zwei Kippbewegungen in bekannte Richtungen, und genau die
macht der Einbaulage-Assistent. macht der Einbaulage-Assistent.
### Beides liegt im Sensor, nicht in der App
Sowohl die **Kalibrierung** als auch die **Einbaulage** speichert der ESP32
selbst und gibt sie an jeden aus, der fragt. Das ist der Punkt, sobald mehr als
ein Gerät im Spiel ist: iPhone, Apple Watch und Android-App zeigen dasselbe,
und bestimmt werden muss beides nur ein einziges Mal, von welchem Gerät aus
auch immer.
| | wo |
|---|---|
| Nullpunkt der Kalibrierung | im ESP (`pitch_offset`, `roll_offset`), wird dort auch schon abgezogen |
| Einbaulage samt Verdrehung | im ESP, Charakteristik `…3428`, lesbar und schreibbar |
| Spurweite und Radstand | in der jeweiligen App, im Fahrzeugprofil |
Beim Verbinden liest jede App die Einbaulage aus dem Gerät und übernimmt sie.
Wer sie neu bestimmt, schreibt sie hinauf. Steht dort noch nichts ältere
Firmware oder nie bestimmt , gilt weiter, was die App örtlich gespeichert hat;
kaputtgehen kann dabei nichts.
Angewandt wird sie trotzdem in den Apps und nicht im Sensor. Der Sensor
verwahrt sie nur: Würde er die Winkel schon umgerechnet melden, rechnete jede
ältere App die Korrektur ein zweites Mal ein.
Die acht Byte der Charakteristik sind in `VanAlignProtocol` beschrieben und in
`run-tests.sh` byteweise festgenagelt daran hängen drei Apps und die
Firmware.
**Danach kalibrieren:** Fahrzeug eben stellen, dann *Auf **Danach kalibrieren:** Fahrzeug eben stellen, dann *Auf
aktuelle Lage kalibrieren*. Ohne das zeigt die Anzeige die Lage des Sensors, aktuelle Lage kalibrieren*. Ohne das zeigt die Anzeige die Lage des Sensors,
nicht die des Fahrzeugs je nachdem, wie schief er eingebaut ist. nicht die des Fahrzeugs je nachdem, wie schief er eingebaut ist.
+46 -3
View File
@@ -18,6 +18,7 @@ final class LevelSession: NSObject {
private static let rollUUID = CBUUID(string: VanAlignProtocol.rollUUID) private static let rollUUID = CBUUID(string: VanAlignProtocol.rollUUID)
private static let offsetsUUID = CBUUID(string: VanAlignProtocol.offsetsUUID) private static let offsetsUUID = CBUUID(string: VanAlignProtocol.offsetsUUID)
private static let calibrateUUID = CBUUID(string: VanAlignProtocol.calibrateUUID) private static let calibrateUUID = CBUUID(string: VanAlignProtocol.calibrateUUID)
private static let orientationUUID = CBUUID(string: VanAlignProtocol.orientationUUID)
let deviceID: UUID let deviceID: UUID
private let queue: DispatchQueue private let queue: DispatchQueue
@@ -25,11 +26,16 @@ final class LevelSession: NSObject {
private let onUpdate: (DeviceSnapshot) -> Void private let onUpdate: (DeviceSnapshot) -> Void
private let onStateChange: (DeviceLinkState) -> Void private let onStateChange: (DeviceLinkState) -> Void
private let onLevelState: (LevelState) -> Void private let onLevelState: (LevelState) -> Void
/// Meldet die Einbaulage, die im Gerät steht. Sie gilt vor der örtlich
/// gespeicherten: dort steht, wie der Sensor eingebaut ist, und das ist für
/// alle Clients dasselbe.
private let onDeviceOrientation: ((SensorOrientation) -> Void)?
private var pitchCharacteristic: CBCharacteristic? private var pitchCharacteristic: CBCharacteristic?
private var rollCharacteristic: CBCharacteristic? private var rollCharacteristic: CBCharacteristic?
private var offsetsCharacteristic: CBCharacteristic? private var offsetsCharacteristic: CBCharacteristic?
private var calibrateCharacteristic: CBCharacteristic? private var calibrateCharacteristic: CBCharacteristic?
private var orientationCharacteristic: CBCharacteristic?
private var state = LevelState() private var state = LevelState()
/// Aus den Geräteeinstellungen; rechnet Sensor- in Fahrzeugachsen um. /// Aus den Geräteeinstellungen; rechnet Sensor- in Fahrzeugachsen um.
@@ -49,7 +55,9 @@ final class LevelSession: NSObject {
queue: DispatchQueue, queue: DispatchQueue,
onUpdate: @escaping (DeviceSnapshot) -> Void, onUpdate: @escaping (DeviceSnapshot) -> Void,
onStateChange: @escaping (DeviceLinkState) -> Void, onStateChange: @escaping (DeviceLinkState) -> Void,
onLevelState: @escaping (LevelState) -> Void) { onLevelState: @escaping (LevelState) -> Void,
onDeviceOrientation: ((SensorOrientation) -> Void)? = nil) {
self.onDeviceOrientation = onDeviceOrientation
self.deviceID = deviceID self.deviceID = deviceID
self.queue = queue self.queue = queue
self.peripheral = peripheral self.peripheral = peripheral
@@ -89,6 +97,28 @@ final class LevelSession: NSObject {
rollCharacteristic = nil rollCharacteristic = nil
offsetsCharacteristic = nil offsetsCharacteristic = nil
calibrateCharacteristic = nil calibrateCharacteristic = nil
orientationCharacteristic = nil
}
// MARK: - Einbaulage im Gerät
/// Schreibt die Einbaulage ins Gerät, damit alle Clients dieselbe sehen.
///
/// Ältere Firmware hat die Charakteristik nicht; dann bleibt es bei der
/// örtlich gespeicherten Fassung, und es passiert schlicht nichts.
func storeOrientation(_ orientation: SensorOrientation) {
guard let characteristic = orientationCharacteristic,
peripheral.state == .connected else { return }
let type: CBCharacteristicWriteType =
characteristic.properties.contains(.write) ? .withResponse : .withoutResponse
peripheral.writeValue(VanAlignProtocol.encoded(orientation),
for: characteristic, type: type)
// Zurücklesen, damit angezeigt wird, was wirklich im Gerät steht.
queue.asyncAfter(deadline: .now() + 0.3) { [weak self] in
guard let self, let characteristic = self.orientationCharacteristic,
self.peripheral.state == .connected else { return }
self.peripheral.readValue(for: characteristic)
}
} }
// MARK: - Kalibrieren // MARK: - Kalibrieren
@@ -169,7 +199,8 @@ extension LevelSession: CBPeripheralDelegate {
return return
} }
peripheral.discoverCharacteristics( peripheral.discoverCharacteristics(
[Self.pitchUUID, Self.rollUUID, Self.offsetsUUID, Self.calibrateUUID], [Self.pitchUUID, Self.rollUUID, Self.offsetsUUID,
Self.calibrateUUID, Self.orientationUUID],
for: service for: service
) )
} }
@@ -188,6 +219,7 @@ extension LevelSession: CBPeripheralDelegate {
case Self.rollUUID: rollCharacteristic = characteristic case Self.rollUUID: rollCharacteristic = characteristic
case Self.offsetsUUID: offsetsCharacteristic = characteristic case Self.offsetsUUID: offsetsCharacteristic = characteristic
case Self.calibrateUUID: calibrateCharacteristic = characteristic case Self.calibrateUUID: calibrateCharacteristic = characteristic
case Self.orientationUUID: orientationCharacteristic = characteristic
default: break default: break
} }
} }
@@ -210,7 +242,8 @@ extension LevelSession: CBPeripheralDelegate {
startPollingIfNeeded() startPollingIfNeeded()
// Einmal alles lesen, damit sofort etwas dasteht. // Einmal alles lesen, damit sofort etwas dasteht.
for characteristic in [pitchCharacteristic, rollCharacteristic, offsetsCharacteristic] { for characteristic in [pitchCharacteristic, rollCharacteristic,
offsetsCharacteristic, orientationCharacteristic] {
guard let characteristic, characteristic.properties.contains(.read) else { continue } guard let characteristic, characteristic.properties.contains(.read) else { continue }
peripheral.readValue(for: characteristic) peripheral.readValue(for: characteristic)
} }
@@ -233,6 +266,16 @@ extension LevelSession: CBPeripheralDelegate {
state.pitchOffset = offsets.pitch state.pitchOffset = offsets.pitch
state.rollOffset = offsets.roll state.rollOffset = offsets.roll
} }
case Self.orientationUUID:
// Was im Gerät steht, gilt: es beschreibt den Einbau, nicht das
// Telefon. Steht dort nichts (Version 0), bleibt es bei der
// örtlichen Fassung der Aufrufer schreibt sie dann hinauf.
guard let stored = VanAlignProtocol.orientation(from: value) else { return }
if stored != orientation {
orientation = stored
}
onDeviceOrientation?(stored)
return
default: default:
return return
} }
+46
View File
@@ -16,6 +16,8 @@ enum VanAlignProtocol {
static let offsetsUUID = "CAD48E28-7FBE-41CF-BAE9-D77A6C233426" static let offsetsUUID = "CAD48E28-7FBE-41CF-BAE9-D77A6C233426"
/// Ein Byte: 0 setzt zurück, alles andere kalibriert auf die aktuelle Lage. /// Ein Byte: 0 setzt zurück, alles andere kalibriert auf die aktuelle Lage.
static let calibrateUUID = "CAD48E28-7FBE-41CF-BAE9-D77A6C233427" static let calibrateUUID = "CAD48E28-7FBE-41CF-BAE9-D77A6C233427"
/// Acht Byte: die Einbaulage, lesbar und schreibbar. Siehe `orientation`.
static let orientationUUID = "CAD48E28-7FBE-41CF-BAE9-D77A6C233428"
static let calibrateCommand = Data([0x01]) static let calibrateCommand = Data([0x01])
static let resetCommand = Data([0x00]) static let resetCommand = Data([0x00])
@@ -41,6 +43,50 @@ enum VanAlignProtocol {
return Double(value) return Double(value)
} }
/// Die Einbaulage, wie sie im Gerät liegt.
///
/// Acht Byte:
///
/// 0 Version, 1 = gültig gesetzt, 0 = nie geschrieben
/// 1 Längsachse: 0 = Pitch des Sensors, 1 = Roll des Sensors
/// 2 längs umgekehrt (0/1)
/// 3 quer umgekehrt (0/1)
/// 4..7 Verdrehung um die Hochachse, float32, Grad
///
/// Sie gehört ins Gerät, weil sie den Einbau beschreibt und nicht das
/// Telefon: iPhone, Uhr und Android sollen dieselbe sehen, ohne sie je
/// einzeln zu bestimmen. Gerechnet wird trotzdem in den Apps das Gerät
/// verwahrt sie nur, sonst rechnete ein älterer Client die Korrektur ein
/// zweites Mal ein.
///
/// Version 0 heisst hier stand noch nie etwas und ergibt nil; dann gilt,
/// was die App örtlich gespeichert hat, und sie schreibt es hinauf.
static func orientation(from data: Data) -> SensorOrientation? {
let bytes = [UInt8](data)
guard bytes.count >= 8, bytes[0] == 1 else { return nil }
var orientation = SensorOrientation()
orientation.longitudinalSource = bytes[1] == 1 ? .roll : .pitch
orientation.invertLongitudinal = bytes[2] != 0
orientation.invertLateral = bytes[3] != 0
guard let twist = angle(from: data.dropFirst(4).prefix(4)) else { return nil }
orientation.twist = twist
return orientation
}
/// Dieselben acht Byte in die andere Richtung.
static func encoded(_ orientation: SensorOrientation) -> Data {
var bytes = [UInt8](repeating: 0, count: 8)
bytes[0] = 1
bytes[1] = orientation.longitudinalSource == .roll ? 1 : 0
bytes[2] = orientation.invertLongitudinal ? 1 : 0
bytes[3] = orientation.invertLateral ? 1 : 0
let raw = Float(orientation.twist).bitPattern
for index in 0..<4 {
bytes[4 + index] = UInt8((raw >> UInt32(8 * index)) & 0xFF)
}
return Data(bytes)
}
/// Die beiden gespeicherten Offsets. /// Die beiden gespeicherten Offsets.
static func offsets(from data: Data) -> (pitch: Double, roll: Double)? { static func offsets(from data: Data) -> (pitch: Double, roll: Double)? {
guard data.count >= 8, guard data.count >= 8,
+36
View File
@@ -970,6 +970,42 @@ let untouched = SensorOrientation.identity.apply(pitch: 1.5, roll: -0.5)
checkEqual("unveränderte Lage lässt längs stehen", untouched.pitch, 1.5) checkEqual("unveränderte Lage lässt längs stehen", untouched.pitch, 1.5)
checkEqual("unveränderte Lage lässt quer stehen", untouched.roll, -0.5) checkEqual("unveränderte Lage lässt quer stehen", untouched.roll, -0.5)
// Die Einbaulage liegt im Gerät, damit iPhone, Uhr und Android dieselbe sehen.
// Acht Byte, hin und zurück.
print("\nEinbaulage im Gerät")
var stored = SensorOrientation()
stored.longitudinalSource = .roll
stored.invertLongitudinal = true
stored.invertLateral = false
stored.twist = -17.5
let storedBytes = VanAlignProtocol.encoded(stored)
checkEqual("acht Byte lang", storedBytes.count, 8)
checkEqual("Version steht vorne", storedBytes.first, 1)
checkEqual("gelesen kommt dasselbe zurück", VanAlignProtocol.orientation(from: storedBytes), stored)
// Ein Gerät, in dem noch nie etwas stand, meldet Version 0. Das ist kein
// Fehler, sondern heisst "hier gilt, was die App hat" und die schreibt sie
// dann hinauf.
checkEqual("Version 0 gilt als leer",
VanAlignProtocol.orientation(from: Data(repeating: 0, count: 8)) == nil, true)
checkEqual("zu kurze Antwort ergibt nichts",
VanAlignProtocol.orientation(from: Data([1, 0, 0, 0])) == nil, true)
// Die Feldbelegung byteweise festgenagelt: daran hängen drei Apps und die
// Firmware, das darf nicht unbemerkt verrutschen.
var plain = SensorOrientation()
plain.twist = 1
checkEqual("Feldbelegung", [UInt8](VanAlignProtocol.encoded(plain)),
[1, 0, 0, 0, 0x00, 0x00, 0x80, 0x3F]) // 1.0f little endian
var mounted = SensorOrientation()
mounted.longitudinalSource = .roll
mounted.invertLateral = true
checkEqual("Achsentausch und Vorzeichen an ihrem Platz",
[UInt8](VanAlignProtocol.encoded(mounted)).prefix(4).map { $0 }, [1, 1, 0, 1])
// Gespeicherte Einrichtungen müssen ältere Fassungen überleben. Ein neues Feld // Gespeicherte Einrichtungen müssen ältere Fassungen überleben. Ein neues Feld
// darf das Lesen nicht scheitern lassen sonst ist die Geräteliste leer, und // darf das Lesen nicht scheitern lassen sonst ist die Geräteliste leer, und
// das nächste Speichern schreibt diese Leere über den Bestand. // das nächste Speichern schreibt diese Leere über den Bestand.
+83
View File
@@ -105,6 +105,32 @@ globals:
type: float type: float
restore_value: yes restore_value: yes
initial_value: '0.0' initial_value: '0.0'
# Die Einbaulage liegt im Gerät, nicht in den Apps: Sie beschreibt, wie der
# Sensor im Fahrzeug sitzt eine Eigenschaft des Einbaus, nicht des Telefons.
# Damit sehen iPhone, Uhr und Android dasselbe, ohne sie je einzeln zu
# bestimmen. Angewandt wird sie weiterhin in den Apps; das Gerät verwahrt sie
# nur, sonst rechneten ältere Clients die Korrektur ein zweites Mal.
- id: orientation_version
type: uint8_t
restore_value: yes
initial_value: '0'
- id: orientation_source
type: uint8_t
restore_value: yes
initial_value: '0'
- id: orientation_invert_long
type: bool
restore_value: yes
initial_value: 'false'
- id: orientation_invert_lat
type: bool
restore_value: yes
initial_value: 'false'
- id: orientation_twist
type: float
restore_value: yes
initial_value: '0.0'
- id: enable_captive - id: enable_captive
type: bool type: bool
restore_value: yes restore_value: yes
@@ -133,6 +159,63 @@ esp32_ble_server:
float val = id(roll).state; float val = id(roll).state;
memcpy(v.data(), &val, sizeof(float)); memcpy(v.data(), &val, sizeof(float));
return v; return v;
# Die gespeicherten Nullpunkte, zwei Floats. Daran erkennen die Apps,
# ob überhaupt schon kalibriert wurde.
- id: offsets_ble
uuid: cad48e28-7fbe-41cf-bae9-d77a6c233426
description: "Kalibrier-Offsets"
read: true
value: !lambda |-
std::vector<unsigned char> v(2 * sizeof(float));
float p = id(pitch_offset);
float r = id(roll_offset);
memcpy(v.data(), &p, sizeof(float));
memcpy(v.data() + sizeof(float), &r, sizeof(float));
return v;
# Die Einbaulage, acht Byte:
#
# 0 Version, 1 = gültig gesetzt, 0 = nie geschrieben
# 1 Längsachse: 0 = Pitch des Sensors, 1 = Roll des Sensors
# 2 längs umgekehrt (0/1)
# 3 quer umgekehrt (0/1)
# 4..7 Verdrehung um die Hochachse, float32, Grad
- id: orientation_ble
uuid: cad48e28-7fbe-41cf-bae9-d77a6c233428
description: "Einbaulage"
read: true
write: true
value: !lambda |-
std::vector<unsigned char> v(8, 0);
v[0] = id(orientation_version);
v[1] = id(orientation_source);
v[2] = id(orientation_invert_long) ? 1 : 0;
v[3] = id(orientation_invert_lat) ? 1 : 0;
float t = id(orientation_twist);
memcpy(v.data() + 4, &t, sizeof(float));
return v;
on_write:
then:
- lambda: |-
if (x.size() < 8 || x[0] != 1) {
ESP_LOGW("vanalign", "Einbaulage verworfen: %d Byte, Version %d",
(int) x.size(), x.empty() ? -1 : (int) x[0]);
return;
}
float t;
memcpy(&t, x.data() + 4, sizeof(float));
if (!std::isfinite(t) || fabsf(t) > 180.0f) {
ESP_LOGW("vanalign", "Einbaulage verworfen: Verdrehung %.1f", t);
return;
}
id(orientation_version) = 1;
id(orientation_source) = x[1];
id(orientation_invert_long) = x[2] != 0;
id(orientation_invert_lat) = x[3] != 0;
id(orientation_twist) = t;
ESP_LOGI("vanalign", "Einbaulage gespeichert: Quelle=%d laengs=%d quer=%d verdreht=%.1f",
(int) x[1], (int) x[2], (int) x[3], t);
- id: calib_ble - id: calib_ble
uuid: cad48e28-7fbe-41cf-bae9-d77a6c233427 uuid: cad48e28-7fbe-41cf-bae9-d77a6c233427
description: "Kalibriere Neigung" description: "Kalibriere Neigung"