Completed targeting system, though certain constants may need to be modified.
Added two autonomous routines