nikon/CANopenLinux
1
0
Fork 0
Code Activity Actions

Merge b47560caf0 into b99ab16ad5

Browse source
This commit is contained in:
ChrisPHL 2024-06-25 11:47:13 +01:00 committed by GitHub
commit 08d85e0296
No known key found for this signature in database
GPG key ID: B5690EEEBB952194
1 changed files with 18 additions and 1 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

19
cocomm/cocomm.c
View file

@ -427,7 +427,24 @@ int main (int argc, char *argv[]) {
while(fgets(commBuf, BUF_SIZE, fp) != NULL) {
size_t len = strlen(commBuf);
if (len < 1) continue;
if (len < 2) continue; // Sort out lines like "\n".
if (commBuf[0] == '#') continue; // Sort out lines starting with '#'.
if (commBuf[0] == 'P') {
// Pause script execution for given time [ms] in case line starts with 'P' followed by an unsigned integer.
uint32_t millis = 1;
uint8_t p = '\0';
uint32_t result = sscanf(commBuf, "%c %u", &p, &millis);
fprintf(errStream, "result = %u\n", result);
if (2 != result) {
fprintf(errStream, "syntax error on 'P'ause command\n");
fflush(errStream);
exit(EXIT_FAILURE);
}
fprintf(stdout, "pause %u msec...\n", millis);
fflush(stdout);
usleep(millis * 1000);
continue;
}
// send command
if (write(fd_gtw, commBuf, len) != len) { /* blocking function */