Fanuc Karel（基于 Pascal）需要帮助

Question

我的项目的任务是通过语音操纵 fanuc 机器人...问题出在机器人控制器上的 karel 中的第二个代码中...首先，在机器人通过 tcp/ip 以整数形式获取命令后，它以某种方式存储它在缓冲区中，所以下次我启动程序时，它会运行上次会话中的命令而不会磨损..这可能非常危险...所以我在卡雷尔程序 BYTES_AHEAD 中找到并尝试清除端口，但它不起作用。下一个问题是条件循环...我尝试运行多个命令，只要有循环的服务器连接重复...直到..但这也不起作用。请我需要帮助..不要知道下一步做什么...提前谢谢大家！这是我在卡雷尔的代码...

PROGRAM nikola
%NOLOCKGROUP
%NOPAUSE = ERROR + COMMAND + TPENABLE



VAR
  i,n,tmp_int,STATUS:INTEGER
  file_var:FILE
  vox_str:STRING[128]
  stat,n_bytes,entry,prog_index:INTEGER
  FINISHED:BOOLEAN
  ----------------------VANJSKE RUTINE-------------------------
  ROUTINE OPEN_FILE_(FILE_ : FILE; TAG_ : STRING) FROM LIB_FILE
  ROUTINE CLOSE_FILE_(FILE_ : FILE; TAG_ : STRING) FROM LIB_FILE
  ROUTINE WRITE_(STRING_ : STRING) FROM LIB_FILE
  ROUTINE HANDSHAKING_(ID_ : STRING; TIP_: STRING) FROM LIB_FILE
  --------------------------------------------------------------

  BEGIN
  SET_FILE_ATR(file_var, ATR_IA)
  --set the server port BEFORE doing a CONNECT
  SET_VAR(entry, '*SYSTEM*','$HOSTS_CFG[5].$SERVER_PORT',12350,STATUS)
  stat=SET_PORT_ATR (PORT_1, ATR_READAHD,1)

  --Spajanje tag-a
  WRITE TPDISPLAY('Uspostava veze sa R2...',CR)
  CLOSE_FILE_(file_var,'S5:')
  OPEN_FILE_(file_var,'S5:')

  IF IO_STATUS(file_var)<>0--inpput,output,value have to be 0 if there is connection established
  THEN FINISHED=TRUE
  ENDIF

  REPEAT
   BYTES_AHEAD (file_var, n_bytes, STAT)--catching number of bytes ready to be read
   IF (n_bytes >= 1) THEN --if there is byres to be read
   READ file_var(vox_str::1) --read byte by byte
   stat=IO_STATUS (file_var) --status of operation
   ENDIF
   UNTIL stat <> 0 --continue until there is no bytes



 REPEAT
   FINISHED=FALSE
  --Reading Command "Robovox go up" 
   REPEAT
   BYTES_AHEAD (file_var, n_bytes, STAT)--catching number of bytes ready to be read
   IF (n_bytes >= 1) THEN --if there is byres to be read
   READ file_var(vox_str::1) --read byte by byte
   stat=IO_STATUS (file_var) --status of operation
   ENDIF
   UNTIL stat <> 0 --continue until there is no bytes
   --
   IF (n_bytes = 0) THEN --is there is no bytes
   READ file_var(vox_str::3)
    ENDIF
   IF UNINIT(vox_str) THEN
    vox_str=''
   ENDIF
   IF (vox_str='120') THEN
   CALL_PROG('NIK_UP',prog_index) 
   ENDIF

--Reading command "Robovox go down"
   REPEAT
   BYTES_AHEAD (file_var, n_bytes, STAT)--catching number of bytes ready to be read
   IF (n_bytes >= 1) THEN --if there is byres to be read
   READ file_var(vox_str::1) --read byte by byte
   stat=IO_STATUS (file_var) --status of operation
   ENDIF
   UNTIL stat <> 0 --continue until there is ni bytes
   --
   IF (n_bytes = 0) THEN --if there is no bytes
   READ file_var(vox_str::3)
   ENDIF
   IF (vox_str='130') THEN
    ENDIF
   CALL_PROG('NIK_DOWN',prog_index)
   ENDIF

 UNTIL (FINISHED=TRUE)


END nikola

Answer 1

我使用这个例程来初始化缓冲区：

ROUTINE init_buffer
BEGIN
    WRITE('init buffer',CR)
    n_bytes=0
    REPEAT
        BYTES_AHEAD (file_var, n_bytes, STATUS) --Get number of bytes ready  to be read 
        WRITE('remaining byte:',n_bytes,' STATUS ',STATUS, CR)
        IF (n_bytes >= 1) THEN --there are bytes to be read 
            IF n_bytes>128 THEN
                READ file_var(init_bufs::128) 
                STATUS=IO_STATUS (rs232) --get the status of the read operation 
            else
                READ file_var(init_bufs::n_bytes) 
                STATUS=IO_STATUS (rs232) --get the status of the read operation 
            ENDIF
        ENDIF 
    UNTIL n_bytes = 0 --continue until no more bytes are left 
END init_buffer

Answer 2

您发布的代码很难阅读（缺乏缩进），有些看起来
奇数（例如，接近结尾： if (vox_str = '130') then endif

所以...这是一个更通用的回复。

尝试添加代码以在开始时初始化变量，看看问题是否存在
消失。如果是这样，则意味着代码中存在某种路径
没有设置其中一个或多个。

我：= 0；
n：= 0；
vox_str := '';
统计：= 0；
n_字节：= 0；
输入：= 0；
编程索引：= 0；

您可能还想阅读http://www.allegro.com/papers/htpp.html