merged maptest file into teleop file

merged files, still need to fix simulated boat and convert utmpose to
lat lon with direction