diff --git a/motion/hybridpath_controller/config/hybridpath_controller_config.yaml b/motion/hybridpath_controller/config/hybridpath_controller_config.yaml
index f01ea96..d8a9193 100644
--- a/motion/hybridpath_controller/config/hybridpath_controller_config.yaml
+++ b/motion/hybridpath_controller/config/hybridpath_controller_config.yaml
@@ -1,5 +1,5 @@
 /**:
   ros__parameters:
     hybridpath_controller:
-      K1_diag: [1., 1., 1.] # First gain matrix
-      K2_diag: [40.0, 30.0, 20.0] # Second gain matrix
\ No newline at end of file
+      K1_diag: [1., 1., 5.] # First gain matrix
+      K2_diag: [40.0, 30.0, 40.0] # Second gain matrix
\ No newline at end of file