From 6e363347a8c7d22d9757120f332171039f7d54d7 Mon Sep 17 00:00:00 2001
From: XI LUO <xluo45@ad.soe.ucsc.edu>
Date: Mon, 20 Mar 2023 21:32:18 -0700
Subject: [PATCH] more commit

---
 Main.m | 10 +++++-----
 1 file changed, 5 insertions(+), 5 deletions(-)

diff --git a/Main.m b/Main.m
index 0ceb105..b5a1e26 100644
--- a/Main.m
+++ b/Main.m
@@ -20,7 +20,7 @@
 %velocity walking
 Control_Command(1)=2;
 %% Feedback Control Parameters
-K_P = 0.6; % Porportional constant on velocity action
+K_P = 0.65; % Porportional constant on velocity action
 K_I = 1;  % Integral
 K_D = 1;
 % constant on velocity action
@@ -41,17 +41,17 @@
 %% MODE
 % Mode 1: Dog will go to Target_point.
 % Mode 2: Dog will follow Way_Points.
-Control_Mode=1;
+Control_Mode=2;
 %% Target Point
 %[x,z]
-Target_Point=[0 -2.8]; 
+Target_Point=[0 0]; 
 %% YAW
 % [0,360)
 % -1: Disable yaw control
-yaw_set = -1;
+yaw_set = 0;
 %% THRESHOLD
 % Distance Threshold to switch to next way point
-Distance_Threshold = 0.1;
+Distance_Threshold = 0.2;
 
 % Cricel way points 18
 Way_Points_center =[0,0];