Improved SWORD_UP Movement

Thomas wrote with sharpie on the board…
Fixed Sword up for real