Moved timestamping to Razor_AHRS.pde
Remove convoluted array references
Remove debugging
update serial port for c++ program