Modified test_stabilize

Changed some parts of test_stabilize before actually testing. Now remote can actually set z-values instead of toggling between +/- z