PenUp/Down Added, LimitSwitches Fixed

Also, Z axis zero is reset by pressing limit switch