mbsysc/MBsysC/mbs__data_8h_source.html

#ifndef mbs_data_h

#define mbs_data_h

/*--------------------*/


#include "stdio.h"

#include "stdlib.h"


#include "mbs_user_interface.h"


#include "mbs_project_fct_ptr.h"


/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */

// utility structure for managing dynamic lib (for userfct and symbolic libraries)


#ifdef PRJ_FCT_PTR


#ifdef UNIX

    #include <dlfcn.h>

#else

    #define WIN32_LEAN_AND_MEAN

    #include <windows.h>

#endif


typedef struct MbsDataLibInfo{

    #ifdef UNIX

    void *lib_handle;

    #else

    HINSTANCE lib_handle;

    #endif

}MbsDataLibInfo;


#endif


/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */


#ifdef PRJ_FCT_PTR


typedef struct{


    // Pointers to libraries from which the functions were loaded

    MbsDataLibInfo* symbolicLibHandle;

    MbsDataLibInfo* userfctLibHandle;


    // Pointers to project function


    // symbolic function pointers are firstly defined to get the same structure

    // fields ordering with and without realtime

    struct{

        mbs_link_ptr    mbs_link;

        mbs_link3D_ptr    mbs_link3D;

        mbs_extforces_ptr mbs_extforces;

        mbs_accelred_ptr mbs_accelred;

        mbs_dirdyna_ptr mbs_dirdyna;

        mbs_invdyna_ptr mbs_invdyna;

        mbs_cons_hJ_ptr mbs_cons_hJ;

        mbs_cons_jdqd_ptr mbs_cons_jdqd;

        mbs_sensor_ptr mbs_sensor;

        mbs_gensensor_ptr mbs_gensensor;

    } symb;


    // user function pointers

    struct{

        user_JointForces_ptr user_JointForces;

        // user load

        user_load_post_ptr user_load_post;

        user_free_ptr user_free;

        // user dirdyn

        user_dirdyn_init_ptr user_dirdyn_init;

        user_dirdyn_loop_ptr user_dirdyn_loop;

        user_dirdyn_finish_ptr user_dirdyn_finish;

        // user invdyn

        user_invdyn_init_ptr user_invdyn_init;

        user_invdyn_loop_ptr user_invdyn_loop;

        user_invdyn_finish_ptr user_invdyn_finish;

        // user equil

        user_equil_init_ptr user_equil_init;

        user_equil_loop_ptr user_equil_loop;

        user_equil_finish_ptr user_equil_finish;

        user_equil_fxe_ptr user_equil_fxe;


        user_Derivative_ptr user_Derivative;

        user_DrivenJoints_ptr user_DrivenJoints;

        user_cons_hJ_ptr user_cons_hJ;

        user_cons_jdqd_ptr user_cons_jdqd;

        user_cons_J_accelred_ptr user_cons_J_accelred;

        user_LinkForces_ptr user_LinkForces;

        user_Link3DForces_ptr user_Link3DForces;

        user_ExtForces_ptr user_ExtForces;


        mbs_new_user_IO_ptr mbs_new_user_IO;

        mbs_new_user_model_ptr mbs_new_user_model;

        mbs_delete_user_model_ptr mbs_delete_user_model;

        mbs_delete_user_IO_ptr mbs_delete_user_IO;

        mbs_get_user_IO_size_ptr mbs_get_user_IO_size;

        mbs_load_user_model_ptr mbs_load_user_model;

        mbs_bind_user_model_ptr mbs_bind_user_model;

        mbs_print_user_model_ptr mbs_print_user_model;

        mbs_get_user_model_size_ptr mbs_get_user_model_size;

        mbs_get_user_model_list_ptr mbs_get_user_model_list;

        mbs_save_um_ptr mbs_save_um;

        mbs_print_user_IO_ptr mbs_print_user_IO;

        mbs_save_user_IO_ptr mbs_save_user_IO;


        #ifdef REAL_TIME

            user_realtime_options_ptr user_realtime_options;


            #ifdef SDL

                user_keyboard_ptr user_keyboard;

                user_realtime_plot_ptr user_realtime_plot;

                user_joystick_axes_ptr user_joystick_axes;

                user_joystick_buttons_ptr user_joystick_buttons;

            #endif


            #ifdef VISU_3D

                user_realtime_visu_ptr user_realtime_visu;

            #endif

        #endif

    } user;


} Functions;


#endif


/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */


struct MbsData

{

    // Geometric and dynamic data //

    int npt;

    double **dpt;

    double **l;

    double *m;

    double **In;

    double g[3+1];


    int nbody;

    int njoint;


    // Infos partitionnement //

    int nqu;

    int nqc;

    int nqlocked;

    int nqdriven;

    int nqa;

    int nqv;

    int nhu;

    int nqrot;


    int *qu;

    int *qc;

    int *qlocked;

    int *qdriven;

    int *qa;

    int *qv;

    int *hu;

    int *qrot;


    // Joint coordinates, initial values and trigonometric values //

    double *q;

    double *qd;

    double *qdd;


    double *q0;

    double *qd0;

    double *qdd0;


    // only for dirdyn and qu, for now :-)

    double *q_sin;

    double *q_cos;

    int flag_optim_symb_sin_cos;

    // for advanced use of Robotran only ! default is 0.


    // Frc, Trq, Qq, tsim

    double **frc;

    double **trq;

    double *Qq;

    double *Qa;


    double tsim;


    double t0;

    double tf;

    double dt0;


    // Constraints

    int n_rod;

    double *lrod;

    int Nloopc;

    int Ncons;

    int Nuserc;

    double NRerr;

    int MAX_NR_ITER;

    double *lambda;

    double **jac_user;

    double *jdqd_user;


    // Driven variables (and joint forces)

    double *Qc;


    // Links

    int Nlink;

    int Nlink3D;

    double *Z;

    double *Zd;

    double *Fl;


    double **l3DWr; // JFC : Attention: la convention des indices est inversÃ©e par rapport aux habitudes Robotran


    // Sensors

    int Nsensor;


    // Ext Forces

    int Nxfrc;

    int *xfidpt;

    double **SWr;


#if !defined SENSORKIN

    // User Model

    int Nuser_model;

    UserModel *user_model;


    int n_user_IO;

    UserIO *user_IO;

    UserIoInfo *__user_IO_info;


#endif


    // User State

    double *ux;

    double *uxd;

    double *ux0;

    int Nux;


    // OTHER FIELDS //

    double *udd;


    int DonePart;

    int DoneEquil;

    int DoneModal;


    int process;

    int flag_stop;

    int flag_jac_position;


    int flag_safety_checks;

    double zero_division_thrs;


    char *mbs_filename;

    char *build_path;

    char *project_path;

    char *mbs_name;


    #ifdef PRJ_FCT_PTR

    Functions fct;

    #endif


    #ifdef REAL_TIME

    // This is set at the end of the structure to allow python (Ctypes) loading

    // with and without real time activated

    void *realtime;

    #endif


};


/*--------------------*/

#endif