@nrp.MapSpikeSink("Place_4",nrp.brain.place_cells[4:5],nrp.spike_recorder)
@nrp.MapSpikeSink("brown_left_output", nrp.brain.wall_neuron[1:2],nrp.spike_recorder)
@nrp.MapSpikeSink("brown_right_output", nrp.brain.wall_neuron[0:1],nrp.spike_recorder)
@nrp.MapVariable("var_angle",scope=nrp.GLOBAL)
@nrp.Neuron2Robot(Topic('/husky/husky/cmd_vel', geometry_msgs.msg.Twist))
def follow_place_cell_4 (t,Place_4,brown_left_output,brown_right_output,var_angle):
if(brown_left_output.spiked and brown_right_output.spiked):
return geometry_msgs.msg.Twist(linear = geometry_msgs.msg.Vector3(-2,0,0))
elif (brown_left_output.spiked):
return geometry_msgs.msg.Twist(linear = geometry_msgs.msg.Vector3(-1,0,0),angular=geometry_msgs.msg.Vector3(0,0,2))
elif (brown_right_output.spiked):
return geometry_msgs.msg.Twist(linear = geometry_msgs.msg.Vector3(-1,0,0),angular=geometry_msgs.msg.Vector3(0,0,-2))
if Place_4.spiked:
if(var_angle.value <= 150 and var_angle.value >120):
return geometry_msgs.msg.Twist(linear=geometry_msgs.msg.Vector3(1,0,0))
elif(var_angle.value <= 120 or var_angle.value > 330):
return geometry_msgs.msg.Twist(angular=geometry_msgs.msg.Vector3(0,0,1))
elif(var_angle.value < 330 and var_angle.value > 150):
return geometry_msgs.msg.Twist(angular=geometry_msgs.msg.Vector3(0,0,-1))