 |
Robotran C Documentation
|
Go to the documentation of this file.
15 #ifndef MBS_SOLVEKIN_h
16 #define MBS_SOLVEKIN_h
MbsInvOptions * options
Structure defining the option of a inverse kinematic analysis.
Definition: mbs_solvekin_struct.h:157
double ** tq
2D array containing the time (first column) and the corresponding coordinates value
Definition: lut.h:44
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
void mbs_lut_res_free(MbsLutRes *lut)
Release memory used by 2D LUT structure.
Definition: lut.c:108
char * resfilename
The keyword used for determining the name of result files.
Definition: mbs_solvekin_struct.h:94
int mbs_solvekin_save(MbsSolvekin *sk, double t)
Save the values of solvekin analysis in the buffers.
Definition: mbs_solvekin.c:152
double ** savedArrays
Pointer to the array that must be saved to buffers.
Definition: mbs_solvekin_struct.h:181
void mbs_msg(const char *msg,...)
Send a message.
Definition: mbs_message.c:87
int mbs_lut_res_interp(MbsLutRes *lut, double t, double *coord)
Interpolate the coordinates from a Results Look Up Table for a specific time value.
Definition: lut.c:364
char * get_char_cpy(const char *fmt,...)
Copy the provided formatted string into a newly allocated memory.
Definition: useful_functions.c:196
int Ncons
Number of algebraic constraints.
Definition: mbs_data.h:317
double * qd
Array with the current values of the generalized velocities.
Definition: mbs_data.h:285
double dt0
Initial value of the integration step size [s]. For dirdyn and invdyn only. This parameter is set fro...
Definition: mbs_data.h:309
char * buffer_format
The format of the results in the res file.
Definition: mbs_solvekin_struct.h:137
MbsBuffer ** buffers
Buffer to store generalized coordinates, velocities, acceleration.
Definition: mbs_solvekin_struct.h:171
int saveperiod
The number of time steps between two buffer records.
Definition: mbs_solvekin_struct.h:118
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
int buffersize
The number of time step that can be recorded in the buffer.
Definition: mbs_solvekin_struct.h:130
int tindex
Current time index.
Definition: mbs_solvekin_struct.h:167
double tsim
The time value.
Definition: mbs_data.h:305
double OM[4]
Angular velocity vector of the sensor expressed in the inertial frame: .
Definition: mbs_sensor_struct.h:23
int nqrot
Number of rotational joint (R1, R2 or R3)
Definition: mbs_data.h:269
void mbs_delete_sensor(MbsSensor *psens)
Free the memory of MbsSensor structure. and its contents.
Definition: mbs_sensor_utilities.c:64
int nqv
Number of dependent articulations.
Definition: mbs_data.h:267
int max_save_user
The maximal number of user variables saved.
Definition: mbs_solvekin_struct.h:123
int mbs_fct_solvekin(MbsData *s, MbsSolvekin *sk)
inverse kinematics computation of q, qd and qdd
Definition: mbs_solvekin.c:799
int * qc
Array with the indices of driven (locked and driven) articulations.
Definition: mbs_data.h:272
int nqu
Number of independent articulations.
Definition: mbs_data.h:262
void mbs_error_msg(int err, const char *msg,...)
Send an error message.
Definition: mbs_message.c:131
#define _MBS_ERR_LOW_FILES
Low Level error number Error during opening/writing files = -9.
Definition: mbs_errors_names.h:157
int njoint
Number of joints in the system.
Definition: mbs_data.h:259
Declaration of functions that are project dependent.
int mbs_buffer_write(MbsBuffer *b)
Write the content of the buffer to disk.
Definition: mbs_buffer.c:389
double tf
Final time of the simulation [s]. For dirdyn and invdyn only. This parameter is set from dirdyn/invyn...
Definition: mbs_data.h:308
char * trajectoryqddname
Give the path and filename (with extention) to the file containing the input trajectory in accelerati...
Definition: mbs_solvekin_struct.h:73
MbsLutRes * qdd
Definition: mbs_solvekin_struct.h:196
int nt
number of time steps
Definition: lut.h:43
void mbs_delete_solvekin(MbsSolvekin *solvekin, MbsData *mbs_data)
Free memory of the inverse kinematic structure The options (MbsInvOptions) and MbsAux structures are ...
Definition: mbs_solvekin.c:89
int mbs_solvekin_loop(MbsSolvekin *sk, MbsData *mbs_data)
Time loop of the run_solvekin function:
Definition: mbs_solvekin.c:553
MbsLutRes * q
Pointer to save the input trajectories.
Definition: mbs_solvekin_struct.h:196
void free_set_output()
release memory of auto_output
Definition: set_output.c:117
int mbs_solvekin_loop(MbsSolvekin *solvekin, MbsData *mbs_data)
Time loop of the run_solvekin function:
Definition: mbs_solvekin.c:553
General structure of the inverse kinematics module.
Definition: mbs_solvekin_struct.h:153
@ BUFFER_QD
Definition: mbs_buffer.h:21
int mbs_buffer_save(MbsBuffer *b, double t, double *x)
Save the given array to the specified buffer with the specified time.
Definition: mbs_buffer.c:254
double dt
Time step, default = 0.001.
Definition: mbs_solvekin_struct.h:86
double V[4]
Velocity vector of the sensor expressed in the inertial frame: .
Definition: mbs_sensor_struct.h:22
int mbs_growing_buffer_write(MbsGrowingBuffer *b)
write the content of the growing buffer to disk
Definition: mbs_buffer.c:599
#define _MBS_ERR_MOD_SPEC_15
Generic error number Module specific errors range from -11 to -19 please read the error message a...
Definition: mbs_errors_names.h:196
int set_output_to_mbs(MbsData *mbs_data, int verbosity)
Set the address of this buffers in MbsData to expose memory + synchronize verbosity.
Definition: set_output.c:26
@ BUFFER_QDD
Definition: mbs_buffer.h:21
#define _MBS_ERR_LOW_NAN
Low Level error number Number is NaN (not a number) = -7.
Definition: mbs_errors_names.h:147
int motion
Determines how the evolution of q, qd qdd are provided.
Definition: mbs_solvekin_struct.h:40
int framerate
Number of frame per second for the .anim file, default = 1000.
Definition: mbs_solvekin_struct.h:113
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
#define _MBS_ERR_INIT
Generic error number Check user options at initialization = -10.
Definition: mbs_errors_names.h:166
void mbs_close_kin(MbsData *s, MbsAux *mbs_aux)
compute the dependent velocities that solves the constraints.
Definition: mbs_close_loops.c:146
int mbs_check_nhu_nqv(MbsData *mbs_data)
Check the coherence between the number of (independant) constraints and the number of dependant varia...
Definition: mbs_check.c:20
char * mbs_dirname(const char *path, int verbose)
mbs_dirname returns the leading part of the path (UNIX and MAC).
Definition: mbs_path.c:407
double t0
Initial time of the simulation, default = 0.0.
Definition: mbs_solvekin_struct.h:76
@ BUFFER_OTHER
Definition: mbs_buffer.h:23
#define _MBS_ERR_MOD_INV_KIN
Module error number module: Inverse Kinematics = -500.
Definition: mbs_errors_names.h:63
int mbs_comp_gen_sensor(MbsSensor *psens, MbsData *mbs_data, int joint_id)
Compute all fields of a sensor located on the specified joint.
Definition: mbs_sensor_utilities.c:83
int nq
number coordinates
Definition: lut.h:42
double ** J
Jacobian matrix of the sensor: .
Definition: mbs_sensor_struct.h:28
int mbs_comp_F_sensor(MbsSensor *psens, MbsData *mbs_data, int isens)
Compute all fields of the specified force sensor.
Definition: mbs_sensor_utilities.c:78
MbsSolvekin * mbs_new_solvekin(MbsData *mbs_data)
Create a new inverse kinematic structure.
Definition: mbs_solvekin.c:33
const char * animpath
Path in which anim file is saved.
Definition: mbs_solvekin_struct.h:104
@ oneshot
Definition: mbs_solvekin_struct.h:25
@ BUFFER_Q
Definition: mbs_buffer.h:21
char * trajectoryqname
Give the path and filename (with extention) to the file containing the input trajectory in position o...
Definition: mbs_solvekin_struct.h:51
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
Definition: mbs_buffer.h:46
int mbs_growing_buffer_save(MbsGrowingBuffer *b, double t)
Save the given values of auto_output to the specified buffer with the specified time.
Definition: mbs_buffer.c:295
void mbs_delete_buffer(MbsBuffer *b)
Free memory of the specified MbsBuffer.
Definition: mbs_buffer.c:206
double ** R
Rotation matrix from the inertial frame to the sensor frame: .
Definition: mbs_sensor_struct.h:21
void mbs_delete_growing_buffer(MbsGrowingBuffer *b)
release memory for growing buffer
Definition: mbs_buffer.c:230
int * qu
Array with the indices of the independent articulations (free)
Definition: mbs_data.h:271
int mbs_fct_solvekin(MbsData *s, MbsSolvekin *sk)
inverse kinematics computation of q, qd and qdd
Definition: mbs_solvekin.c:799
int * qv
Array with the indices of the dependent articulations .
Definition: mbs_data.h:279
void init_sensor(MbsSensor *psens, int njoint)
Initialize all fields of MbsSensor structure to 0.
Definition: mbs_sensor_utilities.c:25
void freeMbsAux(MbsAux *mbs_aux, MbsData *s)
Definition: mbs_aux.c:174
int bufferNb
Number of buffers.
Definition: mbs_solvekin_struct.h:178
double JDQDR[4]
Quadratic acceleration (Jdqd) term vector (R for rotation/angular) of the sensor expressed in the ine...
Definition: mbs_sensor_struct.h:27
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
double * q
Array with the current values of the generalized coordinates.
Definition: mbs_data.h:284
int verbose
Gives informations during the process.
Definition: mbs_solvekin_struct.h:147
void free_dvec_1(double *vec)
release memory for a vector of doubles, starting at index 1
Definition: mbs_1D_array.c:976
@ trajectory
Definition: mbs_solvekin_struct.h:25
int Nsensor
< Array of l3DWr vector for each 3D link forces.
Definition: mbs_data.h:359
MbsSensor * mbs_new_sensor(MbsData *mbs_data)
Create a new MbsSensor structure, allocate and initialize the memory for all fields.
Definition: mbs_sensor_utilities.c:57
char * project_path
Path to the mbs project folder.
Definition: mbs_data.h:411
double P[4]
Position vector of the sensor expressed in the inertial frame: .
Definition: mbs_sensor_struct.h:20
#define _MBS_ERR_MOD_SPEC_12
Generic error number Module specific errors range from -11 to -19 please read the error message a...
Definition: mbs_errors_names.h:178
int mbs_init_sin_cos_q_vecs(MbsData *s, int *qrot_qu_indvec, int *qrot_qc_indvec, int *qrot_qv_indvec)
Initialize the three vectors of indices (they are usually contained in the mbs_aux structure)
Definition: mbs_trigo.c:23
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
char * trajectoryqdname
Give the path and filename (with extention) to the file containing the input trajectory in velocity o...
Definition: mbs_solvekin_struct.h:62
int mbs_check_mbs_data_values(MbsAux *module_mbs_aux, MbsData *mbs_data)
Check the coherence between the mbs_data used before module initialization and module run.
Definition: mbs_check.c:88
This header defines the functions for trigonometric handling in MBsysC integrator in C.
MbsSolvekin * mbs_new_solvekin_aux(MbsAux *mbs_aux)
Fills a new inverse kinematic structure.
Definition: mbs_solvekin.c:43
MbsGrowingBuffer * mbs_new_growing_buffer(int max_nx, int size, const char *respath)
create a new growing buffer for the user inputs to save
Definition: mbs_buffer.c:144
double tf
Final time of the simulation, default = 5.0.
Definition: mbs_solvekin_struct.h:79
Structure defining the option of both inverse kinematics and inverse dynamic analysis.
Definition: mbs_solvekin_struct.h:31
MbsLutRes * mbs_lut_res_load_file(char *fileName)
Load a file and return a new allocated results LUT structure.
Definition: lut.c:904
Interpolation of value from array (Look Up Table) main header.
int nqc
Number of driven articulations, it includes qlocked and qdriven.
Definition: mbs_data.h:263
set_output function called by the user to output his own variables
#define _MBS_ERR_MOD_SPEC_14
Generic error number Module specific errors range from -11 to -19 please read the error message a...
Definition: mbs_errors_names.h:190
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
int mbs_run_solvekin(MbsSolvekin *solvekin, MbsData *mbs_data)
Run the inverse kinematic analysis.
Definition: mbs_solvekin.c:105
const char * respath
Path in which result file are saved.
Definition: mbs_solvekin_struct.h:99
MbsAux * initMbsAux(MbsData *s)
Definition: mbs_aux.c:18
double tsim
Current simulation time.
Definition: mbs_solvekin_struct.h:164
Definition: mbs_data.h:246
double OMP[4]
Angular acceleration vector of the sensor expressed in the inertial frame: . Mutually exclusive with ...
Definition: mbs_sensor_struct.h:25
int mbs_solvekin_finish(MbsSolvekin *solvekin, MbsData *mbs_data)
Run the finalization operations of the run_solvekin function.
Definition: mbs_solvekin.c:710
int mbs_run_solvekin(MbsSolvekin *sk, MbsData *mbs_data)
Run the inverse kinematic analysis.
Definition: mbs_solvekin.c:105
#define _MBS_ERR_MOD_SPEC_11
Mid Level error number Module specific errors range from -11 to -19 please read the error message...
Definition: mbs_errors_names.h:172
MbsSolvekin * mbs_new_solvekin_aux(MbsAux *mbs_aux)
Fills a new inverse kinematic structure.
Definition: mbs_solvekin.c:43
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
Definition: mbs_sensor_struct.h:18
int get_output_vector_size(int index)
get the output vector size corresponding to the requested index
Definition: set_output.c:315
double t0
Initial time of the simulation [s]. For dirdyn and invdyn only. This parameter is set from dirdyn/inv...
Definition: mbs_data.h:307
int get_output_vector_nb()
get the number of user vector inputs
Definition: set_output.c:333
void init_set_output(int max_nb_curves)
initialize the static auto_output structure
Definition: set_output.c:84
double JDQDT[4]
Quadratic acceleration (Jdqd) term vector (T for translation) of the sensor expressed in the inertial...
Definition: mbs_sensor_struct.h:26
int mbs_solvekin_write_buffers(MbsSolvekin *sk)
Write the content of buffer associated to the given MbsSolvekin to disk.
Definition: mbs_solvekin.c:782
int flag_stop
stop the simulation. For dirdyn, equil, invdyn and solvekin only.
Definition: mbs_data.h:397
double * get_dvec_1(int l_v)
create (with memory allocation) a vector (length l_v) of doubles, starting at index 1
Definition: mbs_1D_array.c:960
int save2file
Determine whether results are written to files on disk (in MbsSolvekinOptions::respath folder):
Definition: mbs_solvekin_struct.h:91
void free_dmat_1(double **mat)
release memory for a matrix of doubles, starting at index 1
Definition: mbs_matrix.c:340
#define MBS_INFO_SUCCESS
Definition: mbs_define.h:29
int mbs_solvekin_write_buffers(MbsSolvekin *sk)
Write the content of buffer associated to the given MbsSolvekin to disk.
Definition: mbs_solvekin.c:782
double ** get_dmat_1(int nb_r, int nb_c)
create (with memory allocation) a [nb_r times nb_c] matrix of doubles, starting at index 1
Definition: mbs_matrix.c:294
int mbs_solvekin_finish(MbsSolvekin *sk, MbsData *mbs_data)
Run the finalization operations of the run_solvekin function.
Definition: mbs_solvekin.c:710
void reset_flag_output()
reset the flag_output to 0. Useful when running several simulation in a row with different save2file ...
Definition: set_output.c:76
double A[4]
Acceleration vector of the sensor expressed in the inertial frame: . Mutually exclusive with the comp...
Definition: mbs_sensor_struct.h:24
MbsSolvekin * mbs_new_solvekin(MbsData *mbs_data)
Create a new inverse kinematic structure.
Definition: mbs_solvekin.c:33
MbsGrowingBuffer * user_buffer
Growing buffer to store user values.
Definition: mbs_solvekin_struct.h:175
int save_anim
Determine whether animation file is generated (only valid if MbsSolvekinOptions::save2file is set to ...
Definition: mbs_solvekin_struct.h:110
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
int mbs_comp_S_sensor(MbsSensor *psens, MbsData *mbs_data, int isens)
Compute all fields of the specified sensor.
Definition: mbs_sensor_utilities.c:73
int mbs_step_close_geo(MbsData *s, MbsAux *mbs_aux)
compute an iteration of the position of the multibody system to solve the constraints
Definition: mbs_close_loops.c:81
int trajectorytype
Value to store the type of trajectory provided by the user, automatically set.
Definition: mbs_solvekin_struct.h:193
double * qdd
Array with the current values of the generalized acceleration.
Definition: mbs_data.h:286
char * get_output_vector_label(int index)
get the output vector label corresponding to the requested index
Definition: set_output.c:304
void mbs_delete_solvekin(MbsSolvekin *solvekin, MbsData *mbs_data)
Free memory of the inverse kinematic structure The options (MbsInvOptions) and MbsAux structures are ...
Definition: mbs_solvekin.c:89
MbsBuffer * mbs_new_buffer(char *filename, char *anim_name, int nx, int size, int id, char *buf_format, int save_anim, int save_visu, double anim_period)
Allocate and initialize a MbsBuffer structure.
Definition: mbs_buffer.c:27
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
int mbs_makedirs(char *path)
Create (recursively) the specified directory.
Definition: mbs_path.c:586
MbsLutRes * qd
Definition: mbs_solvekin_struct.h:196
int mbs_solvekin_init(MbsSolvekin *sk, MbsData *mbs_data)
Run the startup operations of the run_solvekin function.
Definition: mbs_solvekin.c:187
MbsAux * mbs_aux
Structure to store auxiliary value needed during computation.
Definition: mbs_solvekin_struct.h:160
int mbs_solvekin_init(MbsSolvekin *solvekin, MbsData *mbs_data)
Run the startup operations of the run_solvekin function.
Definition: mbs_solvekin.c:187
int nhu
Number of independent constraints.
Definition: mbs_data.h:268
#define MBS_VERBOSE_ALL
Definition: mbs_define.h:46
double * get_output_vector_ptr(int index)
get the pointer to the output vector at the requested index
Definition: set_output.c:352
@ closeloop
Definition: mbs_solvekin_struct.h:25
1.8.17