Updated with pen lift height thingy.  Not sure if this will actually work, but haven't got an uno here to test on.