Removed temporary test code

Signed-off-by: Thomas Wang <twang@nps.edu>
Added c2_radar_main() radar detection and tracking algorithm

- It works pretty well.
- Radar parameters tuned for time step of 120 sec/cycle
- Radar functions break down to
- 1. Detect target from radar image
- 2. Associate detected target to track
- 3. Update existing track base on new measurement
- 4. Initiate new track
- 5. Remove old tracks
- 6. Report current track

Signed-off-by: Thomas Wang <twang@nps.edu>
Improved environment performance

Signed-off-by: Thomas Wang <twang@nps.edu>
Added scenario recording/playback for parameter tuning and other improvements

Signed-off-by: Thomas Wang <twang@nps.edu>