fix location fix with bearing and speed

Signed-off-by: Hiroshi Miura <miurahr@linux.com>