config_from_ra.m

来自「多智能体工具包」· M 代码 · 共 13 行

function Robot_Config=config_from_ra(Real_Radius,Real_Angle)
% CONFIG_FROM_RA	Return the robot configuration from an angle.

%     Copyright (c) 1997-2000 Jiming Liu and Jianbing Wu

Object_Config=get_object_config(3,1);

[dist,goal_object_angle]=goal_object_pos(Object_Config);

Robot_Object_Angle=goal_object_angle+Real_Angle;
Robot_Config(1)=Object_Config(1)+Real_Radius*cos(Robot_Object_Angle);
Robot_Config(2)=Object_Config(2)+Real_Radius*sin(Robot_Object_Angle);