[bt-robot] - Refactor code & fix bug.