|
11 | 11 |
|
12 | 12 | ;; Initialize |
13 | 13 | (defmethod hironxjsk-interface |
14 | | - ;; Based on hrp2jsknts-interface.l |
| 14 | + ;; Based on https://github.com/start-jsk/rtmros_tutorials/blob/9132c58702b3b193e14271b4c231ad0080187850/hrpsys_ros_bridge_tutorials/euslisp/hrp2jsknts-interface.l |
15 | 15 | (:init (&rest args) |
16 | 16 | (prog1 |
17 | 17 | (send-super* :init :robot hironxjsk-robot args) |
|
32 | 32 |
|
33 | 33 | ;; AbsoluteForceSensor |
34 | 34 | ;; Overwrite RemoveForceSensorLinkOffset methods |
| 35 | +;; Based on https://github.com/start-jsk/rtmros_common/blob/1.4.2/hrpsys_ros_bridge/euslisp/rtm-ros-robot-interface.l |
35 | 36 | (def-set-get-param-method 'hironx_ros_bridge::OpenHRP_AbsoluteForceSensorService_ForceMomentOffsetParam |
36 | 37 | :raw-set-forcemoment-offset-param :raw-get-forcemoment-offset-param :get-forcemoment-offset-param-arguments |
37 | 38 | :absoluteforcesensorservice_setforcemomentoffsetparam :absoluteforcesensorservice_getforcemomentoffsetparam |
|
146 | 147 | ) |
147 | 148 |
|
148 | 149 | ;; ImpedanceControllerService |
149 | | -;; Based on hironx_client.py in hironx_ros_bridge and rtm-ros-robot-interface.l. |
| 150 | +;; Based on https://github.com/start-jsk/rtmros_hironx/blob/2.1.0/hironx_ros_bridge/src/hironx_ros_bridge/hironx_client.py |
| 151 | +;; and https://github.com/start-jsk/rtmros_common/blob/1.4.2/hrpsys_ros_bridge/euslisp/rtm-ros-robot-interface.l. |
150 | 152 | ;; Enable methods executable with old impedance controller and disable others. |
151 | 153 | ;; The reason why I don't use def-set-get-param-method is that |
152 | 154 | ;; OpenHRP_ImpedanceControllerService_setImpedanceControllerParam.srv has element "name" inside i_param, |
|
233 | 235 | (error ";; :get-impedance-controller-controller-mode cannot be used with hironx~%"))) |
234 | 236 |
|
235 | 237 | ;; ServoControllerService for hand |
236 | | -;; Based on hironx_client.py in hironx_ros_bridge and hrp2-common-interface.l |
| 238 | +;; Based on https://github.com/start-jsk/rtmros_hironx/blob/2.1.0/hironx_ros_bridge/src/hironx_ros_bridge/hironx_client.py |
| 239 | +;; and https://github.com/start-jsk/rtmros_tutorials/blob/0.1.6/hrpsys_ros_bridge_tutorials/euslisp/hrp2-common-interface.l |
237 | 240 | (defmethod hironxjsk-interface |
238 | 241 | (:hand-angle-vector |
239 | 242 | (av &optional (tm 1000) (hand :hands)) |
|
0 commit comments