Stable RTCs

• SequencePlayer * Fix bug in CUBICSPLINE mode (#1201)

  System Message: ERROR/3 (<string>, line 12)

  Unexpected indentation.

  • fix bug in CUBICSOLINE mode a[5] -> a5[i]

  System Message: WARNING/2 (<string>, line 13)

  Block quote ends without a blank line; unexpected unindent.

  • Remove offset while playing patterns (#1191) * enable to generate continuous motion from motion patterns * enable to fix a link while playing patterns

• RobotHardware/DataLogger * Add data port for TimedRobotState2 #1195 from fkanehiro/add_rstate2_port

  System Message: ERROR/3 (<string>, line 18)

  Unexpected indentation.

  • add an output data port for TimedRobotState2

• RobotHardware * Add servo on delay (#1210)

  System Message: ERROR/3 (<string>, line 21)

  Unexpected indentation.

  • [RobotHardware] add document on servoOnDelay
  • [RobotHardware] add servoOnDelay configuration variable

  System Message: WARNING/2 (<string>, line 23)

  Block quote ends without a blank line; unexpected unindent.

  • Fix bug in getStatus() (#1197) * [RobotHardware] fix a bug in getStatus()

• DataLogger * Add logSplitter (#1198)

  System Message: ERROR/3 (<string>, line 27)

  Unexpected indentation.

  • add logSplitter

• rtm.py (#1199) * [rtm.py] add RTcomponent.getProperties()

• hrpEC * Add missing initialization (#1209)

  System Message: ERROR/3 (<string>, line 32)

  Unexpected indentation.

  • Add missing initialization

  System Message: WARNING/2 (<string>, line 33)

  Block quote ends without a blank line; unexpected unindent.

  • Detect use-after-free of hrpExecutionContext (#1208) * Remove C++11 dependency from previous commit * Detect use-after-free of hrpExecutionContext

• Travis (travis.sh, travis.yaml) * Update travis to run hydro/indigo/kinetic (#1194)

  System Message: ERROR/3 (<string>, line 38)

  Unexpected indentation.

  • .travis.sh: remove -j1 -l1 to speed up compile
  • Update .travis.yml
  • run docker without -it
  • disable DEBIAN_FRONTEND, install tzdata before other package https://askubuntu.com/questions/909277/avoiding-user-interaction-with-tzdata-when-installing-certbot-in-a-docker-contai
  • .travis.sh: old git does not support -b with tag name
  • export DISTRO
  • skip hydro specific patches
  • use DISTRO
  • use ROS_DISTRO instead of hydro
  • show lsb_release
  • .travis.yml: add hydro/indigo/kinetic: test on .travis.yml
  • apt-get install python2.7
  • install apt-get software-properties-common
  • mkdir tet_results
  • install git,wget,sudo,sed
  • use docker to run test

Unstable RTCs

• ReferenceForceUpdater * Add is_hold_value flag writing (#1213)

  System Message: ERROR/3 (<string>, line 60)

  Unexpected indentation.

  • [rtc/ReferenceForceUpdater/ReferenceForceUpdater.cpp] Add missing writing of is_hold_value flag

  System Message: WARNING/2 (<string>, line 61)

  Block quote ends without a blank line; unexpected unindent.

  • Update rfu functions (#1212) * [idl/ReferenceForceUpdaterService.idl, rtc/ReferenceForceUpdater] Enable to set transition time for RFU * [idl/ReferenceForceUpdaterService.idl, rtc/ReferenceForceUpdater] Add no-wait version functions

• AccelerationChecker (#1205) * remove a newline * check joint command acceleration only when servo is on

• AutoBalancer (#1203) * [rtc/AutoBalancer/AutoBalancer.cpp] Update for MODE_REF_FORCE_RFU_EXT_MOMENT. Separate MODE_REF_FORCE_RFU_EXT_MOMENT from other UseForceMode.

• CameraImageSaver : Add new component (#1200) * add bindParameter() * add a new component, CameraImageSaver

• CameraImageViewer : Support RTC::CameraImage (#1196) * [CameraImageViewer] support RTC::CameraImage

• Stabilizer * Update calculation of foot origin ext moment (#1203)

  System Message: ERROR/3 (<string>, line 76)

  Unexpected indentation.

  • [rtc/Stabilizer/Stabilizer.*] Update calculation of diff_foot_origin_ext_moment not to use ZMP and to use foot moment
  • [rtc/Stabilizer/Stabilizer.cpp] Move calculation of actual foot origin coords. This is expected not to change the program behavior.

  System Message: WARNING/2 (<string>, line 78)

  Block quote ends without a blank line; unexpected unindent.

  • Update travis to run hydro/indigo/kinetic (#1194) * sample/SampleRobot/samplerobot_stabilizer.py: on hrpsys < 315.5.0 this outputs huge error log message

• Contributors: Fumio KANEHIRO, Jun Inoue, Kei Okada, Shunichi Nozawa, Yasuhiro Ishiguro

Stable RTCs

• .gitignore (#1186) * [.gitignore] add qpoases directory

• CMakeLists * Update for compile definitions (#1179)

  System Message: ERROR/3 (<string>, line 94)

  Unexpected indentation.

  • CMakeLists.txt : add " for string REGREX whoen OPENHRP_DEFINITIONS is not set

  System Message: WARNING/2 (<string>, line 95)

  Block quote ends without a blank line; unexpected unindent.

  • Update compile flags (#1177) * CMakeLists.txt : remove -O2 from OPENHRP_DEFINITIONS

• CollisionDetector * Update debug message (#1178)

  System Message: ERROR/3 (<string>, line 100)

  Unexpected indentation.

  • CollisionDetector.cpp: setupVclipModel() : display size of vclip model verts

  System Message: WARNING/2 (<string>, line 101)

  Block quote ends without a blank line; unexpected unindent.

  • Add service (#1174) * add service for collision loop

• rtm.py * Fix (#1183)

  System Message: ERROR/3 (<string>, line 106)

  Unexpected indentation.

  • fix classFromString()

  System Message: WARNING/2 (<string>, line 107)

  Block quote ends without a blank line; unexpected unindent.

  • Update behavior (#1181) * 関数名を変更 * readDataPort、writeDataPort関数で毎回コネクタを生成しないようにする

• SequencePlayer * Update sample checking (#1143)

  System Message: ERROR/3 (<string>, line 113)

  Unexpected indentation.

  • [sample/SampleRobot/samplerobot_sequence_player.py] Check return value of checkJointAngles of SequencePlayer sample.

  System Message: WARNING/2 (<string>, line 114)

  Block quote ends without a blank line; unexpected unindent.

  • Update for clearOfGroups (#1141) * SequencePlayer.cpp: (setTargetPose) send resetJointGroup to m_seq before call playPatternOfGroup * add test code to check clearOfGroups work when setTargetPose is called
  • Fix bug of return value (#1139) * [rtc/SequencePlayer/interpolator.h] Fix bug of return value type of interpolator dimension.

• hrpsys_config.py * Update debug message (#1153)

  System Message: ERROR/3 (<string>, line 122)

  Unexpected indentation.

  • hrpsys_config.py: display findComps -> (rtcname)

  System Message: WARNING/2 (<string>, line 123)

  Block quote ends without a blank line; unexpected unindent.

  • Update documentation (#1135) * [py][doc] Clarify setTargetPoseRelative's wait behavior (addresses #1121).

    System Message: ERROR/3 (<string>, line 125)

    Unexpected indentation.

    wait argument is to regulate the commands previously run before setTargetPoseRelative, but there are users who thought it stops subsequent commands. This change hopefully clarifies the difference.

Unstable RTCs

• PointCloudViewer * Update checking (#1145)

  System Message: ERROR/3 (<string>, line 132)

  Unexpected indentation.

  • [PointCloudViewer] Validity check seems not to be needed when is_dense param is correctly set
  • [PointCloudViewer] Use union rgb member in PointXYZRGB
  • [PointCloudViewer] Fix point validity check, isnan should take floating value
  • [PointCloudViewer] Fix validity check of color points

  System Message: WARNING/2 (<string>, line 136)

  Block quote ends without a blank line; unexpected unindent.

  • Support coloring (#1144) * [PointCloudViewer] Support color pointcloud view

• Beeper (#1143) * [rtc/Beeper/Beeper.cpp] Update sleep time of beep. Do not access beep device during previous beep command is executed.

• GraspController (#1160) * [rtc/GraspController] Add [] for grasp controller instance name and add more information about parsing of joint group setting

• For fullbody manipulation : AutoBalancer, Stabilizer, ObjectContactTurnaroundDetector, ReferenceForceUpdater * Fix bug of initialization (#1160)

  System Message: ERROR/3 (<string>, line 147)

  Unexpected indentation.

  • [rtc/ReferenceForceUpdater] Update to use interpolated results.
  • [rtc/ReferenceForceUpdater] Output default value for refFootOriginExtMoment if is_active is false.
  • [rtc/Stabilizer] Do not calculate actual foot_origin_ext_moment if in the air, because of invalid act_zmp.

  System Message: WARNING/2 (<string>, line 150)

  Block quote ends without a blank line; unexpected unindent.

  • Update for fullbody manip (#1192) * [idl/ObjectContactTurnaroundDetectorService.idl, rtc/ObjectContactTurnaroundDetector] Add TOTAL_MOMENT2 to use end-effector moments * [idl/ObjectContactTurnaroundDetectorService.idl, rtc/ObjectContactTurnaroundDetector, sample/SampleRobot/samplerobot_carry_object.py] Add friction coefficient wrench. Update samples to print it. * [rtc/AutoBalancer/AutoBalancer.cpp] Set 1.0 as default value for swingsupport time * [rtc/Stabilizer/Stabilizer.cpp] Update increment of support_time. In some PC, previous version does not work because of optimized out.
  • Update for single-leg support (#1180) * [rtc/AutoBalancer] Support foot contact manipulation in static balance point calculation * [python/hrpsys_config.py, rtc/ObjectContactTurnaroundDetector] Use reference contact states in object contact turnaround detector foot origin coords calculation * [rtc/Stabilizer/ZMPDistributor.h] Add check for ee size. Currently, two feet contact is supported. * [rtc/AutoBalancer] Check leg_names length for biped force distribution * [rtc/ObjectContactTurnaroundDetector] Use footorigincoords calculation in OCTD
  • Support fullbody manipulation (#1151) * [rtc/ReferenceForceUpdater] Add arm name printing to add more information in debug print * [sample/SampleRobot/samplerobot_carry_object.py] Add Joint Groups setting for startDefaultUnstableControllers * [sample/SampleRobot/samplerobot_reference_force_updater.py] Update rfu sample (argument update checking and FootOriginExtMoment) * [python/hrpsys_config.py] Connect FootOriginExtMoment ports for fullbody contact manipulation * [rtc/AutoBalancer] Add distibution of zmp to ref force/moment. * [rtc/AutoBalancer] Input ext moment around the foot origin pos and update static balance point calculation for foot force and ext moment. * [idl/AutoBalancerService.idl,rtc/AutoBalancer] Add MODE_REF_FORCE_RFU_EXT_MOMENT and MODE_REF_FORCE_WITH_FOOT of UseForceMode for fullbody contact manipulation. * [rtc/ReferenceForceUpdater] Separate functions for update ref forces / ext moment. * [rtc/ReferenceForceUpdater] Add update for ext moment around the foot origin pos. * [idl/ReferenceForceUpdaterService.idl, rtc/ReferenceForceUpdater] Add is_hold_value to choose holding current value or not. If is_hold_value is true, do not update value, otherwise, update value. * [rtc/ReferenceForceUpdater] Add sensor name for eet param. * [rtc/ReferenceForceUpdater] Enable to set some RFU parameters while active. Separate parameters which can be changed or not while active. * [rtc/Stabilizer] Add calculation of ext moment around the foot origin position for fullbody manipulation. * [rt/Stabilizer] Update for st target values considering foot origin coords

• ReferenceForceUpdater : Fix bug of get/set value (#1173) * [rtc/ReferenceForceUpdater/ReferenceForceUpdater.cpp] Fix bug in get value for is_hold_value flag * [sample/SampleRobot/samplerobot_reference_force_updater.py] Add check for value setting and add comments

• Stabilizer * Support n-sided polygon (#1189)

  System Message: ERROR/3 (<string>, line 183)

  Unexpected indentation.

  • [idl/StabilizerService.idl] add comment about the order of eefm_support_polygon_vertices_sequence
  • [Stabilizer.cpp, Stabilizer.cpp] add vertices with margin for fall detection
  • [ZMPDistributor.h] remove unused function
  • [ZMPDistributor.h] fix bug on calcProjectedPoint
  • [Stabilizer.*, ZMPDistributor.h] calculate convex hull from n-sided polygon's vertices

  System Message: WARNING/2 (<string>, line 188)

  Block quote ends without a blank line; unexpected unindent.

  • Fix bug of initialization (#1190) * [rtc/Stabilizer/Stabilizer.cpp] Fix bug of support_time. Initialize support_time and limit max support_time (too large support_time). Add debug print.
  • Support ZMP truncate (#1158) * [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.cpp,Stabilizer.h,ZMPDistributor.h] add option of zmp truncation * [rtc/Stabilizer/ZMPDistributor.h] Add func to calculate nearest point of foot support polygon

• AutoBalancer * Update ref force balancing (#1188)

  System Message: ERROR/3 (<string>, line 196)

  Unexpected indentation.

  • [idl/AutoBalancerService.idl,python/hrpsys_config.py,rtc/AutoBalancer,rtc/ReferenceForceUpdater] Support walking while MODE_REF_FORCE_RFU_EXT_MOMENT by using is_hold_value flag and move base offset
  • [idl/AutoBalancerService.idl, rtc/AutoBalancer] Add parameters to specify link name and offset point for additional force, such as torso.

  System Message: WARNING/2 (<string>, line 198)

  Block quote ends without a blank line; unexpected unindent.

  • Update footstep limitation (#1185) * [rtc/AutoBalancer/GaitGenerator.h, idl/AutoBalancerService.idl] Update documentations. Add new explanations and fix incorrect explanations. * [rtc/AutoBalancer/testGaitGenerator.cpp] Add sample functions for stride limitation * [rtc/AutoBalancer/GaitGenerator.cpp] Use inside limitation in footstep calculation. * [idl/AutoBalancerService.idl, rtc/AutoBalancer] Enable to set stride_inside_y and stride_inside_th as stride_parameter * [rtc/AutoBalancer/AutoBalancer.cpp, Gaitgenerator] Rename stride_y and stride_theta -> stride_outside_y and stride_outside_theta
  • Fix bug of limiting (#1162) * [rtc/AutoBalancer/GaitGenerator, sample/SampleRobot/samplerobot_auto_balancer.py] Fix foot step limitation in case of offset vel is specified. Fix testing code.
  • Fix bug of initialization (#1157) * [rtc/AutoBalancer/GaitGenerator.h] set state at first double support phase and last double support phase to modify bug of no double support walk without reducing swing count.
  • Fix bug of GaitGenerator memory access (#1159) * [rtc/AutoBalancer/GaitGenerator] Fix invalid access for step_count_list (https://github.com/fkanehiro/hrpsys-base/issues/1154) * [rtc/AutoBalancer/GaitGenerator] Remove unused argument in update_refzmp.
  • Separate simplefullbodyiksolver (#1150) * move operator<< overload into .cpp * separate into SimpleFullbodyInverseKinematicsSolver.h
  • Support footstep modification in goVelocity (#1147) * [GaitGenerator.*] support goVelocity in modifying footsteps * [GaitGenerator.cpp] remove unused variable
  • Update preview queue in GaitGenerator (#1140) * [GaitGenerator.cpp] overwrite refzmp queue only when is_emergency_walking * [GaitGenerator.cpp, PreviewController.h] overwrite preview queue without clearing queue
  • Update testing and plotting of GaitGenerator (#1143) * [rtc/AutoBalancer/testGaitGenerator.cpp] Update comments and print message. Add TODO memo. * [rtc/AutoBalancer/testGaitGenerator.cpp, GaitGenerator.*] Add check for toe heel angle and zmp offset transigion. Use eps_eq instead of calling fabs directly. * [rtc/AutoBalancer/CMakeLists.txt, GaitGenerator.h, testGaitGenerator.cpp] Add check for step times. * [rtc/AutoBalancer/testGaitGenerator.cpp] Add error checker class and add start/end error check between COGxy and REFZMPxy * [rtc/AutoBalancer/CMakeLists.txt] Enable test6 checking in make test * [rtc/AutoBalancer/testGaitGenerator.cpp] Update comment and use fflush to confirm file writing. * [rtc/AutoBalancer/testGaitGenerator.cpp] Add value discontinuous checking for state values. * [rtc/AutoBalancer/testGaitGenerator.cpp] Update test for single step and z change (test6, test5) to remove discontinuous results. * [rtc/AutoBalancer/testGaitGenerator.cpp] Fix empty range of gnuplotting (force set range). * [rtc/AutoBalancer/testGaitGenerator.cpp] Add test_doc_string, add test name to file name, and use sleep for use-graph-append.
  • Fix bug of discontinuous trajectory (#1139) * [rtc/AutoBalancer/testGaitGenerator.cpp] Update comments and documentation. Add appepnding of graphs. * [rtc/AutoBalancer/CMakeLists.txt] Call tests for test17 and test18 in 'make test' (govelocity tests) * [rtc/AutoBalancer/GaitGenerator.*] Update rot eps for mid_coords functions. * [rtc/ImpedanceController/RatsMatrix.*] Add eps argument for mid_rot and mid_coords * [rtc/AutoBalancer/testGaitGenerator.cpp] Increase velocity plotting * [rtc/AutoBalancer/GaitGenerator.*] Enable to update the target value of foot midcoords (for example, foot step modification for updown and rotation). This bug is originally reported by @kyawawa. * [rtc/AutoBalancer/GaitGenerator.cpp] Interpolate difference from src to dst in swing_foot_rot_interpolator * [rtc/AutoBalancer/GaitGenerator.h] Calculate dst and src swing coordinates midcoords for all limbs at first. * [rtc/AutoBalancer/testGaitGenerator.cpp] Add plot for swing support mid coords * [rtc/AutoBalancer/testGaitGenerator.cpp] Separate plot files. This will not change behavior. * [rtc/AutoBalancer/testGaitGenerator.cpp] Add argument for default-double-support-ratio-swing-[after/before] * [rtc/AutoBalancer/testGaitGenerator.cpp] Add rotation velocity change for test18 govelocity test * [rtc/AutoBalancer/GaitGenerator.*] Enable to update the target value of swing foot rot (for example, foot step modification for rotation) * [rtc/AutoBalancer/testGaitGenerator.cpp] Add test for changing govelocity velocities * [rtc/AutoBalancer/testGaitGenerator.cpp] Add test for goVelocity mode. * [rtc/AutoBalancer/testGaitGenerator.cpp] Separate plot and walk pattern generation parts as functions. This will not change the program behavior.

• Contributors: Fumio KANEHIRO, Iori Kumagai, Isaac I.Y. Saito, Juntaro Tamura, Kei Okada, Nobuhiko Miyamoto, Noriaki Takasugi, Shunichi Nozawa, Yuta Kojio, Yasuhiro Ishiguro, Yisha

Stable RTCs

• Update for beeping of SoftErrorLimiter and CollisionDetector (#1124) * [rtc/SoftErrorLimiter/SoftErrorLimiter.cpp,rtc/CollisionDetector/CollisionDetector.cpp] Call quit_beep when is_beep_port_connected is true, because beeping is not required in these RTCs and deregated to Beeper RTC in this case.

• Update documentations of python interfaces for stable rtcs (#1120) * [doc][py] Explain setWrenches method (thanks to https://github.com/fkanehiro/hrpsys-base/issues/1131).

  System Message: ERROR/3 (<string>, line 263)

  Unexpected indentation.

  Similar info should be added to IDL level (this Python file is only the end-user API so the number of audience can be minimum).

  System Message: WARNING/2 (<string>, line 264)

  Block quote ends without a blank line; unexpected unindent.

  • [py][doc] Add how to set ref_{force, moment} for 315.2.0 <= version.
  • [doc][py] More elaboration on startImpedance.
  • [py] Elaborate the "tm" arg.

  System Message: WARNING/2 (<string>, line 267)

  Bullet list ends without a blank line; unexpected unindent.

  AFAI understood from looking at [SequencePlayer/SequencePlayer.cpp](https://github.com/fkanehiro/hrpsys-base/blob/350a3bcdeafd39d82a44c2dbde6a279adb6d88eb/rtc/SequencePlayer/SequencePlayer.cpp#L547)'s implementation, time taken for planning and other processes are not considered for "tm" argument.

  System Message: WARNING/2 (<string>, line 268)

  Block quote ends without a blank line; unexpected unindent.

  • [doc][py] Elaborate playPattern* methods.

• hrpsys-simulator * set default background color of hrpsys-viewer

• Update CMake for VTK (#1123) * Precise the version of VTK

  System Message: ERROR/3 (<string>, line 275)

  Unexpected indentation.

  There seems to be an incompatibility between the version 5.8 and the version 7

Unstable RTCs

• Update Unstable RTC sample, readme, and images (#1126, #1127) * [sample/SampleRobot/README.md] Fix path of images of README * [sample/SampleRobot/README.md, img] Add image and update link for hrpsys sample README * [sample/SampleRobot/samplerobot_terrain_walk.py] Update terrain walk samples * [sample/SampleRobot/SampleRobot.DRCTestbed.xml] Update DRC testbed xml to add floor. * [sample/README.md, SampleRobot/README.md] Update README to fix indent and alignment.

• Update Stabilizer (#1125, #1128, #1137) * Update Stabilizer-related codes and samples (#1125)

  System Message: ERROR/3 (<string>, line 288)

  Unexpected indentation.

  • [sample/SampleRobot/samplerobot_stabilizer.py] Add new sample for st for root rot change and mimic rough terrain.
  • [rtc/PDcontroller/PDcontroller.cpp] Print PD gain when loading
  • [rtc/Stabilizer/Stabilizer.*] Remove unused parameters.

  System Message: WARNING/2 (<string>, line 291)

  Block quote ends without a blank line; unexpected unindent.

  • Update damping control in horizontal direction (#1128) * [Stabilizer] Enable to change horizontal swing damping gain when detect large force/moment
  • IK loop and base rot control (#1137) * [rtc/Stabilizer/Stabilizer.* idl/StabilizerService.idl] Enable to set ik_loop_count in st * [rtc/Stabilizer/ZMPDistributor.h, Stabilizer.cpp] Reduce lines of printing of stabilizer. * [idl/StabilizerService.idl, rtc/Stabilizer] Enable to set Limit of compensation for difference between ref-act root rot [rad].

• Add new functionality for walking (#1129, #1134) * Modify footsteps to keep balance (#1129)

  System Message: ERROR/3 (<string>, line 300)

  Unexpected indentation.

  • [AutoBalancerService.idl, StabilizerService.idl, hrpsys_config.py, AutoBalancer.*, AutoBalancer.*, Stabilizer.*] modify footsteps based on CP
  • [AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.*, sample/SampleRobot/samplerobot_auto_balancer.py] use different parameter when generating footsteps with circle type

  System Message: WARNING/2 (<string>, line 302)

  Block quote ends without a blank line; unexpected unindent.

  • Change base height to avoid from leg stretching (#1134) * [AutoBalancerService.idl, AutoBalancer.*] avoid limb stretch by changing root height * [Stabilizer.cpp] smoothly change root height when switching use_limb_stretch_avoidance

• Update python function to start all default controllers (#1130) * [python/hrpsys_config.py] Support non-legged robot and leg-only robot in startDefaultUnstableControllers and stopDefaultUnstableControllers

• Add new functionality to remove force sensor offset (#1132, #1133) * [idl/RemoveForceSensorLinkOffsetService.idl, rtc/RemoveForceSensorLinkOffset, python/hrpsys_config.py, sample/SampleRobot/samplerobot_remove_force_offset.py] Add argument for duration of calibration. Set 8.0[s] as default value in python code * [python/hrpsys_config.py,sample/SampleRobot/samplerobot_remove_force_offset.py] Add sample and python interface for removing force sensor offset. * [idl/RemoveForceSensorLinkOffsetService, rtc/RemoveForceSensorLinkOffset] Add function to remove force sensor offset in RMFO RTC. * [rtc/RemoveForceSensorLinkOffset/RemoveForceSensorLinkOffset.txt] Add documentation abount two types of offsets.

• Contributors: Fumio KANEHIRO, Isaac I.Y. Saito, Mehdi Benallegue, Shunichi Nozawa, Tatsuya Ishikawa, YutaKojio

Stable RTCs

• Fix bug of https://github.com/fkanehiro/hrpsys-base/pull/1103 (#1114) * [CMakeLists.txt] use separate_arguments to set semicolon to variable.

Unstable RTCs

• Update for 3rdparty (#1115) * [3rdparty/qpOASES/CMakeLists.txt] trust server of QPOASES

• Add ApproximateVoxelGridFilter (#1117) * replace VoxelGridFilter with ApproximateVoxelGridFilter * add a new RT component, ApproximateVoxelGridFilter

• Update for ApproximateVoxelGridFilter * copy timestamp from input cloud to output cloud * add debug mode and pass through mode

• Add PointCloudViewer (#1116) * add a new RT component, PointCloudViewer

• Update for VoxelGridFilter * copy is_dense attribute from input point cloud * add debugLevel property and support pass-through mode

• Update Stabilizer in-the-air behavior (#1090) * [Stabilizer] Set default detection time whether robot is in air to zero * [Stabilizer] Set detection time whether robot is in air * [Stabilizer] Rename variables

• Rename and separate functions (#1111) * Stabilizer

  System Message: ERROR/3 (<string>, line 354)

  Unexpected indentation.

  • [rtc/Stabilizer/Stabilizer.*] Rename contact_states -> ref_contact_states. Rename isContact -> act_contact_states

  System Message: WARNING/2 (<string>, line 355)

  Block quote ends without a blank line; unexpected unindent.

  • AutoBalancer * [rtc/AutoBalancer/AutoBalancer.*] Separate solving IK codes as class. Currently, transition and SBP calculation is not separated. (This is expected not to change behavior). * [rtc/AutoBalancer/AutoBalancer.cpp] Output and set OutPort only for legged robots. * [rtc/AutoBalancer/AutoBalancer.*] Make startWalking without ABC deprecated and fix position of calling of stopWalking and zmp_weight_mzp interpolation. * [rtc/AutoBalancer/AutoBalancer.*] Remove unnecessary member vaiable (target_end_coords) * [rtc/AutoBalancer/AutoBalancer*] Separate codes from IK parts. (This commit is expected not to change the behavior) * [rtc/AutoBalancer/AutoBalancer.*] Include target EE coords calculation in separated functions. (This commit is expected not to change the behavior). * [rtc/AutoBalancer/AutoBalancer.*] Separate procedures in getTargetParameters as fucntions. (This commit is expected not to change the behavior). * [rtc/AutoBalancer/AutoBalancer.*] Fix order of transition code. Separate functions to calculate output from ABC. (This commit is expected not to change the behavior). * [rtc/AutoBalancer/AutoBalancer.cpp] Fix parameter setting section in non-GaitGenerator parts. Fix index of default_zmp_offsets usage. * [rtc/AutoBalancer/AutoBalancer, GaitGenerator] Separate and move codes from AutoBalancer to GaitGenrator, in order to get GaitGenerator results in AutoBalancer. (This commit is expected not to change the behavior) * [rtc/AutoBalancer/AutoBalancer.cpp] Use target EE pos and rot instead of target link origin pos and rot from SequencePlayer target. (This commit is expected not to change the behavior)
  • ImpedanceController * [rtc/ImpedanceController/ImpedanceController.*] Separate functions, add comments, and fix order and calculation of calcForceMoment. (This commit is expected not to change the behavior)
  • Update samples for unstable RTCs * [launch/sample4legrobot.launch,sample6dofrobot.launch,samplespecialjointrobot.launch] Update conf_file setting for launch samples * [sample/SampleRobot/samplerobot_impedance_controller.py] Separate tests as functions and improve execution time and result checking.

• AutoBalancer update by adding inverse dynamics function (#1110) * refactor IIRFilter::setParameterAsBiquadButterworth -> IIRFilter::setParameterAsBiquad * sqrt -> std::sqrt one more * sqrt -> std::sqrt * seperate InverseDynamics calculation sequence * tan -> std::tan * Revert "remove unused dependency from AutoBalancer/CMakeLists.txt"

  System Message: ERROR/3 (<string>, line 380)

  Unexpected indentation.

  This reverts commit 933edb0a1d05b7104e22eccc96f5639cedd607b4.

  System Message: WARNING/2 (<string>, line 381)

  Block quote ends without a blank line; unexpected unindent.

  • remove unused dependency from AutoBalancer/CMakeLists.txt
  • Revert "move InverseDynamics from ABC to IC/JointPathEx" This reverts commit 9b2a76ea3d6e0f871b4460002ded668649711a19.
  • move InverseDynamics from ABC to IC/JointPathEx
  • move InverseDynamics from ABC to IC/JointPathEx
  • merge from master
  • Add inverse dynamics function

• Contributors: Fumio KANEHIRO, Masaki Murooka, Ryo KOYAMA, Shunichi Nozawa, Tatsuya Ishikawa, Yasuhiro Ishiguro

Stable RTCs

• Do not store history of gh-pages * Do not store history of gh-pages (#1107)

  System Message: ERROR/3 (<string>, line 399)

  Unexpected indentation.

  • .travis.yml : do not keep history in gh-pages

  System Message: WARNING/2 (<string>, line 400)

  Block quote ends without a blank line; unexpected unindent.

  • Fix git push for gh-pages (#1108) * fix #1107: need to push with -f

• Fix bug of cmake for latest catkin (#1103) * fix https://github.com/start-jsk/rtmros_common/pull/998, for latest catkin

• Update maintainer and docs (#1100) * Update maintainer * [doc] Clarify workspace for get*Pose methods. [doc] Add missing rtype for setJoint* methods.

Unstable RTCs

• CameraImageViewer OpenNIGrabber * Update for depth image(#1106)

  System Message: ERROR/3 (<string>, line 416)

  Unexpected indentation.

  • resolve conflicts
  • enable output both of image and point cloud
  • update document
  • add a configuration variable depthBits to CameraImageViewer
  • support depth image (not tested yet)
  • support CF_DEPTH (not tested yet)
  • add CF_RGB to ColorFormat

  System Message: WARNING/2 (<string>, line 423)

  Block quote ends without a blank line; unexpected unindent.

  • Update for OpenNIGrabber (#1096) * flip Y and Z coordinates * enable to change execution period * set timestamps to output data * set true to is_dense

• Stabilizer * Bug fix of transition among stop, start, ground, and air mode (#1104)

  System Message: ERROR/3 (<string>, line 431)

  Unexpected indentation.

  • [rtc/Stabilizer/Stabilizer.cpp] Fix bug of st transition related with air and ground (https://github.com/fkanehiro/hrpsys-base/issues/1098, https://github.com/fkanehiro/hrpsys-base/pull/1102)
  • [sample/SampleRobot/samplerobot_stabilizer.py] Add test code to check ST transition problem (https://github.com/fkanehiro/hrpsys-base/issues/1098, https://github.com/fkanehiro/hrpsys-base/pull/1102).

  System Message: WARNING/2 (<string>, line 433)

  Block quote ends without a blank line; unexpected unindent.

  • Bug fix of stop/start transition (#1102) * [rtc/Stabilizer/Stabilizer.cpp] Reset prev_ref_cog for transition (MODE_IDLE=>MODE_ST) because the coordinates for ref_cog differs among st algorithms. * [rtc/Stabilizer/Stabilizer.cpp] Wait for MODE transition regardless of whether the client program is mode changer or not (https://github.com/fkanehiro/hrpsys-base/issues/1098)
  • Update for st control low (#1099) * [rtc/Stabilizer/Stabilizer.*] Enable to update is_feedback_control_enable flag while MODE_ST * [rtc/Stabilizer/ZMPDistributor.h] Use 6dof total wrench in ZMPdistribution in EEFMQPCOP2

• ObjectContactTurnaroundDetector (Add new RTC separated from ImpedanceController) (#1101) * [idl/ImpedanceControllerService.idl,rtc/ImpedanceController] Remove ObjectContactTurnaroundDetector from ImpedanceController. * [sample/SampleRobot/samplerobot_carry_object.py, samplerobot_impedancecontroller.py] Use OCTD RTC instead of ImpedanceController * [python/hrpsys_config.py,launch/samplerobot.launch,doc] Update hrpsyspy, launch, and doc for ObjectContactTurnaroundDetector RTC * [rtc/CMakeLists.txt,idl/CMakeLists.txt,rtc/ObjectContactTurnaroundDetector,idl/ObjectContactTurnaroundDetectorService.idl] Add ObjectContactTurnaroundDetector RTC for object manipulation separated from ImpedanceController

• TorqueFilter/IIRFilter (#1097) * [rtc/TorqueFilter] Add comments for IIR Filter implementation * [rtc/TorqueFilter] Fix reset function to output initial_value

• ImpedanceController (#1099) * [rtc/ImpedanceController/ImpedanceController.cpp,h,ObjectTurnaroundDetector.h] Add port for otd data (mode, wrench values) * [rtc/ImpedanceController/ImpedanceController.cpp] Add calcForwardKinematics for state calculation.

• AutoBalancer (#1099) * [rtc/AutoBalancer/AutoBalancer.cpp] Transition m_limbCOPOffset in ABC (in MODE_IDLE, set to 0). * [rtc/AutoBalancer/AutoBalancer.cpp] Use setGoal instead of go for autobalancer transition.

• KalmanFilter (#1099) * [rtc/KalmanFilter/CMakeLists.txt, testKFilter.cpp] Add test code for KFilter class. * [rtc/KalmanFilter/KalmanFilter.cpp] Consider sensor offset for gyro value.

• Contributors: Fumio KANEHIRO, Isaac I.Y. Saito, Kei Okada, Shunichi Nozawa, Iori Kumagai

Stable RTCs

• supports OpenRTM-aist 1.2.0 (#1076 from fkanehiro/openrtm_1.2.0)
• add ctype and time to Hrpsys.h for QNX (#1085)
  • add include time.h in lib/util/Hrpsys.h for QNX
  • include ctype.h in lib/util/Hrpsys.h for QNX
• Documentation
  • idl/SequencePlayerService.idl: add suppored version in @brief (#1092)
  • idl/SequencePlayerService.idl: Fix documentation of setJointAngleSequenceFull (fix typoes and unit systems). (#1067)
• DataLogger
  • rtc/DataLogger/DataLogger.cpp: add log_precision (configuration variable) (#1081)
• RobotHardware
  • [rtc/RobotHardware/robot.cpp] Fix bugs in setServoGainPercentage condition (#1074)
• Add beep trylock, print PDgain, print time in EC debug (#1060)
  • [rtc/RobotHardware/robot.cpp] Print loaded PD gain.
  • [ec/hrpEC/hrpEC-common.cpp] Print gettimeofday time in ENABLE_DEBUG_PRINT
  • [rtc/Beeper/Beeper.cpp] Use mutex trylock not to block realtime thread
• lib/util/PortHandler.cpp : add VisionSensorPortHandler intrinsic paramter to TimedCamera (#1091 from k-okada/add_camera_info)
• [rtm.py] try to re-connecting to name server, when failed (#1083)
• [hrpsys_config.py] Add clearJointAngles* methods. (#1064)
• [hrpsys_config.py] set HrpsysConfigurator as object class (#1048)

Unstable RTCs

• fix time stamp of warning messages ( #1089)
  • [Stabilizer] reduce number of print messages
  • [AutoBalancer, CollisionDetector, EmergencyStopper, SoftErrorLimitter, Stabilizer, ReferenceForceUpdater] fix time stamp of warning messages
• [AutoBalancer, CollisionDetector, EmergencyStopper, SoftErrorLimitter, Stabilizer] add time stamp to warning messages (#1087)
• PCDLoader
  • rtc/PCDLoader/PCDLoader.cpp: support XYZRGB in PCDLoader (#1093)
• Stabilizer
  • Fix st damping compensation bug. Enable yaw rotation. (#1082)
    • [rtc/Stabilizer/Stabilizer.cpp] Fix st damping compensation bug. Enable yaw rotation.
  • Update st debug messages ( #1075)
    • [sample/SampleRobot/samplerobot_stabilizer.py] Add printing of actual base pos during st testing.
    • [rtc/Stabilizer/ZMPDistributor.h, Stabilizer.cpp] Reduce lines of st debug message in setParameter (total information is same).
  • Change root link height depending on limb length (#1069)
    • [StabilizerService.idl, Stabilizer.*] rename variable and add function for avoiding limb stretch
    • [Stabilizer.cpp] change root link height on world frame not root link frame
    • [StabilizerService.idl, Stabilizer.*] add idl for changing root link height
    • [Stabilizer.*] change root link height depending on limb length
  • do not distribute moment to swing leg (#1068)
    • [Stabilizer.cpp, ZMPDistributor.h] do not distribute moment to swing leg
  • [AutoBalancer, Stabilizer] add warning message (#1066)
  • Update st swing modif (#1062)
    • [rtc/Stabilizer/CMakeLists.txt] Fix build dependency not to depends on Stabilizer codes.
    • [rtc/Stabilizer/Stabilizer.cpp] Use Eigen cwise functions for swing ee modif calculation.
    • [rtc/Stabilizer/Stabilizer.cpp,h] Move vectors for swing ee modif to stikp.
    • [rtc/Stabilizer/Stabilizer.cpp] Enable retrieving of swing ee modif during support phase.
    • [rtc/Stabilizer/Stabilizer.cpp,h] Separate swing foot modif function and re-organize calcEEForceMomentControl
    • [rtc/Stabilizer/Stabilizer.cpp,h] Update swing ee modification to use current state.
  • Initialize st eefm_ee_forcemoment_distribution_weight parameter. (#1059)
    • [rtc/Stabilizer/Stabilizer.cpp] Initialize st eefm_ee_forcemoment_distribution_weight parameter.
  • Use damping control in swing phase (#1058)
    • [StabilizerService.idl, Stabilizer.*] use swing damping only when exceeding threthold
    • [StabilizerService.idl, Stabilizer.*] use damping control in swing phase
• AutoBalancer
  • Add and update test for sync sh baseTform (#1065)
    • [rtc/AutoBalancer/AutoBalancer.cpp] Set fix_leg_coords according to basePos and rpy from StateHolder during MODE_IDLE.
    • [sample/SampleRobot/samplerobot_auto_balancer.py] Add and update test for sync sh baseTform
  • Enable auto toeheel (#1056)
    • [idl/AutoBalancerService.idl, rtc/AutoBalancer/AutoBalancer.cpp] Enable to set use_toe_heel_auto_set, toe,heel_check_thre from idl.
    • [rtc/AutoBalancer/GaitGenerator.] Fix typo (double -> bool) and add flag whether use auto toe heel set or not. Update test to use use_toe_heel_auto_set flag.
    • [rtc/AutoBalancer/GaitGenerator.h] Add toe_heel_type_checker to determin autonomusly whether toe or heel is used.
    • [rtc/AutoBalancer/GaitGenerator.*] Separate calc swing support leg steps as functions
    • [rtc/AutoBalancer/GaitGenerator.cpp] Use first_xx and second_xx instead of toe_xx and heel_xx. Renaming and fix transition.
  • Update toeheel and st (#1054)
    • [rtc/Stabilizer/testZMPDistributor.cpp, CMakeLists.txt] Update testZMPDistributor to switch distribute algorithm and add cmake test for them.
    • [sample/SampleRobot/samplerobot_stabilizer.py] Add test for st+toe heel usage
    • [python/hrpsys_config.py, rtc/Autobalancer, rtc/Stabilizer] Add and connect ports to send toe heel ratio between AutoBalancer and Stabilizer. Add weighting matrix update based on toe heel ratio.
    • [rtc/AutoBalancer/testGaitGenerator.cpp, GaitGenerator.h] Add functions to obtain toe heel ratio and add test for it. Update comment in codes.
  • Fix toe heel phase count of refzmp_generator (#1053)
    • [rtc/AutoBalancer/CMakeLists.txt] Enable cmake test for testGaitGenerator test16
    • [rtc/AutoBalancer/GaitGenerator.*] Fix bug of toe heel phase. Make independent toe heel phase for leg_coords_generator and refzmp_generator. Use thp instead of thp_ptr->.
    • [rtc/AutoBalancer/testGaitGenerator.cpp] Update zmp diff check thre (10mm->20mm). Update test16. Update step time. Add default zmp offsets.
    • [rtc/AutoBalancer/GaitGenerator.h] Use NUM_TH_PHASES directly.
  • Update abc posik ggtest (#1052)
    • [rtc/AutoBalancer/testGaitGenerator.cpp, CMakeLists.txt] Add test for setFootStepWithParam related functions. CMake test is disabled currently.
    • [rtc/AutoBalancer/AutoBalancer.cpp] Update default value for pos_ik_thre according to hrp2 reset manip pose. 0.1[mm] -> 0.5 [mm].
• sample
  • Update SampleRobot xml project file (#1086)
    • [sample/SampleRobot/samplerobot_auto_balancer.py] Omit demoStandingPosResetting because we use floor5 and we do not need to worry about falling down from the floor.
    • [sample/SampleRobot/samplerobot_auto_balancer.py] Add print message for all autobalancer sample time.
    • [sample/SampleRobot/README.md,SampleRobot.*.xml.in] Use floor5 instead of longfloor
    • [sample/SampleRobot/SampleRobot*.xml.in] Update to sample's xml.in files using latest openhrp-project-generator
  • [sample/SampleRobot/README.md] Add readme to generate sample's xml.in files
  • Update st tests (#1061)
    • [sample/SampleRobot/README.md] Add command documentation to generate xml
    • [rtc/AutoBalancer/GaitGenerator.h] Add toe usage for down-stair walking.
    • [sample/SampleRobot/samplerobot_stabilizer.py] Update st tests. Add stair test. Re-organize all tests. Use swing damping mode.
    • [sample/SampleRobot/SampleRobot.torque.xml.in] Add box for stair walking tests.
• IIRFilter.cpp
  • [rtc/TorqueFilter/IIRFilter.cpp] Fix problem of resetting coefficient value in setParameter (#1077)
  • [TorqueFilter, IIRFilter.h] add getParameter and reset method (#1050)
• AccelerationFilter
  • add AccelerationFilter (#1051)
  • [AccelerationFilter] fix compile AccelerationFilterService.idl
  • [AccelerationFilter] add AccelerationFilter to hrpsys_config.py
  • [AccelerationFilter] add Acceleration Filter
• util/SelfCollisionChecker/main.cpp
  • enables to visualize motion with -olv option (#1055)
• JpegDetector/JpegEncoder/RGB2Gray/VideoCapture
  • Add opencv missing header and namespace for OpenCV3 (#1049)
• Contributors: Fumio KANEHIRO, Isaac Saito, Kei Okada, Shunichi Nozawa, Tatsuya Ishikawa, Yohei Kakiuchi, Yuta Kojio, Iori Yanokura, Yasuhiro Ishiguro

Stable RTCs

• [python/hrpsys_config.py, sample/SampleRobot/*.py] Fix bug of hrpsys version checking. Use StrictVersion for version checking. (#1044)

  System Message: WARNING/2 (<string>, line 635); backlink

  Inline emphasis start-string without end-string.

  • Closes https://github.com/tork-a/rtmros_nextage/issues/260

Unstable RTCs

• IIRFilter

  • Add setParameter, passFilter methods (#1046)

  System Message: WARNING/2 (<string>, line 645)

  Bullet list ends without a blank line; unexpected unindent.

  • [IIRFilter] remove warning message
  • [IIRFilter] add test code for IIRFilter to testIIRFilter
  • [IIRFilter] fix indent on IIRFilter.h IIRFilter.cpp
  • [IIRFilter] add new method for using IIRFilter

• AutoBalancer

  • [rtc/AutoBalancer/GaitGenerator.cpp] fix bug of emergency stop (#1045)
  • Add GaitGenerator Sample codes (#1043)
    • [rtc/AutoBalancer/testGaitGenerator.cpp] Add test for stairdown
    • [rtc/AutoBalancer/GaitGenerator.h] Add print message for swing_trajectory_time_offset_xy2z
  • Update swing trajectory xy and z convergence (#1042)
    • [rtc/AutoBalancer/testGaitGenerator.cpp] Add --swing-trajectory-time-offset-xy2z option for testGaitGenerator
    • [idl/AutoBalancerService.idl, rtc/AutoBalancer/AutoBalancer.cpp,GaitGenerator.h] Add swing_trajectory_time_offset_xy2z for time between Z convergence time and XY convergence time. 0 by default, which does not change default behavior.
    • [rtc/AutoBalancer/GaitGenerator.h] Separate xy interpolation and z interpolation
    • [rtc/AutoBalancer/GaitGenerator.h] Use int for if check
    • [rtc/AutoBalancer/GaitGenerator.h] Return final distance antecedent path ratio
    • [rtc/AutoBalancer/GaitGenerator.h] Separate calc function and interpolate function for antecedent path
    • [rtc/AutoBalancer/GaitGenerator.h] Define foot hoffarbib_interpolation as double type interpolation

  System Message: WARNING/2 (<string>, line 668)

  Bullet list ends without a blank line; unexpected unindent.

  • [rtc/AutoBalancer/GaitGenerator.h] Define interpolate_antecedent_path functions as const member functions.

• OpenNIGrabber

  • Changes point type for depth_and_color (#1041)

• Contributors: Fumio Kanehiro, Shunichi Nozawa, Tatsuya Ishikawa, Yohei Kakiuchi

Stable RTCs

• SequencePlayer
  • [rtc/SequencePlayer/timeUtil.cpp] get_tick(): add support for ARM_ARCH_7A and AARCH64EL (#1018 )
• RobotHardware
  • [rtc/RobotHardware/robot.*] Check read_power_state flags to servo off. If power OFF is detected while servo ON, servo OFF all and write EMG_POWER_OFF. Do not used by default. (#1036)
  • [rtc/RobotHardware/RobotHardware.cpp] checks if model path is given before trying to load(#1001)
    • doesn't return RTC_ERROR to pass tests
    • returns RTC_ERROR is the model path is not given instead of calling abort()
    • checks if model path is given before trying to load
  • Use robothardware with simulation(#995)
    • [RobotHardware] add accessor to m_robot
    • [RobotHardware] base time is taken by a virtual method
• CollisionDetector
  • [CollisionDetector] fix warning message while servo off (#1023)
  • get out from initial collision state (#1015)
    • [CollisionDetector] update test code for collision detector
    • [CollisionDetector] fix, get out from initial collision state
    • add test for CollisionDetector on initial collision state
  • [CollisionDetector] Fix problem when set collision_loop (#993, #990)
    • add version check to test-collision-loop
    • [CollisionDetector] fix behavior when using collision_loop
    • add version check to samplerobot_collision_detector.py
    • add test for collision_loop on CollisionDetector
• fixes warnings detected by -Wsign-compare (#1039)
• fixes warnings detected by -Wreorder (#1038)
• Support clang (#1037)
• [ec/hrpEC/hrpEC-common.cpp] supports trunk version of OpenRTM-aist (https://github.com/fkanehiro/hrpsys-base/commit/efce7d47dc3723c868b66bf6205f93bab99b1537)
• [lib/util, rtc/CollisionDetector, rtc/ServoController, util/monitor] fixes some of compile warnings (#1007 <https://github.com/fkanehiro/hrpsys-base/issues/1007>)
• [hrpsys-base.pc] fix version in hrpsys-base.pc(#1004)
• [CMakeLists.txt] enables to use RelWithDebInfo (#997)
• [CMakeLists.txt] check version in CMakeLists.txt against package.xml (#991)
• [CMakeLists.txt] supports ubuntu16.04 (#989)
• python
  • [python/rtm.py] checks if component is already activated/deactivated (#1024)
  • [python/rtm.py] checks return values of activate_component() and deactivate_component() (#1022)
  • [python/hrpsys_config.py] add method for setInterpolationMode (#1012)
  • [python/hrpsys_config.py] save ReferenceForceUpdater output with DataLogger (#1008)
  • [python/rtm.py] improves efficiency of readDataPort() by returning value of dataport.data_value property if available (#1000)
  • [python/rtm.py] enables to specify interface_type (#998)
  • [python/hrpsys_config.py] Fixed mistake of waitForRTCManagerAndRoboHardware's argument (#988)
  • [pyrhon/hrpsys_config.py] Renamed waitForRTCManagerAndRoboHardware to waitForRTCManagerAndRobotHardware #980 (#984)
• [doc] hrpsys_config.py comment update (#1016)
  • [doc for setJointAnglesSequence*] Wrong param type. Better description.
  • [doc] Add in-code comment for the addition #1012.

Unstable RTCs

• AutoBalancer

  • [rtc/AutoBalancer/AutoBalancer.cpp,rtc/Stabilizer/Stabilizer.cpp] Modify ref force output from ABC to ST (#1035)
  • add new stride limitation type when goPos and goVelocity (#1031)
    • [AutoBalancerService.idl, hrpsys_config.py, AutoBalancer.*, GaitGenerator.h, Stabilizer.*] add idl for leg_margin
    • [samplerobot_auto_balancer.py] add test to check goPos when changing stride limitation type to circle
    • [AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.*] add new stride limitation type when goPos and goVelocity
    • [GaitGenerator.*] fix region of stride limitation
  • add a function to limit stride (#1029)
    • [AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.*] limit stride when use_stride_limitation is true
    • [AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.*] add function to limit stride
    • [hrpsys_config.py, AutoBalancer.*, GaitGenerator.h, Stabilizer.*] get leg_margin from st
  • [AutoBalancer/PreviewController.h] get preview_control_gain f (#1027)
  • [rtc/AutoBalancer/AutoBalancer.{cpp,h}] print limb neame in the case of too large IK error. (#1017)

• Stabilizer

  • Add new st distribution and add interpolator printing. (#1013)

  • [idl/StabilizerService.idl, rtc/Stabilizer/] Add new st_algorithm to check multi contact distribution.
  • [rtc/Stabilizer/Stabilizer.cpp] Update checking of st_algorithm (TPCC or not). This commit should not change behavior.
  • [rtc/SequencePlayer/interpolator.cpp] Add print message for MIN_INTERPOLATION_TIME in interpolator.

  • Update stabilizer sbp_cog_offset and add RobotHardware comment (#987)
    • [rtc/RobotHardware/robot.cpp] Add print message for removeForceSensorOffset and calibrateInertiaSensor
    • [rtc/Stabilizer/Stabilizer.cpp] Fix orientation of sbp_cog_offset (reference world frame -> foot origin frame).

• ReferenceForceUpdater

  • [rtc/ReferenceForceUpdater/,idl/ReferenceForceUpdaterService.idl] add frame parameter to set move_dir in world coordinates (#1033)
  • [rtc/ReferenceForceUpdater] Arrange Reference Force Updater(#1010)
    • [ReferenceForceUpdater/ReferenceForceUpdater.cpp] remove unused local variable, base_name_map.
    • [ReferenceForceUpdater/ReferenceForceUpdater.cpp] remove unncessary lines: setting eet.sensor_name.
    • [ReferenceForceUpdater/ReferenceForceUpdater.h] remove unused variable, m_data.
    • [ReferenceForceUpdater/ReferenceForceUpdater.cpp] remove debug print in constructor and deconstructor because oth er rtc does not have debug print.
    • [ReferenceForceUpdater/ReferenceForceUpdater.cpp] fix indent.
  • [rtc/ReferenceForceUpdater] set time for ReferenceForceUpdater output variable (#1009 )
  • support both arm in ReferenceForceUpdater (#1005)
    • [rtc/ReferenceForceUpdater/ReferenceForceUpdater.cpp] fix indent
    • [sample/SampleRobot/samplerobot_reference_force_updater.py] update rfu sample to check data port
    • [idl/ReferenceForceUpdaterService.idl] remove arm parameter from ReferenceForceUpdaterParam and add arm arg to interfaces of rfu [rtc/ReferenceForceUpdater/ReferenceForceUpdaterService_impl{.h,.cpp}] remove arm parameter from ReferenceForceUpdaterParam [rtc/ReferenceForceUpdater/ReferenceForceUpdater.h] add ReferenceForceUpdaterParam structure [rtc/ReferenceForceUpdater/ReferenceForceUpdater.cpp] add Initialization for use_sh_base_pos_rpy [rtc/ReferenceForceUpdater/ReferenceForceUpdater.cpp] enable to set both arms parameters independently in rfu
  • add sample and test for ReferenceForceUpdater(#1003)
    • [test] add test for ReferenceForceUpdater.
    • [sample/SampleRobot] add sample for ReferenceForceUpdater.

• TorqueFilter

  • [rtc/TorqueFilter/IIRFilter.h] Fix type of getCurrentValue (#1032)

• Beeper

  • [rtc/Beeper] Update mutex lock and use buffer for communication between beep thread and real-time thread. (#1030)

• SelfCollisionChecker

  • adds a tool, hrpsys-self-collision-checker (#1026)

• OpenNIGrabber (#1021)

  • checks if OpenNI2 is installed
  • makes error message from OpenNIGrabber more informative
  • adds a configuration variable, mode
  • improves error handling
  • adds a new component, OpenNIGrabber

• Contributors: Fumio Kanehiro, Isaac I.Y. Saito, Jun Inoue, Ryo Koyama, Kei Okada, Masaki Murooka, Noriaki Takasugi, Shunichi Nozawa, Yohei Kakiuchi, Yuta Kojio, Iori Yanokura

Stable RTCs

• SequencePlayer

  • fix bug of setJointAnglesSequenceFull function in SequencePlayer (updated by snozawa) (#908)
    • [sample/SampleRobot/samplerobot_sequence_player.py] Add optionalData check and comment out clear joint angle check currently not working.
    • [rtc/SequencePlayer/seqplay.cpp] Fix typo : RPY->ACC.
    • rtc/SequencePlayer/SequencePlayer.cpp: fix bug of setJointAnglesSequenceFull function in SequencePlayer.
    • rtc/SequencePlayer/SequencePlayerService_impl.cpp: fix the expected length of acc array in setJointAnglesSequenceFull.
    • sample/SampleRobot/samplerobot_sequence_player.py: add test of setJointAnglesSequenceFull in samplerobot_sequence_player.py
  • sample/SampleRobot/samplerobot_sequence_player.py: remove joint group when finishing test. enable clear test of setJointAnglesSequenceFull. (#914)

• DataLogger

  • Make more explicit the dependence of PointCloudViewer on VTK and on IO package of PCL (#65)

• fix include directory for iob.h/idl/util (#842) (io/iob.h -> hrpsys/io/iob.h, xxx.hh -> hrpsys/idl/xxx.hh, util/xxx.h -> hrpsys/util/xxx.h)

• Update semaphore and EcexutionContext (#970)

  • [ec/hrpEC/hrpEC-common.cpp, hrpEC.h] Add ordinaly debug message for processing time if ENABLE_DEBUG_PRINT is true. Update print message for processing time. Move QNX ifdef for fprintf to header file.
  • [rtc/RobotHardware/robot.[cpp,h] ,rtc/SequencePlayer/SequencePlayer.[cpp,h], rtc/StateHolder/StateHolder.[cpp,h]] Use semaphore.h instead of interprocess_semaphore because we do not use interprocess_semaphore specific functionality. On old OS, interprocess_semaphore cannot be used (boost version <= 1.35.0). This commit is related with the discussion : https://github.com/fkanehiro/hrpsys-base/issues/969

• rtm.py

  • rtm.py : fix wrong commit on #634 (isConnected() and False: ) (#978)
  • test/test-hrpsysconf.py: add check do not connect again if already connected for https://github.com/fkanehiro/hrpsys-base/issues/979

• PDController

  • adds a function to interpolate reference angles (#954)
    • updates description of ref_dt
    • adds a function to interpolate reference angles

• lib/util/VectorConvert

  • fixes a parse problem (#954)

• Update docs (#975)

  • [idl/CollisionDetectorService.idl, RobotHardwareService.idl] Update documentation of idl
  • [doc/Doxyfile.in, doc/package.h] Add beeper RTC documentation links.
  • [README.md] Add documentation for directories, papers, and ros wiki

• Fix include dir for QNX build (#971)

  • [rtc/ImpedanceController/ObjectTurnaroundDetector.h] Add including of Hrpsys.h to pass QNX build.
  • [CMakeLists.txt] Specify include_directories as higher priority to pass QNX build.

• [sample/SampleRobot/samplerobot_emergency_stopper.py,samplerobot_remove_force_offset.py] Use DataLogger instead of readDataPort for sample. (#950)

• sample/SampleRobot/samplerobot_sequence_player.py: fix checkArrayBetween function (#919)

  • Add loadpatternst sample (#907)
    • [sample/SampleRobot/samplerobot_stabilizer.py] Add example for loadPattern + Stabilizer.
    • [sample/SampleRobot/data, CMakeLists.txt] Add generated walking pattern file for SampleRobot. Add installation of data.
  • Update carry sample (#909)

  • [.travis.sh] Download and overwrite deb installed tests for downstream hrpsys-ros-bridge
  • [sample/SampleRobot/samplerobot_carry_object.py] Define object turnaround detection time threshold and use hand fix mode during pushing manipulation.
  • [sample/SampleRobot/README.md] Add conf file setting for el sample README.

  • Update st, abc, el, and travis.sh to pass travis tests (#903)
    • [sample/SampleRobot/samplerobot_soft_error_limiter.py] Check soft error limit checking after version '315.5.0'
    • [.travis.sh] Add inputting of N for mongodb configuration during deb install reported in https://github.com/fkanehiro/hrpsys-base/pull/900#issuecomment-162392884
    • [sample/SampleRobot/samplerobot_soft_error_limiter.py] Use getActualState().command instead of rtm.readDataPort of el joint angle output to keep thread safety.
    • [rtc/AutoBalancer/AutoBalancer.cpp] Revert AutoBalancer 7a8bc6781608d4251b6c268123d99781ea4d405b change which does not pass samplerobot_auto_balancer.py test.
    • [sample/SampleRobot/samplerobot_auto_balancer.py] Use abs for Base RPY error checking and check base RPY error between reference and actual.
    • [rtc/Stabilizer/Stabilizer.*] Update Stabilizer doc including paper names and equation numbers.
  • Update samplerobot python unittest (#912)

  • [sample/SampleRobot/samplerobot_sequence_player.py] Use StateHolder's getCommand to get seq results.

  • [test/test-samplerobot-*.py] Use Unittest for samplerobot example testing to enable test results output and respawn of rostest.

    System Message: WARNING/2 (<string>, line 917); backlink

    Inline emphasis start-string without end-string.

  • [.travis.sh] Print rosunit-*.xml if rostest fails

    System Message: WARNING/2 (<string>, line 918); backlink

    Inline emphasis start-string without end-string.

• Fix pkg-config file, includedir should be the include directory, not the compiler flag. (#947)

• [.travis.sh] Use --purge option for mongodb apt-get remove in order to remove configuration file. (reported in https://github.com/fkanehiro/hrpsys-base/pull/900#issuecomment-162392884) (#906)

Unstable RTCs

• ImpedanceController

  • Fix bug of virtualforce (#976)
    • Modified Stabilizer to fix bug of virtual force
    • Modified ImpedanceController for enabling VirtualForce
  • [rtc/ImpedanceController/ObjectTurnaroundDetector.h,sample/SampleRobot/samplerobot_impedance_controller.py] Fix to use round to convert double time parameter to size_t time count. (#964)
  • Add FFI for JointPathEx (#938)
    • [sample/euslisp/eus-joint-path-ex.l] Add FFI example using euslisp. Keeping hrpsys-base working without euslisp existence.
    • [rtc/ImpedanceController/CMakeLists.txt, JointPathExC.cpp] Add JointPathEx example externed into C used for FFI.
  • [rtc/ImpedanceController/JointPathEx.cpp] Add debug print for nan from Inverse Kinematics calculations (#925)

• ReferenceForceUpdater Add reference force updater (#974)

  • [doc/, rtc/ReferenceForceUpdater/ReferenceForceUpdater.txt] add document for ReferenceForceUpdater
  • [python/hrpsys_config.py, launch/samplerobot.launch] enable to use rfu in robots
  • [idl/, rtc/CMakeLists, rtc/ReferenceForceUpdater/] add new RTC named ReferenceForceUpdater(rfu)

• SoftErrorLimitter

  • [rtc/SoftErrorLimiter/robot.cpp] Add print message for setServoErrorLimit (#967)
  • [rtc/SoftErrorLimiter/SoftErrorLimiter.cpp, sample/SampleRobot/samplerobot_soft_error_limiter.py] Fix reference joint angle used to calculate error. Use joint angle which consider position limit and velocity limit. (#966)

• Beeper

  • Add commenttoconnect and build beeper (#964)
    • [python/rtm.py] Add print message for dataflow_type, subscription_type, and so on.
    • [rtc/CMakeLists.txt] Build Beeper RTC.
  • Add Beeper RTC (#963)
    • [python/hrpsys_config.py] Add Beeper to getUnstableRTC. Change order of el and tl to make tl higher priority for beeping.
    • [rtc/SoftErrorLimiter/SoftErrorLimiter.*, rtc/CollisionDetector/CollisionDetector.*] Support both BeepClient to use BeeperRTC and start_beep for stable beeping RTCs because stable RTC does not support BeeperRTC.
    • [rtc/ThermoLimiter/ThermoLimiter*, rtc/EmergencyStopper/EmergencyStopper.*] Use BeepClient to use BeeperRTC instead of start_beep for unstable beeping RTCs.
    • [rtc/SoftErrorLimiter/beep.h] Add BeepClient class to use BeepRTC
    • [rtc/Beeper] Add RTC to beep which takes input from several RTCs.

• Kalman Filter

  • [EKFilter.h] fix typo : fussy -> fuzzy (#958)
  • Fussy tuned kalman filter (#957)
    • [KalmanFilter/EKFilter.h] use fuzzy logic to tune R matrix
    • [samplerobot_kalman_filter.py] run test programs both with RPYKalmanFilter and with QuaternionExtendedKalmanFilter
    • [samplerobot_kalman_filter.py] start auto balancer at the beginning to avoid slip
    • [samplerobot_kalman_filter.py] compare kf_baseRpyCurrent with SampleRobot(Robot)0_WAIST not kf_rpy
  • Add quaternion kf test (#956)
    • [sample6dofrobot_kalman_filter.py.in] optimize label location
    • [sample6dofrobot_kalman_filter.py.in] add quaternion estimator test
    • [EKFilter.h, KalmanFilter.cpp] implement resetKalmanFilterState in EKFFilter
    • [sample6dofrobot_kalman_filter.py.in] use actual rpy from simualtor
    • [sample/Sample6dofRobot] rotate initial pose
  • Update quaternion ekf (#955)
    • [KalmanFilter/EKFilter.h] update coding styles for readability
    • [KalmanFilter/EKFilter.h] refectering
    • [KalmanFilter/EKFilter.h] use reference instead of returning value
    • [KalmanFilter/EKFilter.h] clean up redundant codes
    • [KalmanFilter/EKFilter.h] use rotation quaternion to rotate coordinate instead of rotation matrix
    • [KalmanFilter/EKFilter.h] use hrpUtil to get Euler Angles from Rotation Matrix
    • [KalmanFilter/EKFilter.h] use const reference parameters
    • [KalmanFilter/EKFilter.h] do not pass a member variable to member functions
    • [KalmanFilter/EKFilter.h] update calcF for readability
    • [KalmanFilter/EKFilter.h] use const member functions
    • [KalmanFilter/EKFilter.h] remove unused old comments
    • [KalmanFilter/EKFilter.h] add a magic comment to use a 2 space indentation
    • [KalmanFilter/EKFilter.h] use initializer list at EKFilter
    • [KalmanFilter/EKFilter.h] Q should be gyro noise covariance in order to make it easy to tune parameters
    • [KalmanFilter/EKFilter.h] normalize rotation quaternion as soon as possible
    • [KalmanFilter/EKFilter.h] acceleration reference is to handle in KalmanFilter.cpp
    • [KalmanFilter/EKFilter.h] fix bug : we should normalize only rotation quaternion

• TorqueController

  • Add getter method to torque controller (#933)
    • [TorqueController] Fix transition time expression bag
    • [TorqueController] Rename paramter argument name in torque controller to corersponding rtm-ros-robot-interface: t_param -> i_param
    • [TorqueController] Add get parameter methods for torque controller
  • Fix torque controller pass qref mode (#926)
    • [TorqueController] Fix merge miss in timestamp
    • [TorqueController] Supress dq from torque controller by min/max_dq
    • [TorqueController] Pass qRefIn without checking range of motion when motor torque contorller is disabled
    • [MotorTorqueController] tauMax should be not zero when tau is zero
    • [TorqueController] Check size of qRef to prevent accessing qRefIn when qRefIn size is not same as joint_num

• AutoBalancer

  • [rtc/AutoBalancer/GaitGenerator.h] Add boundary conditions of velocity and acceleration to GaitGenerator (#981)

  • [rtc/AutoBalancer/GaitGenerator.h] Fix zmp weight interpolation and use setGoal instead of go. (#973)

  • Get foosteps (#939)

    • [AutoBalancer.cpp, GaitGenerator.cpp, GaitGenerator.h] use const member function in getGoPosFootstepsSequence
    • [GaitGenerator.cpp, GaitGenerator.h] pass vel_param for argument in go_pos_param_2_footstep_nodes_list
    • [AutoBalancerService.idl, AutoBalancer.cpp, AutoBalancer.h, AutoBalancerService_impl.cpp, AutoBalancerService_impl.h] add getFootstepsSequence function
    • [GaitGenerator.cpp, GaitGenerator.h] overload go_pos_param_2_footstep_nodes_list to get new_footstep_nodes_list
    • [AutoBalancer.cpp, AutoBalancer.h] move initial_support_legs calculation method from inside goPos to a new method

  • [rtc/AutoBalancer/AutoBalancer.cpp] Initialize gait_type as BIPED. (#937)

  • Update JointPathEx IK (#942)

    • [idl/AutoBalancerService.idl,idl/StabilizerService.idl,rtc/AutoBalancer/AutoBalancer.*,rtc/Stabilizer/Stabilizer.cpp] Enable to set IK weight vector for STtabilizer and Autobalancer like ImpedanceController.
    • [rtc/ImpedanceController/ImpedanceController.cpp,rtc/ImpedanceController/JointPathEx.*,rtc/Stabilizer/Stabilizer.cpp] Move end-effector version inverse kinematics to JointPathEx and use it in IC and ST.
    • [rtc/ImpedanceController/ImpedanceController.cpp,JointPathEx.*,rtc/Stabilizer/Stabilizer.cpp,rtc/AutoBalancer/AutoBalancer.cpp] Add calcInverseKinematics2Loop function to take target pos and Rot and use it in ic, abc, and st. Currently omegaFromRot is under checking and tempolarily use old matrix_log function, so program behaviour does not change.
    • [idl/AutoBalancerService.idl,rtc/AutoBalancer/AutoBalancer.*] Remove deprecated footstep information lleg_coords and rleg_coords. Remove unused current_* parameter from ABCIKparam.

  • fix bug when overwriting footstep (#940)

    • [rtc/AutoBalancer/GaitGenerator.cpp, rtc/AutoBalancer/PreviewController.h] fix bug when overwriting footstep
    • [sample/SampleRobot/samplerobot_auto_balancer.py] Add checking for discontinuity of COG trajectory during footstep overwriting by checking COG too large acc.

  • Update gaitgenerator and fix bugs (#918)

    • [rtc/AutoBalancer/GaitGenerator.cpp,h] Add get_overwrite_check_timing
    • [.travis.sh] Print if rosunit_xml_result_files exists
    • [rtc/AutoBalancer/GaitGenerator.cpp] Enable emergencyStop for walking anytime. Previously, emergency flag is checked at half of step time.
    • [rtc/AutoBalancer/GaitGenerator.cpp] Set toe heel time count based on each footstep step count

  • Update gopos (#877)

    • [sample/SampleRobot/samplerobot_impedance_controller.py] Check hrpsys_version for samplerobot impedance test

    • [rtc/ImpedanceController/JointPathEx.*, AutoBalancer, ImpedanceController, SequencePlayer, Stabilizer] Reduce limit over print message frequence in JointPathEx and add more information for it.

    • [sample/SampleRobot/samplerobot_impedance_controller.py, test/test-samplerobot-impedance.py] Test samplerobot_impedance_controller python example

    • [rtc/*] Update print message from RTCs like [el]

      System Message: WARNING/2 (<string>, line 1065); backlink

      Inline emphasis start-string without end-string.

    • [rtc/AutoBalancer/GaitGenerator.*] Update appending of footstep function. Define both const and non-const member function.

    • [rtc/AutoBalancer/GaitGenerator.*, AutoBalancer.cpp] Enable to overwrite goPos target goal.

    • [sample/SampleRobot/samplerobot_auto_balancer.py] Add check test for goPos final dst_foot_midcoords and add example for goPos overwrite.

    • [rtc/AutoBalancer/GaitGenerator.h] Set is_initialize for gopos true by default to pass tests with default argument.

    • [rtc/AutoBalancer/GaitGenerator.*] Use const member function for getter and printing functions.

  • Overwrite current footstep (#916)

    • [rtc/AutoBalancer/GaitGenerator.cpp] Fix for future velocity footsteps. Integrate future steps.
    • [sample/SampleRobot/samplerobot_auto_balancer.py] Add example for current footstep overwrite
    • [rtc/AutoBalancer/GaitGenerator.cpp,rtc/AutoBalancer/PreviewController.h] Enable to set overwritable_footstep_index_offset = 0.
    • [idl/AutoBalancerService.idl, rtc/AutoBalancer/AutoBalancer.cpp,GaitGenerator.h] Enable to set overwritable_footstep_index_offset.
    • [rtc/AutoBalancer/GaitGenerator.cpp] Fix order of overwrite zmp processing and add comments. This should not change behaviour.
    • [rtc/AutoBalancer/GaitGenerator.cpp,h] Enable to set future_step_num and use get_overwritable_index.

• Stabilizer

  • Add refforce weight to eefmqp (#977)
    • [rtc/Stabilizer/Stabilizer.cpp,ZMPDistributor] Add ref force weight to eefmqp
    • [rtc/AutoBalancer/AutoBalancer.cpp] Modify ref force output
  • [rtc/Stabilizer/ZMPDistributor.h] do not distribute ForceMoment to swing foot (#972)
  • Add fall direction (#948)
    • merge origin/master by hand
    • [AutoBalancer.cpp] stop walking if emergency signal is set
    • [Stabilizer.cpp] check single support phase only in wailking for recovery
    • [StabilizerService.idl, Stabilizer.cpp, Stabilizer.h] add tilt_margin parameter for single support phase and double support phase
    • [StabilizerService.idl, Stabilizer.cpp] add TILT emergency mode
    • [Stabilizer.cpp, Stabilizer.h] add fall direction caulculator
  • Fix abc st segfo (#951)
    • [rtc/AutoBalancer/AutoBalancer.cpp] Fix initialization of target_p0 and target_r0
    • [rtc/Stabilizer/ZMPDistributor.h] Check size of ee params to avoid segfo.
  • [Stabilizer.cpp, Stabilizer.h] fix swing leg modification rule (#949)
  • [StabilizerService.idl, Stabilizer.cpp, Stabilizer.h] add eefm_swing_pos_time_const/eefm_swing_rot_time_const parameter (#949)
  • Add argument check st abc (#945)
    • [sample/SampleRobot/samplerobot_*.py] Use DataLogger log for check robot's state for testing
    • [test/test-samplerobot.test] Set order for samplerobot test execution. For example, DataLogger, SequencePlayer, ...
    • [rtc/AutoBalancer/AutoBalancer.cpp,rtc/Stabilizer/Stabilizer.cpp] Fix location of set Ik parameter and add comments and message
    • [rtc/AutoBalancer/AutoBalancer.cpp,rtc/Stabilizer/Stabilizer.cpp] Add argument length check for IK parameter for AutoBalancer and Stabilizer
  • [idl/AutoBalancerService.idl,idl/StabilizerService.idl,rtc/AutoBalancer/AutoBalancer.cpp,rtc/Stabilizer/Stabilizer.cpp] Use IKLimbParameters instead of each sequence paraemters for IK of AutoBalancer and Stabilizer. (#944)
  • [idl/AutoBalancerService.idl,idl/StabilizerService.idl,rtc/AutoBalancer/AutoBalancer.*,rtc/Stabilizer/Stabilizer.*] Add IK parameter interface for AutoBalancer and Stabilizer. (#943)
  • Add moment limit and test for turnwalk (#936)
    • [sample/SampleRobot/samplerobot_stabilizer.py] Add test for turn walk abount 180[deg] yaw rotation.
    • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.*] Add limitation for end-effector frame local reference moment to avoid hardware break.
  • [Stabilizer.cpp] match f_diff frame to ref_f_diff one (#935)

  • Fix fixed coords again (#917)

    • [AutoBalancer.cpp] resize leg_pos to end-effector size
    • [AutoBalancer.cpp] move leg_pos initialization position
    • [Stabilizer.cpp] match f_diff frame to ref_f_diff one
    • [sample4legrobot_auto_balancer.py] add goVelocity in trot sample
    • [AutoBalancer.cpp, GaitGenerator.cpp, GaitGenerator.h] support multileg in go velocity
    • [GaitGenerator.cpp, GaitGenerator.h] support multi legs for overwirte
    • [sample4legrobot_auto_balancer.py] add goPos in trot and in pace samples
    • [sample4legrobot_auto_balancer.py] move all end-pos +50mm in z axis to get manipulability
    • [AutoBalancerService.idl, AutoBalancer.cpp, AutoBalancer.h] add gait_type to AutoBalancer param to realize multiple gait in goPos
    • [sample4legrobot_auto_balancer.py] add crawl mode test
    • [AutoBalancer.cpp, GaitGenerator.h] fix fixed coordinates in multiple legs : only use legs / re-revert and update https://github.com/fkanehiro/hrpsys-base/commit/ad4eb10d05f98aca9f243bb72a81ffba4b51dd77

  • Modify swing leg end coords (#934)

    • [Stabilizer.cpp] add a new modification law as a comment
    • [Stabilizer.cpp] modify swing leg coods only in actual and reference swing time
    • [Stabilizer.cpp] calulate difference rpy in new_swg_R coordinates at swing leg modification
    • [Stabilizer.cpp] print d_rpy_swing / d_pos_swing for DEBUG
    • [Stabilizer.cpp] support multiple legs for swing leg modification
    • [Stabilizer.cpp] separte rotation scope and position one for readability
    • [Stabilizer.cpp, Stabilizer.h] rename delta_pos / delta_rpy to d_rpy_swing / d_pos_swing and keep these variables as member variables for extensibility
    • [Stabilizer.cpp] use eefm_swing_rot_spring_gain / eefm_swing_rot_spring_gain param
    • [StabilizerService.idl, Stabilizer.cpp, Stabilizer.h] add eefm_swing_rot_spring_gain / eefm_swing_rot_spring_gain as st param
    • [Stabilizer.cpp, Stabilizer.h] modify swing leg end-coords to follow target one in world coordinates

  • Return total force or moment from getObjectForcesMoments and consider moment_center as foot mid frame. (#932)

    • [rtc/ImpedanceController/ImpedanceController.cpp] Check for legged robot.

    • [rtc/ImpedanceController/ObjectTurnaroundDetector.h] Reset current filtered param when detect mode switched.

    • [idl/ImpedanceControllerService.idl, rtc/ImpedanceController/*] Return total force or moment from getObjectForcesMoments and consider moment_center as foot mid frame.

      System Message: WARNING/2 (<string>, line 1159); backlink

      Inline emphasis start-string without end-string.

  • Enable total moment detection by object turnaround detection. (#930)

    • [idl/ImpedanceControllerService.idl,rtc/ImpedanceController/ImpedanceController.cpp,rtc/ImpedanceController/ImpedanceController.h,rtc/ImpedanceController/ObjectTurnaroundDetector.h] Enable total moment detection by object turnaround detection.

  • [Stabilizer.cpp] enable to change compensation limit : omission of https://github.com/fkanehiro/hrpsys-base/pull/852 (#929)

  • [Stabilizer.cpp] fix com height of LIPM in Capture Point calculation (#924)

  • [hrpsys_config.py] start stabilizer after auto-balancer in startDefaultUnstableControllers (#928)

  • [Stabilizer.cpp] fix typo of https://github.com/fkanehiro/hrpsys-base/pull/895 (#922)

  • Update graspless manip mode (#921)

    • [sample/SampleRobot/samplerobot_auto_balancer.py] Add example for dual-arm graspless manip walking.
    • [rtc/AutoBalancer/AutoBalancer.cpp] Support dual-arm graspless mode while walking.

  • Add rostest for stabilizer. (#910)

    • [sample/SampleRobot/samplerobot_stabilizer.py] Check existence of sample1_bush.wrl because openhrp3 <= 3.1.8 does not have it.
    • [test/test-samplerobot-st.test, .travis.yml] Add test for samplerobot st with torque + pdcontrol + bush. Add travis job for testing st test.

• RangeDataViewer

  • rtc/RangeDataViewer/RangeDataViewer.cpp: suppresses debug messages and ignores inf

• get all q log (#915)

  • [CollisionDetector.cpp] set timestamp for out port
  • [TorqueController.cpp] use upstream timestamp instead of current timestamp

• Contributors: Benjamin Chrétien, Eisoku Kuroiwa, Fumio Kanehiro, Iori Kumagai, Kei Okada, Kohei Kimura, Masaki Murooka, Mehdi Benallegue, Ryo Koyama, Shunichi Nozawa, Takasugi Noriaki, Yohei Kakiuchi, Yuta Kojio, Iori Yanokura

Stable RTCs

• add rtc xml (https://github.com/fkanehiro/hrpsys-base/pull/880)
• [rtc/SequencePlayer/interpolator.*,seqplay.cpp,rtc/AutoBalancer/AutoBalancer.cpp,rtc/AutoBalancer/GaitGenerator.h,rtc/CollisionDetector/CollisionDetector.cpp,rtc/EmergencyStopper/EmergencyStopper.cpp]

Add name for interpolator and set name for RTCs using interpolator (#848 )

• [README.md, sample/README.md] Add link for samples README.md
• [lib/util/BodyRTC.cpp] Do not use servo off emulation in HighGain mode.
• [python] Clarify arguments for setTargetPoseRelative
• [python/hrpsys_config.py] Modify hrpsys_config.py for connection
• [ec/hrpEC/hrpEC-common.cpp, hrpEC.h] Get RTC names when rtcs size change for https://github.com/fkanehiro/hrpsys-base/issues/806
• [ec/hrpEC/hrpEC-common.cpp] shows instance names when time over is detected
• [.travis.yml] Exec USE_SRC_OPENHRP3=true tests in faster orders to make debug of these tests easy.
• [.travis.{sh,yml}] add test code for openhrp3 source
• [.travis.yml] add slack notification https://jsk-robotics.slack.com/messages/travis/details/
• Change include file path settings in hrpsys-base.pc file
  • [test/test-pkgconfig.py] fixes a include path ("io/iob.h" -> "hrpsys/io/iob.h")
  • [hrpsys-base.pc.in] changes includedir in pc file
• RobotHardware
  • [rtc/RobotHardware/robot.cpp] Add a compile option to add default implementation whenever readDigitalInput and lenghtDigitalInput are not available
  • Add a port and methods to read command torques, as well as actual torques. (They differ when the robot has torque sensing capabilities)
  • [rtc/RobotHardware/robot.cpp] Add print message for setServoGainPercentage
• SequencePlayer
  • [rtc/EmergencyStopper/EmergencyStopper.cpp,rtc/SequencePlayer/SequencePlayer.cpp] fill time stamp on reference of angles
  • Protect pop() and pop_back() operations with a mutex(#839 )
  • [rtc/SequencePlayer/interpolator.{cpp,h}] Switch to using coil::Guard instead of boost
  • [rtc/SequencePlayer/interpolator.{cpp,h}] Include locks.hpp instead of lock_guard, for backwards compatibility
  • [rtc/SequencePlayer/interpolator.{cpp,h}] Protect pop() and pop_back() operations with a mutex to avoid popping twice the same element
• DataLogger
  • [rtc/DataLogger/DataLogger.cpp] Add message printing to DataLogger functions
• rtm.py
  • [python/rtm.py] narrow to RTObject produce error on some environments (#858 )
  • [python/rtm.py] Add try&except for import CORBA failing on old python environment.
• hrpsys_config.py
  • [python/hrpsys_config.py] Support latest startAutoBalancer in startDefaultUnstableControllers.
  • [python/hrpsys_config.py] Use 4limbs in startAutoBalancer when Groups has rarm and larm.
  • [python/hrpsys_config.py, rtc/AutoBalancer/AutoBalancer.*, rtc/Stabilizer/Stabilizer.*, rtc/Stabilizer/ZMPDistributor.h] shift a support polygon when set-ref-force
  • fix typo: tmp_contollers -> tmp_controllers
  • [python/hrpsys_config.py, rtc/Stabilizer, rtc/AutoBalancer] add walkingStates port from abc to st
  • [python/hrpsys_config.py] Add el log for final reference joint angles output for both Stable RTC users and Unstable RTC Users

Unstable RTCs

• Samples

  • [sample/SampleSpecialJointRobot/SampleSpecialJointRobot.conf.in] Add interlocking joint setting

  • [sample/environments/Dumbbell.wrl, sample/SampleRobot/samplerobot_carry_object.py] Update Dumbbell handle and add auto detection sample

  • [README.md, sample/SampleRobot/README.md] Add new sample explanation to SampleRobot README and add link to top page

  • [sample/environments/Dumbbell.wrl, sample/SampleRobot/samplerobot_carry_object.py] Update Dumbbell handle and add auto detection sample

  • [sample/SampleRobot/ForceSensorOffset_SampleRobot.txt, samplerobot_carry_object.py, CMakeLists.txt] Add force sensor offset for rmfo and update controller initialization in carry sample

  • [sample/SampleRobot/carry, sample/environments/PushBox.wrl] Add push box and push manipulation demo

  • [sample/SampleRobot/SampleRobot.carryobject.xml.in,samplerobot_carry_object.py] Add ABS_TRANSFORM for each object and add walking example

  • sample/environments/Dumbbell.wrl, sample/SampleRobot/*] Add Dumbbell model and add carry up example.

    System Message: WARNING/2 (<string>, line 1266); backlink

    Inline emphasis start-string without end-string.

  • [sample/SampleSpecialJointRobot/, rtc/AutoBalancer/] Enable toe joint example and support robots witch leg joints >= 7

  • [launch/samplespecialjointrobot.launch, sample/SampleSpecialJointRobot/, sample/CMakeLists.txt] Add files for SampleSpecialJointRobot

  • [sample/Sample4LegRobot] Add kinematics simulation xml and call set parameter func in demo program

  • [sample/Sample4LegRobot/sample4legrobot_stabilizer.py] Update st params

  • [sample/Sample4LegRobot/Sample4LegRobot.xml.in] Use non-bush model for non-torquecontrol simulation

  • [sample/Sample*Robot/Sample*Robot.conf.in] Add optionalData setting

  • [sample/Sample*Robot/Sample*Robot.conf.in] Add parameters for ThermoLimter and CollisionDetector and hide print messages on simulation

  • [sample/Sample4LegRobot/sample4legrobot_stabilizer.py] Add st and abc setting

  • [launch/sample4legrobot.launch, sample/Sample4LegRobot, sample/CMakeLists.txt] Add files for Sample4LegRobot

  • [sample/SampleRobot/SampleRobot.conf.in, rtc/PDcontroller/PDcontroller.cpp] Enable to set gain file from bindParameter (https://github.com/fkanehiro/hrpsys-base/pull/789) and rename pdgains_sim.file_name => pdgains_sim_file_name

  • [sample/SampleRobot/samplerobot_auto_balancer.py] add a sample program of setFootSteps with arms

  • [sample/SampleRobot/samplerobot_auto_balancer.py] add a sample program of four leg auto-balancer

  • [sample/SampleRobot/samplerobot_auto_balancer.py] add four legs mode pose

  • [sample/SampleRobot/samplerobot_auto_balancer.py] apply numpy.allclose to list of list

  • [sample/SampleRobot/samplerobot_auto_balancer.py] set acceptable error between reference and actual default_zmp_offsets

  • [sample/SampleRobot/samplerobot_auto_balancer.py] add debug message to demoAutoBalancerSetParam

  • [sample/SampleRobot/samplerobot_stabilizer.py] Tune stabilizer eefm parameter using rubber bush and torque control mode

  • [sample/SampleRobot/samplerobot_soft_error_limiter.py] Remove unnecessary mdlldr and fix newline

  • [sample/SampleRobot/samplerobot_soft_error_limiter.py] Update limit table check and add error and vel limit check

  • [launch/samplerobot.launch,sample/SampleRobot/SampleRobot.PDgain.dat,SampleRobot.torque.xml.in] Update torquecontrol to use sample1_bush

  • [sample/SampleRobot/samplerobot_auto_balancer.py] add assert to check success of setting default_zmp_offsets

  • [sample/SampleRobot/samplerobot_stabilizer.py] Fix samplerobot st sample parameter

• AutoBalancer (support 4 legs)

  • [rtc/AutoBalancer/AutoBalancer.cpp] do not change autobalancer mode when leg_names are unchanged
  • [rtc/AutoBalancer/AutoBalancer.cpp] Set is_hand_fix_mode false by default same as startautobalancer in [rleg, lleg].
  • [sample/Sample4LegRobot/sample4legrobot_stabilizer.py,sample/SampleRobot/samplerobot_auto_balancer.py,sample/SampleSpecialJointRobot/samplespecialjointrobot_auto_balancer.py]

Update samples for startAutoBalancer update.

• [sample/Sample4LegRobot/sample4legrobot_auto_balancer.py] Add Rectangle and Cycloiddelay orbit 4leg walking samples.
• [rtc/AutoBalancer/GaitGenerator.[cpp,h]] Support rectangle and cycloiddelay for multi leg walking. Currently other orbits are not supported because we need to update a method to parameter setting and getting.
• [AutoBalancer/AutoBalancer.cpp] fix fixed coordinates in multiple legs : only use legs
• [AutoBalancer/AutoBalancer.cpp, Stabilizer/Stabilizer.cpp] do not change end-effector parameters except during MODE_IDLE
• [rtc/AutoBalancer/AutoBalancer.cpp] add end_effector_list to set/getAutoBalancerParam
• [idl/AutoBalancerService.idl] add end_effector_list to AutoBalancerParam
• [sample/SampleRobot] set all limbs to limbs arguments in trot walking
• [sample/Sample4LegRobot] add a trot walking demo program
• [AutoBalancer/GaitGenerator.cpp] modify toe heel angle in only biped or crawl
• [rtc/AutoBalancer/AutoBalancer.cpp] Disable to change new zmp parameter and Modify for old zmp parameter
• [rtc/AutoBalancer/AutoBalancer.cpp] Enable to Change zmp parameters
• [rtc/AutoBalancer/AutoBalancer.cpp] Add Zmp parameter (default double support ratio before and after)
• [rtc/AutoBalancer/AutoBalancer.cpp] Add Zmp Parameter(default double support static ratio before and after)
• [rtc/AutoBalancer/AutoBalancer.cpp] Fix rotation of hand fix coords offset
• [sample/SampleRobot/samplerobot_auto_balancer.py] Fix order of samples and update for zmp transition and fix hands
• [rtc/AutoBalancer/AutoBalancer.txt] Update fix hand mode according to cog vel and update documentation.
• [sample/SampleRobot/samplerobot_auto_balancer.py] Add sample for hand fix walking.
• [idl/AutoBalancerService.idl, rtc/AutoBalancer/AutoBalancer.[cpp,h]] Add hand fix mode. By default, no fix mode.
• [rtc/AutoBalancer/GaitGenerator.cpp] Check difference projected on start coords to avoid problems reported in https://github.com/fkanehiro/hrpsys-base/issues/845
• [idl/AutoBalancerService.idl, rtc/AutoBalancer/AutoBalancer.cpp] add use_force_mode to AutoBalancerParam

• AutoBalancer (support external forces)
  • [idl/AutoBalancerService.idl, rtc/AutoBalancer/AutoBalancer.cpp] add use_force_mode to AutoBalancerParam
  • add leg orbit type for cross step
  • [rtc/Autobalancer/GaitGenerator.cpp] Modify leg coords generator for changing double support time after swing

　* [rtc/Autobalancer/Autobalancer.cpp] Disable to change double support time for swing leg 　* [rtc/AutoBalancer/AutoBalancer.cpp] Add double support time before and after swing to AutoBalancer

• [rtc/AutoBalancer/GaitGenerator.cpp] Do not reuse vector for swing foot zmp offsets.
• [rtc/AutoBalancer/GaitGenerator.h] Fix printing of footsteps.
• [rtc/AutoBalancer/AutoBalancer.cpp] Substitute ref_forces calculated from ZMP for ref_force's outport at ABC
• [rtc/AutoBalancer/AutoBalancer.cpp] Add Outport of ref_forces to AutoBalancer
• [rtc/AutoBalancer/AutoBalancer.cpp] Set Contact States for ee not included in leg_names to false
• [rtc/AutoBalancer/AutoBalancer.*] Enable to output contact and swing support time
• [AutoBalancer.*] add leg_names_interpolator in order to change leg_names during MODE_ABC
• [AutoBalancer.cpp] add Guard at the top of setAutoBalancerParam
• [rtc/AutoBalancer/testGaitGenerator.cpp,GaitGenerator.cpp] Fix double support phase count and contact state change.
• [rtc/AutoBalancer/GaitGenerator.*] Add is_swing_phase member
• [rtc/AutoBalancer/testGaitGenerator.cpp] Display contact states on swing support time plotting
• [AutoBalancer.cpp, GaitGenerator.*] extend contactStates, controlSwingSupportTime and limbCOPOffset for arms
• [AutoBalancer.cpp] fix typo of index
• [rtc/AutoBalancer/AutoBalancer.*] Reduce debug pring for ik error
• [GaitGenerator.cpp] fix the order of passing arguments
• [AutoBalancer.cpp] use target_p0/r0 instead of target_link->p/R to calculate ref_cog in order to avoid discontinuity of ref_cog
• [AutoBalancer.cpp, GaitGenerator.h] add zmp_weight_interpolator
• [AutoBalancer.*] rename zmp_interpolator to zmp_offset_interpolator for zmp_weight_interpolator
• [idl/AutoBalancerService.idl, AutoBalancer.cpp, AutoBalancerService_impl.cpp] set the number of default_zmp_offsets according to the number of end-effectors
• [AutoBalancer/AutoBalancer.cpp] fix typo : get_default_step_height -> get_toe_angle / get_heel_angle
• [AutoBalancer.cpp] move some code blocks in onInitialize to use end-effector information
• [rtc/AutoBalancer/AutoBalancer.cpp] Fix abc ik error bug. Calculate difference from current->target and update threshold
• [testGaitGenerator.cpp] cannot use comparison operator between const std::vector<std::string> and boost::assign::list_of(std::string) in HRP2 inside PC
• [idl/AutoBalancerService.idl, AutoBalancer.cpp, AutoBalancerService_impl.cpp] add zmp_weight_map to GaitGeneratorParams
• [AutoBalancer.cpp, GaitGenerator.*] add zmp weight map which is used in target zmp calculation
• [rtc/AutoBalancer/AutoBalancer.cpp] Do not check ik error during start and stop auto balancer
• [idl/AutoBalancerService.idl, AutoBalancer.*, AutoBalancerService_impl.*, GaitGenerator.h] add setFootStepNodes for multiple legs
• [GaitGenerator.h] use weight factor in get_swing_support_mid_coords for crawl walking
• [GaitGenerator.h] print index of foot steps
• [AutoBalancer.cpp] do not print unless DEBUG mode
• [GaitGenerator.h] add default constructor of step_node
• add outport for ref-capture-point
• [idl/AutoBalancerService.idl, rtc/AutoBalancer/AutoBalancer.*] Enable to check ik error.

• Stabilizer (capture points)

  • [rtc/Stabilizer/Stabilizer.cpp] Fix bug of st compensation frame.

  • [rtc/Stabilizer/Stabilizer.cpp] fix calculation of cp for visualization

  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.*] check whether capture point is inside support polygon

  • [rtc/Stabilizer/ZMPDistributor.h] add function to check whether point is inside support polygon

  • [rtc/Stabilizer/ZMPDistributor.h] add function to calculate ConvexHull

  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.*] disable emergency stop while walking by default

  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.cpp] add end_effector_list to set/getParameter

  • [Stabilizer/Stabilizer.cpp] add mutex guards

  • [Stabilizer/Stabilizer.cpp] add tm info to out ports

  • [rtc/Stabilizer/Stabilizer.cpp] fix bug about checking cp error

  • [rtc/Stabilizer/Stabilizer.cpp] fix typo : Reduce frequency of cp error print message

  • [Stabilizer/Stabilizer.cpp] set contact states for all the limbs

  • [idl/AutoBalancerService.idl] Change idl's description

  • [rtc/Stabilizer/Stabilizer.cpp, rtc/Stabilizer/ZMPDistributor.h] change detection of falling with cp

  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.*] enable to set compensation limit

  • [rtc/Stabilizer/Stabilizer.cpp] Enable to set emergency_check_mode always.

  • [rtc/Stabilizer/Stabilizer.*] Reduce frequency of cp error print message

  • [rtc/Stabilizer/Stabilizer.cpp] Use inport ref-force moment for initial values.

  • [rtc/Stabilizer/Stabilizer.cpp] Fix wait for stop stabilizer.

  • [rtc/Stabilizer/ZMPDistributor.h, Stabilizer.cpp] Use pinv version for multileg debug and add print messages

  • [rtc/Stabilizer/ZMPDistributor.h] Use limb_gain for feedforward force calculation

  • [rtc/Stabilizer/] Use limb gain for swing support transition

  • [rtc/Stabilizer/ZMPDistributor.h] Add non inequality distribution

  • [idl/StabilizerService.idl] convert CapturePoint from foot-origin relative to root-link relative

  • [rtc/Stabilizer/Stabilizer.cpp] Fix st sensor name check for robots with toe joints

  • [rtc/Stabilizer/Stabilizer.*] Enable swing->support gain transition

  • [rtc/Stabilizer/Stabilizer.cpp, rtc/AutoBalancer/GaitGenerator.*] Print swing support time and consider swing phase for swing suport time calculation

  • [rtc/Stabilizer/Stabilizer.*] Calc swing support gain from remain time

  • [rtc/Stabilizer/Stabilizer.cpp, ZMPDistributor.h] Use cop distance and add d_foot_pos print message

  • [rtc/Stabilizer/Stabilizer.cpp] Add independent limb ik

  • [rtc/Stabilizer/Stabilizer.cpp] Reduce redundant calculation of pos_ctrl

  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.cpp] Remove deprecated parameters for old st mode

  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.*] Add argument to select force difference control mode

  • [python/hrpsys_config.py, rtc/Stabilizer/Stabilizer.*] Update st debug reference and compensation port for multi legged robots

  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.cpp, sample/Sample*/*_stabilizer.py] Enable to set all vertices of support polygon

    System Message: WARNING/2 (<string>, line 1394); backlink

    Inline emphasis start-string without end-string.

  • [rtc/Stabilizer/testZMPDistributor.cpp] Initialize ref force moment for test

  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.*] Enable to set eefmqpcop algorithm

  • [rtc/Stabilizer/ZMPDistributor.h] Update for multi leg force moment distribution

  • [rtc/Stabilizer/Stabilizer.*] Rename ref force moment variable

  • [rtc/Stabilizer/*] Enable to set limb ref force and moment

    System Message: WARNING/2 (<string>, line 1399); backlink

    Inline emphasis start-string without end-string.

  • [rtc/Stabilizer/Stabilizer.*] Fix for prev act force z

  • [rtc/Stabilizer/Stabilizer.cpp] Use zmp calc and feedback checking

  • [rtc/Stabilizer/ZMPDistributor.h] Fix for compile not USE_QPOASES

  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.*] Add parameter for end effector feedback and zmp calc params

  • [rtc/Stabilizer/ZMPDistributor.h, rtc/Stabilizer/testZMPDistributor.cpp] Add force moment distribution by cop distance

  • [rtc/Stabilizer/testZMPDistributor.cpp] Fix plotting of test zmp distributor

  • [rtc/Stabilizer/Stabilizer.*, rtc/EmergencyStopper/EmergencyStopper.cpp] Reset emergency flag when st mode is moved to idle or air.

  • [rtc/Stabilizer/Stabilizer.cpp, rtc/AutoBalancer/AutoBalancer.cpp, rtc/ImpedanceController/ImpedanceController.cpp, JointPathEx.*] Enable interlocking joints setting for AutoBalancer, ImpedanceController, Stabilizer

  • [idl/StabilizerService.idl] Update comments of types

  • [rtc/Stabilizer/Stabilizer.cpp] Update print message and add setter check

  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.*] Enable to set all end effector damping param.

  • [rtc/Stabilizer/Stabilizer.*] Add d_foot_xx to st ik param

  • [rtc/Stabilizer/Stabilizer.*] Use LPF for target ee diff p

  • [rtc/Stabilizer/Stabilizer.*] Enable to use body attitude control for both tpcc and eefm

  • [rtc/Stabilizer/*] Use LPF in IIRFilter.h

    System Message: WARNING/2 (<string>, line 1414); backlink

    Inline emphasis start-string without end-string.

  • [rtc/Stabilizer/ZMPDistributor.h] Fix argument for USE_QPOASES OFF

  • [rtc/Stabilizer/Stabilizer.*] Remove deprecated leg variables and force sensor checking in every loop

  • [python/hrpsys_config.py, rtc/Stabilizer/Stabilizer.*] Connect all force sensors and do not check whether leg or not in python and connection phase

  • [rtc/Stabilizer/testZMPDistributor.cpp, Stabilizer.cpp, ZMPDistributor.h] Fix immediate value for rleg lleg index.

  • [rtc/Stabilizer/ZMPDistributor.h] Fix const addition

  • [rtc/Stabilizer/ZMPDistributor.h] Fix rleg and lleg usage

  • [rtc/Stabilizer/ZMPDistributor.h,rtc/Stabilizer/testZMPDistributor.cpp] Update test moment plot range and extract calc alpha function

• ImpedanceController (estimated force and external objects)

  • [idl/ImpedanceControllerService.idl,rtc/ImpedanceController/ImpedanceController.cpp,rtc/ImpedanceController/ObjectTurnaroundDetector.h] Add tuning parameter for time count after object turnaround detection.

  • [idl/StabilizerService.idl, rtc/Stabilizer/ZMPDistributor.h, rtc/Stabilizer/Stabilizer.*] change variable type of cp_check_margin

  • [rtc/ImpedanceController/JointPathEx.cpp] Fix bug of interlocking joint. Initialize matrix by zero setting.

  • [rtc/ImpedanceController/ImpedanceController.cpp] Print impedance control parameter when DEBUGP controlled by debugLevel.

  • [idl/ImpedanceControllerService.idl,rtc/ImpedanceController/ImpedanceController*, ObjectTurnaroundDetector.h] Return object turnaround detector mode while checking.

  • [idl/ImpedanceControllerService.idl, rtc/ImpedanceController/Impedance*] Add get function for estimated force and moment

  • [idl/ImpedanceControllerService.idl, rtc/ImpedanceController/*] Add idl service functions for object turnaround detector.

    System Message: WARNING/2 (<string>, line 1431); backlink

    Inline emphasis start-string without end-string.

  • [rtc/ImpedanceController/ObjectTurnaroundDetector.h] Add axis and update params

  • [rtc/ImpedanceController/ObjectTurnaroundDetector.h] Add counter and fix checking

  • [rtc/ImpedanceController/*] Add ObjectTurnaroundDetector and tests

    System Message: WARNING/2 (<string>, line 1434); backlink

    Inline emphasis start-string without end-string.

  • [idl/ImpedanceControllerService.idl, rtc/ImpedanceController/Impedance*] Add get function for estimated force and moment

  • [idl/ImpedanceControllerService.idl, rtc/ImpedanceController/*] Add idl service functions for object turnaround detector.

    System Message: WARNING/2 (<string>, line 1436); backlink

    Inline emphasis start-string without end-string.

  • [rtc/ImpedanceController/ObjectTurnaroundDetector.h] Add axis and update params

  • [rtc/ImpedanceController/ObjectTurnaroundDetector.h] Add counter and fix checking

  • [rtc/ImpedanceController/*] Add ObjectTurnaroundDetector and tests

    System Message: WARNING/2 (<string>, line 1439); backlink

    Inline emphasis start-string without end-string.

  • [rtc/ImpedanceController/JointPathEx.*] Add interlocking joint usage. Add interlocking joint component to jacobian and workspace velocity.

• EmergencyStopper

  • add test for emergency stop of wrench in samplerobot_emergency_stopper.py
  • connect data ports of wrenches for EmergencyStopper.
  • interpolate wrenches according to emergency_mode.
  • connect servoState from rh to es.
  • add input/output dataport for reference force sensors in EmergencyStopper

• GaitGenerator

  • [rtc/GaitGenerator.h] Add get function for cog vel and cog acc

• ThermoLimitService

  • [idl/ThermoLimiterService.idl, rtc/ThermoLimiter/ThermoLimiter.*, rtc/ThermoLimiter/ThermoLimiterService_impl.*] enable to set and get ThermoLimiter parameters
  • [ThermoLimiter/ThermoLimiter.cpp] decrease debug messages

• PDController

  • [rtc/PDcontroller/PDcontroller.cpp] Add check for m_robot in PDcontroller (https://github.com/fkanehiro/hrpsys-base/issues/796)
  • [rtc/PDcontroller/PDcontroller.*, sample/SampleRobot/SampleRobot.conf..in] Add torque limit ratio for PDcontroller simulation.
  • [PDcontroller] read gain file at onActivated
  • [rtc/PDcontroller/PDcontroller.*] Remove unused joint reading and add debugLevel and debug print
  • [rtc/PDcontroller/PDcontroller.*] Initialize pdgain and joint angles in onExecute to use bindParameter
  • [rtc/PDcontroller/CMakeLists.txt, PDcontroller.*] Add tlimit based on ModelLoader climit.
  • [PDcontroller] initialize reference angle with current angle at onActevated()

• GraspController

  • [rtc/GraspController/GraspController.cpp] Move to idle mode when servo on/off deactivation

• KalmanFilter

  • [KalmanFilter] add time stamp to output of Kalmanfilter

• SoftErrorLimiter

  • [rtc/SoftErrorLimiter/SoftErrorLimiter.cpp] Limit joint angles in one for loop
  • [rtc/SoftErrorLimiter/SoftErrorLimiter.cpp] Move comments for joint/link
  • [rtc/SoftErrorLimiter/SoftErrorLimiter.cpp] Remove unused variable
  • [rtc/SoftErrorLimiter/SoftErrorLimiter.cpp] Update limitation considering vel, pos, err at once
  • [rtc/SoftErrorLimiter/SoftErrorLimiter.cpp] Limitation by llimit and ulimit to approach valid joint range when (llimit > m_qRef.data[i] && prev_angle[i] <= m_qRef.data[i]) or ( ulimit < m_qRef.data[i] && prev_angle[i] >= m_qRef.data[i] )
  • [rtc/SoftErrorLimiter/SoftErrorLimiter.cpp] Store total last output as prev_angle

• TorqueFilter

  • [TorqueFilter/testIIRFilter.cpp] fix header file to pass qnx
  • [rtc/TorqueFilter/CMakeLists.txt] Add cmake test for testIIRFilter
  • [rtc/TorqueFilter/testIIRFilter.cpp] Enable test for hrp::Vector3
  • [rtc/TorqueFilter/IIRFilter, rtc/TorqueFilter/Stabilizer.cpp, ZMPDistributor.h] Initialize value in constructor
  • [rtc/TorqueFilter/testIIRFilter.cpp, CMakeLists] Add test for IIR filter

• ServoController

  • use 0x... format instead of binary format 0b... Fixes (#868 )
  • [rtc/ServoController/ServoSerial.h, CMakeLists.txt] Check gcc version >= 4.3 for binary format integer constant. (For forl old ubuntu #854 )

• Contributors: Eisoku Kuroiwa, Fumio KANEHIRO, Hervé Audren, Isaac IY Saito, Kei Okada, Shunichi Nozawa, Takasugi Noriaki, Yohei Kakiuchi, Yosuke Matsusaka, Yuta Kojio, Masaki Murooka, jenkinshrg

Stable RTCs

• [doc] Remove old info from downstream pkg
• [CMakeLists.txt] Build 3rdparty directory
• [3rdparty] Add 3rdparty directory based on https://github.com/fkanehiro/hrpsys-base/pull/683 discussion (currently for qpOASES)
• [test/test-samplerobot-el.test] Increase rostest execution time
• [.travis.sh] Check make test
• [.travis] add more information on test matrix see https://github.com/fkanehiro/hrpsys-base/pull/363#issuecomment-122634139
• SequencePlayer
  • [sample/SampleRobot/samplerobot_*.py] Direct printing message to stderr to visualize in rostest results.
  • [sample/SampleRobot/samplerobot_sequence_player.py] Fix invalid length of joint angle function of groups
  • [sample/SampleRobot/samplerobot_sequence_player.py] Direct printing message to stderr to visualize in rostest results.
  • [rtc/SequencePlayer/seqplay.cpp] Fix typo in print message
  • [rtc/SequencePlayer/SequencePlayer*, rtc/SequencePlayer/seqplay*] Add checking of length of argument joint angles for setJointAnglesOfGroups and setJointAnglesSequenceOfGroup and update related function arguments.
  • [sample/SampleRobot/samplerobot_stabilizer.py, samplerobot_remove_force_offset.py, samplerobot_kalman_filter.py, samplerobot_auto_balancer.py] Check hrpsys version for unstable rtc testing
• CollisionDetector
  • [test/test-samplerobot-collision.py,test-samplerobot-datalogger.py] Add unittest for collision and datalogger
  • [sample/SampleRobot/samplerobot_collision_detector.py, samplerobot_data_logger.py] Use functions in hrpsys_config.py instead of idl functions
  • [sample/SampleRobot/samplerobot_collision_detector.py] Add assert for unittesting of collision check. (Comment out collision mask sample because it requires conf change).
• SoftErrorLimitter
  • [rtc/SoftErrorLimiter/SoftErrorLimiter.cpp] Fix bug of Velocity limitation in https://github.com/fkanehiro/hrpsys-base/pull/726
  • [sample/SampleRobot/samplerobot_soft_error_limiter.py] Check hrpsys version
  • [rtc/SoftErrorLimiter/JointLimitTable., rtc/ImpedanceController/JointPathEx*, rtc/SoftErrorLimiter/CMakeLists.txt, rtc/SoftErrorLimiter/SoftErrorLimiter.h] Move limit table codes to separated file.
  • [sample/SampleRobot/samplerobot_soft_error_limiter.py] Add position limit testing
  • [test/test-samplerobot-el.*, sample/SampleRobot/samplerobot_soft_error_limiter.py] Add rostest for soft error limiter
  • do not check position/limit error when lower limit and upper limit is same

Unstable RTCs

• [python/hrpsys_config.py] Enable thermolimiter and thermoestimator (in Unstable RTC)

• [test/test-samplerobot.test, test-samplerobot-*.py] Add rostests for unstable rtcs.

  System Message: WARNING/2 (<string>, line 1543); backlink

  Inline emphasis start-string without end-string.

• [test/test-samplerobot.test] Add data logger and collision detector tests to samplerobot rostest.

• [CMakeLists.txt, rtc/[AutoBalancer, ImpedanceController, Stabilizer]/CMakeLists.txt] Add enable_testing to toplevel cmake and add add_test for impedance, autobalnacer, and stabilizer examples

• AutoBalancer (Support 4/multi leg mode)

  • [GaitGenerator.cpp] fix bug: keep align the order of names and coordinates of foostep_nodes_list.front()
  • [AutoBalancer.cpp, GaitGenerator.*] add multi_mid_coords function to calculate a midcoords of multi coordinates in fixLegToCoords, get_swing_support_mid_coords and stopWalking
  • [AutoBalancer.cpp] use leg_names instead of "rleg" or "lleg"
  • [GaitGenerator.*] use leg_type_map in order to convert between leg_type and name
  • [AutoBalancer.cpp, GaitGenerator.h] move leg_type_map to gait_generator
  • [GaitGenerator.*] rename get_support_leg_types_from_footstep_nodes to calc_counter_leg_types_from_footstep_nodes
  • [GaitGenerator.*] move get_support_leg_types_from_footstep_nodes to gait_generator
  • [AutoBalancer.cpp, GaitGenerator.h] fix return type of get_dst_foot_midcoords from std::vector<coordinates> to coordinates because we need the reference coordinates
  • [GaitGenetarot.*] keep swing_legs at update_leg_steps
  • [AutoBalancer.cpp] consider some variable life times
  • [AutoBalancer.cpp, GaitGenerator.*, testGaitGenerator.cpp] use step_node instead of coords because we need to align the oder of names of legs and coords of legs
  • [AutoBalancer.cpp, GaitGenerator.*, testGaitGenerator.cpp] fix variable names of legs and corresponding method names
  • [GaitGenerator.h] add hints for the second template argument of boost::assign::list_of at a constructor initialization phase
  • [GaitGenerator.*] use std::count_if instead of boost::count_if since HRP2 inside PC does not support boost::count_if
  • [GaitGenerator.*] use vector class functions to get errors : http://qiita.com/ota42y/items/f2067f6b81dd15bca95a
  • [AutoBalancer.cpp] improve startWalking for multiple legs
  • [AutoBalancer.cpp, GaitGenerator.*, testGaitGenerator.cpp] improve go_pos_param_2_footstep_nodes_list for multiple legs
  • [AutoBalancer.cpp, GaitGenerator.*, testGaitGenerator.cpp] remove an unused argument of go_pos_param_2_footstep_nodes_list
  • [AutoBalancer.cpp, GaitGenerator.h] fix indent
  • [AutoBalancer.cpp, GaitGenerator.*, testGaitGenerator.cpp] add an argument of go_pos_param_2_footstep_nodes_list to set start_ref_coords no matter which gait we choose
  • [GaitGenerator.*] improve get_swing_legs of leg_coords_generator for multiple legs
  • add outport for capture point
  • [GaitGenerator.cpp/.h] extend append_go_pos_step_nodes to get an argument of multiple legs
  • [AutoBalancer.cpp, GaitGenerator.cpp/h, testGaitGenerator.cpp] add a variable named all_limbs which stands for candidates of contact legs
  • [GaitGenerator.cpp, .h] fix a function name to follow the naming rule
  • [GaitGenerator.cpp] use count_if for multiple legs
  • [GaitGenerator.cpp] use min max functions for the stride limits
  • [sample/SampleRobot/samplerobot_auto_balancer.py] Add attitude check to auto balancer test
  • do not use boost::remove_erase_if() because it is too new for old systems
  • remove undefined function
  • I will squash this commit: Update variable names following the naming rule
  • extend "std::vector<step_node> footstep_node_list" to "std::vector< std::vector<step_node> > footstep_node_list_list" for N leg walk
  • replace hard-cording value "2" to leg_names.size() or leg_pos.size()
  • fix return type
  • [rtc/AutoBalancer/testPreviewController.cpp] Add use_gnuplot argument for testPreviewController
  • [rtc/AutoBalancer/testGaitGenerator.cpp] Pass check results to return code
  • [rtc/AutoBalancer/testGaitGenerator.cpp] Fix indent for testGaitGenerator
  • [rtc/AutoBalancer/testGaitGenerator.cpp] Add value checking for testGaitGenerator. Currently zmp error and zmp diff are checked
  • [rtc/AutoBalancer/hrpsys_AutoBalancer_GaitGenerator_memo.pptx] Update memo slide to add footstep overwriting
  • [rtc/AutoBalancer/AutoBalancer.txt] Add url linking to AutoBalancer GaitGenerator memo slide
  • [sample/SampleRobot/samplerobot_auto_balancer.py] Update demoGaitGeneratorOverwriteFootsteps
  • [python/hrpsys_config.py] Add setfootsteps wrapper funcs to hrpsys_config.py
  • [rtc/AutoBalancer/AutoBalancer.cpp, rtc/AutoBalancer/GaitGenerator.*] Enable to consider overwrite footstep index in footstep overwriting
  • [rtc/AutoBalancer/AutoBalancer.cpp] Remove unused variable and return current footstep index
  • [rtc/AutoBalancer/AutoBalancer.*] Add arguments for overwrite_fs_idx
  • [idl/AutoBalancerService.idl, rtc/AutoBalancer/AutoBalancerService_impl.*] Add overwrite footstep index to setFootSteps and getRemainingFootstepSequence
  • [idl/AutoBalancerService.idl,rtc/AutoBalancer/GaitGenerator.h] Do not return current support leg from getRemainingFootstepSequence
  • [rtc/AutoBalancer/hrpsys_AutoBalancer_GaitGenerator_memo.pptx] Add documentation and figures for explanation of AutoBalancer and GaitGenerator
  • [rtc/AutoBalancer/GaitGenertor.cpp] Use overwrite_footstep_node_list
  • [samples/SampleRobot/samplerobot_auto_balancer.py] Add sample for footstep overwriting
  • [rtc/AutoBalancer/AutoBalancer.cpp] Enable to pass footstep overwriting from outside of Autobalancer RTC.
  • [rtc/AutoBalancer/GaitGenerator.*] Enable to overwrite current footsteps
  • [AutoBalancer.cpp] remove unused if else
  • [idl/AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.h] add a parameter "leg_names" to AutoBalancerParam

• Stabilizer

  • [rtc/Stabilizer/CMakeLists.txt] Add subdirectory for qpoases linking
  • [rtc/Stabilizer/CMakeLists.txt] Use qpOASES installed by 3rdparty directory.
  • [sample/SampleRobot/samplerobot_stabilizer.py, SampleRobot.torque.xml.in] Add check for attitude to st test
  • [idl/StabilizerService.idl, rtc/Stabilizer/Stabilizer.*] Use vector3 for eefm_pos_time_const_support
  • [idl/StabilizerService.idl] enable to set contact decision threshold
  • [sample/SampleRobot/samplerobot_stabilizer.py] Add assert check for stabilizer
  • [rtc/Stabilizer/testZMPDistributor.cpp] Add use_gnuplot argument for testZMPDistributor

• VoxelGridFilter

  • removes an unused file
  • adds a new component,
  • fix name : foot_midcoords -> ref_coords

• EmergencyStopper

  • add mutex lock when writing is_emergency_mode variable
  • add test-samplerobot-emergency.py and test EmergencyStopper in test-samplerobot.test
  • add test code of EmergencyStopper function
  • go to release_mode when deactivated in EmergencyStopper
  • fix format specifier of size_t
  • support multiple zmp offsets input to PreviewController
  • use switch instead of if to judge emergency_check_mode
  • beep on emergency mode

• TorqueController

  • [TorqueController] Fix typo, emergencyController -> normalController, in disable error message
  • [TorqueController] Add enable/disable methods to MotorTorqueController
  • [TorqueController] Add enable flag to MotorTorqueController to manage activity of both normal and emergency controller
  • [TorqueController] Add instance name to error prefix
  • [TwoDofController] Move error_prefix to TwoDofControllerInterface
  • [TwoDofController] Add instnace_name to error message
  • [TorqueFilter] Add instance name to error message of TorqueFilter

• GraspContrller

  • [rtc/GraspController/GraspController.cpp] Add debug message to grasp controller start/stop grasp and add instance name for print message

• ImpedanceController

  • [sample/SampleRobot/samplerobot_impedance_controller.py] Fix typo in print message.
  • [rtc/ImpedanceController/testImpedanceOutputGenerator.cpp] Add arguments for plotting and printing usage.

• KalmanFilter

  • [sample/SampleRobot/samplerobot_kalman_filter.py] Add exception if no plot is available.
  • [sample/SampleRobot/samplerobot_kalman_filter.py] Add check and assertion for sample kalmanfilter

• RemoveForcesSensorLinkOffset

  • [rtc/RemoveForceSensorLinkOffset/RemoveForceSensorLinkOffset.cpp] Return false for invalid argument
  • [sample/SampleRobot/samplerobot_remove_force_offset.py] Add value check for RMFO

• DataLogger

  • [sample/SampleRobot/samplerobot_data_logger.py] Add assert for unittesting of data logger.
  • [sample/SampleRobot/samplerobot_data_logger.py, samplerobot_soft_error_limiter.py] Define examples as demo functions

• Contributors: Fumio KANEHIRO, Isaac IY Saito, Kei Okada, Masaki Murooka, Shunichi Nozawa, Yuta Kojio, Eisoku Kuroiwa, Iori Kumagai

Stable RTCs

• SequencePlayer
  • Rename arguments and local variables remain_t, x, v, and a because these are same name as member variables
  • Add comments to interpolator
  • [SequencePlayer/seqplay.cpp] clearJointAnglesOfGroup use online = true to clear remain_t
  • Connect seq port to monitor seq interpolation
• python/hrpsys_config.py
  • Add HardEmergencyStopper RTC to stop almost all rtc motion
  • Add check for rmfo-st connection
  • Use rmfo off sensor values in st
  • Remove seq data logging which can replaced by StateHolder data (reported in https://github.com/fkanehiro/hrpsys-base/issues/594)
• test
  • [test/test-samplerobot.test b/test/test-samplerobot.test] wrenches is available from 315.2.0
  • [test/test-samplerobot.test b/test/test-samplerobot.test] update timelimit to 120
• sample
  • [sample/SampleRobot/samplerobot_sequence_player.py] check seq rtc version for executing tests
  • [sample/SampleRobot/samplerobot_sequence_player.py, test/test-samplerobot-sequence.py, test-test-samplerobot.test] add samplerobot_sequence_player to test case
  • [sample/SampleRobot/samplerobot_sequence_player.py] add demoSetJointAnglesSequence() demoSetJointAnglesSequenceOfGroup()
  • [sample/SampleRobot/samplerobot_sequence_player.py] add test code for override and clear function to demoSetJointAngles() demoSetJointAnglesOfGroup(), demoSetJointAnglesOfGroup()
  • [sample/SampleRobot/samplerobot_sequence_player.py] add setSetJointAnglesOfGroup() and check results
  • [sample/SampleRobot/SampleRobot.torque.xml.in] Use RUNGE_KUTTA for torque simulation
  • [sample/SampleRobot/samplerobot_stabilizer.py] Add tpcc eefm st sample
  • [sample/SampleRobot/SampleRobot.PDgain.dat] Fix SampleRobot PD gain
  • Fix stabilizer sample
  • Update sample for stepparam change
  • Use functions defined in hrpsys_config.py
  • Divide samples into small sample functions
  • Add emergency stop and remain fot step sample
• lib/util/Hrpsys.h
  • [lib/util/Hrpsys.h] add atoi
  • [lib/util/Hrpsys.h] add header file for QNX compile
• [doc] Elaborate package overview

Unstable RTCs

• AutoBalancer
  • add kick-test to testGaitGenerator.cpp
  • Update AutoBalancer.cpp enable to stop with one lne
  • check capture point to detect falling down
  • Do not set is_stop_mode for testing
  • Add emergency stop mode and release mode for AutoBalancer
  • Add emergency stop port for autoBalancer to stop walking
  • enable to step with one leg
  • add height check to cycloid_delay_kick_hoffarbib_trajectory_generator and changed initerpolation point
  • modify cycloid_delay_kick_trajectory_generator by adding start_rot
  • modify orbit : enabled to modify kick_offset by function
  • 1 control loop by default for default_retrieve_time
  • Add retrieving after emergency stop
  • add swing leg orbit type :CYCLOIDDELAYKICK
  • Update single footstep support coords
  • Add support and swing leg coords to lcg
  • Add test13 to argument
  • Add test for arbitrary leg switching
  • Revert previous estop commit
  • Fix paren and indent
  • Update rmfo documentation. off_xx equal to xx
  • Update footstep calculation. Push refzmp list immediately.
  • Fix calculation of current remain time and update sample
  • Use footstep_node_list step_time in refzmp_generator
  • Rename leg_coords_generator _dt => dt
  • Remove one_step_len and use foot step time in footstep_node_list
  • Use step time from footstep node list in leg_coords_generator
  • Use total step count from footstep_node_list
  • Set step parameters for foot step node list
  • Set height, toe_angle, heel_angle to 0 at initial and final foot step
  • Add test for changing step param
  • Add set foot steps function
  • Add step_time for each step parameter. Currently interface are provided and step_time is not used in GaitGenerator
  • Fix go pos 000 discontinuous last foot.
  • Update overwrite refzmp
  • Remove unused function is_swinging_leg
  • Rename variables for lcg and add comments
  • Separate gait generator type, class, functions from gait_generator class
  • Add function to get remaining foot steps
  • Add emergency stop interface for walking. Currently, velocity mode is supported.
• Stabilizer
  • add cp_check_margin to avoid hard coding
  • Add emregency check mode for st
  • Fix st cop check to strong constraint
  • Use is_emerency for emergency signal checking
  • Separate state calculation function for emergency signal
  • Add add_subdirectory for qpOASES
  • Fix calculation of stop queue and current seq state resetting
  • Svn co and build qpOases. Disabled by default
  • Add foot rot test
  • Add jaxonred zmp sample and parse args
  • Add test class for ZMPDistributor
  • plot alpha in ZMPdistributor check
  • Set outside margin
  • Add outside margin
  • Enable to set cop check margin
  • Add debug message and check both cop on ground
  • Add check cop outside
  • Add COPInfo including total moment x, y, and total force at each end effectors
  • Add documentation for test samples
• ProjectGenerator
  • add a note in read to use a new program instead of this one
• EmergencyStopper
  • add out port for emergency_mode
  • Fix m_stop_posture setting to be able to change retrieve time
  • Add EmergencyStopper Param and add getter and setter
  • Set interpolator and add message
  • Add emergency signal port to ES and ST and connect them (currently signal writing is comment-outed).
  • implement EmergencyStopper and add sample script
  • add source files of EmergencyStopper rtc
• PDcontroller
  • Add warning for too short pdgain
• Contributors: Eisoku Kuroiwa, Isaac IY Saito, Kei Okada, Masaki Murooka, Shunichi Nozawa, Takasugi Noriaki, Yuta Kojio

Stable RTCs

• rtc/SequencePlayer

  • [idl/SequencePlayerService.idl, SequencePlayer.{h,cpp}, SequencePlayerService_impl.{h,cpp}, seqplay.{h,cpp}] add clearJointAngles and clearJointAnglesOfGroup()

  • [seqplay.cpp] push current data to the queue

  • [idl/SequencePlayerService.idl, SequencePlayer.{h,cpp}, SequencePlayerService_impl{h,cpp}, seqplay.{h,cpp}] add setJointAnglesSequenceFull()

  • [interpolator.h] add dimension() returns dim

  • [interpolator.{cpp,h}] add setGoal(double *, double, bool = true)

    System Message: WARNING/2 (<string>, line 1815); backlink

    Inline emphasis start-string without end-string.

  • [python/hrpsys_config.py, SequencePlayer.{h,cpp}, SequencePlayerService_impl.cpp, seqplay.{h,cpp}] add setJointAnglesSequenceOfGroup

  • [SequencePlayer.cpp] use setJointAnglesSequence for setJointAngles

  • [idl/SequencePlayerService.idl, python/hrpsys_config.py, SequencePlayer.{h,cpp}, SequencePlayerService_impl.{h,cpp}, seqplay.{h,cpp}] add setJointAnglesSequence wcich takes Sequence of JointAngles and overwrite current motion

• rtc/StateHolder

  • [StateHolder.cpp] Reset StateHolder wrench in goActual. Currently zero is assumed.

• rtc/RobotHardware

  • [RobotHardware.cpp,robot.{h,cpp}] adds check of joint command acceleration
  • [robot.{h,cpp}] use imu coordinate for reference gravity
  • [robot.{h,cpp}] memorize the previous joint commands
  • [RobotHardware.cpp,robot.{h,cpp}] modifies checkJointCommands() to check joint command velocities
  • [RobotHardware.cpp,robot.{h,cpp}] Revert "changes checkJointCommands() to check joint command velocities"
  • [RobotHardware.cpp,robot.{h,cpp}]changes checkJointCommands() to check joint command velocities

• python

  • [rtm.py] fixes a mistake in a debug message
  • [hrpsys_config.py] add more features to logger
  • [hrpsys_config.py] Add function to start and stop default unstable controllers (st, abc, ic)
  • [hrpsys_config.py] Add kinematics_only_mode flag to hcf
  • [rtm.py] add more error messages on activate and connnect components
  • [rpsyspy] chekc if RobotHadwareService has joint angle (to avoid confusion such as longfloor)
  • [hrpsys_config.py] import waitInputConfirm from waitInput.py in hrpsys_config.py to resolve function name

• [package.xml] add deped to graphviz for dot program fix #629

Unstable RTCs

• sample
  • [environments/DRCFinalStair.wrl] Add DRC final stair with sloped ground
  • [environments/DRCTestfieldStair.wrl] Add drc testfield stair
  • [environments/DRCTestbedTerrainJPBlock.wrl,environments/DRCTestbedTerrainUSBlock.wrl] Update location of each block of terrain models
  • [environments/DRCTestfieldTerrain.wrl] Add testfield drc terrain vrml file
  • [SampleRobot/samplerobot_impedance_controller.py] Add print message for impedance controller sample
  • [SampleRobot/samplerobot_impedance_controller.py] Add tracking check sample to impedance controller sample
  • [SampleRobot/CMakeLists.txt, ampleRobot/SampleRobot.kinematicsonly.xml.in] Add kinematics only mode Project file for sample robot
• rtc/AverageFilter
  • [AverageFilter.{h,cpp}] adds a configuration parameter, dilation
• rtc/CameraImageLoader
  • adds a new component, CameraImageLoader
• rtc/UndistortImage
  • [UndistortImage.cpp] fixes a bug in onExecute()
  • [UndistortImage.cpp] checks if the calibration file exists
  • adds a new component UndistortImage
• rtc/SoftErrorLimiter
  • [SoftErrorLimit.cpp] display limit violation message for 0.2 period
  • [SoftErrorLimit.cpp] check velocity limit using limit - 0.01 deg, if we use limit = limit, then it will fail at RobotHardware
  • [SoftErrorLimit.cpp] display error message in the first time, see #498
• rtc/ImpedanceController
  • [ImpedanceController.cpp] write debug message
  • [ImpedanceController.cpp] Stop impedance controller which is active in onDeactivated
  • [idl/ImpedanceControllerService.idl, ImpedanceControllerService_impl.{cpp,h}, ImpedanceController.h] Add start and stop impedance without waiting
  • [ImpedanceOutputGenerator.h] Use new version impedance output generation by default which considerstarget acceleration
  • [ImpedanceOutputGenerator.h] Add comment for ImpedanceOutputGenerator
  • [ImpedanceOutputGenerator.h] Fix subtraction of current and target rotation
  • [ImpedanceController/testImpedanceOutputGenerator.cpp] Add plotting of rotation
  • [ImpedanceOutputGenerator.h] Add calcTargetVelocityNew.
  • Separate calculation of impedance control output. This commit will not change ImpedanceController behavior
  • [ImpedanceController.cpp,ImpedanceOutputGenerator.h] Update variables in ImpedanceOutputGenerator. Use output, target, and current
  • [idl/ImpedanceControllerService.idl,ImpedanceController.{h,cpp},sample/SampleRobot/samplerobot_impedance_controller.py] Enable to fix ref force frame (experimental codes)
• rtc/CollisionDetector
  • (Code Refactoring) [rtc/CollisionDetector] enable to work both collision_mask and use_collision_limb
  • [CollisionDetector.{h,cpp}] enable to work both collision_mask and use_collision_limb
  • [sample/SampleRobot/samplerobot_collision_detector.py] Add example for desired collision behavior
  • [CollisionDetector.{h,cpp}] add use_limb_collision mode (VERY EXPERIMENTAL)
  • [sample/SampleRobot/samplerobot_collision_detector.py]Add collision mask test added in https://github.com/fkanehiro/hrpsys-base/pull/627
  • [CollisoinDetector.{h,cpp}] add m_collision_mask property
• rtc/OccupancyGridMap3D
  • [OccupancyGridMap3D.cpp] emits update signal at the end of clear()
  • [idl/OGMap3DService.idl,OccupancyGridMap3D.{h,cpp},OGMap3DService_impl.{h,cpp}] adds clear() to OGMap3DService
• rtc/KalmanFilter
  • [idl/KalmanFilterService.idl, KalmanFilter.{h,cpp}] Add kalman filter offset parameters
• rtc/Stabilizer
  • [Stabilizer.cpp] Fix invalid st index
  • [Stabilizer.cpp] Fix pos_ctrl frame in stabilzier
  • [environments/DRCTestfieldStair.wrl, Stabilizer.cpp] Use sequence for foot_origin_offset and fix printing
  • [idl/StabilizerService.idl, Stabilizer.cpp] Enable to set foot origin offset in ST
  • [idl/StabilizerService.idl, Stabilizer.cpp] Add ee error pos and rot compensation and enable to set is_ik_enable
  • [Stabilizer.cpp] Make slow stabilizer sync
  • [Stabilizer.cpp] Use moment at EE instead of COP
  • [Stabilizer.cpp] Do not use local y COP offset
  • [ZMPDistributor.h] Update Stabilizer QP foot moment force distribution to use alpha parameter
  • [idl/StabilizerService.idl] Add documentation for st param
  • [idl/StabilizerService.idl, Stabilizer.{h,cpp}] Enable to change transition time of ST
  • [ZMPDistributor.h] Do not use foot distribution coords in force moment distribution and limit alpha
  • [idl/StabilizerService.idl, Stabilizer.{h,cpp}, ZMPDistributor.h, testZMPDistributor.cpp] Add alpha force moment distribution lpf
  • [idl/StabilizerService.idl, Stabilizer.cpp, ZMPDistributor.h] Enable to change force moment distribution
  • [ZMPDistributor.h] Update force moment distribution based on reference zmp alpha parameter.
• rtc/AccelerationChecker
  • [AccelerationChecker.cpp] add stdio.h, hope this works on qnx
  • [AccelerationChecker.cpp] adds a configuration variable, print
• rtc/AutoBalancer
  • [idl/AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.{h,cpp}] Enable to set toe heel angle during setFootSteps
  • [AutoBalancer.cpp] Fix org origin and target origin in adjust function
  • [idl/AutoBalancerService.idl, AutoBalancer.cpp] Add adjust footstep for walking
  • [idl/AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.{h,cpp}] Enable to set go pos finalize footsteps num
  • [GaitGenerator.cpp] Remove unused debug message
  • [GaitGenerator.{h,cpp}] Use swing_rot_ratio for swing rot calculation and swing_ratio to get swing phase
  • [GaitGenerator.{h,cpp}] directly use swing_ratio
  • [GaitGenerator.{h,cpp}] Rename rot_ratio -> foot_midcoords_ratio
  • [idl/AutoBalancerService.idl, AutoBalancer.cpp, AutoBalancerService_impl.{h,cpp}, GaitGenerator.h] Add waitFootStepsEarly
  • [GaitGenerator.{h,cpp}] Use setGoal instead of go in gait generator interpolators
  • [idl/AutoBalancerService.idl, AutoBalancer.{h,cpp}] Enable to set leg default offset position
  • [testGaitGenerator.cpp] Add foot rotation testing
  • [GaitGenerator.{h,cpp}] Use interpolator for foot rotation calculation
  • [AutoBalancer.cpp, GaitGenerator.h, testGaitGenerator.cpp] Update toe_heel_phase_ratio enable to be set
  • [testGaitGenerator.cpp] Update for toe heel trajectory. Display toe heel trajectory and add test for it
  • [idl/AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.{cpp,h}, testGaitGenerator.cpp] Add swing foot trajectry by combining cycloid and delay hoff arbib
  • [testGaitGenerator.cpp] Fix plot size of foot trajectory
  • [idl/AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.h, testGaitGenerator.cpp] Add weighting parameter for final path of delay_hoffarbib_trajectory_generator
  • [GaitGenerator.{h,cpp}] Fix zmp transition in second and second_last phase
  • [GaitGenerator.h, testGaitGenerator.cpp] Fix gg param setting and plot cart zmp
  • [testGaitGenerator.cpp] Generate graph eps file, fix test9 foot steps, and arg setting
  • [testGaitGenerator.cpp] Add parsing of GaitGenerator params
  • [AutoBalancer.cpp, GaitGenerator.{h,cpp}] Add print_param for GaitGenerator
  • [testGaitGenerator.cpp] Add foot velocity trajectories in GaitGenerator test
  • [GaitGenerator.{h,cpp}] Use calculation of default_double_support_static_ratio
  • [testGaitGenerator.cpp] Update graph printing and add print messages
  • [idl/AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.h] Add default_double_support_static_ratio to keep reference zmp static
  • [idl/AutoBalancerService.idl, AutoBalancer.{h,cpp}] Enable to set zmp transition time for abc
  • [idl/AutoBalancerService.idl, AutoBalancer.{h,cpp}] Enable to set transition time for abc
  • [sample/SampleRObot/samplerobot_auto_balancer.py] Add test for discontinuous sync
  • [AutoBalancer.cpp] clear interpolator before setting
  • [AutoBalancer.cpp] Fix discontinuous when stopping auto balancer after walking
• Contributors: Eisoku Kuroiwa, Fumio KANEHIRO, Kei Okada, Ryohei Ueda, Shunichi Nozawa

Stable RTCs

• RobotHardware (lib/io/iob.cpp) API Updated

  • [rtm/RobotHardware/robot.cpp] fix for source program with ROBOT_IOB_VERSION < 2
  • [RobotHardwareService.idl, lib/io/iob.cpp] adds a field, temperature to RobotState2
  • [RobotHardwareService.idl] changes interface to get battery status
  • [lib/io/iob{cpp,h},rtc/RobotHardware/{robot.cpp,robot.h,RobotHardwareService_impl.cpp,CMakeList.txt] add ROBOT_IOB_VERSION for backword compatibility
  • [RobotHardware, iob, BodyRTC] fix to compatible with old API
  • [lib/io/iob.cpp] adds the third argument to read_power of iob.h
  • [idl/RobotHardwareService.idl] adds a field, battery to RobotState
  • [RobotHrdware.cpp, robot.cpp] adds checkJointCommands() to check joint commands before setting

• KalmanFilter

  • [KalmanFilter.cpp] output the body frame relative to a world reference frame as baseRpyCurrent
  • [KalmanFilter.cpp] use yaw of sensor->link->R for update of yaw instead of 0.0
  • [python/hrpsys_config.py, KalmanFilter.cpp] connect port from rh.q to kf.qCurrent
  • [KalmanFilter.h] use openhrp3/hrplib/hrpUtil for rotation conversion

• hrpsys_config.py

  • [hrpsys_config.py] add startImpedance and stopImpedance
  • [hrpsys_config.py] add MaxLength option for setupLogger
  • [hrpsys_config.py] #567 is not correct PROJECT_DIR is

  System Message: WARNING/2 (<string>, line 1999)

  Bullet list ends without a blank line; unexpected unindent.

  (OpenHRP3 installed directory)/share/OpenHRP-3.1/sample/project * [hrpsys_config.py] #567 is wrong, do not need to decode * [hrpsys_config.py] fix code to work on python2.5 * [hrpsys_config.py] Import check_output near the line which check_output is used * [hrpsys_config.py] add verbose option to findCOmps()

• [hrpsys_config.py] add max_timeout_count to findComps()

System Message: WARNING/2 (<string>, line 2005)

Bullet list ends without a blank line; unexpected unindent.

• [hrpsys_config.py] fix print message
• [hrpsys_config.py] add verbose option to getRTCInstanceList()

• rtm.py
  • fix typo time->tm in stop()
  • adds timeout to start() and stop()
• test
  • [test-samplerobot-impedance] add test code for impedance controller API
  • [test-drc-testbet.test] add test code for drc samplerobot
  • [test-robot-hardware.test] add test to check robot-hardware service call
  • [test-colcheck.test] load modelfiles
• sample
  • [SampleRobot/samplerobot_auto_balancer.py] Update auto balancer python sample. Add toe heel samples.
  • [PA10/PA10.py] add from hrpsys import OpenHRP, something has changed during openhrp3 3.1.7 and 3.1.8, https://github.com/fkanehiro/openhrp3/commits/master
  • [sample/SampleRobot] fix for new PROJECT_DIR location
  • [sample/RampleRobot,sample/environment] install pyhton scripts under deval
  • [samplerobot_kalman_filter.py] fix typo
  • [samplerobot_kalman_filter.py] update kf test program for baseRpyCurrent
  • install SampleRobot.DRCTestbed.xml under devel
  • remove ROS examples, but enable to call Hrpsys examples directly
• .travis
  • [.travis.sh, .travis.yml] compile with -DROBOT_IOB_VERSION=0
  • [.travis.sh] any diff between 315.1.9 and current is not permitted, since we use cproto without any -DROBOT_IOB_VERSION, so this should output header file compatible with stable version
  • [.travis.sh] hot fix for https://github.com/start-jsk/rtmros_hironx/pull/358
  • [.travis.yml, .travis.sh] enable hrpsys with 315.1.10
  • [.travis.sh] RULE CHANGED adding new function to iob.h is ok
  • [.travis.sh] do not install test/share/samples/src of old hrpsys, use sample/test/launch of latest hrpsys
  • [.travis.sh] display test results when failure
• [util/monitor]
  • [Monitor.cpp] show velocity and acceleration (hold maxmum value for 5 sec)
  • [Monitor.cpp] add -nogui mode
  • [main.cpp] add --host, --port, --interval option
  • [GLscene.cpp, Monitor.cpp, main.cpp] add many error check codes
• [lib/util]
  • [bodyRTC.cpp] get sensor data through getStatus
  • [BodyRTC.cpp] fix bugs in #200
• [CMakeLists.txt] touch rospack_nosubdirs for not search by roslaunch, onlyfor ROS users
• [python/hrpsyspy] rewrite hrpsyspy, now you can just call hrpsyspy to create hcf instance

Unstable RTCs

• OccupancyGridMap3D
  • [OccupancyGridMap3D.cpp] outputs an update signal when onActivate() is called
  • [OccupancyGridMap3D.cpp] uses mutex lock to prevent crash
• ImpedanceController (API updated)
  • [JointPathEx.cpp] Enable to change weight caluclation. If use_inside_joint_weight_retrieval=true (true by default), inward joint weight retrievs to 1.0 (original). Otherwise, always weight is calculated from joint limit to solve https://github.com/fkanehiro/hrpsys-base/issues/516
  • Disable use_inside_joint_weight_retrieval by default in ImpedanceController, AutoBalancer, Stabilizer to reduce oscillation (https://github.com/fkanehiro/hrpsys-base/issues/516)
  • [idl/ImpedanceControllerService.idl] Add optional weight vector for impedance control IK. Currently, this is used for toe joint supression.
  • [ImpedanceController.cpp] Fix target_link calculation for IC. Support sensor->link is not same as ee target link (such as toe joint).
• AutoBalancer (API updated)
  • [GaitGenerator.cpp] Fix discontinuous autobalancer parameter using interpolator
  • [GaitGenerator.h] Fix foot trajectory discontinuous
  • [testGaitGenerator.cpp] Add plotting for several properties of GaitGenerator
  • [AutoBalancer.cpp] Enable to configure toe heel zmp transition
• Stabilizer (API updated)
  • [ZMPDistributor.h] Fix foot vertices and update evaluation codes
  • [Stabilizer.cpp] Update Stabilizer debug messages and calculation
  • [rtc/Stabilizer/testZMPDistributor.cpp] add stdio for qnx
  • [CMakeLists.txt] Add qpoases code. Disabled by default
  • [Stabilizer.cpp] Update for sole vertices
  • [ZMPDistributor.h] Add testing code for force distribution to use fz diff control ()
  • [ZMPDistributor.h] Add plotting of force moment
  • [Stabilizer.cpp] Separate ZMP distribution codes
  • [Stabilizer.cpp, idl/Stabilizer.idl] Enable to set Stabilizer gravitational acceleration (9.8 by default)
  • [GaitGenerator.cpp] Add comments and some functions are renamed
  • [GaitGenerator.cpp] Use negative value for heel_pos_offset_x
  • [idl/AutoBalancerService.idl] Fix unit system in documenatation
  • [AutoBalancer.cpp] Enable to set toe heel zmp
  • [GaitGenerator.cpp] Remove refzmp vel junping
  • [GaitGenerator.cpp] Add transition ZMP among toe, heel, and ee pos. Update tests.
  • [GaitGenerator.cpp] Rename supprot_leg_list -> swing_leg_list
  • [GaitGenerator.cpp] Update refzmp interpolation codes
  • [GaitGenerator.cpp] Use toe_heel_phase_counter pointer in lcg
  • [GaitGenerator.cpp] Add toe_heel_phase_counter. This should be change behaviour.
  • [AutoBalancer.cpp] Get default zmp offset and use ZMP offset in abc
  • [GaitGenerator.cpp] Push swing_foot_zmp_offset to PreviewControl qdata and update sample
  • [PreviewController.cpp] Add qdata for preview control
  • [GaitGenerator.cpp] Enable to get swing foot zmp offset
  • [testGaitGenerator.cpp] Update testGaitGenerator plotting
  • [AutoBalancer.cpp] Add check for toe heel ratio summation
  • [GaitGenerator.cpp] Use leg_type for array index
  • [AutoBalancer.cpp] Update leg_type. RLEG = 0, LLEG = 1. Add both and use it in Abc.
  • [/GaitGenerator.cpp] Rename WC_RLEG => RLEG, WC_LLEG => LLEG
  • [idl/AutoBalancerService.idl] Add StepParam and enable to set step height
  • [GaitGenerator.h, testGaitGenerator.cpp] Update testGaitGenerator sample
  • [idl/AutoBalancerService.idl] Add argument for toe and heel zmp
  • [idl/AutoBalancerService.idl, AutoBalancer.cpp, GaitGenerator.cpp, GaitGenerator.h] Add parameter for use toe joint or not
  • [AutoBalancer.cpp, GaitGenerator.cpp, GaitGenerator.h] Use toe joint in heel toe contact. (Disabled by default)
  • [GaintGenerator.cpp] Update interpolation from toe to heel
• Contributors: Eisoku Kuroiwa, Fumio KANEHIRO, Kei Okada, Shunichi Nozawa, YoheiKakiuchi, Chi Wun Au, Eisoku Kuroiwa, Masaki Mmurooka

Stable RTCs

• python/hrpsys_config.py
  • [hrpsy_config.py] paralell running of log is not available if ExtTrigExecutationContet In simulator, log is not using own ecs so it does not write log on emergency signal, if you wan to activate this se hcf.log_use_own_ec as samplerobot_data_logger, see https://github.com/fkanehiro/hrpsys-base/issues/490 for discussion
  • fixes a bug in disconnectPorts() and it returns True/False
  • (hrpsys python) Correct relative rotation. (https://github.com/fkanehiro/hrpsys-base/pull/543 )
  • (hrpsys_config.py) Better referencing to local getCurrentPose method. (https://github.com/fkanehiro/hrpsys-base/pull/543 )
  • [hrpsys_conifg.py] set version for findComp()
  • [hrpsys_config.py] remove None from getRTCInstanceList() (https://github.com/fkanehiro/hrpsys-base/pull/534)
  • [hrpsys_config.py] add version check for some plugins when connectPorts() (https://github.com/fkanehiro/hrpsys-base/pull/533)
  • [hrpsys_config.py] add variables for servo controller instances (fixes https://github.com/fkanehiro/hrpsys-base/pull/529)
  • [hrpsys_config.py] add delteComps(), deleteComp(), deactiveComps() (https://github.com/fkanehiro/hrpsys-base/pull/512)
  • [hrpsys_conig.py] try to import OpenHRP3 for old version https://github.com/start-jsk/rtmros_hironx/issues/331
  • (Doc) minor clarification in hrpsys_config.py (https://github.com/fkanehiro/hrpsys-base/pull/505)
• python/rtm.py
  • [rtm.py] add more debug message when serializeComponents failed (https://github.com/fkanehiro/hrpsys-base/pull/536)
  • [rtm.py] add more debug message when failed connect port (https://github.com/fkanehiro/hrpsys-base/pull/535)
  • [rtm.py] use rtc.ref.exit after delete_components https://github.com/fkanehiro/hrpsys-base/pull/512#issuecomment-80430387
  • [rtm.py] add delete() (https://github.com/fkanehiro/hrpsys-base/pull/512)
• hrpsys_simulator
  • [lib/util] enable robot simulation on RobotHardwareService (#187)
  • [hrpsys_config.py] fix for connecting to old RobotHardware which does not have service ports
  • [BodyRTC,PortHander] fix memory leak
  • Use basePose in kinemtics only simulation ( https://github.com/fkanehiro/hrpsys-base/pull/521 )
    • Connect RTCs' basePose outports to simulator basePose inport
    • Add basePose port to AutoBalancer like StateHolder
    • Add basePose inport for kinematics simultion (integrate == false)
    • Enable to parse ABS_TRANSFORM inport from link name according to outport ABS_TRANSFORM setting
  • fixes an invalid access to log
• SequencePlayer
  • (fix problem when calling setTargetPose in first time) https://github.com/fkanehiro/hrpsys-base/pull/519
    • [SequencePlayer.cpp] forget to call setInitialState in setTargetPose , update m_Ref.data using m_qInit.data
    • [SequencePlayer.cpp] Print info in setTargetPose
• CollisionDetector
  • add lin breank in debug message (https://github.com/fkanehiro/hrpsys-base/pull/528)
  • [CollisionDetector] set m_have_safe_posture to false in initial time, so that we can check if the system did not know any safe posture (https://github.com/fkanehiro/hrpsys-base/pull/525)
• DataLogger
  • [hrpsys_config.py] running log process for receiving emergency signal (https://github.com/fkanehiro/hrpsys-base/pull/544)
• lib/io
  • adds an option not to install libhrpIo.so
• lib/util
  • [SDLUtil.cpp] SDLwindow::~SDLwindow, call SDL_Quit only when this object is initialized (https://github.com/fkanehiro/hrpsys-base/pull/524)

Unstable RTCs

• AutoBalancer
  • Add toe-off and heelo-contact (https://github.com/fkanehiro/hrpsys-base/pull/553 )
    • Use interpolator for rot_ratio
    • Add toe-off and heel-contact parameters.
    • Enable to set phase time ratio
    • Enable to interpolate smoothly if SOLE1 phase does not exist
  • Update st abc kf param (https://github.com/fkanehiro/hrpsys-base/pull/549)
    • Update print message for parameters
    • Update default parameters for ST, KF, ABC
  • Fix for limbcop and toe joint usage in ST (https://github.com/fkanehiro/hrpsys-base/pull/539)
    • Use ee_pos for foot edge points and alpha calculation
    • Fix variable name ee_trans => STIKParam and add comment
    • Calculate params and IK using reference COP instead of ee
    • Overwrite toe joints' joint angles based on StateHolder output
    • Fix getting ee name and sensor name in ST
  • Add ports for offsets of limbCOP (https://github.com/fkanehiro/hrpsys-base/pull/538)
  • Add user-defined weight for IK and use it for toe joint (https://github.com/fkanehiro/hrpsys-base/pull/515)
    • Set toe joint weight 0 by default
    • Enable to set user-defined weight vector for Inverse Kinematics
• TorqueController
  • Check boost version in TorqueController. sign.hpp is added at 1.35 (https://github.com/fkanehiro/hrpsys-base/pull/541)
• NullComponent
  • adds debug messages in constructor/destructor
• ImpedanceController
  • [rtc/ImpedanceController] return true/false for {start,stop}ImpedanceController https://github.com/fkanehiro/hrpsys-base/pull/513
• sample/SampleRobot
  • add yaw test code (samplerobot_kalman_filter.py : https://github.com/fkanehiro/hrpsys-base/pull/550)
  • Reset virtual force sensor conf setting (https://github.com/fkanehiro/hrpsys-base/pull/545)
  • [sample/SampleRobot/rtc/CMakeLists.txt] set OPENHRP_DIR (https://github.com/fkanehiro/hrpsys-base/pull/520)
  • [sample/SampleRobot/rtc] update for solo compilation (https://github.com/fkanehiro/hrpsys-base/pull/520)
  • [sample/SampleRbot/rtc] add sample rtc program for samplerobot(https://github.com/fkanehiro/hrpsys-base/pull/520)
• sample/environments/
  • Add Stair model and update Terrain model with ground https://github.com/fkanehiro/hrpsys-base/pull/540
  • Fix indent of vrml models
  • Add DRC testbed terrain VRMLs (JP block version and US block version) https://github.com/fkanehiro/hrpsys-base/pull/523
• doc
  • Add PD controller doc (https://github.com/fkanehiro/hrpsys-base/pull/517)
• travis.sh
  • [.travis.sh] use infinite loop to compile old hrpsys
  • [.travis.sh] do not touch installed, to rerun catkin_make twice
  • [.travis.sh] add CollisionDetector, which is disabled by USE_HRPSYSUTIL=0
  • [.travis.sh] run catkin_make_isolated twice for old hrpsys compile due to g++ memory error
  • [.travis.sh] disabling all SDL does not work
  • [.travis.sh] display time for each tests
  • [.travis.sh] use -j2 and disable SDL
  • [.travis.sh] do not compile hrpsysext (python binding)
  • [.travis.sh] less verbose when install code
  • [.travis.sh] disable roslisp generation for speedup
  • [.travis.sh] disable PCL/OCTMAP/IRRLIGHT for test
  • [.travis.sh] use -j2 for old hrpsys compile
  • [.travis.sh] 'check rtmros_common compiled on newer version of hrpsys works with deb version of hrpsys' means hrpsys running in OLD machine and roslaunch from NEW machine so we assume latest python codes using for this setup
  • [.travis.sh] use git repository, instead of svn due to googlecode shoutdown
  • [.travis.sh] apply https://github.com/start-jsk/rtmros_hironx/pull/318.diff
  • [.travis.sh] disable pcl/octmap/irrlight
  • [.travis.sh] do not show status for basic packages of apt-get install
  • [.travis.sh] hrpsys_config requires openhrp3
• Contributors: Eisoku Kuroiwa, Fumio KANEHIRO, Isaac IY Saito, Kei Okada, Shunichi Nozawa, YoheiKakiuchi, eisoku9618

Stable RTCs

• RobotHardware
  • Use average of force sensor values for force sensor offsetting and use it in removeforcesensorlinkoffset (https://github.com/fkanehiro/hrpsys-base/pull/455 )
• SequencePlayer
  • Write more message for Seq remove and add group functions (https://github.com/fkanehiro/hrpsys-base/pull/477)
  • Use Wrech In Sequence Player (https://github.com/fkanehiro/hrpsys-base/pull/434 )
• CollisionDetector
  • Add beep sound for CollisionDetector (https://github.com/fkanehiro/hrpsys-base/pull/476 )
  • Check Servo On/Off status in CollisionDetector (https://github.com/fkanehiro/hrpsys-base/pull/442 )
  • Use delete because m_interpolator is not array (https://github.com/fkanehiro/hrpsys-base/pull/430 )
  • Update collision debug message. Include m_loop_for_check and print time as [s] (https://github.com/fkanehiro/hrpsys-base/pull/430 )
  • Support CollisionDetector build without hrpsysUtil (https://github.com/fkanehiro/hrpsys-base/pull/428 )
  • Use onInitialize and onFinalize for CollisionDetector member init+finalizing, becaus onActivate (start) and onDeactivated (stop) may be used as servoOn/Off syncing, according to https://github.com/fkanehiro/hrpsys-base/issues/215#issuecomment-52633295)
• SoftErrorLimitter
  • Reduce debug print message from SoftErrorLimiter (once per 0.02[s]) (https://github.com/fkanehiro/hrpsys-base/pull/492 )
  • Add joint velocity limitation in SoftErrorLimiter (https://github.com/fkanehiro/hrpsys-base/pull/459 )
  • Swap order of error limit check and position limit check: check position limit check , then check error limit (https://github.com/fkanehiro/hrpsys-base/pull/457 )
• DataLogger
  • enables each instance has different max length (https://github.com/fkanehiro/hrpsys-base/commit/f9caa7a193a2909fd82cb85c52bdadf4783491f9 )
• [python/hrpsys_config.py]
  • Add 'some' argument for isServoOn and update documentation (https://github.com/fkanehiro/hrpsys-base/pull/484)
  • Add utility functions for Unstable RTCs (https://github.com/fkanehiro/hrpsys-base/pull/479)
  • connect rh->ic evenif they do not have rmfo (https://github.com/fkanehiro/hrpsys-base/pull/462 )
  • (hrpsys_config) : Reduce service port accessing and remove unnecessary sleep (https://github.com/fkanehiro/hrpsys-base/pull/424 )
• QNX
  • [Hrpsys.h] add sin/cos for QNX
  • [Hrpsys.h, testKalmanFilterEstimation.cpp] fix for qnx compile, see #470
  • Include Hrpsys.h for QNX compile according to https://github.com/fkanehiro/hrpsys-base/pull/476#issuecomment-73882215
• Documentation
  • configure doxygen to output xml data that can be imported from other document system (https://github.com/fkanehiro/hrpsys-base/pull/469)
  • Update seqencePlayer IDL documentation (https://github.com/fkanehiro/hrpsys-base/pull/448 )
  • (doc, hrpsys_config) Elaborate what wait means. (https://github.com/fkanehiro/hrpsys-base/pull/445 )
  • Add documentation of CollisionDetector (https://github.com/fkanehiro/hrpsys-base/pull/426 )

Unstable RTCs

• New feature
  • adds a new component, RotateImage
• AutoBalancer (walking plugin)
  • Check leg name alternation in setFootSteps (https://github.com/fkanehiro/hrpsys-base/pull/496 )
  • Add graspless manip mode, in which foot steps are modified based on hand modification (https://github.com/fkanehiro/hrpsys-base/pull/487)
  • smooth velocity interpolation during sync mode (https://github.com/fkanehiro/hrpsys-base/pull/465 )
  • Fix initialize f value and this will solve divergence of rare pattern generation (https://github.com/fkanehiro/hrpsys-base/pull/464 )
  • Update calculation of fix coords (https://github.com/fkanehiro/hrpsys-base/pull/449 )
  • Reduce duplicated ee vfs codes (https://github.com/fkanehiro/hrpsys-base/pull/438 )
    • Use virtual force sensor param in abc balancing
    • Rename m_sensor->m_vfs in ic
    • Move VirtualForceSensorParam to common file and use it in ABC and IC
    • Use localPos, link, localR in VirtualForceSensor
    • Rename to localPos and localR
  • Enable to set Gravitational_Acceleration (https://github.com/fkanehiro/hrpsys-base/pull/432 )
• AverageFilter
  • fixes a bug in conversion from point cloud to height field (https://github.com/fkanehiro/hrpsys-base/commit/b332f4476e8e9ee3da195329c7a761224e7ec5a1 )
• GraspController
  • Update GraspController's control law. Remove unnecessary limitation and gain parameter (https://github.com/fkanehiro/hrpsys-base/pull/453 )
• ImpedanceController
  • use manipulator name such as "larm" for configuration (https://github.com/fkanehiro/hrpsys-base/pull/467, related discussion -> https://github.com/start-jsk/rtmros_common/issues/649)
  • Fix Impedance Controlelr start + stop functions (https://github.com/fkanehiro/hrpsys-base/pull/461, Issue https://github.com/fkanehiro/hrpsys-baase/issues/232)
  • Fix velocity calculation. Convert ee frame objective vel -> link frame objective vel (https://github.com/fkanehiro/hrpsys-base/pull/441 )
  • Load end_effectors and use ee in ik and ref wrench, Support virtual force ref force (https://github.com/fkanehiro/hrpsys-base/pull/437 )
  • Add joint limit table and currently use el (https://github.com/fkanehiro/hrpsys-base/pull/433 )
• KalmenFilter
  • Use RPY-fixed linear KF by default (https://github.com/fkanehiro/hrpsys-base/pull/489 )
  • fix test cord for KF plugins(https://github.com/fkanehiro/hrpsys-base/pull/473, https://github.com/fkanehiro/hrpsys-base/pull/470)
  • Clean up Kalman filter codes and add test code made by @fkanehiro (https://github.com/fkanehiro/hrpsys-base/pull/469 )
  • Add SampleRobot KF example (https://github.com/fkanehiro/hrpsys-base/pull/463 )
  • Add ABS_TRANSFORM port and connect it to logger (https://github.com/fkanehiro/hrpsys-base/pull/463 )
  • Enable to change KalmanFilter Algorithm from idl (https://github.com/fkanehiro/hrpsys-base/pull/452 )
  • Update KF samle (https://github.com/fkanehiro/hrpsys-base/pull/450 )
• OccupancyGridMap3D
  • adds an inport to receive sensor position
  • adds an inport to receive range data
  • changes initial pose of sensor and replaces a deprecated function
• RemoveForceSnsorLinkOffset
  • Fix typo in RMFO. force_offset -> moment_offset (https://github.com/fkanehiro/hrpsys-base/pull/454 )
• Stabilizer
  • "fix" mode (fix hand position relateive to world coordinates) in stabilizer (https://github.com/fkanehiro/hrpsys-base/pull/499 )
  • Add actual contact states port based on Force sensor measurement (https://github.com/fkanehiro/hrpsys-base/pull/474 )
  • Keep fix pose bofore solving IK (https://github.com/fkanehiro/hrpsys-base/pull/466)
  • Add reference wrench from state holder to stabilizer and new zmp distributor (https://github.com/fkanehiro/hrpsys-base/pull/422)
  • Control force xy during double support phase to avoid too large internal force (https://github.com/fkanehiro/hrpsys-base/pull/418)
  • Add alpha blending parameter for Fz distribution (https://github.com/fkanehiro/hrpsys-base/pull/417)
• ThermoLimitter
  • Reduce ThermoLimiter debug print (once per 0.1[s]) (https://github.com/fkanehiro/hrpsys-base/pull/491 )
  • Print in current value and max value in ThermoLimiter alart (https://github.com/fkanehiro/hrpsys-base/pull/447 )
• VideCapture
  • adds a test program
  • enables to change video capture format
  • fixes a memory leak
  • makes start_capturing return boolean result
• Other Fixes
  • [lib/util/GLutil.cpp] adds a missing bracket in output
  • [CMakeLists.txt, idl/CMakeLists.txt] fix for deb building
  • [CMakeLists.txt] RelWithDebInfo is not supported on hrpsys-base
  • [CMakeLists.txt] fix for shre/hrpsys/share link
  • [CMakeLists.txt] super ugry hack for catkin build (https://github.com/fkanehiro/hrpsys-base/pull/497)
  • create symlink for share directory for backword compatibility (https://github.com/fkanehiro/hrpsys-base/pull/471)
  • Autobalancer/ImpedanceController : Use lvlimit/uvlimit in dq limitation of JointPathEx. This commit changes costructor of JointPathEx (add control cycle argument) (https://github.com/fkanehiro/hrpsys-base/pull/460 )
  • [CMakeLists.txt] improve openrtm major version detection (https://github.com/fkanehiro/hrpsys-base/pull/446 )
  • fix problem when environment variable "_" not set (https://github.com/fkanehiro/hrpsys-base/pull/444 )
  • [sample/Sample6dofRobot] Fix rpy of sample6dofrobot (https://github.com/fkanehiro/hrpsys-base/pull/451 )
  • [sample/Sample6dofRobot] Use samplerobot as 6dofarm robot. Fix end effector link to ARM_WRIST_P which has force sensors (https://github.com/fkanehiro/hrpsys-base/pull/439 )
  • [sample/Sample6dofRobot] Update samplerobot examples (https://github.com/fkanehiro/hrpsys-base/pull/436 )
    • Add auto-balancer example to balance against reference hand forces
    • Add SoftErrorLimiter example for SampleRobot. Currently joint limit table is tested.
  • [sample/SampleRobot] Update seq sample without self collision (https://github.com/fkanehiro/hrpsys-base/pull/429 )
  • [sample/SampleRobot] Update collision detector examples (https://github.com/fkanehiro/hrpsys-base/pull/427 )
    • Add samplerobot_collision_detector example
    • Update autoablancer and terrain walk example without self collision
  • [sample/SampleRobot] Add example for SampleRobot SequencePlayer (https://github.com/fkanehiro/hrpsys-base/pull/419 )
• Contributors: Shunichi Nozawa, Yosuke Matsusaka, Fumio Kanehiro, Iori Kumaga, Kunio Kojima, Isaac IY Saito, Kei Okada

Stable RTCs

• hrpEC
  • update message of timeover on hrpEC (https://github.com/fkanehiro/hrpsys-base/pull/411 )
• SequencePlayer
  • Update seq documentation to add loadPattern file format (https://github.com/fkanehiro/hrpsys-base/pull/385 )
• SoftErorLImitter
  • Update beep sound frequency to avoid from making confusing alert sound. This commit is discussed in https://github.com/fkanehiro/hrpsys-base/issues/220, (https://github.com/fkanehiro/hrpsys-base/pull/403 )
• Fixes
  • add missing EXPORT headers (https://github.com/fkanehiro/hrpsys-base/pull/408 )
  • [.gitigure] adds a line for emacs backup files
  • [iob.h] updates comments ( https://github.com/fkanehiro/hrpsys-base/commit/c91ff93ba2459adcf810e1f8f8c8697b93a1d530 )
  • Use OpenHRP3 codes (https://github.com/fkanehiro/hrpsys-base/pull/370 )
    • (ImpedanceController,RatsMatrix) : Remove rotation_matrix and use Eigen toRotationMatrix
    • (RatsMatrix, Stabilizer) : Remove outer_product_matrix and matrix_exponent, use calcRodrigues, and comment out unused function
    • (RatsMatrix,AutoBalancer,GaitGenerator) : Remove local copied function. Remove translate, difference_position
• [python/rtm.py]
  • adds an option parameter pushpolicy to connectPorts() (https://github.com/fkanehiro/hrpsys-base/commit/1e7aaa7fea8e770fbdfe9ceb7a844fa370399df5)
  • clean up styles (https://github.com/fkanehiro/hrpsys-base/pull/358)
• [CatkinLists.txt] https://github.com/fkanehiro/hrpsys-base/pull/371
  • set Release if CMAKE_BUILD_TYPE is set to None
  • fix for ros buildfirm, check CATKIN_BUILD_BINARY_PACKAGE
  • Disable Compile java stuff
• add package.xml

Unstable RTCs

• AutoBalancer

  • Fix zmp z to add zmp to preview queue (https://github.com/fkanehiro/hrpsys-base/pull/401 )
  • Add backward stride limitation, Remove deprecated samplerobot conf setting for abc (https://github.com/fkanehiro/hrpsys-base/pull/400 )
  • Fix double support phase for Rectangle and Stair orbit (https://github.com/fkanehiro/hrpsys-base/pull/399 )
  • Update default values for abc idl parameters (https://github.com/fkanehiro/hrpsys-base/pull/398 )
  • Fix servoOff transition of AutoBalancer. (https://github.com/fkanehiro/hrpsys-base/pull/397 )
  • (GaitGenerator, PreviewController) : Push finailize reference zmp until que is full (https://github.com/fkanehiro/hrpsys-base/pull/396 )
  • (hrpsys_config, AutoBalancer) : Add debug port for COG (https://github.com/fkanehiro/hrpsys-base/pull/396 )
  • (AutoBalancer, Stabilizer) : Add interface to get current controller mode (https://github.com/fkanehiro/hrpsys-base/pull/387 )
  • Use optionalData from SH in ABC. (https://github.com/fkanehiro/hrpsys-base/pull/384 )
  • Enable to Passthrough the Reference (https://github.com/fkanehiro/hrpsys-base/pull/382 )
    • (Stabilizer, AutoBalancer) : Use ref_zmp in base frame according to specification of Seq and Sh
    • (AutoBalancer) : Use MODE_SYNC_TO_IDLE instead of MODE_IDLE.
    • (AutoBalancer) : Use transition_interpolator for joint angle synchronization.
    • (samplerobot_auto_balancer.py) : Add example to check reference pass through by starting and stopping of abc mode.
    • (AutoBalancer) : Enable to pass through references.
    • (hrpsys_config.py) Revert qCurrent for st calculation.
  • Add rtc instance name in debug message (https://github.com/fkanehiro/hrpsys-base/pull/381 )
  • Input StateHolder Reference to ABC (https://github.com/fkanehiro/hrpsys-base/pull/379 )
    • (hrpsys_config, AutoBalancer) : Refine data ports. Remove unused qCurrent and rename in-out data ports.
    • (hrpsys_config, AutoBalancer) : Input references from StateHolder for AutoBalancer
    • (RatsMatrix) : Add mid_rot to interpolate matrix33
  • Update Many Coords... (https://github.com/fkanehiro/hrpsys-base/pull/378 )
    • check walking and add print message for setter function
    • get current value in onExecute and use target coords
    • remove unused gg setting and fix time
    • remove unused is_legged_robot checking
    • fix guard
    • remove unused resetting in startABC
    • set cog and end-coords in onExecute thread
    • remove unused param and fix initialize
  • Add new trajectory any time (https://github.com/fkanehiro/hrpsys-base/pull/369 )
    • (samplerobot_terrain_walk) : Support stair swing orbit type example
    • (AutoBalancer, GaitGenerator) : Add STAIR swing orbit type and gaitgeneratorParam for swing trajectory
    • (samplerobot_terrain_walk) : Do not specify step height.
    • (GaitGenerator) : Update rectangle trajectory to use common linear path function
  • Update control swing support time (https://github.com/fkanehiro/hrpsys-base/pull/364 )
    • (hrpsys_config) : Logging controlSwingSupportTime
    • (AutoBalancer, GaitGenerator, Stabilizer) : Define controlSwingSupportTime as TimedDoubleSeq for both feet

• CaptureController

  • enables to control frame rate (https://github.com/fkanehiro/hrpsys-base/commit/aa6a20ee241601243d580da813f5899f21d17545)

• ImpedanceController

  • Remove name from impedanceParam fucntion **** This fill change IDL ****. (https://github.com/fkanehiro/hrpsys-base/pull/388 )

    System Message: WARNING/2 (<string>, line 2579); backlink

    Inline strong start-string without end-string.

    System Message: WARNING/2 (<string>, line 2579); backlink

    Inline strong start-string without end-string.

    System Message: WARNING/2 (<string>, line 2579); backlink

    Inline strong start-string without end-string.

  • Add rtc instance name in debug message (https://github.com/fkanehiro/hrpsys-base/pull/380 )

  • remove unused include (boost/interprocess/sync/interprocess_semaphore.hpp) (https://github.com/fkanehiro/hrpsys-base/pull/365 )

• ProjectGenerator

  • Connect ports of first input object. (https://github.com/fkanehiro/hrpsys-base/pull/402 )
  • Support PD Controller for project generation (https://github.com/fkanehiro/hrpsys-base/pull/373 )
    • (utilities.h) : Add documentation for use-highgain-mode and for default values
    • (ProjectGenerator) : Support PDcontrollre in ProjectGenerator.
  • Add documentation for ProjectGenerator (https://github.com/fkanehiro/hrpsys-base/pull/372 )

• PDController

  • Add instance name to PDcontroller debug message and add file open debug message (https://github.com/fkanehiro/hrpsys-base/pull/486 )

• RemoveForceSensorLinkOffset

  • Add feture to dump offset file (https://github.com/fkanehiro/hrpsys-base/pull/415 )
    • Add example to use load and dump offset file for rmfo
    • Check string reading in rmfo loading
    • Update documentation for RMFO parameter file
    • Add service to load and dump rmfo offset files
  • Add component name to debug message (https://github.com/fkanehiro/hrpsys-base/pull/377 )

• Stabilzer

  • Represent st foot moment in ee frame (https://github.com/fkanehiro/hrpsys-base/pull/413 )
  • Add calcAlpha function to distribute force and moment. (https://github.com/fkanehiro/hrpsys-base/pull/412 )
  • Use foot edges in calculation of alpha (https://github.com/fkanehiro/hrpsys-base/pull/394 )
  • Fix Alpha Calculation (https://github.com/fkanehiro/hrpsys-base/pull/392 )
    • Calculate ee local moment and do not use OrientRotationMatrix
    • Consider foot orientation in calculating alpha
    • Add comments to specify frame
  • Move order of Stabilizer codes and remove unused Stabilizer codes. (https://github.com/fkanehiro/hrpsys-base/pull/391 )
  • Calculate LPF parameter based on controller time step dt and enable to set cut-off frequency from IDL. (https://github.com/fkanehiro/hrpsys-base/pull/389 )
  • Add component name to debug message (https://github.com/fkanehiro/hrpsys-base/pull/377 )
  • Enable to Change ST Algorithms (https://github.com/fkanehiro/hrpsys-base/pull/376 )
    • (StabilizerService, Stabilizer) : Add new body attitude control parameter not to share same parameter among different ST alg.
    • (Stabilizer) : Remove unnecessary ST algorithm checking.
    • (Stabilizer) : Just fix indent.
    • (StabilizerService, Stabilizer) : Enable to change st algorithm (TPCC or EEFM).
  • modify spell miss in comment (https://github.com/fkanehiro/hrpsys-base/pull/375 )
  • Update ST Transition (https://github.com/fkanehiro/hrpsys-base/pull/366 )
    • (Stabilizer) : Add eefm_pos_margin_time for gain scheduling
    • (Stabilizer, hrpsys_config) : Add data port for debugging data for Stabilizer

• [util/monitor, utils/simulator] (https://github.com/fkanehiro/hrpsys-base/pull/407 )

  • add help message for viewer as well
  • add small setting to make emacs people happy convert tab character to spaces
  • improve user interface

• New Features

  • adds a new component, AccelerationChecker
  • adds a new component MLSFilter

• [samples/SampleRobot]

  • (samplerobot_terrain_walk) : Update parameter setting for terrain walk example and add start up down demo
  • (sample6dofrobot_kalman_filter) : Update to use get and set KalmanFilterParam. (https://github.com/fkanehiro/hrpsys-base/pull/390 )
  • (SampleRobot.conf.in) : Fix order of end effector according to ForceSensor order. (https://github.com/fkanehiro/hrpsys-base/pull/383 )