reduced time delay time
changed bluetooth parameters
fixed starting coordinates
Improved localization constants
changed angles to Radians