Smikkelbakje/J2S1-Kobuki
1
0
Fork 0
mirror of https://gitlab.fdmci.hva.nl/technische-informatica-sm3/ti-projectten/rooziinuubii79.git synced 2025-08-04 04:14:58 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

trying to fix calibration for rotation

Browse Source
This commit is contained in:
ishak jmilou.ishak
2024-10-07 10:26:00 +02:00
parent 65adec8e1a
commit 50ba162717
1 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
src/C++/Driver/src/CKobuki.cpp
View File

@@ -700,9 +700,9 @@ void CKobuki::doRotation(long double th)
{
long double u = 0; // controlled variable, angular speed of the robot during movement
long double w = th; // desired value in radians
long double Kp = PI;
long double Kp = PI * 2;
long double e = 0;
int thresh = PI / 2;
int thresh = PI;
theta = 0;
x = 0;
@@ -720,8 +720,8 @@ void CKobuki::doRotation(long double th)
if (u > thresh)
u = thresh;
if (u < 0.4)
u = 0.4;
if (u < 0.6)
u = 0.6;
if (i < u)
{
@@ -743,8 +743,8 @@ void CKobuki::doRotation(long double th)
if (u > thresh)
u = thresh;
if (u < 0.4)
u = 0.4;
if (u < 0.6)
u = 0.6;
if (i < u)
{