major code restructure and cleanup
This commit is contained in:
@@ -263,17 +263,6 @@ class MXTuning(Tuning):
|
||||
|
||||
|
||||
prog+=''' iqCmd=DesPos*{V}-{y};
|
||||
if (iqCmd>maxDac)
|
||||
{{
|
||||
iqCmd=maxDac;
|
||||
}}
|
||||
else
|
||||
{{
|
||||
if (iqCmd<-maxDac)
|
||||
{{
|
||||
iqCmd=-maxDac;
|
||||
}}
|
||||
}}
|
||||
//return iqCmd;
|
||||
pshm->P[200{motid}]=iqCmd; //lowpass of Position error
|
||||
return pshm->ServoCtrl(Mptr);
|
||||
|
||||
Reference in New Issue
Block a user