arm seems to be off by 90degrees, but the code mostly works for stationary pieces. The hold wrist angle seems to be the last major bug, and slight callibration is in order