def main():
global ini_pos, vel, gbestl_1, domain
ini_pos = [
list(random.uniform(domain[0], domain[1]) for i in range(2))
for t in range(1)
]
vel = [[0, 0]]
start_pos = [-8, -2]
robot_id = 0
pso_run = pso_ros(robot_id)
print("ini_pos", ini_pos)
while not rospy.is_shutdown():
mypub = rospy.Publisher('/Bot_1/pbest', swarm, queue_size=1)
tmp_pos = ini_pos
tmp_vel = vel
bot1 = swarm()
bot1.header.stamp = rospy.Time.now()
bot1.header.frame_id = '/Bot-1'
bot1.pbest = tmp_pos[0]
mypub.publish(bot1)
get_gbest = rospy.Subscriber('/gbest_calc', swarm, callback_s)
print("gbestl", gbestl_1)
if gbestl_1:
print("am i violating swarm 1", gbestl_1)
new_pos, n_vel = pso_run.run_pso(tmp_pos, tmp_vel, gbestl_1)
laser_topic = '/robot_0/base_scan'
pose_topic = '/robot_0/odom'
pub_topic = '/robot_0/cmd_vel'
oa_obj = pso_movement(laser_topic, pose_topic, pub_topic,
start_pos, new_pos[0])
oa_obj.main()
if oa_obj.flag == 1:
ini_pos = new_pos
vel = n_vel
start_pos = new_pos[0]
# pflag = 0
else:
pass
def robot_0_main():
laser_topic = '/robot_0/base_scan'
pose_topic = '/robot_0/odom'
pub_topic = '/robot_0/cmd_vel'
next_waypoint = pso_ros():