Robotran C Documentation
mbs_sensor.h
Go to the documentation of this file.
1 #ifndef _SENSOR_UTILITIES_H
2 #define _SENSOR_UTILITIES_H
3 
4 #include "mbs_sensor_struct.h"
5 
6 #ifdef __cplusplus
7 extern "C" {
8 #endif
9 
10 // forward declaration
11 struct MbsData;
12 
18 void allocate_sensor(MbsSensor *psens, int njoint);
19 
25 void init_sensor(MbsSensor *psens, int njoint);
26 
33 void free_sensor(MbsSensor *psens);
34 
35 
41 MbsSensor* mbs_new_sensor(struct MbsData* mbs_data);
42 
50 void mbs_delete_sensor(MbsSensor *psens);
51 
52 
61 int mbs_comp_F_sensor(MbsSensor *psens, struct MbsData *mbs_data, int isens);
62 
71 int mbs_comp_S_sensor(MbsSensor *psens, struct MbsData *mbs_data, int isens);
72 
81 int mbs_comp_gen_sensor(MbsSensor *psens, struct MbsData *mbs_data, int joint_id);
82 
83 #ifdef __cplusplus
84 }
85 #endif
86 
87 #endif
user_call_Link3DForces_dqdd
double * user_call_Link3DForces_dqdd(double PxF[4], double d_PxF[4], double RxF[4][4], double d_RxF[4][4], double VxF[4], double d_VxF[4], double OMxF[4], double d_OMxF[4], double AxF[4], double d_AxF[4], double OMPxF[4], double d_OMPxF[4], MbsData *s, double tsim, int i_link3d, int i_param)
Module redirection for user function, see user_Link3DForces_dqdd().
Definition: mbs_project_fct_ptr.c:481
Functions::user_LinkForces_dq
user_LinkForces_d_ptr user_LinkForces_dq
Definition: mbs_data.h:167
mbs_Rred
int mbs_Rred(MbsAux *mbs_aux, MbsData *s)
compute Rred, the reduced equations of motions on a residual form [nqu x 1] obtained after the 2 cons...
Definition: mbs_Rred.c:23
user_call_Link3DForces_dq
double * user_call_Link3DForces_dq(double PxF[4], double d_PxF[4], double RxF[4][4], double d_RxF[4][4], double VxF[4], double d_VxF[4], double OMxF[4], double d_OMxF[4], double AxF[4], double d_AxF[4], double OMPxF[4], double d_OMPxF[4], MbsData *s, double tsim, int i_link3d, int i_param)
Module redirection for user function, see user_Link3DForces_dq().
Definition: mbs_project_fct_ptr.c:449
user_call_invdyn_init
void user_call_invdyn_init(MbsData *mbs_data, MbsInvdyn *mbs_invd)
Module redirection for user own dirdyn initialization function, see user_dirdyn_init().
Definition: mbs_project_fct_ptr.c:534
Functions::mbs_check_symbolic
mbs_checksymb_ptr mbs_check_symbolic
Definition: mbs_data.h:79
mbs_call_link3D
int mbs_call_link3D(double **frc, double **trq, MbsData *s, double tsim)
Symbolic link 3D forces function declaration.
Definition: mbs_project_fct_ptr.c:40
MBS_INFO_FAILURE
#define MBS_INFO_FAILURE
Definition: mbs_define.h:31
mbs_msg
void mbs_msg(const char *msg,...)
Send a message.
Definition: mbs_message.c:87
Realtime_option
user real-time option
Definition: realtime.h:42
Functions::mbs_invdynared_dqdd
mbs_invdynared_d_ptr mbs_invdynared_dqdd
Definition: mbs_data.h:82
MbsData::Ncons
int Ncons
Number of algebraic constraints.
Definition: mbs_data.h:317
Functions::mbs_invdynared_dqd
mbs_invdynared_d_ptr mbs_invdynared_dqd
Definition: mbs_data.h:81
Functions::user_realtime_visu
user_realtime_visu_ptr user_realtime_visu
Definition: mbs_data.h:188
Functions::user
struct Functions::@5 user
MbsInvdyn
General structure of the inverse dynamics module.
Definition: mbs_invdyn_struct.h:27
user_call_invdyn_loop
void user_call_invdyn_loop(MbsData *mbs_data, MbsInvdyn *mbs_invd)
Module redirection for user own dirdyn loop function, see user_dirdyn_loop().
Definition: mbs_project_fct_ptr.c:540
Functions::mbs_cons_hJ
mbs_cons_hJ_ptr mbs_cons_hJ
Definition: mbs_data.h:75
user_call_equil_fxe
void user_call_equil_fxe(MbsData *mbs_data, double *f)
Module redirection for user own equilibrium equations function, see user_equil_fxe().
Definition: mbs_project_fct_ptr.c:572
Functions::user_equil_finish
user_equil_finish_ptr user_equil_finish
Definition: mbs_data.h:103
MbsData::tsim
double tsim
The time value.
Definition: mbs_data.h:305
MbsData::nqrot
int nqrot
Number of rotational joint (R1, R2 or R3)
Definition: mbs_data.h:269
mbs_comp_S_sensor
int mbs_comp_S_sensor(MbsSensor *psens, struct MbsData *mbs_data, int isens)
Compute all fields of the specified sensor.
Definition: mbs_sensor_utilities.c:73
user_call_dirdyn_finish
void user_call_dirdyn_finish(MbsData *mbs_data, MbsDirdyn *mbs_dd)
Module redirection for user own dirdyn finish function, see user_dirdyn_finish().
Definition: mbs_project_fct_ptr.c:526
user_call_realtime_visu
void user_call_realtime_visu(MbsData *mbs_data, int nb_models, int *nb_q, double **q_vec)
Redirection to the user-specified user function of realtime visualization.
Definition: mbs_project_fct_ptr.c:620
user_call_JointForces_dp
double * user_call_JointForces_dp(MbsData *s, double tsim)
Module redirection for user function, see user_JointForces_dp().
Definition: mbs_project_fct_ptr.c:334
user_call_Link3DForces_dp
double * user_call_Link3DForces_dp(double PxF[4], double d_PxF[4], double RxF[4][4], double d_RxF[4][4], double VxF[4], double d_VxF[4], double OMxF[4], double d_OMxF[4], double AxF[4], double d_AxF[4], double OMPxF[4], double d_OMPxF[4], MbsData *s, double tsim, int i_link3d)
Module redirection for user function, see user_Link3DForces_dp().
Definition: mbs_project_fct_ptr.c:497
Functions::mbs_invdynared_dp
mbs_invdynared_d_ptr mbs_invdynared_dp
Definition: mbs_data.h:83
MbsData::nqv
int nqv
Number of dependent articulations.
Definition: mbs_data.h:267
Functions::mbs_link
mbs_link_ptr mbs_link
Definition: mbs_data.h:69
mbs_data.h
MbsData::qc
int * qc
Array with the indices of driven (locked and driven) articulations.
Definition: mbs_data.h:272
Functions::mbs_invdyna
mbs_invdyna_ptr mbs_invdyna
Definition: mbs_data.h:74
user_call_dirdyn_loop
void user_call_dirdyn_loop(MbsData *mbs_data, MbsDirdyn *mbs_dd)
Module redirection for user own dirdyn loop function, see user_dirdyn_loop().
Definition: mbs_project_fct_ptr.c:520
mbs_comp_F_sensor
int mbs_comp_F_sensor(MbsSensor *psens, struct MbsData *mbs_data, int isens)
Compute all fields of the specified force sensor.
Definition: mbs_sensor_utilities.c:78
MbsData::nqu
int nqu
Number of independent articulations.
Definition: mbs_data.h:262
user_call_LinkForces_dqd
double user_call_LinkForces_dqd(double Z, double d_Z, double Zd, double d_Zd, MbsData *s, double tsim, int i_link, int index)
Module redirection for user function, see user_LinkForces_dqd().
Definition: mbs_project_fct_ptr.c:354
lubksb
void lubksb(double **a, int n, int *indx, double b[])
Definition: lubksb.c:10
mbs_new_sensor
MbsSensor * mbs_new_sensor(struct MbsData *mbs_data)
Create a new MbsSensor structure, allocate and initialize the memory for all fields.
Definition: mbs_sensor_utilities.c:57
MbsData::njoint
int njoint
Number of joints in the system.
Definition: mbs_data.h:259
mbs_project_interface.h
Declaration of functions that are project dependent.
mbs_call_cons_jdqd
int mbs_call_cons_jdqd(double *Jdqd, MbsData *s, double tsim)
Symbolic jdqd function declaration.
Definition: mbs_project_fct_ptr.c:105
mbs_define.h
Functions::user_equil_init
user_equil_init_ptr user_equil_init
Definition: mbs_data.h:101
Functions::user_dirdyn_init
user_dirdyn_init_ptr user_dirdyn_init
Definition: mbs_data.h:93
Functions::user_equil_loop
user_equil_loop_ptr user_equil_loop
Definition: mbs_data.h:102
Functions::user_synch_outputs
set_mbs_to_output_ptr user_synch_outputs
Definition: mbs_data.h:191
user_call_JointForces
double * user_call_JointForces(MbsData *s, double tsim)
Module redirection for user joint force function, see user_JointForces().
Definition: mbs_project_fct_ptr.c:202
Functions::user_dirdyn_loop
user_dirdyn_loop_ptr user_dirdyn_loop
Definition: mbs_data.h:94
user_call_keyboard
void user_call_keyboard(MbsData *mbs_data, Simu_realtime *realtime, int cur_t_usec, const Uint8 *keystates)
Definition: mbs_project_fct_ptr.c:587
Functions::user_invdyn_finish
user_invdyn_finish_ptr user_invdyn_finish
Definition: mbs_data.h:99
mbs_call_link
int mbs_call_link(double **frc, double **trq, double *Flnk, double *Z, double *Zd, MbsData *s, double tsim)
Symbolic link forces function declaration.
Definition: mbs_project_fct_ptr.c:29
user_call_LinkForces_dp
double user_call_LinkForces_dp(double Z, double d_Z, double Zd, double d_Zd, MbsData *s, double tsim, int i_link)
Module redirection for user function, see user_LinkForces_dp().
Definition: mbs_project_fct_ptr.c:374
ludcmp
int ludcmp(double **a, int n, int *indx, double *d)
LU decomposition of a matrix with index starting at 1.
Definition: ludcmp.c:19
Functions::user_JointForces_dqdd
user_JointForces_d_ptr user_JointForces_dqdd
Definition: mbs_data.h:164
Functions::user_ExtForces
user_ExtForces_ptr user_ExtForces
Definition: mbs_data.h:115
mbs_call_invdynared_dqd
int mbs_call_invdynared_dqd(MbsData *s, double tsim)
Compute the damping matrix of the system.
Definition: mbs_project_fct_ptr.c:165
Functions::mbs_dirdyna
mbs_dirdyna_ptr mbs_dirdyna
Definition: mbs_data.h:73
user_call_JointForces_dqdd
double * user_call_JointForces_dqdd(MbsData *s, double tsim, int ixJ)
Module redirection for user function, see user_call_JointForces_dqdd().
Definition: mbs_project_fct_ptr.c:324
Functions::user_joystick_axes
user_joystick_axes_ptr user_joystick_axes
Definition: mbs_data.h:186
_MBS_ERR_LOW_NAN
#define _MBS_ERR_LOW_NAN
Low Level error number Number is NaN (not a number) = -7.
Definition: mbs_errors_names.h:147
user_call_equil_loop
void user_call_equil_loop(MbsData *mbs_data, MbsEquil *mbs_equil)
Module redirection for user own equil loop function, see user_equil_loop().
Definition: mbs_project_fct_ptr.c:560
mbs_1D_array.h
MbsData::flag_optim_symb_sin_cos
int flag_optim_symb_sin_cos
allow the "optimisation" of the computation of the sine/cosine in the symbolic files....
Definition: mbs_data.h:295
MbsData::SWr
double ** SWr
Array of Swr vector for each external forces.
Definition: mbs_data.h:364
MBSfun.h
user_call_invdyn_finish
void user_call_invdyn_finish(MbsData *mbs_data, MbsInvdyn *mbs_invd)
Module redirection for user own dirdyn finish function, see user_dirdyn_finish().
Definition: mbs_project_fct_ptr.c:546
mbs_close_kin
void mbs_close_kin(MbsData *s, MbsAux *mbs_aux)
compute the dependent velocities that solves the constraints.
Definition: mbs_close_loops.c:146
Functions::mbs_link3D
mbs_link3D_ptr mbs_link3D
Definition: mbs_data.h:70
Functions::user_Link3DForces
user_Link3DForces_ptr user_Link3DForces
Definition: mbs_data.h:114
user_call_joystick_buttons
void user_call_joystick_buttons(MbsData *mbs_data, int buttonID)
Definition: mbs_project_fct_ptr.c:612
MbsData::hu
int * hu
Array with the indices of independent constraints.
Definition: mbs_data.h:280
user_call_ExtForces
double * user_call_ExtForces(double PxF[4], double RxF[4][4], double VxF[4], double OMxF[4], double AxF[4], double OMPxF[4], MbsData *s, double tsim, int ixF)
Module redirection for the computation of external forces, see user_DrivenJoints().
Definition: mbs_project_fct_ptr.c:235
user_call_realtime_plot
void user_call_realtime_plot(MbsData *mbs_data)
Definition: mbs_project_fct_ptr.c:596
mbs_sensor_struct.h
user_call_synch_outputs
void user_call_synch_outputs(MbsData *mbs_data)
Definition: mbs_project_fct_ptr.c:636
Functions::user_joystick_buttons
user_joystick_buttons_ptr user_joystick_buttons
Definition: mbs_data.h:187
MbsEquil
Definition: mbs_equil_struct.h:79
Functions::user_Link3DForces_dqd
user_Link3DForces_d_ptr user_Link3DForces_dqd
Definition: mbs_data.h:173
user_call_LinkForces_dqdd
double user_call_LinkForces_dqdd(double Z, double d_Z, double Zd, double d_Zd, MbsData *s, double tsim, int i_link, int index)
Module redirection for user function, see user_LinkForces_dqdd().
Definition: mbs_project_fct_ptr.c:364
Functions::user_keyboard
user_keyboard_ptr user_keyboard
Definition: mbs_data.h:184
user_call_cons_jdqd
int user_call_cons_jdqd(double *jdqd, MbsData *s, double tsim)
Module redirection for jdqd term of the user-specified constraints, see user_cons_jdqd() however the ...
Definition: mbs_project_fct_ptr.c:280
MbsData::flag_safety_checks
int flag_safety_checks
Flag to activate safety checks everywhere in mbsysc core. Faster computation if this flag is put to 0...
Definition: mbs_data.h:406
user_call_dirdyn_init
void user_call_dirdyn_init(MbsData *mbs_data, MbsDirdyn *mbs_dd)
Module redirection for user own dirdyn initialization function, see user_dirdyn_init().
Definition: mbs_project_fct_ptr.c:514
Functions::mbs_sensor
mbs_sensor_ptr mbs_sensor
Definition: mbs_data.h:77
Functions::user_equil_fxe
user_equil_fxe_ptr user_equil_fxe
Definition: mbs_data.h:104
_MBS_ERR_MID_RRED
#define _MBS_ERR_MID_RRED
Mid Level error number Related to the computation of the Rred matrix.
Definition: mbs_errors_names.h:102
MbsData::qu
int * qu
Array with the indices of the independent articulations (free)
Definition: mbs_data.h:271
Uint8
uint8_t Uint8
Definition: mbs_project_fct_ptr.h:98
MbsData::qv
int * qv
Array with the indices of the dependent articulations .
Definition: mbs_data.h:279
Functions::user_Link3DForces_dq
user_Link3DForces_d_ptr user_Link3DForces_dq
Definition: mbs_data.h:172
MbsData::Qc
double * Qc
Array with the value of joint force introduced in driven joint to respect the user function.
Definition: mbs_data.h:332
Functions::mbs_extforces
mbs_extforces_ptr mbs_extforces
Definition: mbs_data.h:71
Functions::user_cons_hJ
user_cons_hJ_ptr user_cons_hJ
Definition: mbs_data.h:109
_MBS_ERR_LOW_NULL_PTR
#define _MBS_ERR_LOW_NULL_PTR
Low Level error number A called symbolic or user function is set to NULL;.
Definition: mbs_errors_names.h:142
Functions::user_LinkForces
user_LinkForces_ptr user_LinkForces
Definition: mbs_data.h:113
mbs_call_cons_hJ
int mbs_call_cons_hJ(double *h, double **Jac, MbsData *s, double tsim)
Symbolic constraints function declaration.
Definition: mbs_project_fct_ptr.c:94
MbsData::Qq
double * Qq
Array with the values of the joint forces.
Definition: mbs_data.h:301
mbs_call_sensor
int mbs_call_sensor(MbsSensor *sens, MbsData *s, int isens)
Declaration of the symbolic function computing all fields of a sensor.
Definition: mbs_project_fct_ptr.c:116
MbsData::q
double * q
Array with the current values of the generalized coordinates.
Definition: mbs_data.h:284
Functions::user_ExtForces_dp
user_ExtForces_dp_ptr user_ExtForces_dp
Definition: mbs_data.h:180
Functions::user_Link3DForces_dp
user_Link3DForces_dp_ptr user_Link3DForces_dp
Definition: mbs_data.h:175
mbs_call_accelred
int mbs_call_accelred(MbsData *s, double tsim)
Symbolic reduced acceleration function declaration.
Definition: mbs_project_fct_ptr.c:62
Functions::user_realtime_plot
user_realtime_plot_ptr user_realtime_plot
Definition: mbs_data.h:185
Functions::user_JointForces_dqd
user_JointForces_d_ptr user_JointForces_dqd
Definition: mbs_data.h:163
mbs_calc_jdqd
int mbs_calc_jdqd(MbsData *s, MbsAux *mbs_aux)
compute the quadratic term of the constraints at acceleration level:
Definition: mbs_close_loops.c:236
mbs_trigo.h
This header defines the functions for trigonometric handling in MBsysC integrator in C.
user_call_ExtForces_dq
double * user_call_ExtForces_dq(double PxF[4], double d_PxF[4], double RxF[4][4], double d_RxF[4][4], double VxF[4], double d_VxF[4], double OMxF[4], double d_OMxF[4], double AxF[4], double d_AxF[4], double OMPxF[4], double d_OMPxF[4], MbsData *s, double tsim, int i_force, int i_joint)
Module redirection for user function, see user_call_ExtForces_dq().
Definition: mbs_project_fct_ptr.c:384
Functions::user_realtime_options
user_realtime_options_ptr user_realtime_options
Definition: mbs_data.h:183
MbsData::fct
Functions fct
Structure to store the pointer to the project-specific functions.
Definition: mbs_data.h:414
Functions::user_Derivative
user_Derivative_ptr user_Derivative
Definition: mbs_data.h:106
nrfct.h
user_call_Link3DForces
double * user_call_Link3DForces(double PxF[4], double RxF[4][4], double VxF[4], double OMxF[4], double AxF[4], double OMPxF[4], MbsData *s, double tsim, int ixF)
Module redirection for user link 3D function, see user_Link3DForces().
Definition: mbs_project_fct_ptr.c:212
mbs_call_invdynared_dq
int mbs_call_invdynared_dq(MbsData *s, double tsim)
Compute the stiffness matrix of the system.
Definition: mbs_project_fct_ptr.c:154
mbs_call_extforces
int mbs_call_extforces(double **frc, double **trq, MbsData *s, double tsim)
Symbolic external forces function declaration.
Definition: mbs_project_fct_ptr.c:51
Functions::user_invdyn_loop
user_invdyn_loop_ptr user_invdyn_loop
Definition: mbs_data.h:98
init_sensor
void init_sensor(MbsSensor *psens, int njoint)
Initialize all fields of MbsSensor structure to 0.
Definition: mbs_sensor_utilities.c:25
mbs_calc_force
int mbs_calc_force(MbsData *s)
compute the force and torques applied on the multibody system.
Definition: mbs_calc_force.c:16
MbsData::nqc
int nqc
Number of driven articulations, it includes qlocked and qdriven.
Definition: mbs_data.h:263
MbsData::l3DWr
double ** l3DWr
Definition: mbs_data.h:342
Functions::user_LinkForces_dp
user_LinkForces_dp_ptr user_LinkForces_dp
Definition: mbs_data.h:170
mbs_message.h
mbs_close_geo
int mbs_close_geo(MbsData *s, MbsAux *mbs_aux)
compute a position of the multibody system which solves the constraints
Definition: mbs_close_loops.c:43
Functions::mbs_accelred
mbs_accelred_ptr mbs_accelred
Definition: mbs_data.h:72
user_call_Link3DForces_dqd
double * user_call_Link3DForces_dqd(double PxF[4], double d_PxF[4], double RxF[4][4], double d_RxF[4][4], double VxF[4], double d_VxF[4], double OMxF[4], double d_OMxF[4], double AxF[4], double d_AxF[4], double OMPxF[4], double d_OMPxF[4], MbsData *s, double tsim, int i_link3d, int i_param)
Module redirection for user function, see user_Link3DForces_dqd().
Definition: mbs_project_fct_ptr.c:465
mbs_call_invdyna
int mbs_call_invdyna(double *Q, MbsData *s, double tsim)
Symbolic inverse dynamic function declaration.
Definition: mbs_project_fct_ptr.c:83
mbs_call_invdynared_dp
int mbs_call_invdynared_dp(MbsData *s, double tsim)
Definition: mbs_project_fct_ptr.c:187
MbsData
Definition: mbs_data.h:246
user_call_Derivative
int user_call_Derivative(MbsData *s)
Module redirection for the time derivative of the user state variables, see user_Derivative() however...
Definition: mbs_project_fct_ptr.c:248
realtime.h
Real-time constraints main header.
user_call_cons_hJ
int user_call_cons_hJ(double *h, double **Jac, MbsData *s, double tsim)
Module redirection for user joint force function, see user_cons_hJ() however the return differs.
Definition: mbs_project_fct_ptr.c:269
Functions::mbs_gensensor
mbs_gensensor_ptr mbs_gensensor
Definition: mbs_data.h:78
Simu_realtime
real-time structure
Definition: realtime.h:99
Functions::user_cons_J_accelred
user_cons_J_accelred_ptr user_cons_J_accelred
Definition: mbs_data.h:111
Functions::user_ExtForces_dqd
user_ExtForces_d_ptr user_ExtForces_dqd
Definition: mbs_data.h:178
Functions::user_Link3DForces_dqdd
user_Link3DForces_d_ptr user_Link3DForces_dqdd
Definition: mbs_data.h:174
mbs_call_check_symbolic
int mbs_call_check_symbolic(MbsData *s)
Call the symbolic checking function, see mbs_check_symbolic().
Definition: mbs_project_fct_ptr.c:138
user_call_ExtForces_dqdd
double * user_call_ExtForces_dqdd(double PxF[4], double d_PxF[4], double RxF[4][4], double d_RxF[4][4], double VxF[4], double d_VxF[4], double OMxF[4], double d_OMxF[4], double AxF[4], double d_AxF[4], double OMPxF[4], double d_OMPxF[4], MbsData *s, double tsim, int i_force, int i_joint)
Module redirection for user function, see user_ExtForces_dqdd().
Definition: mbs_project_fct_ptr.c:416
mbs_compute_sin_cos_quc
void mbs_compute_sin_cos_quc(MbsData *s, int *qrot_qu_indvec, int *qrot_qc_indvec)
Compute the sine and cosine of the q_sin and q_cos, only for the rotational joints that are independe...
Definition: mbs_trigo.c:65
MbsSensor
Definition: mbs_sensor_struct.h:18
user_call_equil_finish
void user_call_equil_finish(MbsData *mbs_data, MbsEquil *mbs_equil)
Module redirection for user own equil finish function, see user_equil_finish().
Definition: mbs_project_fct_ptr.c:566
user_call_equil_init
void user_call_equil_init(MbsData *mbs_data, MbsEquil *mbs_equil)
Module redirection for user own equilibrium initialization function, see user_equil_init().
Definition: mbs_project_fct_ptr.c:554
Functions::user_JointForces_dq
user_JointForces_d_ptr user_JointForces_dq
Definition: mbs_data.h:162
user_call_realtime_options
void user_call_realtime_options(MbsData *mbs_data, Realtime_option *options)
Definition: mbs_project_fct_ptr.c:579
user_call_JointForces_dq
double * user_call_JointForces_dq(MbsData *s, double tsim, int ixJ)
Module redirection for user function, see user_JointForces_dq().
Definition: mbs_project_fct_ptr.c:304
Functions::user_cons_jdqd
user_cons_jdqd_ptr user_cons_jdqd
Definition: mbs_data.h:110
Functions::user_DrivenJoints
user_DrivenJoints_ptr user_DrivenJoints
Definition: mbs_data.h:107
user_call_ExtForces_dp
double * user_call_ExtForces_dp(double PxF[4], double d_PxF[4], double RxF[4][4], double d_RxF[4][4], double VxF[4], double d_VxF[4], double OMxF[4], double d_OMxF[4], double AxF[4], double d_AxF[4], double OMPxF[4], double d_OMPxF[4], MbsData *s, double tsim, int i_force)
Module redirection for user function, see user_ExtForces_dp().
Definition: mbs_project_fct_ptr.c:432
Functions::user_invdyn_init
user_invdyn_init_ptr user_invdyn_init
Definition: mbs_data.h:97
user_call_LinkForces
double user_call_LinkForces(double Z, double Zd, MbsData *s, double tsim, int ilnk)
Module redirection for user link force function, see user_LinkForces().
Definition: mbs_project_fct_ptr.c:225
mbs_comp_gen_sensor
int mbs_comp_gen_sensor(MbsSensor *psens, struct MbsData *mbs_data, int joint_id)
Compute all fields of a sensor located on the specified joint.
Definition: mbs_sensor_utilities.c:83
MbsData::flag_stop
int flag_stop
stop the simulation. For dirdyn, equil, invdyn and solvekin only.
Definition: mbs_data.h:397
allocate_sensor
void allocate_sensor(MbsSensor *psens, int njoint)
Allocate the Jacobian matrix of the MbsSensor according to the number of joints in the multibody syst...
Definition: mbs_sensor_utilities.c:20
Functions::user_JointForces_dp
user_JointForces_dp_ptr user_JointForces_dp
Definition: mbs_data.h:165
free_sensor
void free_sensor(MbsSensor *psens)
Deprecated: Free the memory inside MbsSensor structure. i.e. free the space allocated for the jacobia...
Definition: mbs_sensor_utilities.c:51
copy_dvec_0
void copy_dvec_0(double *vec_src, double *vec_dest, int l_v)
Copy the content of a vector (of sizel_v) of doubles to a second vector, starting with index 0.
Definition: mbs_1D_array.c:981
mbs_call_dirdyna
int mbs_call_dirdyna(double **M, double *c, MbsData *s, double tsim)
Symbolic direct dynamic function declaration.
Definition: mbs_project_fct_ptr.c:72
MBS_INFO_SUCCESS
#define MBS_INFO_SUCCESS
Definition: mbs_define.h:29
slct_dvec_1
void slct_dvec_1(double *vec_src, int *vec_ind_src, int l_v, double *vec_dest)
fill the third vector by slicing the first vector of doubles at the indexes specified in the second (...
Definition: mbs_1D_array.c:1323
pick_and_place_dvec_1
void pick_and_place_dvec_1(double *src, int *index, int n, double *dest)
Pick the values from an array and set them in the destination array at the specified index.
Definition: mbs_1D_array.c:1305
MbsData::lambda
double * lambda
Array with the values of the Lagrange Multipliers related to the constraints.
Definition: mbs_data.h:321
Functions::symb
struct Functions::@4 symb
MbsDirdyn
General structure of the direct dynamic module.
Definition: mbs_dirdyn_struct.h:166
mbs_call_gensensor
int mbs_call_gensensor(MbsSensor *sens, MbsData *s, int isens)
Declaration of the symbolic function computing all fields of a sensor located at a body origin.
Definition: mbs_project_fct_ptr.c:127
Functions::user_ExtForces_dqdd
user_ExtForces_d_ptr user_ExtForces_dqdd
Definition: mbs_data.h:179
Functions::user_LinkForces_dqd
user_LinkForces_d_ptr user_LinkForces_dqd
Definition: mbs_data.h:168
user_call_ExtForces_dqd
double * user_call_ExtForces_dqd(double PxF[4], double d_PxF[4], double RxF[4][4], double d_RxF[4][4], double VxF[4], double d_VxF[4], double OMxF[4], double d_OMxF[4], double AxF[4], double d_AxF[4], double OMPxF[4], double d_OMPxF[4], MbsData *s, double tsim, int i_force, int i_joint)
Module redirection for user function, see user_ExtForces_dqd().
Definition: mbs_project_fct_ptr.c:400
MbsData::qdd
double * qdd
Array with the current values of the generalized acceleration.
Definition: mbs_data.h:286
user_call_LinkForces_dq
double user_call_LinkForces_dq(double Z, double d_Z, double Zd, double d_Zd, MbsData *s, double tsim, int i_link, int index)
Module redirection for user function, see user_LinkForces_dq().
Definition: mbs_project_fct_ptr.c:344
Functions::mbs_cons_jdqd
mbs_cons_jdqd_ptr mbs_cons_jdqd
Definition: mbs_data.h:76
MBS_INFO_WARNING
#define MBS_INFO_WARNING
Definition: mbs_define.h:30
user_call_DrivenJoints
int user_call_DrivenJoints(MbsData *s, double tsim)
Module redirection for the computation of driven joints, see user_DrivenJoints() however the return d...
Definition: mbs_project_fct_ptr.c:258
mbs_Rred_core
int mbs_Rred_core(MbsAux *mbs_aux, MbsData *s)
Compute the residual force on independant joints and required force in driven joints.
Definition: mbs_Rred.c:41
user_call_JointForces_dqd
double * user_call_JointForces_dqd(MbsData *s, double tsim, int ixJ)
Module redirection for user function, see user_JointForces_dqd().
Definition: mbs_project_fct_ptr.c:314
user_call_cons_J_accelred
int user_call_cons_J_accelred(MbsData *s, double tsim)
Module redirection for accelred user-specified constraints function, see user_cons_J_accelred().
Definition: mbs_project_fct_ptr.c:291
Functions::user_LinkForces_dqdd
user_LinkForces_d_ptr user_LinkForces_dqdd
Definition: mbs_data.h:169
mbs_delete_sensor
void mbs_delete_sensor(MbsSensor *psens)
Free the memory of MbsSensor structure. and its contents.
Definition: mbs_sensor_utilities.c:64
user_call_joystick_axes
void user_call_joystick_axes(MbsData *mbs_data, Simu_realtime *realtime, int nb_joysticks)
Definition: mbs_project_fct_ptr.c:604
Functions::mbs_invdynared_dq
mbs_invdynared_d_ptr mbs_invdynared_dq
Definition: mbs_data.h:80
mbs_call_invdynared_dqdd
int mbs_call_invdynared_dqdd(MbsData *s, double tsim)
Compute the reduced mass matrix of the system.
Definition: mbs_project_fct_ptr.c:176
Functions::user_JointForces
user_JointForces_ptr user_JointForces
Definition: mbs_data.h:88
MbsData::nhu
int nhu
Number of independent constraints.
Definition: mbs_data.h:268
mbs_errors_names.h
Functions::user_dirdyn_finish
user_dirdyn_finish_ptr user_dirdyn_finish
Definition: mbs_data.h:95
Functions::user_ExtForces_dq
user_ExtForces_d_ptr user_ExtForces_dq
Definition: mbs_data.h:177