2 files changed, 17 insertions, 4 deletions

diff --git a/firmware/target/arm/pbell/vibe500/backlight-vibe500.c b/firmware/target/arm/pbell/vibe500/backlight-vibe500.c
index 727370633b..321484cd9a 100644
--- a/firmware/target/arm/pbell/vibe500/backlight-vibe500.c
+++ b/firmware/target/arm/pbell/vibe500/backlight-vibe500.c
@@ -64,16 +64,16 @@ void _buttonlight_on(void)
 {
     if (!buttonlight_status)
     {
-        touchpad_set_buttonlights(0x0f, 0);
+        touchpad_set_parameter(0x22, 0x000f); /* 0x22 - GPO_ENABLE */
         buttonlight_status = 1;
     }
 }
- 
+
 void _buttonlight_off(void)
 {
     if (buttonlight_status)
     {
-        touchpad_set_buttonlights(0x00, 0);
+        touchpad_set_parameter(0x22, 0x0000); /* 0x22 - GPO_ENABLE */
         buttonlight_status = 0;
     }
 }
@@ -81,7 +81,8 @@ void _buttonlight_off(void)
 void _buttonlight_set_brightness(int brightness)
 {
     /* no brightness control, but lights stays on - for compatibility */
-    touchpad_set_buttonlights(0x0f, brightness);
+    (void)brightness;
+    touchpad_set_parameter(0x22, 0x000f); /* 0x22 - GPO_ENABLE */
     buttonlight_status = 1;
 }
 #endif
diff --git a/firmware/target/arm/pbell/vibe500/power-vibe500.c b/firmware/target/arm/pbell/vibe500/power-vibe500.c
index e55c69e033..45ab7fb1fd 100644
--- a/firmware/target/arm/pbell/vibe500/power-vibe500.c
+++ b/firmware/target/arm/pbell/vibe500/power-vibe500.c
@@ -46,6 +46,18 @@ void power_init(void)
     {
         logf("touchpad not ready");
     }
+    /* Max touch sensivity = 0x77, Rate=80/s,NoFilter=0,
+       KeyMatrix=0,Buttons=1,Relative=0,Absolute=1.
+       MEP parameter 0x20 - Report Modes */
+    touchpad_set_parameter(0x20,0x7785);
+    /* MinAbsReporting=0, NotAllCapButtons=0,SingleCapButton=0,
+       50msDebounce=0,MotionReporting=1 (reduce transmission overhead),
+       ClipZifnoFinger=0,DisableDeceleration=0,Dribble=0.
+       MEP parameter 0x21 - Enhanced Operating Configuration */
+    touchpad_set_parameter(0x21,0x0008);
+    /* Set the GPO_LEVEL = 0 - for the button lights */
+    touchpad_set_parameter(0x23,0x0000);
+
     /* Sound unmute (on) */
     GPIO_CLEAR_BITWISE(GPIOL_OUTPUT_VAL, 0x10);
 }