Fix MOK Fitness S10 Ultra resistance control (use 0xFFF2 instead of FTMS control point)

src/devices/ftmsbike/ftmsbike.cpp

@@ -304,6 +304,31 @@ void ftmsbike::forceResistance(resistance_t requestResistance) {
     }
     enableManualResistancePowerAdjustment(requestResistance);
 
+    if (MOK_FITNESS) {
+        // The MOK Fitness S10 Ultra NAKs the FTMS control point (0x2AD9) for resistance changes.
+        // Its own app changes resistance with a single write to 0xFFF2: AF 05 04 <level> AA.
+        if (requestResistance < 0) {
+            qDebug() << "Negative resistance detected:" << requestResistance << "using fallback value 1";
+            requestResistance = 1;
+        }
+        if (max_resistance > 0 && requestResistance > max_resistance) {
+            qDebug() << "Resistance" << requestResistance << "exceeds max_resistance" << max_resistance << "- clamping";
+            requestResistance = max_resistance;
+        }
+
+        Resistance = requestResistance;
+
+        if (gattMokFitnessService && gattWriteCharMokFitnessId.isValid()) {
+            uint8_t write[] = {0xAF, 0x05, 0x04, (uint8_t)requestResistance, 0xAA};
+            enqueueWrite(gattMokFitnessService, gattWriteCharMokFitnessId, write, sizeof(write),
+                        QStringLiteral("forceResistance MOK ") + QString::number(requestResistance), false, false,
+                        gattWriteCharMokFitnessId.properties() & QLowEnergyCharacteristic::WriteNoResponse);
+        } else {
+            qDebug() << QStringLiteral("MOK Fitness resistance characteristic (0xFFF2) not found");
+        }
+        return;
+    }
+
     QSettings settings;
     bool ergModeNotSupported = (requestPower > 0 && !ergModeSupported);
     if (!settings.value(QZSettings::ss2k_peloton, QZSettings::default_ss2k_peloton).toBool() &&
@@ -1720,6 +1745,16 @@ void ftmsbike::stateChanged(QLowEnergyService::ServiceState state) {
                     zwiftPlayWriteChar = c;
                     zwiftPlayService = s;
                 }
+
+                QBluetoothUuid _mokFitnessWriteCharId((quint16)0xFFF2);
+                if (MOK_FITNESS &&
+                    (c.properties() & QLowEnergyCharacteristic::Write ||
+                     c.properties() & QLowEnergyCharacteristic::WriteNoResponse) &&
+                    c.uuid() == _mokFitnessWriteCharId) {
+                    qDebug() << QStringLiteral("MOK Fitness resistance control characteristic found");
+                    gattWriteCharMokFitnessId = c;
+                    gattMokFitnessService = s;
+                }
             }
         }
     }

src/devices/ftmsbike/ftmsbike.h

@@ -131,6 +131,11 @@ class ftmsbike : public bike {
     QLowEnergyCharacteristic zwiftPlayWriteChar;
     QLowEnergyService *zwiftPlayService = nullptr;
 
+    // MOK Fitness bikes don't use the FTMS control point (0x2AD9) to change resistance,
+    // they need a raw command written to a proprietary characteristic (0xFFF2) instead.
+    QLowEnergyCharacteristic gattWriteCharMokFitnessId;
+    QLowEnergyService *gattMokFitnessService = nullptr;
+
     uint8_t sec1Update = 0;
     QByteArray lastPacket;
     QByteArray lastPacketFromFTMS;