本發明涉及一種機器人，尤其是跟隨機器人，包括：機器人本體、安裝在機器人本體上的控制系統、安裝在機器人本體上且與所述控制系統連接的移動裝置、攝像頭、UWB基站和超聲波傳感器；所述移動裝置用于驅動機器人本身跟隨人體移動，所述攝像頭用于捕捉人體，所述UWB基站用于與設置在人體上的UWB移動端進行定位，所述超聲波傳感器用于檢測障礙物。本發明提供的跟隨機器人通過檢測跟隨機器人與人體之間的距離和使用超聲波傳感器進行避障控制移動裝置使跟隨機器人跟隨人員移動，實現實時連續的監控，并且無死角。

技術領域

本發明涉及一種機器人，尤其是跟隨機器人、跟隨系統及其跟隨方法。

背景技術

隨著老齡化，養老問題日益嚴峻。老人需要隨時看護，護工需要監管，因此如何實現老人和護工隨時監管是亟待解決的問題。目前主要采用固定在墻體上的攝像頭進行監管，這種方式監控有死角，并且不能連續監控。

發明內容

為解決上述問題，本發明提供一種能夠跟隨人員移動，實現實時、連續的監控，無死角的跟隨機器人，具體技術方案為：

跟隨機器人，包括：機器人本體、安裝在機器人本體上的控制系統、安裝在機器人本體上且與所述控制系統連接的移動裝置、攝像頭、UWB基站和超聲波傳感器；所述移動裝置用于驅動機器人本身跟隨人體移動，所述攝像頭用于捕捉人體，所述UWB基站用于與設置在人體上的UWB移動端進行定位，所述超聲波傳感器用于檢測障礙物。

跟隨系統，包括：所述的跟隨機器人；UWB移動端，所述UWB移動端佩戴在人體上。

跟隨方法，包括以下步驟：

S110、數據處理，UWB基站獲取UWB移動端的信號數據，并對信號數據進行處理；

S120、計算跟隨機器人與人體之間的距離L和與人體之間的偏移角度A；

S130、若跟隨機器人與人體之間的距離L小于停止距離L1，且跟隨機器人與人體之間的偏移角度在A1范圍內，則進入S210，否則進入S140；

S140、若跟隨機器人與人體之間的距離L在停止距離L1與最大距離L2之間，且跟隨機器人與人體之間的偏移角度在A2范圍內，則進入S310，否則進入S150；

S150、若跟隨機器人與人體之間的距離L大于最大距離L2，則進入S410，否則返回S110；

其中，

S210、跟隨機器人停止移動；

S310、跟隨機器人根據距離計算跟隨速度，并進入S320；

S320、超聲波傳感器檢測是否有障礙物，若有障礙物則進入S330，否則根據計算的跟隨速度向人體移動；

S330、檢測障礙物左右兩側是否存在空道，若有空道則進入S340，否則進入S350；

S340、跟隨機器人向空道處轉彎繞過障礙物；

S350、以機器人當前位置為基點分別向左右兩個方向貼著障礙物走指定距離來判斷兩側是否存在空道；

S410、則跟隨機器進行高速移動，并進入S420；

S420、超聲波傳感器檢測是否有障礙物，若有障礙物則進入S430，否則高速向人體移動；

S430、檢測障礙物左右兩側是否存在空道，若有空道則進入S440，否則進入S450；

S440、跟隨機器人向空道處轉彎繞過障礙物；

S450、以機器人當前位置為基點分別向左右兩個方向貼著障礙物走指定距離來判斷兩側是否存在空道。

進一步的，所述步驟S110中信號處理包括以下步驟：