First working version. Added serial communication to get position information. Also added open-loop arm positioning.