Update Hachpees.c

Wrote Swap, needs to be tested.