Fixed bug and added grab

Fixed that bug that made it so the commands wouldn't update.

Made it so numbers aren't grabbed unless the "grab" command happens on
top of them. This way the robot can walk through numbers without picking
them up