Added more actions to action server. Robot can now drive to set different sets of blocks