James Upload 1

added new PID loops based on C++, not C.  Also duplicated fw_att_control...