gpr_billard_mobility.pr.c

opnet Ad hoc仿真源程序,自己构建的路由协议和网络模型

			FSM_STATE_EXIT_UNFORCED (1, "idle", "gpr_billard_mobility [idle exit execs]")
				FSM_PROFILE_SECTION_IN (gpr_billard_mobility [idle exit execs], state1_exit_exec)
				{
				}
				FSM_PROFILE_SECTION_OUT (gpr_billard_mobility [idle exit execs], state1_exit_exec)


			/** state (idle) transition processing **/
			FSM_PROFILE_SECTION_IN (gpr_billard_mobility [idle trans conditions], state1_trans_conds)
			FSM_INIT_COND (MOVE)
			FSM_DFLT_COND
			FSM_TEST_LOGIC ("idle")
			FSM_PROFILE_SECTION_OUT (gpr_billard_mobility [idle trans conditions], state1_trans_conds)

			FSM_TRANSIT_SWITCH
				{
				FSM_CASE_TRANSIT (0, 2, state2_enter_exec, ;, "MOVE", "", "idle", "position")
				FSM_CASE_TRANSIT (1, 1, state1_enter_exec, ;, "default", "", "idle", "idle")
				}
				/*---------------------------------------------------------*/



			/** state (position) enter executives **/
			FSM_STATE_ENTER_FORCED (2, "position", state2_enter_exec, "gpr_billard_mobility [position enter execs]")
				FSM_PROFILE_SECTION_IN (gpr_billard_mobility [position enter execs], state2_enter_exec)
				{
				///////////////////////////////////////////////////////////////
				// BILLARD MOBILITY POSITION STATE
				//
				// Update the position of the node containing the current mobility 
				// process
				///////////////////////////////////////////////////////////////
				
				
				// Get the actual position of the node containing the current process
				op_ima_obj_attr_get(my_node_id,"x position",&x_pos);
				op_ima_obj_attr_get(my_node_id,"y position",&y_pos);
				if (1)
					{
					op_prg_odb_bkpt("ztl_mov");
					}
				
				// calcul the new x and y position according to the STEP_DIST and the current direction (angle)
				x=x_pos+STEP_DIST*cos(angle);
				y=y_pos+STEP_DIST*sin(angle);
				
				// if the new x position is outside the network grid boundaries
				if ((x<XMIN)||(XMAX<x))
					{
					// if the new y position is also outside the network grid boundaries
					if ((y<YMIN)||(YMAX<y))
						{
						// come back to the previous position (on x and y)
						x=x_pos-STEP_DIST*cos(angle);
						y=y_pos-STEP_DIST*sin(angle);
						// and calculate a random new direction
						angle=op_dist_outcome(one)*PI;	
						}
					// if new y position are still in the network boundaries 
					else 
						{
						// come back to the previous position (only on x)
						x=x_pos-STEP_DIST*cos(angle);
						// and calculate a random new direction
						angle=op_dist_outcome(one)*PI;
						}
					}
				
				// if only the new y position is outside (x and y outside handle before) the network boundaries 
				if ((y<YMIN)||(YMAX<y))
					{
					// come back to the previous position (only on y)
					y=y_pos-STEP_DIST*sin(angle);
					// and calculate a random new direction
					angle=op_dist_outcome(one)*PI;
					}
				
				printf(" my_id : %d previous pos (%f,%f), new position (%f,%f), direction %f\n",my_node_id,x_pos,y_pos,x,y,angle);
				
				// set the new position of the node
				op_ima_obj_attr_set(my_node_id, "x position",x);
				op_ima_obj_attr_set(my_node_id, "y position",y);
				
				// schedule the interuption for the next movement (position updating)
				op_intrpt_schedule_self(op_sim_time()+POS_TIMER,0);
				
				// breakpoint for debugging purpose
				if (1)
					{
					op_prg_odb_bkpt("ztl_mov");
					}
				
				
				
				
				
				}

				FSM_PROFILE_SECTION_OUT (gpr_billard_mobility [position enter execs], state2_enter_exec)

			/** state (position) exit executives **/
			FSM_STATE_EXIT_FORCED (2, "position", "gpr_billard_mobility [position exit execs]")
				FSM_PROFILE_SECTION_IN (gpr_billard_mobility [position exit execs], state2_exit_exec)
				{
				}
				FSM_PROFILE_SECTION_OUT (gpr_billard_mobility [position exit execs], state2_exit_exec)


			/** state (position) transition processing **/
			FSM_TRANSIT_FORCE (1, state1_enter_exec, ;, "default", "", "position", "idle")
				/*---------------------------------------------------------*/



			}


		FSM_EXIT (0,"gpr_billard_mobility")
		}
	}




void
gpr_billard_mobility_diag (OP_SIM_CONTEXT_ARG_OPT)
	{
	/* No Diagnostic Block */
	}




void
gpr_billard_mobility_terminate (OP_SIM_CONTEXT_ARG_OPT)
	{

#if !defined (VOSD_NO_FIN)
	int _op_block_origin = __LINE__;
#endif

	FIN_MT (gpr_billard_mobility_terminate ())

	Vos_Poolmem_Dealloc_MT (OP_SIM_CONTEXT_THREAD_INDEX_COMMA pr_state_ptr);

	FOUT
	}


/* Undefine shortcuts to state variables to avoid */
/* syntax error in direct access to fields of */
/* local variable prs_ptr in gpr_billard_mobility_svar function. */
#undef one
#undef my_node_id
#undef my_process_id
#undef angle
#undef my_net_id
#undef bMobile

#undef FIN_PREAMBLE_DEC
#undef FIN_PREAMBLE_CODE

#define FIN_PREAMBLE_DEC
#define FIN_PREAMBLE_CODE

VosT_Obtype
gpr_billard_mobility_init (int * init_block_ptr)
	{

#if !defined (VOSD_NO_FIN)
	int _op_block_origin = 0;
#endif
	VosT_Obtype obtype = OPC_NIL;
	FIN_MT (gpr_billard_mobility_init (init_block_ptr))

	Vos_Define_Object (&obtype, "proc state vars (gpr_billard_mobility)",
		sizeof (gpr_billard_mobility_state), 0, 20);
	*init_block_ptr = 0;

	FRET (obtype)
	}

VosT_Address
gpr_billard_mobility_alloc (VOS_THREAD_INDEX_ARG_COMMA VosT_Obtype obtype, int init_block)
	{

#if !defined (VOSD_NO_FIN)
	int _op_block_origin = 0;
#endif
	gpr_billard_mobility_state * ptr;
	FIN_MT (gpr_billard_mobility_alloc (obtype))

	ptr = (gpr_billard_mobility_state *)Vos_Alloc_Object_MT (VOS_THREAD_INDEX_COMMA obtype);
	if (ptr != OPC_NIL)
		ptr->_op_current_block = init_block;
	FRET ((VosT_Address)ptr)
	}



void
gpr_billard_mobility_svar (void * gen_ptr, const char * var_name, void ** var_p_ptr)
	{
	gpr_billard_mobility_state		*prs_ptr;

	FIN_MT (gpr_billard_mobility_svar (gen_ptr, var_name, var_p_ptr))

	if (var_name == OPC_NIL)
		{
		*var_p_ptr = (void *)OPC_NIL;
		FOUT
		}
	prs_ptr = (gpr_billard_mobility_state *)gen_ptr;

	if (strcmp ("one" , var_name) == 0)
		{
		*var_p_ptr = (void *) (&prs_ptr->one);
		FOUT
		}
	if (strcmp ("my_node_id" , var_name) == 0)
		{
		*var_p_ptr = (void *) (&prs_ptr->my_node_id);
		FOUT
		}
	if (strcmp ("my_process_id" , var_name) == 0)
		{
		*var_p_ptr = (void *) (&prs_ptr->my_process_id);
		FOUT
		}
	if (strcmp ("angle" , var_name) == 0)
		{
		*var_p_ptr = (void *) (&prs_ptr->angle);
		FOUT
		}
	if (strcmp ("my_net_id" , var_name) == 0)
		{
		*var_p_ptr = (void *) (&prs_ptr->my_net_id);
		FOUT
		}
	if (strcmp ("bMobile" , var_name) == 0)
		{
		*var_p_ptr = (void *) (&prs_ptr->bMobile);
		FOUT
		}
	*var_p_ptr = (void *)OPC_NIL;

	FOUT
	}