Replaced garmin code with simple test code for now