From a4e19f02a461e6b06f22b77259f041920780adef Mon Sep 17 00:00:00 2001
From: LucianoDev <herlicson@gmail.com>
Date: Thu, 16 Apr 2026 18:31:07 +0200
Subject: [PATCH] tested in 815 and focus and works in both, so new immo fully
 verified. Also added 004002 kline data

---
 Core/Inc/id.h              | 29 +++++++++++++++++------------
 Core/Inc/id_004002.h       |  7 +++++++
 Core/Kline_Libs/psg_prop.h |  6 ++++++
 3 files changed, 30 insertions(+), 12 deletions(-)

diff --git a/Core/Inc/id.h b/Core/Inc/id.h
index 10a0112..39c1a29 100644
--- a/Core/Inc/id.h
+++ b/Core/Inc/id.h
@@ -13,10 +13,12 @@
 //#define T06215   			//bmw rover  	004 -> 005 014 015 016 017	||	504 -> 005 007 017	||	006 -> 001 002 003 004 007 008
 //#define T15021   			//audi 			506 -> 030 033
 //#define T31804   			//audi 			506 -> 037 038
+//#define T06209	//eq: T06216
+//#define T06211
 
 //#define _004006
-#define _004004
-//#define _004002
+//#define _004004
+#define _004002
 //#define _504003
 //#define _504009
 //#define _504010
@@ -30,26 +32,28 @@
 #define CYLINDERS 4
 
 /* TIMING COMPENSATIONS */
-#define PHI1 25.4 //25.4??
+#define PHI1 24.914
 
 #define TEIN_NOMINAL 0
 #define TEIN_FAULT 950.5
 
 /* ALL FBKW */
 #define FBKW_DEM_M 0.5
+#define FBKW_DEM_TEMP_M -0.0145
+#define FBKW_DEM_TEMP_N 0.53
 
-#define FBKW_DEM_TEMP_M -0.0138271344
-#define FBKW_DEM_TEMP_N 1.619546633
+#define FBKW_DEM_A1 1.42
+#define FBKW_DEM_A2 1.45
+#define FBKW_DEM_A3 -0.459
 
-#define FBKW_DEM_A1 -0.649
-#define FBKW_DEM_A2 3.86
-#define FBKW_DEM_A3 -0.795
+#define FBKW_DEM_ME_M 0.0031
+#define FBKW_DEM_ME_N 0.527
 
 #define FBKW_DEM_MIN 0
 
-#define FBKW_FEEDBACK_ZERO 8.345
-#define FBKW_FEEDBACK_MIN -3.77
-#define FBKW_FEEDBACK_MAX 18
+#define FBKW_FEEDBACK_ZERO 7.617
+#define FBKW_FEEDBACK_MIN -3.188
+#define FBKW_FEEDBACK_MAX 17.813
 #define FBKW_FEEDBACK_IC_DT 27
 
 #define FBKW_PID_KP 90	//16
@@ -74,7 +78,8 @@
 /* ALL FUELMAP */
 #define FM_N_RPM 10
 #define FM_N_ME 12
-#define FM_N_T 5
+#define FM_N_T 6
+
 
 /* PEAK AND HOLD */
 #define PH_PEAK_DEF 600
diff --git a/Core/Inc/id_004002.h b/Core/Inc/id_004002.h
index bd492c3..39c1a29 100644
--- a/Core/Inc/id_004002.h
+++ b/Core/Inc/id_004002.h
@@ -16,6 +16,13 @@
 //#define T06209	//eq: T06216
 //#define T06211
 
+//#define _004006
+//#define _004004
+#define _004002
+//#define _504003
+//#define _504009
+//#define _504010
+
 /* FORD  */
 #define FORD_SYNC_PULSE_OUT 1
 
diff --git a/Core/Kline_Libs/psg_prop.h b/Core/Kline_Libs/psg_prop.h
index f135669..f47269e 100644
--- a/Core/Kline_Libs/psg_prop.h
+++ b/Core/Kline_Libs/psg_prop.h
@@ -40,6 +40,12 @@
 #define PSG_KUNDENNUMMER1_STR "YC1Q-9A543"
 #define PSG_KUNDENNUMMER2_STR "-D"
 #define PSG_MOD_INDEX_STR       "000003"
+#elif defined(_004002)
+#define PSG_IDENT_STR           "0470004002"
+#define PSG_KUNDENNUMMER_STR "139031      "
+#define PSG_KUNDENNUMMER1_STR "139031    "
+#define PSG_KUNDENNUMMER2_STR "  "
+#define PSG_MOD_INDEX_STR       "000000"
 
 #else
 /* Modification index — 6 ASCII chars, ROM 0x93A7 */