diff --git a/hironx_ros_bridge/robot/hrpiob/iob.cpp b/hironx_ros_bridge/robot/hrpiob/iob.cpp index 138b5e2e..fd594784 100644 --- a/hironx_ros_bridge/robot/hrpiob/iob.cpp +++ b/hironx_ros_bridge/robot/hrpiob/iob.cpp @@ -733,3 +733,33 @@ int read_digital_output(char *doutput) else return FALSE; } + +/** + * @brief Needed for hrpsys 315.4.0 onward (added at https://github.com/fkanehiro/hrpsys-base/pull/598). + * TODO Implement if we want to utilize this. + */ +int number_of_thermometers(void) +{ + std::fprintf(stdout, "number_of_thermometers not implemented.\n"); + return 0; +} + +/** + * @brief Needed for hrpsys 315.4.0 onward (added at https://github.com/fkanehiro/hrpsys-base/pull/598). + * TODO Implement if we want to utilize this. + */ +int number_of_batteries(void) +{ + std::fprintf(stdout, "number_of_batteries not implemented.\n"); + return 0; +} + +/** + * @brief Needed for hrpsys 315.4.0 onward (added at https://github.com/fkanehiro/hrpsys-base/pull/598). + * TODO Implement if we want to utilize this. + */ +int read_battery(char *battery) +{ + std::fprintf(stdout, "read_battery not implemented.\n"); + return 0; +} diff --git a/hironx_ros_bridge/robot/hrpiob/nextage-open.hpp b/hironx_ros_bridge/robot/hrpiob/nextage-open.hpp index 2e9a434d..c91e2e2a 100644 --- a/hironx_ros_bridge/robot/hrpiob/nextage-open.hpp +++ b/hironx_ros_bridge/robot/hrpiob/nextage-open.hpp @@ -60,7 +60,6 @@ namespace NEXTAGE_OPEN virtual int wait_for_iob_signal(void) = 0; virtual long get_signal_period(void) = 0; - virtual int initializeJointAngle(const char *name, const char *option) = 0; virtual int read_digital_input(char *dIn) = 0; virtual int length_digital_input(void) = 0; @@ -68,6 +67,10 @@ namespace NEXTAGE_OPEN virtual int write_digital_output_with_mask(const char *doutput, const char *mask) = 0; virtual int length_digital_output(void) = 0; virtual int read_digital_output(char *doutput) = 0; + + virtual int number_of_thermometers(void) = 0; + virtual int number_of_batteries(void) = 0; + virtual int read_battery(char *battery) = 0; }; }