radio_ms.c

软件无线电的平台

/***************************************************************************
          radio_ms.c  -  SRadio controller module for convolutional coding
                            -------------------
    begin                :  03/12/10
    authors              :  Roman Hofer
    emails               :  [e-mail]
 ***************************************************************************/

/***************************************************************************
                                 Changes
                                 -------
 date - name - description
 
 **************************************************************************/

/***************************************************************************
 *                                                                         *
 *   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.                                   *
 *                                                                         *
 ***************************************************************************/


/**
 * Make a simple MS that connects to the BS. On another slot, random data is sent
 * using a convolutional encoder.
 *
 * Function:
 * - listen to Synch
 * - find synch
 * - set up a channel for sending
 *
 */

#include "system.h"
#include "sdb.h"
#include "stfa.h"
#include "antenna.h"
#include "std.h"
#include "debugging.h"
#include "../convolution_radio.h"
#include "chain.h"

#define ANTENNA 0
#define DBG_LVL 0

swr_sdb_id stfa, mafi, macro_synch, sch, synch_rcv, slicer;
struct chain_t *ch_up, *ch_bch, *ch_sink;
enum st{ user_mode, synching, send_up, stop_stfa, done } state;
int count, offset;
struct bch_struct bch_data;

int callback( int msg, void *data, swr_sdb_id ret_id );

/**
 * This function is called once to clean up the synchronisation-macro,
 * set up the bch and up-channel, and to set the callback-function
 * as default.
 */
int synchronised( int msg, void *data, swr_sdb_id ret_id ) {
  swr_sdb_id rand_u8, conv_send, test_data_send;

  // Clean the synchronisation
  swr_sdb_set_config_int( macro_synch, "synch", 0 );

  // Initialise some values
  count = 0;
  state = send_up;
  offset = swr_sdb_get_stats_int( macro_synch, "offset" );
  synch_rcv = swr_sdb_get_stats_int( macro_synch, "synch_rcv" );
  swr_stfa_notice_func( stfa, 0, callback );

  // Listen to the bch
  ch_bch = swr_chain_create(
             OLD_SPC( synch_rcv ),
             NEW_SPC_VAR( "matched_filter", mafi ),
             NEW_SPC( "despread" ),
             NEW_SPC_VAR( "slicer", slicer ),
             NEW_SPC_VAR( "sch_rcv", sch ),
             CHAIN_END );
  swr_sdb_set_config_int( sch, "antenna", 0 );
  swr_sdb_set_config_int( sch, "id", 0x1234 );
  swr_sdb_set_config_int( mafi, "gain_control", 8000 );

  //Give the mafi_id to the slicer, so it can get the
  //max signal amplitude from the matched filter
  //if set to -1, the slicer evaluate the ampl itself
  swr_sdb_set_config_int(slicer, "mafi_id", mafi);

  PR( "Setting uplink in slot 1\n" );
  // And setup a simple UP-chain...
  ch_up = swr_chain_create(
            NEW_SPC_VAR( "random", rand_u8 ),
            NEW_SPC_VAR( "test_data_send", test_data_send),
            NEW_SPC_VAR( "convolution_send", conv_send),
            NEW_SPC( "mapper" ),
            NEW_SPC( "midamble" ),
            NEW_SPC( "rrc" ),
            OLD_SPC_IN( stfa, 1 ),
            CHAIN_END );

  //Connect the 2nd output of the test_data_send to a sink (just to have it connected to something)
  ch_sink=swr_chain_create(
            OLD_SPC_OUT( test_data_send, 1 ),
            NEW_SPC( "sink"),
            CHAIN_END );

  PR_DBG(4, "Configuring sender...\n" );
  swr_sdb_set_config_int( rand_u8, "seed", 0x1234 );

#if 0
  //number of output bits
  swr_sdb_set_config_int( conv_send, "cfg_n", 7 );
  //per number of input bits
  swr_sdb_set_config_int( conv_send, "cfg_k", 5 );
  //number of memory registers
  swr_sdb_set_config_int( conv_send, "cfg_m", 8 );
  //polynomes, must contain n polynomes
  swr_sdb_set_config_pointer( conv_send, "cfg_polys", polys );
#endif
  
  PR_DBG(4, "...sender configured\n" );

  //Use mode 1 (restart random every block) and fixed seed to produce
  //same data at sender and receiver
  swr_sdb_set_config_int( rand_u8, "seed", 0x1234 );
  swr_sdb_set_config_int( rand_u8, "mode", 1 );

  swr_stfa_notice_sdb( stfa, 1, rand_u8 );

  PR( "Ready to go" );
  return 0;
}


/**
 * Once a frame this function is called. Do here whatever seems accurate...
 */
void do_send_up( void ) {}


/**
 * The first time this
 */
int callback( int msg, void *data, swr_sdb_id ret_id ) {

  count++;
  switch( state ) {
  case send_up:
    do_send_up();
    break;
  case stop_stfa:
    swr_stfa_stop( stfa );
    state++;
    break;
  case done:
    // WARNING: this is never reached...
    PR( "Done...\n" );
    break;
  default:
    break;
  }
  return 0;
}

void *start_it( void *arg ) {
  int i;

  PR( "getting sdbs\n" );
  stfa = swr_sdb_instantiate_name( "stfa" );

  // Initialise the STFA
  swr_sdb_set_config_int( stfa, "slots_per_frame", SLOTS );
  swr_sdb_set_config_int( stfa, "blocks_per_slot", SLOT_LEN );
  swr_sdb_set_config_int( stfa, "slot_send_offset", SLOT_OFFSET );
  PR( "Slots: %i, Length: %i\n", SLOTS, SLOT_LEN );

  // Initialise our local vars
  ch_up = ch_bch = NULL;

  // This sets up the synchronisation-macro
  PR( "Setting up synchronisation\n" );
  macro_synch = swr_sdb_instantiate_name( "macro_synch" );
  swr_sdb_set_config_int( macro_synch, "stfa_id", stfa );
  swr_sdb_set_config_int( macro_synch, "synch", 1 );
  swr_sdb_set_config_pointer( macro_synch, "call_synched", synchronised );

  PR( "Starting stfa\n" );
  swr_stfa_go( stfa );

  i = 0;
  while ( state != done ) {
    usleep( 1000000 );
  }

  swr_sdb_set_config_int( macro_synch, "synch", 0 );
  swr_stfa_stop( stfa );
  PR( "stfa stopped\n" );

  return NULL;
}

struct thread start;

/**
 * This function is called upon "insmod" and is used to register the
 * different parts of the module to the SPM.
 */
int um_module_init(void) {

  state = synching;
  if ( swr_thread_init( &start, start_it, NULL ) ) {
    goto rrc_no_thread;
  }
  return 0;

rrc_no_thread:
  PR( "Couldn't init thread\n" );
  return -1;
}

void um_module_exit( void ) {

  state = done;
  PR( "Waiting for thread to finish\n" );
  swr_thread_free( &start, NULL );

  PR_DBG( 2, "Destroying uplink\n" );
  swr_chain_destroy( ch_up );
  PR_DBG( 2, "Destroying bch\n" );
  swr_chain_destroy( ch_bch );
  PR_DBG( 2, "Destroying ch_sink\n" );
  swr_chain_destroy( ch_sink );
  PR_DBG( 2, "Destroying macro_synch\n" );
  swr_sdb_destroy( macro_synch );
  PR_DBG( 2, "Destroying stfa\n" );
  swr_sdb_destroy( stfa );

}


module_init( um_module_init );
module_exit( um_module_exit );