-
Notifications
You must be signed in to change notification settings - Fork 50
BallJoint: apply axis properties to ball joints #753
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
BallJoint: apply axis properties to ball joints #753
Conversation
- Use gazebosim/gz-physics#753 Signed-off-by: Rhys Mainwaring <rhys.mainwaring@me.com>
Codecov ReportAttention: Patch coverage is
Additional details and impacted files@@ Coverage Diff @@
## gz-physics8 #753 +/- ##
==============================================
Coverage ? 79.19%
==============================================
Files ? 144
Lines ? 8801
Branches ? 0
==============================================
Hits ? 6970
Misses ? 1831
Partials ? 0 ☔ View full report in Codecov by Sentry. 🚀 New features to boost your workflow:
|
RotorHead - Adjust pose of model in world - Add further links and joints. - Add lever coupling links and joints. - Simplify collisions. - Compose ball joint from 2 revolute joints. - Simplify collisions for linkages. - Ensure all ball joints have 3DoF - Add servo linkage visuals. - Limit movement of lever joints. - Lever coupling top joints are revolute, not ball. - Add guide rod and retainer to prevent lower swashplate rotation. - Update friction and damping. - Recompute ball joint inertials. - Add servos and rods. - Update joint damping. - Update link and joint names. - Align swashplate joints. - Replace collision guide with joints. - Add rotor blades. - Add lift-drag plugins. - Correct joint orientations. - Reorient servo links. - Reduce mass of rotor head. - Adjust rotor lift-drag. - Rename rotor head model - Add ccw version of rotor head. - Update orientation in ccw rotor head. - Velocity controllers were not using force and PIDs - Update PIDs for joint and position controllers. - Fit lift-drag coefficients to NACA0012 profile. - Add blade visuals for CW and CCW rotors. - Move servo2 to be near centre of rotor head. - Remove debug info. - Remove debug colours of servo rods and joints. - Add credit for visuals Helicopter - Add helicopter model in world. - Add tail rotor. - Add stabiliser bars and wheels. - Add ArduPilot plugin. - Swap servo_1 and servo_3 to be consistent with AP ordering. - Adjust CoG. - Adjust IMU position to main rotor. - Add separate model and config files. - Use standalone model for helicopter. - Place on runway model. - Rename helicopter world - Update to SDF version 1.11 - Add intermeshing dual rotor example. - Add meshes. - Increase friction on stabilizers. - Correct orientation of tail rotor blade visual and collision. - Correct dual heli control elements. - Increase mass of base link for dual heli. - Add params for dual transverse helicopter. - Add gimbal for testing attitude control. - Allow blades to flap on rotor heads - This is essential for correct operation. - Blades hinge at blade grips with range +/- 8 deg. - Adjust blade flapping damping and spring constant. - Remove oscillation / resonance when rolling at higher collective. - Reduce blade hinge spring stiffness. - Set ball joint properties - Use gazebosim/gz-physics#753 - Set physics params in detachable joints - Use gazebosim/gz-physics#754 - Use gazebosim/gz-sim#2960 - Adjust flapping hinge position - Move hinge towards rotor hub. - This position gives a flapping lag of about 80 deg behind the blade pitch. - Retune ATC_RAT PIDs for flapping blades. - Add visuals for frame and rotors - Add mesh visuals based on TRex-450. - Remove stabilising links and wheels. - Reposition tail rotor to match rescaled model. - Update rotor velocity command topic. - Add config for the ros_gz bridge - Retune model for adjusted CoM and tail position - Add credit for visuals Signed-off-by: Rhys Mainwaring <rhys.mainwaring@me.com>
RotorHead - Adjust pose of model in world - Add further links and joints. - Add lever coupling links and joints. - Simplify collisions. - Compose ball joint from 2 revolute joints. - Simplify collisions for linkages. - Ensure all ball joints have 3DoF - Add servo linkage visuals. - Limit movement of lever joints. - Lever coupling top joints are revolute, not ball. - Add guide rod and retainer to prevent lower swashplate rotation. - Update friction and damping. - Recompute ball joint inertials. - Add servos and rods. - Update joint damping. - Update link and joint names. - Align swashplate joints. - Replace collision guide with joints. - Add rotor blades. - Add lift-drag plugins. - Correct joint orientations. - Reorient servo links. - Reduce mass of rotor head. - Adjust rotor lift-drag. - Rename rotor head model - Add ccw version of rotor head. - Update orientation in ccw rotor head. - Velocity controllers were not using force and PIDs - Update PIDs for joint and position controllers. - Fit lift-drag coefficients to NACA0012 profile. - Add blade visuals for CW and CCW rotors. - Move servo2 to be near centre of rotor head. - Remove debug info. - Remove debug colours of servo rods and joints. - Add credit for visuals Helicopter - Add helicopter model in world. - Add tail rotor. - Add stabiliser bars and wheels. - Add ArduPilot plugin. - Swap servo_1 and servo_3 to be consistent with AP ordering. - Adjust CoG. - Adjust IMU position to main rotor. - Add separate model and config files. - Use standalone model for helicopter. - Place on runway model. - Rename helicopter world - Update to SDF version 1.11 - Add intermeshing dual rotor example. - Add meshes. - Increase friction on stabilizers. - Correct orientation of tail rotor blade visual and collision. - Correct dual heli control elements. - Increase mass of base link for dual heli. - Add params for dual transverse helicopter. - Add gimbal for testing attitude control. - Allow blades to flap on rotor heads - This is essential for correct operation. - Blades hinge at blade grips with range +/- 8 deg. - Adjust blade flapping damping and spring constant. - Remove oscillation / resonance when rolling at higher collective. - Reduce blade hinge spring stiffness. - Set ball joint properties - Use gazebosim/gz-physics#753 - Set physics params in detachable joints - Use gazebosim/gz-physics#754 - Use gazebosim/gz-sim#2960 - Adjust flapping hinge position - Move hinge towards rotor hub. - This position gives a flapping lag of about 80 deg behind the blade pitch. - Retune ATC_RAT PIDs for flapping blades. - Add visuals for frame and rotors - Add mesh visuals based on TRex-450. - Remove stabilising links and wheels. - Reposition tail rotor to match rescaled model. - Update rotor velocity command topic. - Add config for the ros_gz bridge - Retune model for adjusted CoM and tail position - Add credit for visuals Signed-off-by: Rhys Mainwaring <rhys.mainwaring@me.com>
- Use gazebosim/gz-physics#753 Signed-off-by: Rhys Mainwaring <rhys.mainwaring@me.com>
- Use gazebosim/gz-physics#753 Signed-off-by: Rhys Mainwaring <rhys.mainwaring@me.com>
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
I added expanded one of the dartsim tests to include loading a simple ball joint model in 0cb06bf. Please take a look and integrate the changes if they look good to you. Feel free to expand the test.
dartsim/src/SDFFeatures.cc
Outdated
const ModelInfo &_modelInfo, | ||
const ::sdf::Joint &_sdfJoint, | ||
dart::dynamics::BodyNode * const _parent, | ||
dart::dynamics::BodyNode * const _child, | ||
const Eigen::Isometry3d &_T_joint) |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
a couple of unused param warning here:
const ModelInfo &_modelInfo, | |
const ::sdf::Joint &_sdfJoint, | |
dart::dynamics::BodyNode * const _parent, | |
dart::dynamics::BodyNode * const _child, | |
const Eigen::Isometry3d &_T_joint) | |
const ModelInfo &, | |
const ::sdf::Joint &_sdfJoint, | |
dart::dynamics::BodyNode * const _parent, | |
dart::dynamics::BodyNode * const _child, | |
const Eigen::Isometry3d &) |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Updated in fa15dff
Thanks! LGTM, added in b6beef1 Hmmm... on second thoughts seem to be some issues with the test? Having linker issues with testing on macOS - so hard to run locally. Will look into this on VM, but looks like sdformat does not like the element for ball joints? |
oh weird. I just pulled in the latest changes and ran the tests locally but everything passed. Need to investigate |
I've managed to get the tests running on macOS again (removed a stray conflicting version of |
- Allow dynamics properties to be applied to ball joints in dart sim. Signed-off-by: Rhys Mainwaring <rhys.mainwaring@me.com>
Signed-off-by: Rhys Mainwaring <rhys.mainwaring@me.com>
Signed-off-by: Rhys Mainwaring <rhys.mainwaring@me.com>
Signed-off-by: Ian Chen <ichen@openrobotics.org>
b6beef1
to
e9c0a6a
Compare
As a quick test, I commented out the |
ok finally had more time to look into this. I pushed a change to make CIs green. It was not related to the ball joint axis. I was probably working with outdated branch. The number of entities got bumped to 8 in #723 so it makes sense now that we need to bump it again to 9 after adding the model with ball joint. |
🎉 New feature
Closes #634
Summary
Allow joint properties to be applied to ball joints in the dart sim physics engine.
As suggested in #634, the properties from the first
<axis>
field in the ball joint are applied to all DoF if this element is set. Otherwise the defaults are used, which is current behaviour.Test it
<axis>
element to a model using a ball joint and set some of the properties (eg.<limit>
).Example:
wind.sdf
wind.sdf
model to include<axis>
elements for each sphere restricting the movement:Figure: Expected

wind.sdf
behaviour with ball joint limit. Wind sock does not move.The motivation for this change is to stabilise a complex closed kinematic chain mechanism employing multiple ball joints (a helicopter rotor head). Without this change the simulation is not stable, and the joints vibrated so badly the simulated model does not maintain integrity (companion change to adjust the dynamic joint erp and cfm properties is also required to get satisfactory behaviour. That is be the subject of the follow up PRs:
Figure: Application of ball joint properties to a helicopter rotor head demonstrating swash plate collective and cyclic operation.
Checklist
codecheck
passed (See contributing)Note to maintainers: Remember to use Squash-Merge and edit the commit message to match the pull request summary while retaining
Signed-off-by
andGenerated-by
messages.