EmbodiedAI
/
quadruped_ros2_control
mirror of https://github.com/legubiao/quadruped_ros2_control.git
3
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

use swing all rather than stance all

This commit is contained in:
Huang Zhenbiao 2024-09-20 22:10:43 +08:00
parent 269e3b6a3d
commit da99daa31c
4 changed files with 23 additions and 22 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
controllers/unitree_guide_controller/src/FSM/StateBalanceTest.cpp
View File

@ -52,6 +52,7 @@ void StateBalanceTest::run() {
}
void StateBalanceTest::exit() {
wave_generator_.status_ = WaveStatus::SWING_ALL;
}
FSMStateName StateBalanceTest::checkChange() {

2
controllers/unitree_guide_controller/src/FSM/StateTrotting.cpp
View File

@ -64,7 +64,7 @@ void StateTrotting::run() {
}
void StateTrotting::exit() {
wave_generator_.status_ = WaveStatus::STANCE_ALL;
wave_generator_.status_ = WaveStatus::SWING_ALL;
}
FSMStateName StateTrotting::checkChange() {

4
controllers/unitree_guide_controller/src/gait/WaveGenerator.cpp
View File

@ -11,8 +11,8 @@
WaveGenerator::WaveGenerator() {
phase_past_ << 0.5, 0.5, 0.5, 0.5;
contact_past_.setZero();
status_past_ = WaveStatus::STANCE_ALL;
status_ = WaveStatus::STANCE_ALL;
status_past_ = WaveStatus::SWING_ALL;
status_ = WaveStatus::SWING_ALL;
}
void WaveGenerator::init(const double period, const double st_ratio, const Vec4 &bias) {

38
descriptions/quadruped_gazebo/urdf/common/imu.xacro
View File

@ -28,7 +28,7 @@
<gazebo reference="${imu_name}">
<sensor name="imu_sensor" type="imu">
<always_on>1</always_on>
<update_rate>500</update_rate>
<update_rate>1000</update_rate>
<visualize>true</visualize>
<topic>imu</topic>
<imu>
@ -60,28 +60,28 @@
</angular_velocity>
<linear_acceleration>
<x>
<noise type="gaussian">
<mean>0.0</mean>
<stddev>1.7e-2</stddev>
<bias_mean>0.1</bias_mean>
<bias_stddev>0.001</bias_stddev>
</noise>
<!-- <noise type="gaussian">-->
<!-- <mean>0.0</mean>-->
<!-- <stddev>1.7e-2</stddev>-->
<!-- <bias_mean>0.1</bias_mean>-->
<!-- <bias_stddev>0.001</bias_stddev>-->
<!-- </noise>-->
</x>
<y>
<noise type="gaussian">
<mean>0.0</mean>
<stddev>1.7e-2</stddev>
<bias_mean>0.1</bias_mean>
<bias_stddev>0.001</bias_stddev>
</noise>
<!-- <noise type="gaussian">-->
<!-- <mean>0.0</mean>-->
<!-- <stddev>1.7e-2</stddev>-->
<!-- <bias_mean>0.1</bias_mean>-->
<!-- <bias_stddev>0.001</bias_stddev>-->
<!-- </noise>-->
</y>
<z>
<noise type="gaussian">
<mean>0.0</mean>
<stddev>1.7e-2</stddev>
<bias_mean>0.1</bias_mean>
<bias_stddev>0.001</bias_stddev>
</noise>
<!-- <noise type="gaussian">-->
<!-- <mean>0.0</mean>-->
<!-- <stddev>1.7e-2</stddev>-->
<!-- <bias_mean>0.1</bias_mean>-->
<!-- <bias_stddev>0.001</bias_stddev>-->
<!-- </noise>-->
</z>
</linear_acceleration>
</imu>