[all] FAS Offset compensation, +/- 1.5A ( issue 166 )

2013-11-30 11:43:59 +01:00
parent 0c0f559f75
commit c31f184813
23 changed files with 45 additions and 1 deletions
@@ -191,6 +191,10 @@ void parseTelemHubByte(uint8_t byte)
      break;

    case offsetof(FrskySerialData, current):
+      if(((int16_t)frskyData.hub.current + g_model.frsky.fasOffset)>0)
+        frskyData.hub.current += g_model.frsky.fasOffset;
+      else
+        frskyData.hub.current = 0;
      if (frskyData.hub.current > frskyData.hub.maxCurrent)
        frskyData.hub.maxCurrent = frskyData.hub.current;
      break;