turned arm code into a function and wrote a test for it, also calibrated the camera