Created one cypress position command for 4 positions

Moved defines to Robot.h for easier access