25 this->axesNames = axesNames;
38 bool ok = attachAllUsingAxesNames(
polylist);
44 if (!remappedControlBoards.
subdevices[
k].isAttached())
59 allJointsBuffers.
configure(remappedControlBoards);
60 selectedJointsBuffers.
configure(remappedControlBoards);
135 <<
"multiple axes have the same name" <<
axName
137 <<
"and another on device" <<
it->second.subDeviceKey <<
"with index" <<
it->second.indexInSubDevice;
157 for(
const auto&
axesName : axesNames)
164 <<
"specified in axesNames was not found in the axes of the controlboards passed to attachAll, attachAll failed.";
180 assert(controlledJoints == (
int) axesNames.size());
184 remappedControlBoards.
lut.resize(controlledJoints);
203 for(
size_t l=0;
l < axesNames.size();
l++)
218 for (
int k = 0;
k < devices;
k++) {
237 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
238 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
242 return ReturnValue::return_code::return_value_error_generic;
251 ok = ReturnValue::return_code::return_value_error_generic;
259 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
260 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
265 return ReturnValue::return_code::return_value_error_generic;
273 return ReturnValue::return_code::return_value_error_generic;
280 for(
int l=0;
l<controlledJoints;
l++)
282 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
284 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
289 return ReturnValue::return_code::return_value_error_generic;
299 ret=ReturnValue::return_code::return_value_error_generic;
307 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
308 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
314 return ReturnValue::return_code::return_value_error_generic;
322 return ReturnValue::return_code::return_value_error_generic;
329 for(
int l=0;
l<controlledJoints;
l++)
331 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
333 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
338 return ReturnValue::return_code::return_value_error_generic;
348 ret=ReturnValue::return_code::return_value_error_generic;
356 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
357 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
362 return ReturnValue::return_code::return_value_error_generic;
370 return ReturnValue::return_code::return_value_error_generic;
377 for(
int l=0;
l<controlledJoints;
l++)
379 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
381 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
386 return ReturnValue::return_code::return_value_error_generic;
396 ret=ReturnValue::return_code::return_value_error_generic;
404 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
405 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
411 return ReturnValue::return_code::return_value_error_generic;
419 return ReturnValue::return_code::return_value_error_generic;
426 for(
int l=0;
l<controlledJoints;
l++)
428 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
429 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
434 return ReturnValue::return_code::return_value_error_generic;
444 ret=ReturnValue::return_code::return_value_error_generic;
452 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
453 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
458 return ReturnValue::return_code::return_value_error_generic;
466 return ReturnValue::return_code::return_value_error_generic;
473 for(
int l=0;
l<controlledJoints;
l++)
475 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
477 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
482 return ReturnValue::return_code::return_value_error_generic;
491 ret=ReturnValue::return_code::return_value_error_generic;
499 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
500 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
505 return ReturnValue::return_code::return_value_error_generic;
513 return ReturnValue::return_code::return_value_error_generic;
518 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
519 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
524 return ReturnValue::return_code::return_value_error_generic;
532 return ReturnValue::return_code::return_value_error_generic;
537 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
538 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
543 return ReturnValue::return_code::return_value_error_generic;
551 return ReturnValue::return_code::return_value_error_generic;
556 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
557 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
562 return ReturnValue::return_code::return_value_error_generic;
570 return ReturnValue::return_code::return_value_error_generic;
575 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
576 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
581 return ReturnValue::return_code::return_value_error_generic;
589 return ReturnValue::return_code::return_value_error_generic;
596 for(
int l=0;
l<controlledJoints;
l++)
598 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
599 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
604 return ReturnValue::return_code::return_value_error_generic;
614 ret=ReturnValue::return_code::return_value_error_generic;
623 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
624 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
629 return ReturnValue::return_code::return_value_error_generic;
637 return ReturnValue::return_code::return_value_error_generic;
644 for(
int l=0;
l<controlledJoints;
l++)
646 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
648 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
653 return ReturnValue::return_code::return_value_error_generic;
663 ret=ReturnValue::return_code::return_value_error_generic;
671 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
672 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
678 return ReturnValue::return_code::return_value_error_generic;
685 return ReturnValue::return_code::return_value_error_generic;
692 for(
int l=0;
l<controlledJoints;
l++)
694 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
696 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
702 return ReturnValue::return_code::return_value_error_generic;
712 ret=ReturnValue::return_code::return_value_error_generic;
720 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
721 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
727 return ReturnValue::return_code::return_value_error_generic;
735 return ReturnValue::return_code::return_value_error_generic;
740 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
741 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
747 return ReturnValue::return_code::return_value_error_generic;
755 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
756 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
762 return ReturnValue::return_code::return_value_error_generic;
770 return ReturnValue::return_code::return_value_error_generic;
775 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
776 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
782 return ReturnValue::return_code::return_value_error_generic;
790 return ReturnValue::return_code::return_value_error_generic;
795 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
796 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
802 return ReturnValue::return_code::return_value_error_generic;
810 return ReturnValue::return_code::return_value_error_generic;
817 for(
int l=0;
l<controlledJoints;
l++)
819 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
820 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
825 return ReturnValue::return_code::return_value_error_generic;
835 ret=ReturnValue::return_code::return_value_error_generic;
851 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
852 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
858 return ReturnValue::return_code::return_value_error_generic;
866 return ReturnValue::return_code::return_value_error_generic;
872 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
887 ok = ReturnValue::return_code::return_value_error_generic;
898 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
913 ok = ReturnValue::return_code::return_value_error_generic;
923 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
924 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
930 return ReturnValue::return_code::return_value_error_generic;
939 return ReturnValue::return_code::return_value_error_generic;
945 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
961 ok = ReturnValue::return_code::return_value_error_generic;
976 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
995 ok = ReturnValue::return_code::return_value_error_generic;
1008 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1009 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1015 return ReturnValue::return_code::return_value_error_generic;
1023 return ReturnValue::return_code::return_value_error_generic;
1029 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
1043 ok = ReturnValue::return_code::return_value_error_generic;
1054 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
1068 ok = ReturnValue::return_code::return_value_error_generic;
1078 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1079 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1085 return ReturnValue::return_code::return_value_error_generic;
1093 return ReturnValue::return_code::return_value_error_generic;
1101 for(
int l=0;
l<controlledJoints;
l++)
1103 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
1104 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
1110 return ReturnValue::return_code::return_value_error_generic;
1122 ret = ReturnValue::return_code::return_value_error_generic;
1133 for(
int j=0;j<joints.size();j++)
1137 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
1138 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
1144 return ReturnValue::return_code::return_value_error_generic;
1156 ret = ReturnValue::return_code::return_value_error_generic;
1165 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1166 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1172 return ReturnValue::return_code::return_value_error_generic;
1180 return ReturnValue::return_code::return_value_error_generic;
1186 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
1201 ok = ReturnValue::return_code::return_value_error_generic;
1212 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
1227 ok = ReturnValue::return_code::return_value_error_generic;
1237 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1238 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1244 return ReturnValue::return_code::return_value_error_generic;
1252 return ReturnValue::return_code::return_value_error_generic;
1258 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
1273 ok = ReturnValue::return_code::return_value_error_generic;
1284 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
1299 ok = ReturnValue::return_code::return_value_error_generic;
1309 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1310 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1316 return ReturnValue::return_code::return_value_error_generic;
1324 return ReturnValue::return_code::return_value_error_generic;
1330 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
1345 ok = ReturnValue::return_code::return_value_error_generic;
1360 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
1379 ok = ReturnValue::return_code::return_value_error_generic;
1392 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1393 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1399 return ReturnValue::return_code::return_value_error_generic;
1407 return ReturnValue::return_code::return_value_error_generic;
1413 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
1429 ok = ReturnValue::return_code::return_value_error_generic;
1443 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
1461 ok = ReturnValue::return_code::return_value_error_generic;
1474 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1475 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1481 return ReturnValue::return_code::return_value_error_generic;
1489 return ReturnValue::return_code::return_value_error_generic;
1495 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
1508 ok = ReturnValue::return_code::return_value_error_generic;
1519 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
1520 std::lock_guard<std::mutex>
lock2(buffers.
mutex);
1535 ok = ReturnValue::return_code::return_value_error_generic;
1546 int off = (
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1547 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
1553 return ReturnValue::return_code::return_value_error_generic;
1561 return ReturnValue::return_code::return_value_error_generic;
1568 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1569 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1575 return ReturnValue::return_code::return_value_error_generic;
1583 return ReturnValue::return_code::return_value_error_generic;
1589 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
1604 ok = ReturnValue::return_code::return_value_error_generic;
1615 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1616 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1621 return ReturnValue::return_code::return_value_error_generic;
1629 return ReturnValue::return_code::return_value_error_generic;
1636 for(
int l=0;
l<controlledJoints;
l++)
1638 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
1639 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
1644 return ReturnValue::return_code::return_value_error_generic;
1654 ret=ReturnValue::return_code::return_value_error_generic;
1662 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1663 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1669 return ReturnValue::return_code::return_value_error_generic;
1677 return ReturnValue::return_code::return_value_error_generic;
1684 for(
int l=0;
l<controlledJoints;
l++)
1686 int off = (
int) remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
1687 size_t subIndex = remappedControlBoards.
lut[
l].subControlBoardIndex;
1693 return ReturnValue::return_code::return_value_error_generic;
1703 ret = ReturnValue::return_code::return_value_error_generic;
1711 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1712 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1718 return ReturnValue::return_code::return_value_error_generic;
1726 return ReturnValue::return_code::return_value_error_generic;
1733 for(
int l=0;
l<controlledJoints;
l++)
1735 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
1736 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
1742 return ReturnValue::return_code::return_value_error_generic;
1752 ret = ReturnValue::return_code::return_value_error_generic;
1762 for(
int l=0;
l<controlledJoints;
l++)
1764 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
1765 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
1771 return ReturnValue::return_code::return_value_error_generic;
1781 ret = ReturnValue::return_code::return_value_error_generic;
1789 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1790 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1796 return ReturnValue::return_code::return_value_error_generic;
1804 return ReturnValue::return_code::return_value_error_generic;
1809 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1810 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1816 return ReturnValue::return_code::return_value_error_generic;
1824 return ReturnValue::return_code::return_value_error_generic;
1831 for(
int l=0;
l<controlledJoints;
l++)
1833 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
1834 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
1840 return ReturnValue::return_code::return_value_error_generic;
1850 ret = ReturnValue::return_code::return_value_error_generic;
1858 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
1859 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
1865 return ReturnValue::return_code::return_value_error_generic;
1873 return ReturnValue::return_code::return_value_error_generic;
1880 for(
int l=0;
l<controlledJoints;
l++)
1882 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
1883 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
1889 return ReturnValue::return_code::return_value_error_generic;
1899 ret = ReturnValue::return_code::return_value_error_generic;
1908 *num=controlledJoints;
1914 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
1915 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
1921 return ReturnValue::return_code::return_value_error_generic;
1929 return ReturnValue::return_code::return_value_error_generic;
1935 for(
int l=0;
l<controlledJoints;
l++)
1937 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
1938 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
1943 return ReturnValue::return_code::return_value_error_generic;
1952 ret=ReturnValue::return_code::return_value_error_generic;
1960 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
1961 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
1967 return ReturnValue::return_code::return_value_error_generic;
1975 return ReturnValue::return_code::return_value_error_generic;
1980 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
1981 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
1987 return ReturnValue::return_code::return_value_error_generic;
1995 return ReturnValue::return_code::return_value_error_generic;
2000 int off = (
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2001 size_t subIndex = remappedControlBoards.
lut[m].subControlBoardIndex;
2007 return ReturnValue::return_code::return_value_error_generic;
2015 return ReturnValue::return_code::return_value_error_generic;
2020 int off = (
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2021 size_t subIndex = remappedControlBoards.
lut[m].subControlBoardIndex;
2027 return ReturnValue::return_code::return_value_error_generic;
2035 return ReturnValue::return_code::return_value_error_generic;
2051 return ReturnValue::return_code::return_value_error_generic;
2056 return ReturnValue::return_code::return_value_error_generic;
2082 return ReturnValue::return_code::return_value_error_generic;
2092 ReturnValue::return_code::return_value_error_generic;
2097 ReturnValue::return_code::return_value_error_generic;
2107 return ReturnValue::return_code::return_value_error_generic;
2118 size_t subIndex = remappedControlBoards.
lut[0].subControlBoardIndex;
2123 return ReturnValue::return_code::return_value_error_generic;
2131 return ReturnValue::return_code::return_value_error_generic;
2138 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2139 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2145 return ReturnValue::return_code::return_value_error_generic;
2153 return ReturnValue::return_code::return_value_error_generic;
2160 for(
int l=0;
l<controlledJoints;
l++)
2162 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
2163 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
2168 return ReturnValue::return_code::return_value_error_generic;
2178 ret=ReturnValue::return_code::return_value_error_generic;
2187 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2188 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2194 return ReturnValue::return_code::return_value_error_generic;
2202 return ReturnValue::return_code::return_value_error_generic;
2209 for(
int l=0;
l<controlledJoints;
l++)
2211 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
2212 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
2218 return ReturnValue::return_code::return_value_error_generic;
2228 ret=ReturnValue::return_code::return_value_error_generic;
2237 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2238 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2244 return ReturnValue::return_code::return_value_error_generic;
2252 return ReturnValue::return_code::return_value_error_generic;
2257 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2258 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2264 return ReturnValue::return_code::return_value_error_generic;
2272 return ReturnValue::return_code::return_value_error_generic;
2277 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2278 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2284 return ReturnValue::return_code::return_value_error_generic;
2292 return ReturnValue::return_code::return_value_error_generic;
2299 for(
int l=0;
l<controlledJoints;
l++)
2301 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
2302 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
2306 return ReturnValue::return_code::return_value_error_generic;
2313 ret = ReturnValue::return_code::return_value_error_generic;
2323 for(
int l=0;
l<controlledJoints;
l++)
2325 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
2326 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
2332 return ReturnValue::return_code::return_value_error_generic;
2342 ret = ReturnValue::return_code::return_value_error_generic;
2350 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2351 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2357 return ReturnValue::return_code::return_value_error_generic;
2365 return ReturnValue::return_code::return_value_error_generic;
2370 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2371 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2377 return ReturnValue::return_code::return_value_error_generic;
2385 return ReturnValue::return_code::return_value_error_generic;
2392 for(
int l=0;
l<controlledJoints;
l++)
2394 int off = (
int) remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
2395 size_t subIndex = remappedControlBoards.
lut[
l].subControlBoardIndex;
2401 return ReturnValue::return_code::return_value_error_generic;
2411 ret = ReturnValue::return_code::return_value_error_generic;
2419 int off = (
int) remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2420 size_t subIndex = remappedControlBoards.
lut[m].subControlBoardIndex;
2426 return ReturnValue::return_code::return_value_error_generic;
2434 return ReturnValue::return_code::return_value_error_generic;
2441 for(
int l=0;
l<controlledJoints;
l++)
2443 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
2444 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
2450 return ReturnValue::return_code::return_value_error_generic;
2460 ret=ReturnValue::return_code::return_value_error_generic;
2470 *num=controlledJoints;
2477 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2478 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
2484 return ReturnValue::return_code::return_value_error_generic;
2492 return ReturnValue::return_code::return_value_error_generic;
2504 for(
int l=0;
l<controlledJoints;
l++)
2506 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
2507 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
2513 return ReturnValue::return_code::return_value_error_generic;
2523 ret=ReturnValue::return_code::return_value_error_generic;
2532 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2533 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
2539 return ReturnValue::return_code::return_value_error_generic;
2547 return ReturnValue::return_code::return_value_error_generic;
2552 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2553 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
2559 return ReturnValue::return_code::return_value_error_generic;
2567 return ReturnValue::return_code::return_value_error_generic;
2572 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2573 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
2579 return ReturnValue::return_code::return_value_error_generic;
2587 return ReturnValue::return_code::return_value_error_generic;
2592 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2593 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2599 return ReturnValue::return_code::return_value_error_generic;
2604 return ReturnValue::return_code::return_value_error_generic;
2612 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2613 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2619 return ReturnValue::return_code::return_value_error_generic;
2624 return ReturnValue::return_code::return_value_error_generic;
2632 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2633 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2639 return ReturnValue::return_code::return_value_error_generic;
2644 return ReturnValue::return_code::return_value_error_generic;
2652 int off = (
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2653 size_t subIndex = remappedControlBoards.
lut[m].subControlBoardIndex;
2659 return ReturnValue::return_code::return_value_error_generic;
2664 return ReturnValue::return_code::return_value_error_generic;
2672 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2673 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2679 return ReturnValue::return_code::return_value_error_generic;
2684 return ReturnValue::return_code::return_value_error_generic;
2691 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2692 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2698 return ReturnValue::return_code::return_value_error_generic;
2703 return ReturnValue::return_code::return_value_error_generic;
2711 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2712 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2718 return ReturnValue::return_code::return_value_error_generic;
2723 return ReturnValue::return_code::return_value_error_generic;
2731 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
2732 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
2738 return ReturnValue::return_code::return_value_error_generic;
2743 return ReturnValue::return_code::return_value_error_generic;
2754 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2755 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
2761 return ReturnValue::return_code::return_value_error_generic;
2769 return ReturnValue::return_code::return_value_error_generic;
2774 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2775 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
2781 return ReturnValue::return_code::return_value_error_generic;
2789 return ReturnValue::return_code::return_value_error_generic;
2794 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2795 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
2801 return ReturnValue::return_code::return_value_error_generic;
2806 return ReturnValue::return_code::return_value_error_generic;
2814 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2815 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
2821 return ReturnValue::return_code::return_value_error_generic;
2826 return ReturnValue::return_code::return_value_error_generic;
2847 int off = (
int) remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2848 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
2853 return ReturnValue::return_code::return_value_error_generic;
2861 return ReturnValue::return_code::return_value_error_generic;
2878 return ReturnValue::return_code::return_value_error_generic;
2887 return ReturnValue::return_code::return_value_error_generic;
2899 int off = (
int) remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2900 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
2905 return ReturnValue::return_code::return_value_error_generic;
2913 return ReturnValue::return_code::return_value_error_generic;
2926 for(
int l=0;
l<controlledJoints;
l++)
2944 int off = (
int) remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
2945 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
2950 return ReturnValue::return_code::return_value_error_generic;
2958 return ReturnValue::return_code::return_value_error_generic;
2972 for(
int l=0;
l<controlledJoints;
l++)
2996 return ReturnValue::return_code::return_value_error_generic;
3005 return ReturnValue::return_code::return_value_error_generic;
3022 return ReturnValue::return_code::return_value_error_generic;
3031 return ReturnValue::return_code::return_value_error_generic;
3043 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3044 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3052 return ReturnValue::return_code::return_value_error_generic;
3057 int off = (
int) remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3058 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
3067 return ReturnValue::return_code::return_value_error_generic;
3072 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3073 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3079 return ReturnValue::return_code::return_value_error_generic;
3087 return ReturnValue::return_code::return_value_error_generic;
3093 return ReturnValue::return_code::return_value_error_generic;
3099 return ReturnValue::return_code::return_value_error_generic;
3106 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3107 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3113 return ReturnValue::return_code::return_value_error_generic;
3121 return ReturnValue::return_code::return_value_error_generic;
3126 int off = (
int) remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3127 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
3133 return ReturnValue::return_code::return_value_error_generic;
3141 return ReturnValue::return_code::return_value_error_generic;
3148 for(
int l=0;
l<controlledJoints;
l++)
3150 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
3151 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
3157 return ReturnValue::return_code::return_value_error_generic;
3167 ret = ReturnValue::return_code::return_value_error_generic;
3175 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3176 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3182 return ReturnValue::return_code::return_value_error_generic;
3189 return ReturnValue::return_code::return_value_error_generic;
3195 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
3213 ok = ReturnValue::return_code::return_value_error_generic;
3224 int off = (
int) remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3225 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
3230 return ReturnValue::return_code::return_value_error_generic;
3237 return ReturnValue::return_code::return_value_error_generic;
3243 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
3262 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3263 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3269 return ReturnValue::return_code::return_value_error_generic;
3277 return ReturnValue::return_code::return_value_error_generic;
3282 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3283 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3289 return ReturnValue::return_code::return_value_error_generic;
3297 return ReturnValue::return_code::return_value_error_generic;
3302 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3303 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3309 return ReturnValue::return_code::return_value_error_generic;
3317 return ReturnValue::return_code::return_value_error_generic;
3322 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3323 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3329 return ReturnValue::return_code::return_value_error_generic;
3337 return ReturnValue::return_code::return_value_error_generic;
3342 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3343 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3349 return ReturnValue::return_code::return_value_error_generic;
3357 return ReturnValue::return_code::return_value_error_generic;
3364 for(
int l=0;
l<controlledJoints;
l++)
3366 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
3367 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
3373 return ReturnValue::return_code::return_value_error_generic;
3383 ret=ReturnValue::return_code::return_value_error_generic;
3392 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3393 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3399 return ReturnValue::return_code::return_value_error_generic;
3407 return ReturnValue::return_code::return_value_error_generic;
3414 for(
int l=0;
l<controlledJoints;
l++)
3416 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
3417 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
3423 return ReturnValue::return_code::return_value_error_generic;
3433 ret=ReturnValue::return_code::return_value_error_generic;
3441 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3442 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3448 return ReturnValue::return_code::return_value_error_generic;
3456 return ReturnValue::return_code::return_value_error_generic;
3461 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3462 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3468 return ReturnValue::return_code::return_value_error_generic;
3476 return ReturnValue::return_code::return_value_error_generic;
3481 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3482 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3488 return ReturnValue::return_code::return_value_error_generic;
3496 return ReturnValue::return_code::return_value_error_generic;
3501 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3502 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3506 return ReturnValue::return_code::return_value_error_generic;
3515 ok = ReturnValue::return_code::return_value_error_generic;
3523 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3524 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3528 return ReturnValue::return_code::return_value_error_generic;
3537 ok = ReturnValue::return_code::return_value_error_generic;
3547 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
3562 ok = ReturnValue::return_code::return_value_error_generic;
3577 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
3595 ok = ReturnValue::return_code::return_value_error_generic;
3610 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3611 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3617 return ReturnValue::return_code::return_value_error_generic;
3626 ret = ReturnValue::return_code::return_value_error_generic;
3635 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
3649 ok = ReturnValue::return_code::return_value_error_generic;
3660 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
3674 ok = ReturnValue::return_code::return_value_error_generic;
3684 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3685 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3691 return ReturnValue::return_code::return_value_error_generic;
3699 return ReturnValue::return_code::return_value_error_generic;
3705 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
3720 ok = ReturnValue::return_code::return_value_error_generic;
3731 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
3746 ok = ReturnValue::return_code::return_value_error_generic;
3759 for(
int l=0;
l<controlledJoints;
l++)
3761 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
3778 std::lock_guard<std::mutex> lock(buffers.
mutex);
3789 return buffers.
stamp;
3794 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3795 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3801 return ReturnValue::return_code::return_value_error_generic;
3810 return ReturnValue::return_code::return_value_error_generic;
3816 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
3832 ok = ReturnValue::return_code::return_value_error_generic;
3847 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
3866 ok = ReturnValue::return_code::return_value_error_generic;
3883 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
3899 ok = ReturnValue::return_code::return_value_error_generic;
3909 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3910 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
3916 return ReturnValue::return_code::return_value_error_generic;
3925 return ReturnValue::return_code::return_value_error_generic;
3932 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
3948 ok = ReturnValue::return_code::return_value_error_generic;
3962 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
3981 ok = ReturnValue::return_code::return_value_error_generic;
3994 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
3995 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
4001 return ReturnValue::return_code::return_value_error_generic;
4009 return ReturnValue::return_code::return_value_error_generic;
4015 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
4033 ok = ReturnValue::return_code::return_value_error_generic;
4047 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
4062 ok = ReturnValue::return_code::return_value_error_generic;
4075 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
4076 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
4082 return ReturnValue::return_code::return_value_error_generic;
4090 return ReturnValue::return_code::return_value_error_generic;
4096 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
4115 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
4134 ReturnValue ret = ReturnValue::return_code::return_value_error_generic;
4136 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
4142 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
4153 for(
int l=0;
l<controlledJoints;
l++)
4155 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
4156 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
4162 return ReturnValue::return_code::return_value_error_generic;
4172 ret=ReturnValue::return_code::return_value_error_generic;
4181 ReturnValue ret = ReturnValue::return_code::return_value_error_generic;;
4183 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
4189 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
4200 for(
int l=0;
l<controlledJoints;
l++)
4202 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
4203 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
4209 return ReturnValue::return_code::return_value_error_generic;
4219 ret=ReturnValue::return_code::return_value_error_generic;
4228 ReturnValue ret = ReturnValue::return_code::return_value_error_generic;
4230 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
4236 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
4247 for(
int l=0;
l<controlledJoints;
l++)
4249 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
4250 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
4256 return ReturnValue::return_code::return_value_error_generic;
4266 ret=ReturnValue::return_code::return_value_error_generic;
4275 ReturnValue ret = ReturnValue::return_code::return_value_error_generic;
4277 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
4283 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
4294 for(
int l=0;
l<controlledJoints;
l++)
4296 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
4297 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
4303 return ReturnValue::return_code::return_value_error_generic;
4313 ret=ReturnValue::return_code::return_value_error_generic;
4322 ReturnValue ret = ReturnValue::return_code::return_value_error_generic;
4324 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
4330 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
4341 for(
int l=0;
l<controlledJoints;
l++)
4343 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
4344 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
4350 return ReturnValue::return_code::return_value_error_generic;
4360 ret=ReturnValue::return_code::return_value_error_generic;
4369 ReturnValue ret = ReturnValue::return_code::return_value_error_generic;
4371 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
4377 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
4387 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
4395 if (!(p && p->
iCurr))
4397 ret = ReturnValue::return_code::return_value_error_generic;
4413 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
4432 ReturnValue ret = ReturnValue::return_code::return_value_error_generic;
4434 size_t subIndex=remappedControlBoards.
lut[m].subControlBoardIndex;
4440 int off=(
int)remappedControlBoards.
lut[m].axisIndexInSubControlBoard;
4451 for(
int l=0;
l<controlledJoints;
l++)
4453 int off=(
int)remappedControlBoards.
lut[
l].axisIndexInSubControlBoard;
4454 size_t subIndex=remappedControlBoards.
lut[
l].subControlBoardIndex;
4460 return ReturnValue::return_code::return_value_error_generic;
4470 ret=ReturnValue::return_code::return_value_error_generic;
4482 ReturnValue ret = ReturnValue::return_code::return_value_error_not_ready;
4484 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
4488 int off = (
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
4497 ReturnValue ret = ReturnValue::return_code::return_value_error_not_ready;
4499 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
4503 int off = (
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
4512 ReturnValue ret = ReturnValue::return_code::return_value_error_not_ready;
4514 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
4518 int off = (
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
4527 ReturnValue ret = ReturnValue::return_code::return_value_error_not_ready;
4529 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
4533 int off = (
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
4544 int off =
static_cast<int>(remappedControlBoards.
lut[
jnt].axisIndexInSubControlBoard);
4545 size_t subIndex = remappedControlBoards.
lut[
jnt].subControlBoardIndex;
4550 return ReturnValue::return_code::return_value_error_generic;
4557 if (
vels.size() !=
static_cast<size_t>(controlledJoints))
4559 return ReturnValue::return_code::return_value_error_method_failed;
4562 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
4570 ret = ReturnValue::return_code::return_value_error_generic;
4583 return ReturnValue::return_code::return_value_error_method_failed;
4586 std::lock_guard<std::mutex> lock(selectedJointsBuffers.
mutex);
4594 ret = ReturnValue::return_code::return_value_error_generic;
4606 int off =
static_cast<int>(remappedControlBoards.
lut[
jnt].axisIndexInSubControlBoard);
4607 size_t subIndex = remappedControlBoards.
lut[
jnt].subControlBoardIndex;
4612 return ReturnValue::return_code::return_value_error_generic;
4619 vels.resize(controlledJoints);
4621 std::lock_guard<std::mutex> lock(allJointsBuffers.
mutex);
4623 for (
int l = 0;
l < controlledJoints;
l++)
4625 int off =
static_cast<int>(remappedControlBoards.
lut[
l].axisIndexInSubControlBoard);
4626 size_t subIndex = remappedControlBoards.
lut[
l].subControlBoardIndex;
4630 ret = ReturnValue::return_code::return_value_error_generic;
4643 for (
size_t i = 0; i <
jnts.size(); ++i)
4646 int off =
static_cast<int>(remappedControlBoards.
lut[j].axisIndexInSubControlBoard);
4647 size_t subIndex = remappedControlBoards.
lut[j].subControlBoardIndex;
4651 ret = ReturnValue::return_code::return_value_error_generic;
const yarp::os::LogComponent & CONTROLBOARDREMAPPER()
bool configure(const RemappedControlBoards &remappedControlBoards)
Resize the buffers using the information in the RemappedControlBoards.
std::vector< std::vector< double > > m_bufferForSubControlBoard
std::vector< std::vector< yarp::dev::SelectableControlModeEnum > > m_bufferForSubControlBoardSelectableControlModesEnum
std::vector< std::vector< yarp::dev::InteractionModeEnum > > m_bufferForSubControlBoardInteractionModes
std::vector< std::vector< yarp::dev::ControlModeEnum > > m_bufferForSubControlBoardControlModesEnum
void fillSubControlBoardBuffersFromArbitraryJointVector(const double *arbitraryVec, const int n_joints, const int *joints, const RemappedControlBoards &remappedControlBoards)
Fill buffers for the SubControlBoard from a vector of joints of the RemappedControlBoards.
std::vector< std::vector< int > > m_jointsInSubControlBoard
void resizeSubControlBoardBuffers(const int n_joints, const int *joints, const RemappedControlBoards &remappedControlBoards)
Resize buffers to have the dimension of specified by the method (used for multi joint methods that re...
void fillArbitraryJointVectorFromSubControlBoardBuffers(double *arbitraryVec, const int n_joints, const int *joints, const RemappedControlBoards &remappedControlBoards)
Fill a vector of joints of the ControlBoardRemapper from the buffers of the SubControlBoard .
std::vector< int > m_nJointsInSubControlBoard
std::mutex mutex
Mutex to grab to use this class.
std::vector< double > dummyBuffer
std::vector< int > controlBoardModes
yarp::dev::ReturnValue getPidErrorLimit(const yarp::dev::PidControlTypeEnum &pidtype, int j, double *limit) override
Get the error limit for the controller on a specific joint.
yarp::dev::ReturnValue positionMove(int j, double ref) override
Set new reference point for a single axis.
yarp::dev::ReturnValue getImpedanceOffset(int j, double *offset) override
Get current force Offset for a specific joint.
yarp::dev::ReturnValue resetEncoders() override
Reset encoders.
yarp::dev::ReturnValue getRemoteVariablesList(yarp::os::Bottle *listOfKeys) override
yarp::dev::ReturnValue getTrajAcceleration(int j, double *acc) override
Get reference acceleration for a joint.
yarp::dev::ReturnValue getTemperature(int m, double *val) override
Get temperature of a motor.
yarp::dev::ReturnValue getPid(const yarp::dev::PidControlTypeEnum &pidtype, int j, yarp::dev::Pid *p) override
Get current PID value for a specific joint.
yarp::dev::ReturnValue setControlModes(const std::vector< int > &joints, const std::vector< yarp::dev::SelectableControlModeEnum > &modes) override
Set the current control mode for a subset of axes.
yarp::dev::ReturnValue setPidErrorLimits(const yarp::dev::PidControlTypeEnum &pidtype, const double *limits) override
Get the error limit for the controller on all joints.
yarp::dev::ReturnValue setPidFeedforward(const yarp::dev::PidControlTypeEnum &pidtype, int j, double v) override
Set the feedforward value for the specified PID controller.
yarp::dev::ReturnValue calibrateWholePart() override
calibrateWholePart: call the procedure for calibrating the whole device
yarp::dev::ReturnValue getMotorEncoders(double *encs) override
Read the position of all motor encoders.
yarp::dev::IRemoteCalibrator * getCalibratorDevice() override
getCalibratorDevice: return the pointer stored with the setCalibratorDevice
yarp::dev::ReturnValue getPidOutput(const yarp::dev::PidControlTypeEnum &pidtype, int j, double *out) override
Get the output of the controller (e.g.
yarp::dev::ReturnValue getPWM(int m, double *val) override
yarp::dev::ReturnValue setMaxCurrent(int j, double v) override
yarp::dev::ReturnValue getRefDutyCycles(double *refs) override
Gets the last reference sent using the setRefDutyCycles function.
yarp::dev::ReturnValue setPidErrorLimit(const yarp::dev::PidControlTypeEnum &pidtype, int j, double limit) override
Set the error limit for the controller on a specific joint.
yarp::dev::ReturnValue getEncoderTimed(int j, double *v, double *t) override
Read the instantaneous acceleration of all axes.
yarp::dev::ReturnValue getControlMode(int j, yarp::dev::ControlModeEnum &mode) override
Get the current control mode.
yarp::dev::ReturnValue setCalibrationParameters(int j, const yarp::dev::CalibrationParameters ¶ms) override
Start calibration, this method is very often platform specific.
yarp::dev::ReturnValue getMotorEncoderSpeed(int m, double *sp) override
Read the instantaneous speed of a motor encoder.
yarp::dev::ReturnValue getPosLimits(int j, double *min, double *max) override
Get the software limits for a particular axis.
yarp::dev::ReturnValue getAvailableControlModes(int j, std::vector< yarp::dev::SelectableControlModeEnum > &avail) override
Return a list of available control mode for the given joint.
yarp::dev::ReturnValue setRefDutyCycle(int m, double ref) override
Sets the reference dutycycle to a single motor.
yarp::dev::ReturnValue setNominalCurrent(int m, const double val) override
yarp::dev::ReturnValue getTemperatures(double *vals) override
Get temperature of all the motors.
yarp::dev::ReturnValue setTrajSpeeds(const double *spds) override
Set reference speed on all joints.
yarp::dev::ReturnValue getNominalCurrent(int m, double *val) override
yarp::dev::ReturnValue getCurrent(int m, double *curr) override
Get the instantaneous current measurement for a single motor.
yarp::dev::ReturnValue getAmpStatus(int *st) override
yarp::dev::ReturnValue getPidExtraInfo(const yarp::dev::PidControlTypeEnum &pidtype, int j, yarp::dev::PidExtraInfo &units) override
Get PID extra info and measurement units for a specific joint.
yarp::dev::ReturnValue setPeakCurrent(int m, const double val) override
yarp::dev::ReturnValue getCurrentRanges(double *min, double *max) override
Get the full scale of the current measurements for all motors motor (e.g.
yarp::dev::ReturnValue getPids(const yarp::dev::PidControlTypeEnum &pidtype, yarp::dev::Pid *pids) override
Get current PID value for a specific joint.
yarp::dev::ReturnValue disableAmp(int j) override
Disable the amplifier on a specific joint.
yarp::dev::ReturnValue getNumberOfMotorEncoders(int *num) override
Get the number of available motor encoders.
yarp::dev::ReturnValue setControlMode(int j, yarp::dev::SelectableControlModeEnum mode) override
Set the current control mode.
yarp::dev::ReturnValue getEncoderAcceleration(int j, double *acc) override
Read the instantaneous acceleration of an axis.
yarp::dev::ReturnValue setPositions(const int n_joints, const int *joints, const double *dpos) override
Set new reference point for all axes.
yarp::dev::ReturnValue getRefCurrents(double *currs) override
Get the reference value of the currents for all motors.
yarp::dev::ReturnValue setAutoBrakeEnabled(int j, bool enabled) override
Enables/Disables the automatic joint brake.
yarp::dev::ReturnValue getTemperatureLimit(int m, double *val) override
Retrieves the current temperature limit for a specific motor.
yarp::dev::ReturnValue getRefPosition(const int joint, double *ref) override
Get the last position reference for the specified axis.
void setAxesNames(const std::vector< std::string > &axesNames)
yarp::dev::ReturnValue getLastJointFault(int j, int &fault, std::string &message) override
yarp::dev::ReturnValue getTorque(int j, double *t) override
Get the value of the torque on a given joint (this is the feedback if you have a torque sensor).
yarp::dev::ReturnValue setPids(const yarp::dev::PidControlTypeEnum &pidtype, const yarp::dev::Pid *ps) override
Set new PID value on multiple axes.
yarp::dev::ReturnValue setInteractionModes(const std::vector< int > &joints, const std::vector< yarp::dev::InteractionModeEnum > &modes) override
Set the interaction mode of the robot for a set of joints, values can be stiff or compliant.
yarp::dev::ReturnValue abortPark() override
yarp::dev::ReturnValue getCurrentImpedanceLimit(int j, double *min_stiff, double *max_stiff, double *min_damp, double *max_damp) override
Get the current impedance limits for a specific joint.
yarp::dev::ReturnValue getRefTorque(int j, double *t) override
Get the reference value of the torque for a given joint.
yarp::dev::ReturnValue getTorqueRanges(double *min, double *max) override
Get the full scale of the torque sensors of all joints.
yarp::dev::ReturnValue isPidEnabled(const yarp::dev::PidControlTypeEnum &pidtype, int j, bool &enabled) override
Get the current status (enabled/disabled) of the PID.
yarp::dev::ReturnValue homingSingleJoint(int j) override
homingSingleJoint: call the homing procedure for a single joint
yarp::dev::ReturnValue enableAmp(int j) override
Enable the amplifier on a specific joint.
yarp::dev::ReturnValue resetPid(const yarp::dev::PidControlTypeEnum &pidtype, int j) override
Reset the controller of a given joint, usually sets the current status of the joint as the reference ...
yarp::dev::ReturnValue getMotorEncoder(int m, double *v) override
Read the value of a motor encoder.
yarp::dev::ReturnValue getTargetVelocities(double *vels) override
Get the last reference speed set by velocityMove for all joints.
yarp::dev::ReturnValue parkSingleJoint(int j, bool _wait=true) override
parkSingleJoint(): start the parking procedure for the single joint
yarp::dev::ReturnValue getTrajSpeed(int j, double *ref) override
Get reference speed for a joint.
yarp::dev::ReturnValue getTargetVelocity(const int joint, double *vel) override
Get the last reference speed set by velocityMove for single joint.
yarp::dev::ReturnValue setEncoders(const double *vals) override
Set the value of all encoders.
yarp::dev::ReturnValue getInteractionMode(int j, yarp::dev::InteractionModeEnum &mode) override
Get the current interaction mode of the robot, values can be stiff or compliant.
yarp::dev::ReturnValue setVelLimits(int j, double min, double max) override
Set the software speed limits for a particular axis, the behavior of the control card when these limi...
yarp::dev::ReturnValue getEncoderSpeed(int j, double *sp) override
Read the istantaneous speed of an axis.
yarp::dev::ReturnValue getRefCurrent(int m, double *curr) override
Get the reference value of the current for a single motor.
yarp::dev::ReturnValue getRemoteVariable(std::string key, yarp::os::Bottle &val) override
yarp::dev::ReturnValue getAutoBrakeEnabled(int j, bool &enabled) const override
checks if the automatic joint brake mode is enabled or disabled.
yarp::dev::ReturnValue setPWMLimit(int m, const double val) override
yarp::dev::ReturnValue calibrationDone(int j) override
Check if the calibration is terminated, on a particular joint.
yarp::dev::ReturnValue parkWholePart() override
parkWholePart: start the parking procedure for the whole part
yarp::dev::ReturnValue getPidError(const yarp::dev::PidControlTypeEnum &pidtype, int j, double *err) override
Get the current error for a joint.
yarp::dev::ReturnValue getMotorTorqueParams(int j, yarp::dev::MotorTorqueParameters *params) override
Get a subset of motor parameters (bemf, ktau etc) useful for torque control.
yarp::dev::ReturnValue getRefTorques(double *refs) override
Get the reference value of the torque for all joints.
yarp::dev::ReturnValue isJointBraked(int j, bool &braked) const override
Check is the joint brake is currently active.
yarp::dev::ReturnValue getJointType(int j, yarp::dev::JointTypeEnum &type) override
yarp::dev::ReturnValue getTargetPosition(const int joint, double *ref) override
Get the last position reference for the specified axis.
yarp::dev::ReturnValue getTorqueRange(int j, double *min, double *max) override
Get the full scale of the torque sensor of a given joint.
yarp::dev::ReturnValue setPosLimits(int j, double min, double max) override
Set the software limits for a particular axis, the behavior of the control card when these limits are...
yarp::dev::ReturnValue getInteractionModes(const std::vector< int > &joints, std::vector< yarp::dev::InteractionModeEnum > &modes) override
Get the current interaction mode of the robot for a set of joints, values can be stiff or compliant.
yarp::dev::ReturnValue getPidReference(const yarp::dev::PidControlTypeEnum &pidtype, int j, double *ref) override
Get the current reference of the PID controller for a specific joint.
yarp::dev::ReturnValue getPeakCurrent(int m, double *val) override
yarp::dev::ReturnValue getRefPositions(double *refs) override
Get the last position reference for all axes.
yarp::dev::ReturnValue setManualBrakeActive(int j, bool active) override
Enables/Disables manually the joint brake.
yarp::dev::ReturnValue setPidReferences(const yarp::dev::PidControlTypeEnum &pidtype, const double *refs) override
Set the controller reference, multiple axes.
yarp::dev::ReturnValue setGearboxRatio(int m, const double val) override
Set the gearbox ratio for a specific motor.
yarp::dev::ReturnValue getAxisName(int j, std::string &name) override
yarp::dev::ReturnValue setPid(const yarp::dev::PidControlTypeEnum &pidtype, int j, const yarp::dev::Pid &p) override
Set new PID value for a joint axis.
yarp::dev::ReturnValue setTrajAccelerations(const double *accs) override
Set reference acceleration on all joints.
yarp::dev::ReturnValue getPidErrors(const yarp::dev::PidControlTypeEnum &pidtype, double *errs) override
Get the error of all joints.
yarp::dev::ReturnValue getGearboxRatio(int m, double *val) override
Get the gearbox ratio for a specific motor.
yarp::dev::ReturnValue getRefVelocity(const int jnt, double &vel) override
Get the last reference velocity set by setRefVelocity() for a single joint.
yarp::dev::ReturnValue getAxes(size_t &ax) override
Get the number of controlled axes.
yarp::dev::ReturnValue getTorques(double *t) override
Get the value of the torque for all joints (this is the feedback if you have torque sensors).
yarp::dev::ReturnValue enablePid(const yarp::dev::PidControlTypeEnum &pidtype, int j) override
Enable the PID computation for a joint.
yarp::dev::ReturnValue getMotorEncoderCountsPerRevolution(int m, double *cpr) override
Gets number of counts per revolution for motor encoder m.
yarp::dev::ReturnValue setMotorEncoder(int m, const double val) override
Set the value of the motor encoder for a given motor.
yarp::dev::ReturnValue quitPark() override
quitPark: interrupt the park procedure
yarp::dev::ReturnValue getMotorEncoderTimed(int m, double *v, double *t) override
Read the instantaneous position of a motor encoder.
yarp::dev::ReturnValue getImpedance(int j, double *stiff, double *damp) override
Get current impedance gains (stiffness,damping,offset) for a specific joint.
yarp::dev::ReturnValue getEncodersTimed(double *encs, double *t) override
Read the instantaneous acceleration of all axes.
yarp::dev::ReturnValue setPidReference(const yarp::dev::PidControlTypeEnum &pidtype, int j, double ref) override
Set the controller reference for a given axis.
yarp::dev::ReturnValue setRefTorque(int j, double t) override
Set the reference value of the torque for a given joint.
yarp::dev::ReturnValue calibrateSingleJoint(int j) override
calibrateSingleJoint: call the calibration procedure for the single joint
yarp::dev::ReturnValue getPWMLimit(int m, double *val) override
yarp::dev::ReturnValue stop() override
Stop motion, multiple joints.
yarp::dev::ReturnValue getPidExtraInfos(const yarp::dev::PidControlTypeEnum &pidtype, std::vector< yarp::dev::PidExtraInfo > &units) override
Get PID extra info and measurement units for a specific joint.
yarp::dev::ReturnValue homingWholePart() override
homingWholePart: call the homing procedure for a the whole part/device
yarp::dev::ReturnValue resetMotorEncoders() override
Reset motor encoders.
yarp::dev::ReturnValue setMotorEncoderCountsPerRevolution(int m, const double cpr) override
Sets number of counts per revolution for motor encoder m.
yarp::dev::ReturnValue setRefVelocity(int jnt, double vel) override
Set the velocity of single joint.
yarp::dev::ReturnValue getDutyCycle(int m, double *val) override
Gets the current dutycycle of the output of the amplifier (i.e.
yarp::dev::ReturnValue getMotorEncoderAccelerations(double *accs) override
Read the instantaneous acceleration of all motor encoders.
yarp::dev::ReturnValue calibrateAxisWithParams(int j, unsigned int ui, double v1, double v2, double v3) override
Start calibration, this method is very often platform specific.
yarp::dev::ReturnValue setRefTorques(const double *t) override
Set the reference value of the torque for all joints.
yarp::dev::ReturnValue getControlModes(const std::vector< int > &joints, std::vector< yarp::dev::ControlModeEnum > &modes) override
Get the current control mode for a subset of axes.
yarp::dev::ReturnValue getPidFeedforward(const yarp::dev::PidControlTypeEnum &pidtype, int j, double &v) override
Get the currently set feedforward value for the specified PID controller.
yarp::dev::ReturnValue getCurrents(double *currs) override
Get the instantaneous current measurement for all motors.
yarp::dev::ReturnValue disablePid(const yarp::dev::PidControlTypeEnum &pidtype, int j) override
Disable the PID computation for a joint.
yarp::dev::ReturnValue isCalibratorDevicePresent(bool *isCalib) override
isCalibratorDevicePresent: check if a calibrator device has been set
yarp::dev::ReturnValue getPidErrorLimits(const yarp::dev::PidControlTypeEnum &pidtype, double *limits) override
Get the error limit for all controllers.
yarp::dev::ReturnValue resetMotorEncoder(int m) override
Reset motor encoder, single motor.
yarp::dev::ReturnValue getMaxCurrent(int j, double *v) override
Returns the maximum electric current allowed for a given motor.
yarp::dev::ReturnValue quitCalibrate() override
quitCalibrate: interrupt the calibration procedure
yarp::dev::ReturnValue setRemoteVariable(std::string key, const yarp::os::Bottle &val) override
yarp::dev::ReturnValue getTrajAccelerations(double *accs) override
Get reference acceleration of all joints.
yarp::dev::ReturnValue setMotorTorqueParams(int j, const yarp::dev::MotorTorqueParameters params) override
Set a subset of motor parameters (bemf, ktau etc) useful for torque control.
bool attachAllDevices(const yarp::dev::PolyDriverList &l)
yarp::dev::ReturnValue getEncoderSpeeds(double *spds) override
Read the instantaneous speed of all axes.
yarp::dev::ReturnValue setEncoder(int j, double val) override
Set the value of the encoder for a given joint.
yarp::dev::ReturnValue getPidOutputs(const yarp::dev::PidControlTypeEnum &pidtype, double *outs) override
Get the output of the controllers (e.g.
yarp::dev::ReturnValue getPidOffset(const yarp::dev::PidControlTypeEnum &pidtype, int j, double &v) override
Get the currently set offset value for the specified PID controller.
yarp::dev::ReturnValue getMotorEncodersTimed(double *encs, double *t) override
Read the instantaneous position of all motor encoders.
void setNrOfControlledAxes(const size_t nrOfControlledAxes)
Set the number of controlled axes, resizing appropriately all the necessary buffers.
yarp::dev::ReturnValue getRefDutyCycle(int m, double *ref) override
Gets the last reference sent using the setRefDutyCycle function.
yarp::os::Stamp getLastInputStamp() override
Return the time stamp relative to the last acquisition.
yarp::dev::ReturnValue getPidReferences(const yarp::dev::PidControlTypeEnum &pidtype, double *refs) override
Get the current reference of all PID controllers.
yarp::dev::ReturnValue setImpedanceOffset(int j, double offset) override
Set current force Offset for a specific joint.
yarp::dev::ReturnValue setTemperatureLimit(int m, const double val) override
Set the temperature limit for a specific motor.
yarp::dev::ReturnValue abortCalibration() override
yarp::dev::ReturnValue getMotorEncoderSpeeds(double *spds) override
Read the instantaneous speed of all motor encoders.
yarp::dev::ReturnValue getCurrentRange(int m, double *min, double *max) override
Get the full scale of the current measurement for a given motor (e.g.
yarp::dev::ReturnValue setImpedance(int j, double stiff, double damp) override
Set current impedance gains (stiffness,damping) for a specific joint.
yarp::dev::ReturnValue getTrajSpeeds(double *spds) override
Get reference speed of all joints.
yarp::dev::ReturnValue getTargetPositions(double *refs) override
Get the last position reference for all axes.
yarp::dev::ReturnValue getPowerSupplyVoltage(int m, double *val) override
yarp::dev::ReturnValue getEncoders(double *encs) override
Read the position of all axes.
yarp::dev::ReturnValue getNumberOfMotors(int *num) override
Retrieves the number of controlled motors from the current physical interface.
yarp::dev::ReturnValue setTrajAcceleration(int j, double acc) override
Set reference acceleration for a joint.
yarp::dev::ReturnValue getMotorEncoderAcceleration(int m, double *acc) override
Read the instantaneous acceleration of a motor encoder.
yarp::dev::ReturnValue getEncoderAccelerations(double *accs) override
Read the instantaneous acceleration of all axes.
yarp::dev::ReturnValue setRefCurrents(const double *currs) override
Set the reference value of the currents for all motors.
yarp::dev::ReturnValue setPosition(int j, double ref) override
Set new position for a single axis.
yarp::dev::ReturnValue velocityMove(int j, double v) override
Start motion at a given speed, single joint.
yarp::dev::ReturnValue checkMotionDone(int j, bool &flag) override
Check if the current trajectory is terminated.
yarp::dev::ReturnValue resetEncoder(int j) override
Reset encoder, single joint.
yarp::dev::ReturnValue getAvailablePids(int j, std::vector< yarp::dev::PidControlTypeEnum > &avail) override
ControlBoard methods.
yarp::dev::ReturnValue setRefDutyCycles(const double *refs) override
Sets the reference dutycycle for all the motors.
yarp::dev::ReturnValue getVelLimits(int j, double *min, double *max) override
Get the software speed limits for a particular axis.
yarp::dev::ReturnValue getEncoder(int j, double *v) override
Read the value of an encoder.
yarp::dev::ReturnValue setRefCurrent(int m, double curr) override
Set the reference value of the current for a single motor.
yarp::dev::ReturnValue setTrajSpeed(int j, double sp) override
Set reference speed for a joint, this is the speed used during the interpolation of the trajectory.
yarp::dev::ReturnValue relativeMove(int j, double delta) override
Set relative position.
yarp::dev::ReturnValue setInteractionMode(int j, yarp::dev::InteractionModeEnum mode) override
Set the interaction mode of the robot, values can be stiff or compliant.
yarp::dev::ReturnValue setMotorEncoders(const double *vals) override
Set the value of all motor encoders.
yarp::dev::ReturnValue setPidOffset(const yarp::dev::PidControlTypeEnum &pidtype, int j, double v) override
Set an offset value for a given controller.
yarp::dev::ReturnValue getDutyCycles(double *vals) override
Gets the current dutycycle of the output of the amplifier (i.e.
std::vector< int > m_nJointsInSubControlBoard
bool configure(const RemappedControlBoards &remappedControlBoards)
Resize the buffers using the information in the RemappedControlBoards.
std::mutex mutex
Mutex to grab to use this class.
std::vector< std::vector< int > > m_jointsInSubControlBoard
void fillCompleteJointVectorFromSubControlBoardBuffers(double *full, const RemappedControlBoards &remappedControlBoards)
Fill a vector of joints of the ControlBoardRemapper from the buffers of the SubControlBoard .
void fillSubControlBoardBuffersFromCompleteJointVector(const double *full, const RemappedControlBoards &remappedControlBoards)
Fill buffers for the SubControlBoard from a vector of joints of the RemappedControlBoards.
std::vector< std::vector< double > > m_bufferForSubControlBoard
std::vector< std::vector< yarp::dev::ControlModeEnum > > m_bufferForSubControlBoardControlModesEnum
std::vector< std::vector< yarp::dev::SelectableControlModeEnum > > m_bufferForSubControlBoardSelectableControlModesEnum
std::vector< std::vector< yarp::dev::InteractionModeEnum > > m_bufferForSubControlBoardInteractionModes
size_t getNrOfSubControlBoards() const
std::vector< RemappedSubControlBoard > subdevices
Vector of dimension getNrOfSubControlBoards .
std::vector< RemappedAxis > lut
Vector of dimension getNrOfRemappedAxes .
RemappedSubControlBoard * getSubControlBoard(size_t i)
Given a controlboard index between 0 and getNrOfSubControlBoards()-1, return the relative SubControlB...
yarp::dev::IPositionControl * pos
yarp::dev::IImpedanceControl * iImpedance
yarp::dev::IAmplifierControl * amp
yarp::dev::IEncodersTimed * iJntEnc
yarp::dev::IInteractionMode * iInteract
yarp::dev::IRemoteVariables * iVar
yarp::dev::ICurrentControl * iCurr
yarp::dev::ITorqueControl * iTorque
yarp::dev::IVelocityControl * vel
yarp::dev::IControlMode * iMode
yarp::dev::IJointFault * iFault
yarp::dev::IVelocityDirect * iVelDir
yarp::dev::IPositionDirect * posDir
yarp::dev::IRemoteCalibrator * remcalib
yarp::dev::IPidControl * pid
yarp::dev::IAxisInfo * info
yarp::dev::IControlLimits * lim
yarp::dev::IMotor * imotor
yarp::dev::IJointBrake * iBrake
yarp::dev::IPWMControl * iPwm
yarp::dev::IControlCalibration * calib
yarp::dev::IMotorEncoders * iMotEnc
yarp::dev::IPreciselyTimed * iTimed
virtual yarp::dev::ReturnValue setPWMLimit(int j, const double val)=0
virtual yarp::dev::ReturnValue setNominalCurrent(int m, const double val)=0
virtual yarp::dev::ReturnValue getPeakCurrent(int m, double *val)=0
virtual yarp::dev::ReturnValue getPWMLimit(int j, double *val)=0
virtual yarp::dev::ReturnValue setPeakCurrent(int m, const double val)=0
virtual yarp::dev::ReturnValue getMaxCurrent(int j, double *v)=0
Returns the maximum electric current allowed for a given motor.
virtual yarp::dev::ReturnValue getPWM(int j, double *val)=0
virtual yarp::dev::ReturnValue getAmpStatus(int *st)=0
virtual yarp::dev::ReturnValue setMaxCurrent(int j, double v)=0
virtual yarp::dev::ReturnValue getNominalCurrent(int m, double *val)=0
virtual yarp::dev::ReturnValue enableAmp(int j)=0
Enable the amplifier on a specific joint.
virtual yarp::dev::ReturnValue getPowerSupplyVoltage(int j, double *val)=0
Interface for getting information about specific axes, if available.
virtual yarp::dev::ReturnValue getJointType(int axis, yarp::dev::JointTypeEnum &type)
virtual yarp::dev::ReturnValue getAxisName(int axis, std::string &name)=0
virtual yarp::dev::ReturnValue calibrationDone(int j)=0
Check if the calibration is terminated, on a particular joint.
virtual yarp::dev::ReturnValue calibrateAxisWithParams(int axis, unsigned int type, double p1, double p2, double p3)=0
Start calibration, this method is very often platform specific.
virtual yarp::dev::ReturnValue setCalibrationParameters(int axis, const CalibrationParameters ¶ms)=0
Start calibration, this method is very often platform specific.
virtual yarp::dev::ReturnValue setPosLimits(int axis, double min, double max)=0
Set the software limits for a particular axis, the behavior of the control card when these limits are...
virtual yarp::dev::ReturnValue getVelLimits(int axis, double *min, double *max)=0
Get the software speed limits for a particular axis.
virtual yarp::dev::ReturnValue getPosLimits(int axis, double *min, double *max)=0
Get the software limits for a particular axis.
virtual yarp::dev::ReturnValue setVelLimits(int axis, double min, double max)=0
Set the software speed limits for a particular axis, the behavior of the control card when these limi...
virtual yarp::dev::ReturnValue getControlMode(int j, yarp::dev::ControlModeEnum &mode)=0
Get the current control mode.
virtual yarp::dev::ReturnValue getControlModes(std::vector< yarp::dev::ControlModeEnum > &mode)=0
Get the current control mode (multiple joints).
virtual yarp::dev::ReturnValue setControlModes(const std::vector< int > &joints, const std::vector< yarp::dev::SelectableControlModeEnum > &mode)=0
Set the current control mode for a subset of axes.
virtual yarp::dev::ReturnValue setControlMode(int j, yarp::dev::SelectableControlModeEnum mode)=0
Set the current control mode.
virtual yarp::dev::ReturnValue getAvailableControlModes(int j, std::vector< yarp::dev::SelectableControlModeEnum > &avail)=0
Return a list of available control mode for the given joint.
virtual yarp::dev::ReturnValue setRefCurrent(int m, double curr)=0
Set the reference value of the current for a single motor.
virtual yarp::dev::ReturnValue setRefCurrents(const double *currs)=0
Set the reference value of the currents for all motors.
virtual yarp::dev::ReturnValue getCurrent(int m, double *curr)=0
Get the instantaneous current measurement for a single motor.
virtual yarp::dev::ReturnValue getCurrentRange(int m, double *min, double *max)=0
Get the full scale of the current measurement for a given motor (e.g.
virtual yarp::dev::ReturnValue getRefCurrent(int m, double *curr)=0
Get the reference value of the current for a single motor.
virtual yarp::dev::ReturnValue getEncoderTimed(int j, double *encs, double *time)=0
Read the instantaneous acceleration of all axes.
Control board, encoder interface.
virtual yarp::dev::ReturnValue getEncoderAcceleration(int j, double *spds)=0
Read the instantaneous acceleration of an axis.
virtual yarp::dev::ReturnValue getEncoderSpeed(int j, double *sp)=0
Read the istantaneous speed of an axis.
virtual yarp::dev::ReturnValue getEncoder(int j, double *v)=0
Read the value of an encoder.
virtual yarp::dev::ReturnValue resetEncoder(int j)=0
Reset encoder, single joint.
virtual yarp::dev::ReturnValue setEncoder(int j, double val)=0
Set the value of the encoder for a given joint.
virtual yarp::dev::ReturnValue getCurrentImpedanceLimit(int j, double *min_stiff, double *max_stiff, double *min_damp, double *max_damp)=0
Get the current impedance limits for a specific joint.
virtual yarp::dev::ReturnValue getImpedance(int j, double *stiffness, double *damping)=0
Get current impedance gains (stiffness,damping,offset) for a specific joint.
virtual yarp::dev::ReturnValue getImpedanceOffset(int j, double *offset)=0
Get current force Offset for a specific joint.
virtual yarp::dev::ReturnValue setImpedanceOffset(int j, double offset)=0
Set current force Offset for a specific joint.
virtual yarp::dev::ReturnValue setImpedance(int j, double stiffness, double damping)=0
Set current impedance gains (stiffness,damping) for a specific joint.
virtual yarp::dev::ReturnValue setInteractionModes(const std::vector< int > &joints, const std::vector< yarp::dev::InteractionModeEnum > &modes)=0
Set the interaction mode of the robot for a set of joints, values can be stiff or compliant.
virtual yarp::dev::ReturnValue getInteractionMode(int axis, yarp::dev::InteractionModeEnum &mode)=0
Get the current interaction mode of the robot, values can be stiff or compliant.
virtual yarp::dev::ReturnValue setInteractionMode(int axis, yarp::dev::InteractionModeEnum mode)=0
Set the interaction mode of the robot, values can be stiff or compliant.
virtual yarp::dev::ReturnValue getInteractionModes(const std::vector< int > &joints, std::vector< yarp::dev::InteractionModeEnum > &modes)=0
Get the current interaction mode of the robot for a set of joints, values can be stiff or compliant.
virtual yarp::dev::ReturnValue setAutoBrakeEnabled(int j, bool enabled)=0
Enables/Disables the automatic joint brake.
virtual yarp::dev::ReturnValue isJointBraked(int j, bool &braked) const =0
Check is the joint brake is currently active.
virtual yarp::dev::ReturnValue getAutoBrakeEnabled(int j, bool &enabled) const =0
checks if the automatic joint brake mode is enabled or disabled.
virtual yarp::dev::ReturnValue setManualBrakeActive(int j, bool active)=0
Enables/Disables manually the joint brake.
virtual yarp::dev::ReturnValue getLastJointFault(int j, int &fault, std::string &message)=0
virtual yarp::dev::ReturnValue getMotorEncoderSpeed(int m, double *sp)=0
Read the instantaneous speed of a motor encoder.
virtual yarp::dev::ReturnValue getMotorEncoderAcceleration(int m, double *acc)=0
Read the instantaneous acceleration of a motor encoder.
virtual yarp::dev::ReturnValue setMotorEncoder(int m, const double val)=0
Set the value of the motor encoder for a given motor.
virtual yarp::dev::ReturnValue getMotorEncoderCountsPerRevolution(int m, double *cpr)=0
Gets number of counts per revolution for motor encoder m.
virtual yarp::dev::ReturnValue resetMotorEncoder(int m)=0
Reset motor encoder, single motor.
virtual yarp::dev::ReturnValue setMotorEncoderCountsPerRevolution(int m, const double cpr)=0
Sets number of counts per revolution for motor encoder m.
virtual yarp::dev::ReturnValue getMotorEncoder(int m, double *v)=0
Read the value of a motor encoder.
virtual yarp::dev::ReturnValue getMotorEncoderTimed(int m, double *encs, double *time)=0
Read the instantaneous position of a motor encoder.
virtual yarp::dev::ReturnValue getTemperatureLimit(int m, double *temp)=0
Retrieves the current temperature limit for a specific motor.
virtual yarp::dev::ReturnValue setGearboxRatio(int m, const double val)=0
Set the gearbox ratio for a specific motor.
virtual yarp::dev::ReturnValue getTemperature(int m, double *val)=0
Get temperature of a motor.
virtual yarp::dev::ReturnValue getGearboxRatio(int m, double *val)=0
Get the gearbox ratio for a specific motor.
virtual yarp::dev::ReturnValue setTemperatureLimit(int m, const double temp)=0
Set the temperature limit for a specific motor.
virtual yarp::dev::ReturnValue getDutyCycle(int m, double *val)=0
Gets the current dutycycle of the output of the amplifier (i.e.
virtual yarp::dev::ReturnValue setRefDutyCycle(int m, double ref)=0
Sets the reference dutycycle to a single motor.
virtual yarp::dev::ReturnValue getRefDutyCycle(int m, double *ref)=0
Gets the last reference sent using the setRefDutyCycle function.
virtual yarp::dev::ReturnValue disablePid(const PidControlTypeEnum &pidtype, int j)=0
Disable the PID computation for a joint.
virtual yarp::dev::ReturnValue getPidErrorLimit(const PidControlTypeEnum &pidtype, int j, double *limit)=0
Get the error limit for the controller on a specific joint.
virtual yarp::dev::ReturnValue getPidOutput(const PidControlTypeEnum &pidtype, int j, double *out)=0
Get the output of the controller (e.g.
virtual yarp::dev::ReturnValue getPidFeedforward(const PidControlTypeEnum &pidtype, int j, double &v)=0
Get the currently set feedforward value for the specified PID controller.
virtual yarp::dev::ReturnValue getPidOffset(const PidControlTypeEnum &pidtype, int j, double &v)=0
Get the currently set offset value for the specified PID controller.
virtual yarp::dev::ReturnValue isPidEnabled(const PidControlTypeEnum &pidtype, int j, bool &enabled)=0
Get the current status (enabled/disabled) of the PID.
virtual yarp::dev::ReturnValue resetPid(const PidControlTypeEnum &pidtype, int j)=0
Reset the controller of a given joint, usually sets the current status of the joint as the reference ...
virtual yarp::dev::ReturnValue getAvailablePids(int j, std::vector< PidControlTypeEnum > &avail)=0
Return a list of available pid types mode for the given joint.
virtual yarp::dev::ReturnValue getPidExtraInfo(const PidControlTypeEnum &pidtype, int j, yarp::dev::PidExtraInfo &info)=0
Get PID extra info and measurement units for a specific joint.
virtual yarp::dev::ReturnValue setPidReference(const PidControlTypeEnum &pidtype, int j, double ref)=0
Set the controller reference for a given axis.
virtual yarp::dev::ReturnValue setPidErrorLimit(const PidControlTypeEnum &pidtype, int j, double limit)=0
Set the error limit for the controller on a specific joint.
virtual yarp::dev::ReturnValue setPid(const PidControlTypeEnum &pidtype, int j, const Pid &pid)=0
Set new PID value for a joint axis.
virtual yarp::dev::ReturnValue getPidError(const PidControlTypeEnum &pidtype, int j, double *err)=0
Get the current error for a joint.
virtual yarp::dev::ReturnValue setPidFeedforward(const PidControlTypeEnum &pidtype, int j, double v)=0
Set the feedforward value for the specified PID controller.
virtual yarp::dev::ReturnValue enablePid(const PidControlTypeEnum &pidtype, int j)=0
Enable the PID computation for a joint.
virtual yarp::dev::ReturnValue getPidReference(const PidControlTypeEnum &pidtype, int j, double *ref)=0
Get the current reference of the PID controller for a specific joint.
virtual yarp::dev::ReturnValue getPid(const PidControlTypeEnum &pidtype, int j, Pid *pid)=0
Get current PID value for a specific joint.
virtual yarp::dev::ReturnValue setPidOffset(const PidControlTypeEnum &pidtype, int j, double v)=0
Set an offset value for a given controller.
virtual yarp::dev::ReturnValue getTargetPosition(const int joint, double *ref)=0
Get the last position reference for the specified axis.
virtual yarp::dev::ReturnValue setTrajSpeed(int j, double sp)=0
Set reference speed for a joint, this is the speed used during the interpolation of the trajectory.
virtual yarp::dev::ReturnValue getTargetPositions(double *refs)=0
Get the last position reference for all axes.
virtual yarp::dev::ReturnValue setTrajAcceleration(int j, double acc)=0
Set reference acceleration for a joint.
virtual yarp::dev::ReturnValue relativeMove(int j, double delta)=0
Set relative position.
virtual yarp::dev::ReturnValue getTrajSpeeds(double *spds)=0
Get reference speed of all joints.
virtual yarp::dev::ReturnValue setTrajSpeeds(const double *spds)=0
Set reference speed on all joints.
virtual yarp::dev::ReturnValue positionMove(int j, double ref)=0
Set new reference point for a single axis.
virtual yarp::dev::ReturnValue getTrajAccelerations(double *accs)=0
Get reference acceleration of all joints.
virtual yarp::dev::ReturnValue checkMotionDone(int j, bool &flag)=0
Check if the current trajectory is terminated.
virtual yarp::dev::ReturnValue getTrajSpeed(int j, double *ref)=0
Get reference speed for a joint.
virtual yarp::dev::ReturnValue setTrajAccelerations(const double *accs)=0
Set reference acceleration on all joints.
virtual yarp::dev::ReturnValue stop(int j)=0
Stop motion, single joint.
virtual yarp::dev::ReturnValue getTrajAcceleration(int j, double *acc)=0
Get reference acceleration for a joint.
virtual yarp::dev::ReturnValue getRefPosition(const int joint, double *ref)=0
Get the last position reference for the specified axis.
virtual yarp::dev::ReturnValue setPositions(const int n_joint, const int *joints, const double *refs)=0
Set new reference point for all axes.
virtual yarp::dev::ReturnValue setPosition(int j, double ref)=0
Set new position for a single axis.
virtual yarp::dev::ReturnValue getRefPositions(double *refs)=0
Get the last position reference for all axes.
virtual yarp::os::Stamp getLastInputStamp()=0
Return the time stamp relative to the last acquisition.
IRemoteCalibrator interface is meant to remotize the access of the calibration device in order to all...
virtual yarp::dev::ReturnValue calibrateWholePart()=0
calibrateWholePart: call the procedure for calibrating the whole device
virtual yarp::dev::ReturnValue releaseCalibratorDevice()
releaseCalibratorDevice: reset the internal pointer to NULL when stop using the calibrator
virtual yarp::dev::ReturnValue parkWholePart()=0
parkWholePart: start the parking procedure for the whole part
virtual yarp::dev::ReturnValue calibrateSingleJoint(int j)=0
calibrateSingleJoint: call the calibration procedure for the single joint
virtual yarp::dev::ReturnValue isCalibratorDevicePresent(bool *isCalib)
isCalibratorDevicePresent: check if a calibrator device has been set
virtual yarp::dev::ReturnValue homingSingleJoint(int j)=0
homingSingleJoint: call the homing procedure for a single joint
virtual yarp::dev::ReturnValue parkSingleJoint(int j, bool _wait=true)=0
parkSingleJoint(): start the parking procedure for the single joint
virtual yarp::dev::IRemoteCalibrator * getCalibratorDevice()
getCalibratorDevice: return the pointer stored with the setCalibratorDevice
virtual yarp::dev::ReturnValue quitCalibrate()=0
quitCalibrate: interrupt the calibration procedure
virtual yarp::dev::ReturnValue quitPark()=0
quitPark: interrupt the park procedure
virtual yarp::dev::ReturnValue setCalibratorDevice(yarp::dev::IRemoteCalibrator *dev)
setCalibratorDevice: store the pointer to the calibrator device.
virtual yarp::dev::ReturnValue getRemoteVariablesList(yarp::os::Bottle *listOfKeys)=0
virtual yarp::dev::ReturnValue getRemoteVariable(std::string key, yarp::os::Bottle &val)=0
virtual yarp::dev::ReturnValue setRemoteVariable(std::string key, const yarp::os::Bottle &val)=0
virtual yarp::dev::ReturnValue getMotorTorqueParams(int j, yarp::dev::MotorTorqueParameters *params)=0
Get a subset of motor parameters (bemf, ktau etc) useful for torque control.
virtual yarp::dev::ReturnValue getTorqueRange(int j, double *min, double *max)=0
Get the full scale of the torque sensor of a given joint.
virtual yarp::dev::ReturnValue getTorque(int j, double *t)=0
Get the value of the torque on a given joint (this is the feedback if you have a torque sensor).
virtual yarp::dev::ReturnValue setMotorTorqueParams(int j, const yarp::dev::MotorTorqueParameters params)=0
Set a subset of motor parameters (bemf, ktau etc) useful for torque control.
virtual yarp::dev::ReturnValue getRefTorque(int j, double *t)=0
Get the reference value of the torque for a given joint.
virtual yarp::dev::ReturnValue setRefTorque(int j, double t)=0
Set the reference value of the torque for a given joint.
virtual yarp::dev::ReturnValue setRefTorques(const double *t)=0
Set the reference value of the torque for all joints.
virtual yarp::dev::ReturnValue getTargetVelocities(double *vels)=0
Get the last reference speed set by velocityMove for all joints.
virtual yarp::dev::ReturnValue getTargetVelocity(const int joint, double *vel)=0
Get the last reference speed set by velocityMove for single joint.
virtual yarp::dev::ReturnValue velocityMove(int j, double sp)=0
Start motion at a given speed, single joint.
virtual yarp::dev::ReturnValue getRefVelocity(const int jnt, double &vel)=0
Get the last reference velocity set by setRefVelocity() for a single joint.
virtual yarp::dev::ReturnValue setRefVelocity(int jnt, double vel)=0
Set the velocity of single joint.
Contains the parameters for a PID.
A simple collection of objects that can be described and transmitted in a portable way.
void append(const Bottle &alt)
Append the content of the given bottle to the current list.
size_type size() const
Gets the number of elements in the bottle.
Value & get(size_type index) const
Reads a Value v from a certain part of the list.
A mini-server for performing network communication in the background.
An abstraction for a time stamp and/or sequence number.
void update()
Set the timestamp to the current time, and increment the sequence number (wrapping to 0 if the sequen...
virtual Bottle * asList() const
Get list value.
#define yCError(component,...)
#define yCWarning(component,...)
For streams capable of holding different kinds of content, check what they actually have.
SelectableControlModeEnum
An interface to the operating system, including Port based communication.
size_t indexOfSubDeviceInPolyDriverList