Problem while controlling the second slave controller

[robodyne-robotics]

Hello,

the library works pretty well and I'm able to control one controller.
However, when I set up a master and a slave, with 0x80 and 0x81 address, the node is not able to control the second controller.

I'm able to read encoders values coming from both controllers with index 0 and index 1, but when I set the motor command to make the motors on the second controllers spin, they act weird since they start to spin very fast with no control! This is very dangerous!

When I use Motion Studio and I plug the USB from the master controller, I'm also able to see the second controller so everything works fine if I use the official software since I can also control the motors on the second controller.

I suppose there is some problem with the command routine used for the second controller in the node, I tried to check the code but I wasn't able to fix it.

Hope this issue can be solved, thank you!