Beginnings of a working quad library! Testing movement commands