linse/sics
0
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Add posit2soft to get soft position from position

Browse Source
This commit is contained in:
Douglas Clowes
2014-05-30 12:22:31 +10:00
parent a1572f3152
commit c7a2d05832
1 changed files with 21 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

21
site_ansto/motor_dmc2280.c
View File

@ -621,6 +621,13 @@ static double posit2unit(pDMC2280Driv self, double target) {
return result; return result;
} }
static double posit2soft(pDMC2280Driv self, double target) {
double fSoft, fHard;
fHard = posit2unit(self, target);
getSoftFromHard(self, NULL, fHard, &fSoft);
return fSoft;
}
static long long posit2count(pDMC2280Driv self, double target) { static long long posit2count(pDMC2280Driv self, double target) {
return unit2count(self, posit2unit(self, target)); return unit2count(self, posit2unit(self, target));
} }
@ -6092,6 +6099,20 @@ int DMC2280Action(SConnection *pCon, SicsInterp *pSics, void *pData,
SCWrite(pCon, line, eValue); SCWrite(pCon, line, eValue);
return 1; return 1;
} }
else if(strcasecmp("posit2soft", argv[1]) == 0) {
char line[132];
if (argc > 2) {
double target;
target = strtod(argv[2], NULL);
snprintf(line, 132, "%s.posit2soft = %f",
self->name,
posit2soft(self, target));
}
else
strcpy(line, "missing value");
SCWrite(pCon, line, eValue);
return 1;
}
else if(strcasecmp("posit2unit", argv[1]) == 0) { else if(strcasecmp("posit2unit", argv[1]) == 0) {
char line[132]; char line[132];
if (argc > 2) { if (argc > 2) {