Add Z motor sketch