📄 cch_send.c
字号:
/*************************************************************************** * cch_send.c - Sends the structure and adds a CRC * ------------------- * begin : 2003 * authors : ineiti * emails : linus.gasser@epfl.ch ***************************************************************************//*************************************************************************** * Changes * ------- * date - name - description * 03/01/16 - ineiti - begin * **************************************************************************//*************************************************************************** * * * This program is free software; you can redistribute it and/or modify * * it under the terms of the GNU General Public License as published by * * the Free Software Foundation; either version 2 of the License, or * * (at your option) any later version. * * * ***************************************************************************//** * This module takes a structure, and sends it over the air. Additionally, * it adds a CRC. The reception-part checks for this CRC to be valid. */#include "spc.h"#include "std.h"#define DBG_LVL 0typedef struct { // A pointer to the data you want to send void *data; // NULL // The length in size of the data to send int len; // NULL}config_t;typedef struct {}stats_t;typedef struct { void *data; int len;}private_t;/* * The initialisation function, or constructor, * is called the first time this module is instantiated. */int send_init( swr_sdb_t *context ) { config_t *config; stats_t *stats; MOD_INC_USE_COUNT; if ( sizeof( private_t ) > 0 ) context->private_data = swr_malloc( sizeof( private_t ) ); swr_sdb_get_config_struct( context->id, (void**)&config ); swr_sdb_get_stats_struct( context->id, (void**)&stats ); private->data = config->data = NULL; private->len = config->len = 0; swr_sdb_free_stats_struct( context->id, (void**)&stats ); swr_sdb_free_config_struct( context->id, (void**)&config ); return 0;}/* * Every time modules from the outside change the value of a configuration parameter, * this function is called. */int send_reconfig( swr_sdb_t *context ) { // Definition of variables - don't touch config_t *config; swr_sdb_get_config_struct( context->id, (void**)&config ); private->data = config->data; private->len = config->len; // Definition - don't touch swr_sdb_free_config_struct( context->id, (void**)&config ); return 0;}/* * This is the function that implements the `main method' of the class * Every class has got just ONE method/working-mode. */int send_pdata( swr_sdb_t *context ) { stats_t *stats; U8 *out; // Check for valid sizes if ( private->len + sizeof( U32 ) > port_out(0).size ) { PR_DBG( 0, "Output-length %i is bigger than port-size %i\n", private->len + sizeof( U32 ), port_out(0).size ); private->len = port_out(0).size - sizeof( U32 ); if ( private->len <= 0 ) { PR_DBG( 0, "This output-port is really too small\n" ); return -1; } } out = buffer_out( 0 ); if ( private->data ) { // Add the crc-32 *((U32*)out ) = swr_crc32( private->data, private->len ); out += sizeof( U32 ); // And copy the data-block memcpy( out, private->data, private->len ); } swr_sdb_get_stats_struct( context->id, (void**)&stats ); swr_sdb_free_stats_struct( context->id, (void**)&stats ); return(0);}/** * User messages */int send_custom_msg( swr_sdb_t *context, swr_usr_msg_t *data, swr_msgq ret ) { send_pdata( context ); return 0;}/* * This is the `destructor'. */int send_finalize( swr_sdb_t *context ) { if ( sizeof( private_t ) > 0 ) swr_free( private ); MOD_DEC_USE_COUNT; return 0;}/* * This function is called upon "insmod" and is used to register the * different parts of the module to the SPM. */swr_spc_id_t send_id;int send_module_init(void) { swr_spc_desc_t *desc; /** * Get a description-part from SPM * Give the following parameters: * Input-ports, output-ports, config-params, stat-params */ desc = swr_spc_get_new_desc( 0, 1, 2, 0 ); if ( !desc ) { PR_DBG( 0, "Can't initialise the module. This is BAD!\n" ); return -1; } /** * Define the different parts of config and stats. You have to define * them in the same order as they appear in the structures. The names * can be freely chosen. * * UM_CONFIG_{INT,DOUBLE,STRING128,POINTER}( "name" ); * UM_STATS_{INT,DOUBLE,STRING128,POINTER,BLOCK}( "name" ); */ UM_CONFIG_POINTER( "data" ); UM_CONFIG_INT( "length" ); /** * The in- and outputs have also to be defined in the right order. First * port first. The additional flag is not used yet, but it will... * * UM_INPUT( SIG_{U8,SYMBOL_{S16,COMPLEX,MMX},SAMPLE_S12,S32}, 0 ); * UM_OUTPUT( SIG_{U8,SYMBOL_{S16,COMPLEX,MMX},SAMPLE_S12,S32}, 0 ); */ UM_OUTPUT( SIG_U8, 0 ); // Initialise the callback-functions. Delete the ones you don't use desc->fn_init = send_init; desc->fn_reconfigure = send_reconfig; desc->fn_process_data = send_pdata; desc->fn_custom_msg = send_custom_msg; desc->fn_finalize = send_finalize; // And register the module in the SPM. Change the name! send_id = swr_cdb_register_spc( &desc, "cch_send" ); if ( send_id == SWR_SPM_INVALID_ID ) { swr_spc_free_desc( desc ); PR_DBG( 0, "Couldn't register the module!\n" ); return 1; } PR_DBG( 4, "Ready\n" ); return 0;}/* * This is called upon rmmod */void send_module_exit( void ) { PR_DBG( 4, "Freeing id: %i\n", send_id ); if ( swr_cdb_unregister_spc( send_id ) < 0 ) { PR_DBG( 0, "Still in use somewhere\n" ); }}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -