*** empty log message ***
This commit is contained in:
25
tecs/tecc.c
25
tecs/tecc.c
@@ -1,4 +1,6 @@
|
||||
#include <string.h>
|
||||
#include "errhdl.h"
|
||||
#include "util.h"
|
||||
#include "tecc.h"
|
||||
|
||||
static char device[80], command[80];
|
||||
@@ -10,9 +12,9 @@ pTecsClient TeccInit(char *startcmd, int port) {
|
||||
|
||||
ERR_SP(conn=(CocConn *)malloc(sizeof(*conn)));
|
||||
ERR_I(CocInitClient(conn, "", port, "#rwacs", 0, startcmd));
|
||||
CocDefFlt(tempX, CocRD);
|
||||
CocDefFlt(tempC, CocRD);
|
||||
CocDefFlt(tempP, CocRD);
|
||||
CocDefFlt(tempC, CocWR);
|
||||
CocDefFlt(tempX, CocRD);
|
||||
CocDefStr(device, CocWR);
|
||||
CocDefInt(quit, CocWR);
|
||||
CocDefCmd(command);
|
||||
@@ -34,19 +36,18 @@ char *TeccGetDev(pTecsClient conn) {
|
||||
OnError: return(NULL);
|
||||
}
|
||||
|
||||
int TeccGet3(pTecsClient conn, float temp[3]) {
|
||||
int TeccGet3(pTecsClient conn, float *tC, float *tX, float *tP) {
|
||||
ERR_I(CocCmd(conn, "tempC,tempX,tempP"));
|
||||
temp[0]=tempC;
|
||||
temp[1]=tempX;
|
||||
temp[2]=tempP;
|
||||
*tC=tempC;
|
||||
*tX=tempX;
|
||||
*tP=tempP;
|
||||
return(0);
|
||||
OnError: return(-1);
|
||||
}
|
||||
|
||||
int TeccGet(pTecsClient conn, float *temp) {
|
||||
float t[3];
|
||||
ERR_I(TeccGet3(conn, t));
|
||||
*temp=t[2];
|
||||
ERR_I(CocCmd(conn, "tempP"));
|
||||
*temp=tempP;
|
||||
return(0);
|
||||
OnError: return(-1);
|
||||
}
|
||||
@@ -65,14 +66,14 @@ int TeccSend(pTecsClient conn, char *cmd, char *reply, int replyLen) {
|
||||
str_copy(command, cmd);
|
||||
ERR_I(CocCmd(conn, "[$]"));
|
||||
cnt=40;
|
||||
util_delay(100);
|
||||
CocDelay(100);
|
||||
while (cnt>0) {
|
||||
ERR_I(CocCmd(conn, "$"));
|
||||
if (command[0]!='\0') {
|
||||
str_ncpy(reply, command, replyLen);
|
||||
return(0);
|
||||
}
|
||||
util_delay(250);
|
||||
CocDelay(250);
|
||||
cnt--;
|
||||
}
|
||||
str_ncpy(reply, "<no response>", replyLen);
|
||||
@@ -82,7 +83,7 @@ int TeccSend(pTecsClient conn, char *cmd, char *reply, int replyLen) {
|
||||
|
||||
int TeccQuitServer(pTecsClient conn) {
|
||||
quit=1;
|
||||
ERR_I(CocCmd(conn, "quit"));
|
||||
ERR_I(CocCmd(conn, "[quit]"));
|
||||
return(0);
|
||||
OnError: return(-1);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user