一种点绘式独立模块动态轨迹线倒车辅助系统及其方法
【专利摘要】本发明公开了一种点绘式独立模块动态轨迹线倒车辅助系统及其方法，其中该系统包括后视摄像头、数据处理单元、控制单元、操作系统单元、显示屏、角度信息获取单元和定时触发单元；所述角度信息获取单元用于获取方向盘转动的角度信息，所述定时触发单元用于提供定时触发信号给数据处理单元；所述数据处理单元用于结合方向盘角度信息将实车地面倒车坐标点映射为显示屏上的倒车轨迹坐标点，所述操作系统单元用于连接多组屏幕轨迹坐标点，形成实时动态的倒车轨迹线。本发明较传统读取预存轨迹图像的方法，能够为驾驶员提供更加真实可靠地倒车辅助信息；同时，采用独立的数据处理单元，解放了控制单元，提高了控制性能和运行速度。
【专利说明】一种点绘式独立模块动态轨迹线倒车辅助系统及其方法
【技术领域】
[0001] 本发明涉及倒车辅助产品领域，具体地涉及一种点绘式独立模块动态轨迹线倒车 辅助系统及其方法。
【背景技术】
[0002] 在现今的社会中，公民汽车保有量越来越多，由倒车引发的安全事故问题也在呈 现递增趋势，倒车安全问题也越来越受到社会的关注。倒车辅助系统，可以直观的将车后方 的情况以视觉图像效果反馈给驾驶员，同时又能实时动态的显示倒车轨迹线，以辅助驾驶 员安全倒车。但在现有的倒车辅助系统技术中通常都具有以下缺陷： 一、普遍采用的为静态式轨迹，预先在系统的FLASH存储器中，以静态图片形式存入 倒车轨迹线图片，通过调取倒车轨迹图片，并且叠加到倒车视频上，实现倒车轨迹显示的功 能。这种方法成本都比较低，但是此静态预存图片的方案给驾驶者带来一个非真实的动态 倒车轨迹线，其无法根据实际倒车情况提示驾驶员正确预判倒车轨迹，不能可靠地提醒驾 驶员及时调整纠正量，容易导致事故的发生。如申请号为"201010577842. 5"、发明名称为 "一种动态轨迹线倒车影像辅助系统及其方法"的专利以及申请号为"201010598513. 9"、发 明名称为"摄像头集成智能轨迹倒车系统"的专利等均采用上述方式。
[0003] 二、采用高速度的CPU进行运算，形成一个倒车轨迹线画面，CPU接收到汽车方向 盘的转动信息，输出随方向盘转动而摆动的动态倒车轨迹线画面，这个动态的倒车轨迹线 画面显示在倒车显示屏上，和倒车摄像头的图像叠加，给车主车后方真实的倒车信息。此方 案对CPU要求太高，不仅需要控制各个模块的运行，还得根据倒车轨迹模型和方向盘的转 角信息，计算实时动态的倒车轨迹线，这样会极大的影响CPU的控制性能和运行速度，同时 成本也太高，电路复杂，导致售价昂贵，难以满足市场对经济实惠的要求。
【发明内容】
[0004] 本发明的目的在于提供一种点绘式独立模块动态轨迹线倒车辅助系统及其方法， 该方法通过一个与控制器相分离的独立的数据处理模块计算倒车轨迹线，以解放控制单 元，提高控制器的工作效率；同时本发明的方法还根据获取的方向盘转角信息实时计算倒 车轨迹线，解决现有技术倒车辅助系统无法根据实际倒车情况提醒驾驶员调整纠正量的问 题。
[0005] 为达到上述目的，本发明提供一种点绘式独立模块动态轨迹线倒车辅助系统，该 系统包括后视摄像头、角度信息获取单元、定时触发单元，数据处理单元、控制单元、操作系 统单元以及显示屏； 所述控制单元分别与角度信息获取单元、定时触发单元、操作系统单元以及数据处理 单元连接，用于控制转发各单元之间的通信信息； 所述角度信息获取单元用于获取方向盘转动的角度信息，并将所获取的角度信息经由 控制单元发送给数据处理单元； 所述定时触发单元用于产生定时触发信号并通过控制器转发所述定时触发信号给数 据处理单元； 所述数据处理单元用于控制器接收到定时触发信号后，结合接收到的方向盘角度信息 将实车地面倒车坐标点映射为所述显示屏上的倒车轨迹坐标点，并将其回传给控制单元； 所述操作系统单元用于从控制单元获取显示屏上的倒车轨迹坐标点，并将多组所述显 示屏上的倒车轨迹坐标点按顺序连接起来，形成实时动态的倒车轨迹线。
[0006] 优选地，所述数据处理器为专用数据处理器。
[0007] 优选地，所述定时触发单元包括距离传感器和定时触发器，所述距离传感器用于 探测实车运动的距离，所述定时触发器用于当实车运动距离满足一定值时产生定时触发信 号。
[0008] 优选地，所述角度信息获取单元通过CAN总线或LIN总线连接于控制单元。
[0009] 优选地，所述数据处理单元通过I2C、SPI或UART方式连接于控制单元。
[0010] 为实现上述目的，本发明还提供一种点绘式独立模块动态轨迹线倒车辅助方法， 该方法包括如下步骤： A、 角度信息获取单元获取方向盘转角信息，并通过控制单元发送给数据处理单元； B、 定时触发单元每隔一定周期向控制单元发送定时触发信号； C、 控制单元检测是否收到定时触发信号，若收到则将所述定时触发信号转发给数据处 理单元，否则重复检测； D、 数据处理单元接收到所述定时触发信号后，根据地面坐标模型计算实车运动的地面 坐标点； E、 数据处理单元根据读入的方向盘转角信息，将所述实车地面坐标点映射为显示屏的 屏幕坐标系中的坐标点； F、 数据处理单元将该屏幕坐标系中的坐标点通过控制器发送给所述操作系统单元； G、 所述操作系统单元将多组所述屏幕坐标系中的坐标点按顺序连接起来，形成实时动 态的倒车轨迹线； H、 重复执行步骤C至G。
[0011] 优选地，所述定时触发单元每隔一定周期向控制单元发送定时触发信号具体为： 当车体运动距离满足一定值S时，定时触发单元向控制单元发送定时触发信号。
[0012] 优选地，所述数据处理单元根据地面坐标模型计算实车倒车地面坐标点的具体方 法为： A、 标定车身参数及后视摄像头的参数； B、 建立地面坐标模型，以车正后方为坐标系y方向，以向右为坐标系X方向； C、 根据车身参数及方向盘的转角参数建立实车倒车轨迹方程； D、 将倒车启动前摄像头所能看到的离车尾最近的与X方向平行的线作为倒车起始线， 并记录该起始线在y方向的坐标值Y0 ; E、 实车前进/后退一定的距离nS，将Y0+nS/Y0-nS作为实车倒车地面坐标y方向的值 Yi，其中η为自然数，代表定时触发的次数； F、 将Yi代入到所述倒车轨迹方程中，即可算出此时实车倒车地面坐标点。
[0013] 本发明具有如下优点和有益效果： 1、本方案与现有传统行业倒车轨迹技术相比，是根据方向盘转角实时动态的倒车轨迹 线，而不是依赖在flash中预存倒车图片来模拟非真实的实时倒车轨迹。
[0014] 2、本方案采用独立的数据处理芯片，解放MCU主控单元，提高了其控制性能和运 行速度，同时专业数据处理芯片，数据处理速度和精确度也更高。
[0015] 3、本方案与现有传统行业倒车轨迹技术相比，设计方式更简单可行，功能安全可 靠，对产品的针对性更强。
【专利附图】
【附图说明】
[0016] 为了更清楚地说明本发明实施例的技术方案，下面将对实施例描述中所需要的附 图做简单的介绍，显而易见地，下面描述的附图仅仅是本发明的一些实施例，对于本领域普 通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0017] 图1是本发明点绘式独立模块动态轨迹线倒车辅助系统结构示意框图。
[0018] 图2是本发明实施例中方向盘右转倒车轨迹示意图。
[0019] 图3是本发明实施例中方向盘左转倒车轨迹示意图。
[0020] 图4是本发明点绘式独立模块动态轨迹线倒车辅助方法流程图。
【具体实施方式】
[0021] 下面结合说明书附图对本发明实施例的【具体实施方式】作详细说明。
[0022] 本发明提供了一种点绘式独立模块动态轨迹线倒车辅助系统，其组成结构如图1 所示，其中的后视摄像头选用系列针对大众朗逸车型的CAM2363倒车专用摄像头，并安装 于车身尾部的车牌灯正下方，并通过CAN接口连接到车身车载总线系统，从而可在系统中 设置显示器来显示后视摄像头摄取的图像，这样驾驶员在倒车时可以根据自己的需要实时 地监控车辆后面的情况，保证倒车安全。数据处理单元选用TI的DSP型号为TMS320VC5402， 目的在于选用专用的数据处理器，所述独立模块即强调了 DSP算法芯片的独立性，将数据 处理和模块控制分离开来，提高MCU工作效率，同时专业数据处理芯片，数据处理速度和精 确度也更高。所述控制单元采用MCU作为主芯片，选用型号为STM8S105,主要控制其他各个 模块如蓝牙、行车记录仪、导航等。操作系统单元采用ARM9处理芯片，主要集成wince操作 系统界面，同时其将从控制单元获取的屏幕上倒车轨迹坐标点通过绘图工具，按照顺序连 接起来，形成实时动态的倒车轨迹线。显示屏共用原车本身自带显示器如GPS、DVD等即可。
[0023] 本发明还提供了一种点绘式独立模块动态轨迹线倒车辅助方法，下面具体分析该 方法的实现过程。
[0024] -、实车倒车地面坐标点计算方法 在实际倒车过程中，方向盘有可能右转或左转以调整倒车方向，图2和图3分别为方向 盘右转、左转倒车轨迹示意图，选取摄像头垂直交于地面的点作为地面坐标系的原点，如图 2和图3中点0所示，以向车正后方为坐标系y方向，以向右为坐标系X方向,倒车轨迹是以 前后轮轴向线的焦点P为圆心的圆。
[0025] 图中#为前轮同水平方向的夹角，根据夹角#以及车体自带的转角系数即可算 出方向盘的转角，当#接近〇°时行进轨迹近似直线，接近90°时半径呈缩小趋势，前后轮 轴距为L,后轮轴长为w,后轮距离车尾的距离为D,摄像头安装位置偏离车尾中间向右侧的 距离为d，则后轮轴心在地面的轨迹为以p点为圆心半径为Lcot (多）的圆。有以下结论： 1、 当方向盘右转时后轴中心轨迹方程为： p 点坐标为（_ ]L cot-I 堯I, _D
【权利要求】
1. 一种点绘式独立模块动态轨迹线倒车辅助系统，该系统包括后视摄像头、数据处理 单元、控制单元、操作系统单元以及显示屏，其特征在于，还包括：角度信息获取单元和定时 触发单元； 所述控制单元分别与角度信息获取单元、定时触发单元、操作系统单元以及数据处理 单元连接，用于控制转发各单元之间的通信信息； 所述角度信息获取单元用于获取方向盘转动的角度信息，并将所获取的角度信息经由 控制单元发送给数据处理单元； 所述定时触发单元用于产生定时触发信号并通过控制器转发所述定时触发信号给数 据处理单元； 所述数据处理单元用于接收到定时触发信号后，计算实车地面倒车坐标点，以及结合 接收到的方向盘角度信息将实车地面倒车坐标点映射为所述显示屏上的倒车轨迹坐标点， 并将所述显示屏上的倒车轨迹坐标点回传给控制单元； 所述操作系统单元用于从控制单元获取显示屏上的倒车轨迹坐标点，并将多组所述显 示屏上的倒车轨迹坐标点按顺序连接起来，形成实时动态的倒车轨迹线。
2. 根据权利要求1所述的点绘式独立模块动态轨迹线倒车辅助系统，其特征在于，所 述数据处理器为专用数据处理器。
3. 根据权利要求1或2所述的点绘式独立模块动态轨迹线倒车辅助系统，其特征在于， 所述定时触发单元包括距离传感器和定时触发器，所述距离传感器用于探测实车运动的距 离，所述定时触发器用于每当实车运动距离满足一定值时产生定时触发信号。
4. 根据权利要求1所述的点绘式独立模块动态轨迹线倒车辅助系统，其特征在于，所 述角度信息获取单元通过CAN总线或LIN总线连接于控制单元。
5. 根据权利要求1所述的点绘式独立模块动态轨迹线倒车辅助系统，其特征在于，所 述数据处理单元通过I2C、SPI或UART方式连接于控制单元。
6. -种使用权利要求1至5任一所述的点绘式独立模块动态轨迹线倒车辅助系统进行 倒车辅助的方法，其特征在于，该方法包括如下步骤： A、 角度信息获取单元获取方向盘转角信息，并通过控制单元发送给数据处理单元； B、 定时触发单元每隔一定周期向控制单元发送定时触发信号； C、 控制单元检测是否收到定时触发信号，若收到则将所述定时触发信号转发给数据处 理单元，否则重复检测； D、 数据处理单元接收到所述定时触发信号后，根据地面坐标模型计算实车运动的地面 坐标点； E、 数据处理单元根据读入的方向盘转角信息，将所述实车地面坐标点映射为显示屏的 屏幕坐标系中的坐标点； F、 数据处理单元将该屏幕坐标系中的坐标点通过控制器发送给所述操作系统单元； G、 所述操作系统单元将多组所述屏幕坐标系中的坐标点按顺序连接起来，形成实时动 态的倒车轨迹线； H、 重复执行步骤C至G。
7. 根据权利要求6所述的倒车辅助方法，其特征在于，所述定时触发单元每隔一定周 期向控制单元发送定时触发信号具体为：车体运动距离每当满足一定值S时，定时触发单 元向控制单元发送定时触发信号。
8.根据权利要求7所述的倒车辅助方法，其特征在于，所述数据处理单元根据地面坐 标模型计算实车倒车地面坐标点的具体方法为： A、 标定车身参数及后视摄像头的参数； B、 建立地面坐标模型，以车正后方为坐标系y方向，以向右为坐标系X方向； C、 根据车身参数及方向盘的转角参数建立实车倒车轨迹方程； D、 将倒车启动前摄像头所能看到的离车尾最近的与X方向平行的线作为倒车起始线， 并记录该起始线在y方向的坐标值Y0 ; E、 实车前进/后退一定的距离nS，将YO+nS/YO-nS作为实车倒车地面坐标y方向的值 Yi，其中η为自然数，代表定时触发的次数； F、 将Yi代入到所述倒车轨迹方程中，算出此时实车倒车地面坐标点。
【文档编号】B60R1/00GK104159078SQ201410391414
【公开日】2014年11月19日 申请日期:2014年8月11日 优先权日:2014年8月11日
【发明者】朱剑, 袁建民, 石树鑫 申请人:惠州市德赛西威汽车电子有限公司