Robot 0.4

Changed upper wrist servo buttons.
Fixed include issues.
Added irArm infrared sensor.
Major improvements and fixes to autonomous code.