Update 11/4/13

Created readAllPosition function
Autonomous now outputs 3 debuging files
xyz-way, waypoints generated
xyz-sent, command coord sent to controller
xyz-cont, controller values
dt in arm remains constant while dt_mod it updated at beginning of
function then changed within