From c3de3c574aa7a9ea1d0f41ad5f54405cc3e60de9 Mon Sep 17 00:00:00 2001
From: Urban Wallasch <urban.wallasch@freenet.de>
Date: Sun, 28 Jul 2019 11:21:02 +0200
Subject: [PATCH] * Added forward gear count to telemetry and use it to fix
 skewed gear display.

---
 dash.html     | 12 ++++++++----
 telehttpd.c   |  1 +
 telelogger.c  |  1 +
 telemetry.h   |  1 +
 teleshmem.cpp |  9 ++++++++-
 5 files changed, 19 insertions(+), 5 deletions(-)

diff --git a/dash.html b/dash.html
index d404941..2f961c2 100644
--- a/dash.html
+++ b/dash.html
@@ -126,9 +126,13 @@ x-bar {
 
 <script type="text/javascript">
 
-function dgear(x, m) {
-  if ( x > 0 ) return ( m ? '' : 'A' ) + x;
-  if ( x < 0 ) return 'R' + Math.abs(x);
+function dgear(x, f, m) {
+  // We try to deduce the correct forward gear number to display from
+  // the number of gears available. This likely just plain nonsense!
+  if ( x > 0 )
+    return ( m ? '' : 'A' ) + ( f>12 ? ( x<3 ? 'C'+x : x-2 ) : x );
+  if ( x < 0 )
+    return 'R' + -x;
   return 'N';
 }
 
@@ -203,7 +207,7 @@ function loadDoc() {
 
       cctrl.innerHTML = Math.round(tele.cctrl * 3.6);
 
-      gear.innerHTML = dgear(tele.gear_disp, tele.shifter);
+      gear.innerHTML = dgear(tele.gear_disp, tele.gear_fwdcnt, tele.shifter);
       if ( tele.clutch_eff > 0 )
         gear.classList.add("hilite");
       else
diff --git a/telehttpd.c b/telehttpd.c
index 35d3b15..c465c14 100644
--- a/telehttpd.c
+++ b/telehttpd.c
@@ -79,6 +79,7 @@ static void write_telejson( int fd ) {
     write(fd, buf, sprintf( buf, "  \"rpm\": %f,\n", telemetry->rpm ) );
     write(fd, buf, sprintf( buf, "  \"gear\": %d,\n", telemetry->gear ) );
     write(fd, buf, sprintf( buf, "  \"gear_disp\": %d,\n", telemetry->gear_disp ) );
+    write(fd, buf, sprintf( buf, "  \"gear_fwdcnt\": %u,\n", telemetry->gear_fwdcnt ) );
     write(fd, buf, sprintf( buf, "  \"clutch_eff\": %f,\n", telemetry->clutch_eff ) );
     write(fd, buf, sprintf( buf, "  \"shifter\": %d,\n", telemetry->shifter ) );
 
diff --git a/telelogger.c b/telelogger.c
index 3bb6620..1647742 100644
--- a/telelogger.c
+++ b/telelogger.c
@@ -59,6 +59,7 @@ static int log_console(void) {
         printf( "rpm: %.0f /min\n", telemetry->rpm );
         printf( "gear: %d\n", telemetry->gear );
         printf( "gear d: %d\n", telemetry->gear_disp );
+        printf( "gear fwd cnt: %u\n", telemetry->gear_fwdcnt );
         printf( "clutch eff: %.1f\n", telemetry->clutch_eff );
         printf( "shifter: %s\n", telemetry->shifter ? "manual" : "automatic" );
 
diff --git a/telemetry.h b/telemetry.h
index 6e8613c..e29db93 100644
--- a/telemetry.h
+++ b/telemetry.h
@@ -31,6 +31,7 @@ struct telemetry_state_t {
     float   rpm;        // engine rpm
     int     gear;       // engine gear
     int     gear_disp;  // displayed gear
+    unsigned gear_fwdcnt; // gearbox number of forward gears
     float   clutch_eff; // effective clutch
     int     shifter;    // 0 = automatic, 1 = manual
 
diff --git a/teleshmem.cpp b/teleshmem.cpp
index 6de9e4e..3be153d 100644
--- a/teleshmem.cpp
+++ b/teleshmem.cpp
@@ -278,7 +278,14 @@ SCSAPI_VOID telemetry_configuration(const scs_event_t event, const void *const e
 {
     const struct scs_telemetry_configuration_t *const info = static_cast<const scs_telemetry_configuration_t *>(event_info);
 
-    if ( 0 == strcmp( info->id, SCS_TELEMETRY_CONFIG_controls ) ) {
+    if ( 0 == strcmp( info->id, SCS_TELEMETRY_CONFIG_truck ) ) {
+        for (const scs_named_value_t *current = info->attributes; current->name; ++current) {
+            if ( 0 == strcmp( current->name, SCS_TELEMETRY_CONFIG_ATTRIBUTE_forward_gear_count ) ) {
+                telemetry->gear_fwdcnt = current->value.value_u32.value;
+            }
+        }
+    }
+    else if ( 0 == strcmp( info->id, SCS_TELEMETRY_CONFIG_controls ) ) {
         for (const scs_named_value_t *current = info->attributes; current->name; ++current) {
             if ( 0 == strcmp( current->name, SCS_TELEMETRY_CONFIG_ATTRIBUTE_shifter_type ) ) {
                 // SCS_SHIFTER_TYPE_arcade
-- 
2.30.2