Implement STP, macro the opcodes (not complete)