Your Speed calculation is almost perfect, just remove that multiply by 2 after length and make sure to set old loc after you set speed and it should be fine.
Your Speed calculation is almost perfect, just remove that multiply by 2 after length and make sure to set old loc after you set speed and it should be fine.