Implement support for stateful systems

[traversaro]

This is probably a long term goal, but for now let's collect some possible basic steps:

• Add support for reading continuous state in BlockInformation
• Add support for reading and writing discrete state in BlockInformation
• Implement support for reading continuous state in SimulinkBlockInformation (probably using ssGetContStates)
• Implement support for reading discrete state in SimulinkBlockInformation (probably using ssGetDiscStates)
• Implement support for reading continuous state in CoderBlockInformation
• Implement support for reading and writing discrete state in CoderBlockInformation
• Correctly implement mdlDerivatives in the BlockFactory S-Function:

  blockfactory/sources/Mex/src/BlockFactory.cpp

  Line 317 in 78a8723

  static void mdlDerivatives(SimStruct* /*S*/)

• Permit to specify that a (input) port of the block is not direct feed-through (see ssSetInputPortDirectFeedThrough and https://drake.mit.edu/doxygen_cxx/classdrake_1_1systems_1_1_system.html the drake::systems::System<T>::xxxDirectFeedthrough methods for an inspiration related to the corresponding Drake API . At the moment this is hardcoded at Simulink level in

  blockfactory/sources/Mex/src/SimulinkBlockInformationImpl.cpp

  Line 173 in 78a8723

  ssSetInputPortDirectFeedThrough(simstruct, idx, 1);

  .

[traversaro]

For the discrete state, it is also important to specify the sample time of the period update connected to the discrete state update. See https://it.mathworks.com/help/simulink/sfg/sample-times-cpp.html#f4-33929 for a description of this concept in the Simulink docs, and https://drake.mit.edu/doxygen_cxx/classdrake_1_1systems_1_1_leaf_system.html#a262f71637a37127840acefca3bda8897 for the related API in Drake's System API.

[traversaro]

For the discrete state, it is also important to specify the sample time of the period update connected to the discrete state update.

Related to that, for properly describing this in FMUs it is necessary to wait for FMI 3. See modelica/fmi-standard#353 and http://www.ep.liu.se/ecp/132/057/ecp17132507.pdf .

[traversaro]

Still related to stateful systems, it is relevant to mention that simStateCompliance should be properly set in Simulink:

blockfactory/sources/Simulink/src/BlockFactory.cpp

Line 175 in f8a363e

ssSetSimStateCompliance(S, USE_CUSTOM_SIM_STATE); //??

.
At the moment, it is set to USE_CUSTOM_SIM_STATE. This means (see https://it.mathworks.com/help/simulink/sfg/s-function-compliance-with-the-simstate.html) that the S-Function "has mdlGetSimState and mdlSetSimState methods", that are not implemented in the existing BlockFactory S-Function.

[diegoferigo]

That part of S-Function code is a very old heritage (from first versions of WBI-Toolbox I think). All of them would need a refreshing, not only this one.

[diegoferigo]

cc @fjandrad