Added a push and pop to psw inside 2s comp

Worried that otherwise, our check on the carry just after this function
might be affected.