diff --git a/Code/Control/Laptop_Code/constants.py b/Code/Control/Laptop_Code/constants.py index 336b1d4ad468da7c2d177d72374d8f8fb72d00cf..9c7c47bd4b54c1f04a243ba48dd0bfd7d372fcfe 100644 --- a/Code/Control/Laptop_Code/constants.py +++ b/Code/Control/Laptop_Code/constants.py @@ -30,22 +30,27 @@ Bmin = 31 Bmax = 127 threshold = [Lmin, Lmax, Amin, Amax, Bmin, Bmax] -base_speed = 70 -seeking_speed = 100 +base_speed = 120 +seeking_speed = 70 LIDAR_Thres = 300 # mm # PID Control in move2ball -kpx,kix,kdx = 1.5, 0.01, 0.5 -kpy,kiy,kdy = 1.2, 0.01, 0.5 +kpx,kix,kdx = 1.2, 0.01, 0.5 +# kpx,kix,kdx = 0.0, 0.00, 0.0 +kpy,kiy,kdy = 1.2, 0.05, 0.9 +# kpy,kiy,kdy = 0.0, 0.0, 0.0 # PID Control in move2goal -kpx_g,kix_g,kdx_g = 1.5, 0.01, 0.5 -kpy_g,kiy_g,kdy_g = 1.2, 0.01, 0.5 +# kpx_g,kix_g,kdx_g = 1.5, 0.01, 0.5 +kpx_g,kix_g,kdx_g = 2, 0.01, 0.7 +# kpx_g,kix_g,kdx_g = 0.0, 0.0, 0.0 +kpy_g,kiy_g,kdy_g = 1.7, 0.01, 0.7 +# kpy_g,kiy_g,kdy_g = 0.0, 0.0, 0.0 # difference between center of AT and center of goal -AT_goal_Delta = 110 #cm +AT_goal_Delta = 0 #cm AT_h1 = 50 # meters