New code for 4 Robot Drive