坡度測量方法及裝置的制造方法
【技術(shù)領(lǐng)域】
[0001] 本發(fā)明設(shè)及汽車測量技術(shù)領(lǐng)域，更具體地說，設(shè)及一種坡度測量方法及裝置。
【背景技術(shù)】
[0002] 目前，電子駐車制動系統(tǒng)巧PB，ElectricalPark化ake)不僅能實(shí)現(xiàn)傳統(tǒng)機(jī)械手 剎的功能，還能引入一些比如再夾緊、輔助坡起W及緊急制動等高級功能。
[0003] EPB功能的實(shí)現(xiàn)需要一個重要信息輸入，即坡度信息，現(xiàn)有技術(shù)中對于配置較高的 車輛，坡度信息可W直接從整車網(wǎng)絡(luò)中獲取，而對于配置較低的車輛，整車無法提供坡度信 息，從而導(dǎo)致，EPB功能在配置較低的車輛中無法實(shí)現(xiàn)。
[0004] 對于整車網(wǎng)絡(luò)無法提供坡度信息的車輛中，如何使EPB功能得W實(shí)現(xiàn)是本領(lǐng)域技 術(shù)人員亟待解決的問題。

【發(fā)明內(nèi)容】

[0005] 有鑒于此，本發(fā)明提供一種坡度測量方法及裝置，W實(shí)現(xiàn)在不限定多軸加速度傳 感器在整車中的布置方式的前提下，準(zhǔn)確得到整車的坡度值。
[0006] 一種坡度測量方法，包括：
[0007]采集多軸加速度傳感器輸出的Xi軸加速度和y 1軸加速度；
[000引計算得到加速度傳感器坐標(biāo)系中對應(yīng)所述Xi軸加速度和y1軸加速度的第一坐標(biāo) 值（xl，yl，zl);
[0009] 根據(jù)整車坐標(biāo)系和加速度傳感器坐標(biāo)系的變換矩陣，計算整車坐標(biāo)系中與所述第 一坐標(biāo)值（XI，yl，zl)對應(yīng)的第二坐標(biāo)值（x2,y2,z2);
[0010] 根據(jù)所述第二坐標(biāo)值（x2,y2,z2)中的橫坐標(biāo)值（x2)計算整車的坡度值。
[0011] 優(yōu)選的，所述計算得到加速度傳感器坐標(biāo)系中對應(yīng)所述xi軸加速度和y1軸加速度 的第一坐標(biāo)值^1，71，21)，包括：
[0012] 根據(jù)重力加速度與Xi軸加速度的第一映射關(guān)系計算得到所述加速度傳感器坐標(biāo) 系中的Xi軸與世界坐標(biāo)系中、平行于重力方向的Z2軸的第一夾角；
[0013] 根據(jù)重力加速度與yi軸加速度的第二映射關(guān)系計算得到所述加速度傳感器坐標(biāo) 系中的yi軸與所述Z2軸的第二夾角；
[0014] 根據(jù)所述第一夾角、第二夾角，計算所述Z2軸上的單位長度對應(yīng)的第=坐標(biāo)值投 影到加速度傳感器坐標(biāo)系中的第一坐標(biāo)值（XI，yl，zl);
[00巧]其中；
[0016] 所述第一夾角、第二夾角均為銳角；
[0017] 所述第一映射關(guān)系或所述第二映射關(guān)系所對應(yīng)的公式為：
[001引
【主權(quán)項(xiàng)】
1. 一種坡度測量方法，其特征在于，包括： 采集多軸加速度傳感器輸出的X1軸加速度和y i軸加速度； 計算得到加速度傳感器坐標(biāo)系中對應(yīng)所述X1軸加速度和y :軸加速度的第一坐標(biāo)值 (xl，yl，zl)； 根據(jù)整車坐標(biāo)系和加速度傳感器坐標(biāo)系的變換矩陣，計算整車坐標(biāo)系中與所述第一坐 標(biāo)值（Xl，yl，Zl)對應(yīng)的第二坐標(biāo)值（x2, y2, z2); 根據(jù)所述第二坐標(biāo)值（x2，y2，z2)中的橫坐標(biāo)值（x2)計算整車的坡度值。
2. 根據(jù)權(quán)利要求1所述的坡度測量方法，其特征在于，所述計算得到加速度傳感器坐 標(biāo)系中對應(yīng)所述X1軸加速度和y 加速度的第一坐標(biāo)值（xl，yl，zl)，包括： 根據(jù)重力加速度與X1軸加速度的第一映射關(guān)系計算得到所述加速度傳感器坐標(biāo)系中 的X1軸與世界坐標(biāo)系中、平行于重力方向的z 2軸的第一夾角； 根據(jù)重力加速度與Y1軸加速度的第二映射關(guān)系計算得到所述加速度傳感器坐標(biāo)系中 的yji與所述z 2軸的第二夾角； 根據(jù)所述第一夾角、第二夾角，計算所述Z2軸上的單位長度對應(yīng)的第三坐標(biāo)值投影到 加速度傳感器坐標(biāo)系中的第一坐標(biāo)值（xl，yl，zl); 其中： 所述第一夾角、第二夾角均為銳角； 所述第一映射關(guān)系或所述第二映射關(guān)系所對應(yīng)的公式為：
當(dāng)α為所述第一夾角時，A是加速度傳感器沿^軸輸出的加速度，當(dāng)α為所述第二夾 角時，A是加速度傳感器沿yi軸輸出的加速度，g為重力加速度。
3. 根據(jù)權(quán)利要求1所述的坡度測量方法，其特征在于，所述根據(jù)整車坐標(biāo)系和加速度 傳感器坐標(biāo)系的變換矩陣，計算整車坐標(biāo)系中與所述第一坐標(biāo)值（xl，yl，zl)對應(yīng)的第二 坐標(biāo)值（x2, y2, z2)所采用的公式，包括：
其中，（x2，y2，z2)為整車坐標(biāo)系中的第二坐標(biāo)值，（xl，yl，zl)為傳感器坐標(biāo)系中的第 一坐標(biāo)值，M為坐標(biāo)系變換矩陣。
4. 根據(jù)權(quán)利要求1所述的坡度測量方法，其特征在于，根據(jù)所述第二坐標(biāo)值（x2, y2， z2)中的橫坐標(biāo)值（x2)計算整車的坡度值所采用的公式，包括：
其中，α為整車的坡度值。
5. 根據(jù)權(quán)利要求1-4任一項(xiàng)所述的坡度測量方法，其特征在于，還包括： 根據(jù)所述坡度值控制整車中的電子駐車制動系統(tǒng)EPB輸出相應(yīng)的制動力。
6. -種坡度測量裝置，其特征在于，包括： 采集單元，用于采集多軸加速度傳感器輸出的X1軸加速度和y i軸加速度； 第一計算單元，用于計算得到加速度傳感器坐標(biāo)系中對應(yīng)所述X1軸加速度和y i軸加速 度的第一坐標(biāo)值（xl，yl，zl); 第二計算單元，用于根據(jù)整車坐標(biāo)系和加速度傳感器坐標(biāo)系的變換矩陣，計算整車坐 標(biāo)系中與所述第一坐標(biāo)值（xl，yl，zl)對應(yīng)的第二坐標(biāo)值（x2, y2, z2); 第三計算單元，用于根據(jù)所述第二坐標(biāo)值（x2，y2，z2)中的橫坐標(biāo)值（x2)計算整車的 坡度值。
7. 根據(jù)權(quán)利要求6所述的坡度測量裝置，其特征在于，所述第一計算單元，包括： 第一夾角計算單元，根據(jù)重力加速度與加速度的第一映射關(guān)系計算得到所述加速 度傳感器坐標(biāo)系中的X1軸與世界坐標(biāo)系中、平行于重力方向的Z軸的第一夾角； 第二夾角計算單元，根據(jù)重力加速度與yji加速度的第二映射關(guān)系計算得到所述加速 度傳感器坐標(biāo)系中的yji與所述z 2軸的第二夾角； 投影單元，根據(jù)所述第一夾角、第二夾角，計算所述Z2軸上的單位長度對應(yīng)的第三坐標(biāo) 值投影到加速度傳感器坐標(biāo)系中的第一坐標(biāo)值（xl，yl，zl); 其中： 所述第一夾角、第二夾角均為銳角； 所述第一映射關(guān)系或所述第二映射關(guān)系所對應(yīng)的公式為：
當(dāng)α為所述第一夾角時，A是加速度傳感器沿^軸輸出的加速度，當(dāng)α為所述第二夾 角時，A是加速度傳感器沿yi軸輸出的加速度，g為重力加速度。
8. 根據(jù)權(quán)利要求6所述的坡度測量裝置，其特征在于，所述第二計算單元所采用的公 式，包括：
其中，（x2，y2，z2)為整車坐標(biāo)系中第二坐標(biāo)值，（xl，yl，zl)為傳感器坐標(biāo)系中第一坐 標(biāo)值，M為坐標(biāo)系變換矩陣。
9. 根據(jù)權(quán)利要求6所述的坡度測量裝置，其特征在于，所述第三計算單元所采用的公 式，包括：
其中，α為整車的坡度值。
10. 根據(jù)權(quán)利要求6-9任一項(xiàng)所述的坡度測量裝置，其特征在于，還包括： 控制單元，用于根據(jù)所述坡度值控制整車中的電子駐車制動系統(tǒng)EPB輸出相應(yīng)的制動 力。
【專利摘要】本發(fā)明實(shí)施例公開了一種坡度測量方法及裝置。所述方法包括：采集多軸加速度傳感器輸出的x1軸加速度和y1軸加速度；計算得到加速度傳感器坐標(biāo)系中對應(yīng)所述x1軸加速度和y1軸加速度的第一坐標(biāo)值(x1，y1，z1)；根據(jù)整車坐標(biāo)系和加速度傳感器坐標(biāo)系的變換矩陣，計算整車坐標(biāo)系中與所述第一坐標(biāo)值(x1，y1，z1)對應(yīng)的第二坐標(biāo)值(x2，y2，z2)；根據(jù)所述第二坐標(biāo)值(x2，y2，z2)中的橫坐標(biāo)值(x2)計算整車的坡度值。應(yīng)用本發(fā)明的方案能夠在不限定所述多軸加速度傳感器在整車中的布置方式的前提下，準(zhǔn)確的得到整車的坡度值。
【IPC分類】G01C9-00
【公開號】CN104748725
【申請?zhí)枴緾N201510175180
【發(fā)明人】程愛明, 王旭, 王文平
【申請人】北京經(jīng)緯恒潤科技有限公司
【公開日】2015年7月1日
【申請日】2015年4月14日