Home › Forum › SOFA › Programming with SOFA › [SOLVED] MechanicalObject rotation
Tagged: Linux_ubuntu, MechanicalObject, rotation, SOFA_2006
- This topic has 7 replies, 2 voices, and was last updated 3 years, 7 months ago by BrunoB81HK.
-
AuthorPosts
-
16 April 2021 at 00:05 #19187BrunoB81HKBlocked
Hi!
I’m currently working on a plugin to link a custom haptic device to a Sofa simulation. My goal is to move and rotate a mechanical object base on the position of my haptic device. So far, I implemented the translation and the force computation, but I can’t find how to apply a rotation that make sense. In my .scn file, the mechanical object is defined as such :
<Node name="Instr"> <EulerImplicitSolver rayleighStiffness='0.1' rayleighMass='0.1'/> <CGLinearSolver threshold='1e-11' tolerance='1e-11' iterations='25'/> <MechanicalObject name='InstrDOFs' template='Rigid3d'/> <UniformMass name='InstrMass' totalMass='0.05'/> <LCPForceFeedback template="Rigid3d" name="ForceFeedback" listening="1" activate="1" forceCoef="1."/> <Node name='InstrCol'> <MechanicalObject name='InstrColModel' src='@../../InstrColMesh'/> <SphereCollisionModel contactStiffness='1' listRadius='0.0025'/> <RigidMapping input='@../InstrDOFs' output='@InstrColModel'/> </Node> <Node name='InstrVis'> <OglModel name='InstrVisModel' src='@../../InstrVisMesh'/> <RigidMapping input='@../InstrDOFs' output='@InstrVisModel'/> </Node> </Node>
In my plugin, I start by retrieving the pointer
m_instrument
to the mechanical object. From there, I compute the needed translation and apply it withm_instrument->applyTranslation(trans[0], trans[1], trans[2])
. This part is working very well.The next step is to apply the required rotation. My mechanical object is basically a long cylinder. I want the axis of the cylinder to pass through a fixed point in the simulation. This point stay static through the entire simulation. I can easily compute the required axis/angle pair to achieve my rotation. I then use
m_instrument->applyRotation(q)
to apply my rotation (q being a quaternion).The problem is that the rotation is applied, but doesn’t match the one that I want. I don’t know if it as to do with reference frame, but I compute my quaternion in the general reference frame. I feel like the rotations might be applied in the mechanical object reference frame. I’m kinda lost on this one.
Thanks a lot for your help!
Bruno
23 April 2021 at 11:15 #19281HugoKeymasterHi @brunob81hk
I would first use for transformation a TransformEngine : this engine allows to apply a transformation (translation/rotation) and output the associated positions based on input positions. You can have a look at the example : TransformEngine. The TransformMatrixEngine might also be of interest.
I would recommend to decouple each transformation (translation // rotation).
I hope this helps.Best wishes,
Hugo
26 April 2021 at 05:17 #19309BrunoB81HKBlockedHi @hugo
Thanks a lot for the answer!
I will try it later this week and I’ll keep you posted.
Have a nice day!
Bruno
7 May 2021 at 22:28 #19397HugoKeymaster10 May 2021 at 23:14 #19425BrunoB81HKBlockedHi @hugo
Things are moving pretty fast here. This task is still in my backlog. I should be able to try it soon.
Have a nice day!
Bruno
14 May 2021 at 18:42 #19451BrunoB81HKBlockedHi @hugo
I finally had the time to thinker with a TransformEngine. It looks like its what I want, although I am not ale to use it from c++.
I now retrieve the pointer (
m_instrument
) to the TransformEngine instead of the MechanicalObject. I thought that I could usem_instrument->translation.setValue()
to set the desired position, butm_instrument->translation
is a protected member. I wanted to see if it was the only thing stopping me from using this method, so I setm_instrument->translation
as a public member in TransformEngine.h. This method did work as I wanted it to.Since I changed a part of the source code and I didn’t like it, I reverted the changes and tried to create my own
TrexTransformEngine
which is inherited fromTransformEngine
.After a lot of tinkering, I came up with a solution. Here is my code :
#pragma once #include <SofaGeneralEngine/TransformEngine.h> #include <sofa/core/ObjectFactory.h> namespace sofa::component::engine { template <class DataTypes> class TrexTransformEngine : public TransformEngine<DataTypes> { public: SOFA_CLASS(SOFA_TEMPLATE(TrexTransformEngine, DataTypes), SOFA_TEMPLATE(TransformEngine, DataTypes)); protected: TrexTransformEngine() : TransformEngine<DataTypes>{ } {}; ~TrexTransformEngine() override {} public: void setTranslation(defaulttype::Vector3 trans) { this->translation.setValue(trans); } void setQuaternion(defaulttype::Quaternion quat) { this->quaternion.setValue(quat); } }; int TrexTransformEngineClass = core::RegisterObject("Transform engine to help move the instrument.") .add< TrexTransformEngine<defaulttype::Rigid3Types> >(true) // default template .add< TrexTransformEngine<defaulttype::Vec1Types> >() .add< TrexTransformEngine<defaulttype::Vec2Types> >() .add< TrexTransformEngine<defaulttype::Vec3Types> >() .add< TrexTransformEngine<defaulttype::Rigid2Types> >() ; template class TrexTransformEngine<defaulttype::Vec1Types>; template class TrexTransformEngine<defaulttype::Vec2Types>; template class TrexTransformEngine<defaulttype::Vec3Types>; template class TrexTransformEngine<defaulttype::Rigid2Types>; template class TrexTransformEngine<defaulttype::Rigid3Types>; } //namespace sofa::component::engine
Is this a good way to do such a thing?
Thanks a lot for your help and have a nice day!
Bruno
19 May 2021 at 08:12 #19482HugoKeymasterHi @brunob81hk
Sorry but by reading throughout the topic again, I realize your purpose is to build a connector between an interface and a virtual object in the scene.
The way we usually do it is by building a C++ driver component (recovering information from your interface). As being a SOFA component, this driver has Data which a mechanical object could then be linked against.
Could you take a look at the Geomagic plugin (especially the class GeomagicDriver)?
Best
Hugo
25 May 2021 at 21:45 #19575BrunoB81HKBlockedHi @hugo
Just tried the method based on the Geomagic Driver and it works like a charm. This is everything I want.
Thanks a lot for your help and have a nice day!
Bruno
-
AuthorPosts
- You must be logged in to reply to this topic.