[發明專利]一種臂架控制方法和裝置及混凝土泵車及布料機

有效

• 申請號: 201310562374.8
• 申請日: 2013-11-13
• 公開（公告）號: CN103590606A
• 公開（公告）日: 2014-02-19
• 發明（設計）人: 譚凌群;蒲東亮;武利沖
• 申請（專利權）人: 三一汽車制造有限公司
• 主分類號: E04G21/04
• 分類號: E04G21/04
• 代理公司: 暫無信息
• 代理人: 暫無信息

1.一種臂架控制方法，其特征在于，包括以下幾個步驟：

步驟1、在水平面上建立二維絕對坐標系；在水平面上建立二維動態坐標系；二維絕對坐標系的原點與二維動態坐標系的原點連線為二維動態坐標系的一軸；二維絕對坐標系的原點位于臂架旋轉中心點或臂架末端點，二維動態坐標系的原點位于遙控裝置上；

步驟2、獲取遙控裝置的操作手柄擺動方向與二維動態坐標系坐標軸形成的角度；獲取二維動態坐標系相對二維絕對坐標系旋轉的角度；

步驟3：通過坐標系轉換計算，獲得遙控裝置的操作手柄擺動方向與二維絕對坐標系坐標軸形成的角度。

步驟4：控制臂架末端朝操作手柄擺動方向與二維絕對坐標系中坐標軸形成的相應角度的方向移動。

2.根據權利要求1所述的臂架控制方法，其特征在于，在步驟2中，獲取臂架在二維絕對坐標系中旋轉的角度；獲取臂架末端點和臂架旋轉中心及遙控裝置三點位置距離以及三者之間的連線與水平面之間的角度信號，通過三角函數計算獲得二維動態坐標系相對二維絕對坐標系旋轉的角度。

3.根據權利要求1或2所述的臂架控制方法，其特征在于，當遙控裝置的操作手柄垂直上下移動時，臂架末端上下移動。

4.一種臂架控制裝置，包括控制器和遙控裝置，遙控裝置包括一個操作手柄，操作手柄可任意方向擺動，其特征在于，還包括感知裝置，在控制器上建立二維絕對坐標系和二維動態坐標系；二維絕對坐標系的原點與二維動態坐標系的原點連線為二維動態坐標系的一軸；二維絕對坐標系的原點位于臂架旋轉中心點或臂架末端點，二維動態坐標系的原點位于遙控裝置上；

控制器獲取感知裝置信號，并通過計算獲得遙控裝置的操作手柄擺動方向與二維絕對坐標系坐標軸形成的角度；控制器控制臂架末端朝操作手柄擺動方向與二維絕對坐標系中坐標軸形成的相應角度的方向移動。

5.根據權利要求所述的臂架控制裝置，其特征在于，感知裝置包括用于獲取臂架旋轉中心位置方位的第一感知裝置，用于獲取臂架末端位置方位的第二感知裝置，用于獲取遙控裝置位置方位的第三感知裝置，第一感知裝置和第二感知裝置及第三感知裝置信號可以相互接收信號和發送信號，控制器獲取第一感知裝置和第二感知裝置及第三感知裝置信號。

6.根據權利要求5所述的臂架控制裝置，其特征在于，第一感知裝置和第二感知裝置及第三感知裝置為測距裝置，測量臂架旋轉中心位置、臂架末端位置及遙控裝置位置三點連線距離以及三者之間的連線與水平面之間的角度。

7.根據權利要求5所述的臂架控制裝置，其特征在于，第一感知裝置和第二感知裝置及第三感知裝置為測角裝置，測量臂架旋轉中心位置至臂架末端位置和遙控裝置位置三點連線的角度；或者測量臂架末端位置至臂架旋轉中心位置和遙控裝置位置三點連線的角度。

8.根據權利要求4所述的臂架控制裝置，其特征在于，感知裝置為雷達或超聲波或測距傳感器。

9.根據權利要求4至8任意一項所述的臂架控制裝置，其特征在于，當操作手柄任意方向擺動時，控制器控制臂架末端在水平面上的移動方向與遙控裝置的操作手柄擺動方向在水平面上的投影平行。

10.根據權利要求4至7任意一項所述的臂架控制裝置，其特征在于，操作手柄還可垂直上下移動；當操作手柄垂直上下移動時，控制器控制臂架末端上下移動。

11.一種混凝土泵車，其特征在于，包括如權利要求4至10任意一項所述的臂架控制裝置。

12.一種布料機，其特征在于，包括如權利要求4至10任意一項所述的臂架控制裝置。