saving
Working gui to write pid values to stm. Also first semi-successfull 2
arm balance test!