motor-control: Added possibility to test pxmc_spd with timout

It seems it is not working.

diff --git a/src/motor-control/cmd_pxmc.c b/src/motor-control/cmd_pxmc.c
index 6b8999242702c14738719a71dd7f853f4975bc99..928ebfb04fd31b2da00eea156499f539713cc67d 100644 (file)
--- a/src/motor-control/cmd_pxmc.c
+++ b/src/motor-control/cmd_pxmc.c
@@ -99,11 +99,14 @@ int cmd_do_reg_hh(cmd_io_t *cmd_io, const struct cmd_des *des, char *param[])
 int cmd_do_reg_spd(cmd_io_t *cmd_io, const struct cmd_des *des, char *param[])
 {
   long val;
+  int timeout=0;
   pxmc_state_t *mcs;
   if(*param[2]!=':') return -CMDERR_OPCHAR;
   if((mcs=cmd_opchar_getreg(cmd_io,des,param))==NULL) return -CMDERR_BADREG;
   val=atol(param[3]);
-  val=pxmc_spd(mcs,val,0);
+  if (param[4])
+    timeout=atol(param[4]);
+  val=pxmc_spd(mcs,val,timeout);
   if(val<0)
     return val;
   return 0;