轴偏移估计装置的制作方法

轴偏移估计装置
1.相关申请的交叉引用
2.本国际申请基于在2019年10月9日在日本专利局申请的日本专利申请第2019-186317号主张优先权，通过参照将日本专利申请第2019-186317号的全部内容引用到本国际申请。
技术领域
3.本发明涉及对检测物体的方位、相对速度的雷达装置的轴偏移进行估计的技术。


背景技术：

4.在车载雷达装置中，由于某种原因而设置状态发生变化，从而产生雷达波束的中心轴偏移的所谓轴偏移。例如在下述专利文献1中公开如下的技术：基于在产生了轴偏移时来自车辆附近的反射波的接收强度成为最大的情况，估计车载雷达装置的轴偏移角度。
5.专利文献1：日本专利第6321448号公报
6.然而，发明者的详细研究的结果为，在专利文献1所记载的以往装置中，发现了无法估计高度方向上的雷达装置的轴偏移的课题。


技术实现要素：

7.本发明的一个方式提供能够估计雷达装置的轴偏移角度和高度方向上的轴偏移双方的技术。
8.本发明的一个方式提供搭载于移动体的轴偏移估计装置。轴偏移估计装置具备获取部、提取部、装置系坐标部以及估计部。
9.获取部被构成为针对由雷达装置检测出的多个反射点中的每个反射点，获取反射点信息。反射点信息至少包含水平角度和垂直角度、以及雷达装置与反射点之间的距离，该水平角度和垂直角度是关于反射点的方位角，并且是以沿着雷达波束的中心轴的方向即波束方向为基准而求出的。提取部被构成为至少基于反射点信息，提取多个反射点中的、通过在路面的反射而检测出的至少一个路面反射点。
10.装置系坐标部被构成为基于反射点信息，针对路面反射点中的每个路面反射点，确定基于雷达装置的坐标轴的三维坐标亦即装置系坐标。估计部被构成为使用在包含轴偏移角度和雷达装置的搭载高度的至少两个未知参数与路面反射点的装置系坐标所包含的至少两个元素之间成立的关系式，估计轴偏移角度和搭载高度。轴偏移角度是雷达装置的坐标轴绕对象轴的偏移角度，该对象轴是作为移动体的坐标轴的水平轴和行进方向轴中的一个。
11.其结果为，轴偏移估计装置能够同时估计轴偏移角度和搭载高度。
附图说明
12.图1是表示车辆控制系统的结构的框图。
13.图2是对雷达波的水平方向上的照射范围进行说明的说明图。
14.图3是对雷达波的垂直方向上的照射范围进行说明的说明图。
15.图4是对信号处理部的功能进行说明的框图。
16.图5是对垂直轴偏移角度和侧倾角度进行说明的说明图。
17.图6是对垂直轴偏移的例子进行说明的说明图。
18.图7是对雷达装置的高度方向上的位置的偏移进行说明的说明图。
19.图8是第一实施方式的轴偏移估计处理的流程图。
20.图9是路面反射提取处理的流程图。
21.图10是第一实施方式的计算处理的流程图。
22.图11是对在第一实施方式中估计垂直轴偏移角度的原理进行说明的说明图。
23.图12是变形例1的计算处理的流程图。
24.图13是对在变形例1中估计侧倾角度的原理进行说明的说明图。
25.图14是变形例3的计算处理的流程图。
26.图15是表示在变形例3中估计垂直轴偏移角度和侧倾角度的原理的说明图。
27.图16是第二实施方式的轴偏移估计处理的流程图。
28.图17是平坦度处理的流程图。
29.图18是加权处理的流程图。
具体实施方式
30.以下，一边参照附图，一边对本发明的例示的实施方式进行说明。此外，以下所说的“垂直”不限于严格意义上的“垂直”，只要起到同样的效果，也可以不是严格的“垂直”。以下所说的“水平”、“一致”也同样。
31.[1.第一实施方式]
[0032]
[1-1.结构]
[0033]
(1)整体结构
[0034]
图1所示的车辆控制系统1是搭载于作为移动体的车辆vh的系统。车辆控制系统1具备雷达装置2、车载传感器组3、信号处理部4以及辅助执行部5。另外，车辆控制系统1也可以具备轴偏移通知装置51、调整装置52。以下，将搭载车辆控制系统1的车辆vh也称为本车vh。另外，将本车vh的车宽方向也称为水平方向，将车高方向也称为垂直方向。
[0035]
如图2和图3所示，雷达装置2搭载于本车vh的前侧。雷达装置2向本车vh前方的水平方向上的规定角度范围ra内和本车vh前方的垂直方向上的规定角度范围rb内照射雷达波。雷达装置2通过接收所照射的雷达波的反射波，生成与反射了雷达波的反射点相关的反射点信息。
[0036]
此外，雷达装置2也可以是使用毫米波段的电磁波作为雷达波的所谓的毫米波雷达，也可以是使用激光作为雷达波的激光雷达、使用声波作为雷达波的声纳。总之，发送接收雷达波的天线部被构成为在水平方向和垂直方向中的任意方向上都能够检测反射波的到来方向。天线部也可以具备在水平方向和垂直方向上排列的阵列天线。
[0037]
雷达装置2被安装为波束方向与本车vh的前后方向即行进方向一致，用于检测存在于本车vh的前方的各种物标。波束方向是指沿着所照射的雷达波束的中心轴ca方向的方
向。
[0038]
雷达装置2所生成的反射点信息中至少包含反射点的方位角、反射点的距离。反射点的距离是指雷达装置2与反射点之间的距离。此外，雷达装置2也可以被构成为检测反射点相对于本车vh的相对速度、由反射点反射的雷达波束的接收强度。反射点信息中也可以包含反射点的相对速度、接收强度。
[0039]
如图2、3所示，反射点的方位角是以沿着雷达波束的中心轴ca的方向即波束方向为基准而求出的、反射点所在的水平方向的角度(以下，水平角度)hor和垂直方向的角度(以下，垂直角度)ver中的至少一方。在本实施方式中，垂直角度ver和水平角度hor双方作为表示反射点的方位角的信息而包含于反射点信息。
[0040]
在本实施方式中，雷达装置2采用fmcw方式，以预先设定的调制周期交替地发送上行调制区间的雷达波和下行调制区间的雷达波，并接收反射的雷达波。fmcw是frequency modulated continuous wave(调频连续波)的缩写。在本实施方式中，雷达装置2按照每个调制周期，如上述那样将反射点的方位角即水平角度hor和垂直角度ver、到反射点为止的距离、与反射点的相对速度、以及接收到的雷达波的接收功率检测为反射点信息。以下，将接收到的雷达波的接收功率称为反射功率。
[0041]
车载传感器组3是为了检测本车vh的状态等而搭载于本车vh的至少一个传感器。在车载传感器组3中也可以包含车速传感器。车速传感器是基于车轮的旋转来检测车速的传感器。另外，在车载传感器组3中也可以包含相机。该相机拍摄与雷达装置2的雷达波的照射范围同样的范围。
[0042]
另外，在车载传感器组3中也可以包含加速度传感器。加速度传感器检测本车vh的加速度。另外，在车载传感器组3中也可以包含横摆率传感器。横摆率传感器检测表示本车vh的行进方向相对于本车vh前方的倾斜的横摆角的变化速度。
[0043]
另外，在车载传感器组3中也可以包含具备地图信息的导航装置。导航装置也可以基于gps信号等检测本车vh的位置，将该本车vh的位置与地图信息对应起来。在地图信息中，作为与道路相关的各种信息，也可以包含表示道路的路面的平坦度的数值。车载传感器组3所具备的各传感器通过通信线与信号处理部4连接。
[0044]
信号处理部4具备微型计算机，该微型计算机包含cpu41、以及rom43、ram44、闪存等半导体存储器(以下，存储器42)。通过由cpu41执行储存于非迁移实体记录介质的程序而实现信号处理部4的各种功能。在该例中，存储器42对应于储存程序的非迁移实体记录介质。另外，通过执行该程序，而执行与程序对应的方法。此外，信号处理部4也可以具备一个微型计算机，也可以具备多个微型计算机。
[0045]
如图4所示，信号处理部4具备识别部45、估计部46的功能。识别部45基于从雷达装置2得到的反射点信息、从车载传感器组3得到的各种信息，检测本车vh行驶的车道、在与本车vh相同的车道上行驶的先行车辆、其他的车辆、障碍物等。识别部45中的检测结果被输出到辅助执行部5等。估计部46像后述那样，估计雷达装置2的轴偏移。
[0046]
辅助执行部5基于识别部45中的检测结果，控制各种车载设备，执行规定的驾驶辅助。在成为控制对象的各种车载设备中也可以包含显示图像的监视器、输出警报音或引导声音的声学设备。另外，也可以包含控制本车vh的内燃机、动力传动机构、制动机构等的控制装置。
[0047]
轴偏移通知装置51是设置在车厢内的声音输出装置，对本车vh的乘员输出警告音。此外，也可以将辅助执行部5所具备的声学设备等作为轴偏移通知装置51使用。
[0048]
调整装置52具备马达以及安装于雷达装置2的齿轮。调整装置52根据从信号处理部4输出的驱动信号而使马达旋转。由此，能够将马达的旋转力传递到齿轮，使雷达装置2以沿着水平方向的轴以及沿着垂直方向的轴为中心旋转。另外，调整装置52能够使雷达装置2在垂直方向上进行上下。
[0049]
(2)雷达装置2的轴偏移
[0050]
对由估计部46检测的雷达装置2的轴偏移进行说明。轴偏移是指雷达装置2实际安装于本车vh时的该雷达装置2的坐标轴相对于雷达装置2准确地安装于本车vh时的该雷达装置2的坐标轴产生偏移。雷达装置2的轴偏移包含绕装置坐标轴的轴偏移以及高度方向的轴偏移。
[0051]
(a)坐标轴
[0052]
对雷达装置2的坐标轴和本车vh的坐标轴进行说明。
[0053]
这里，如图5所示，雷达装置2的坐标轴是指在雷达装置2安装于本车vh的状态下，沿雷达装置2的上下延伸的上下轴zs、沿雷达装置2的左右延伸的左右轴ys、以及沿雷达装置2的前后延伸的前后轴xs。上下轴zs、左右轴ys以及前后轴xs相互正交。在本车vh的前方设置雷达装置2的本实施方式中，前后轴xs与中心轴ca相等。
[0054]
另一方面，本车vh的坐标轴是指沿铅垂方向延伸的轴即垂直轴zc、沿水平方向延伸的轴即水平轴yc、以及沿本车vh的行进方向延伸的行进方向轴xc。垂直轴zc、水平轴yc以及行进方向轴xc相互正交。
[0055]
此外，如上述那样，在本实施方式中，在将雷达装置2准确地安装于本车vh时，中心轴ca与本车vh的行进方向一致。即，关于雷达装置2的坐标轴与本车vh的坐标轴，各方向一致。例如在从工厂出厂时那样的初始状态下，雷达装置2准确地安装于本车vh，即安装于预先决定的位置。基于准确地安装于本车vh的雷达装置2的检测结果，在识别部45中，高精度地实现物标识别的功能。
[0056]
(b)绕装置坐标轴的轴偏移
[0057]
在初始状态以后，在本车vh中，会产生绕装置坐标轴的轴偏移。这样的轴偏移包含垂直轴偏移和侧倾轴偏移。轴偏移角度利用角度表示这样的轴偏移的大小。
[0058]
这里，垂直轴偏移是指在雷达装置2的坐标轴的上下轴zs与本车vh的坐标轴的垂直轴zc产生偏移的状态。将这样的垂直轴偏移时的轴偏移角度称为垂直轴偏移角θp。垂直轴偏移角θp为所谓俯仰角θp，为雷达装置2的坐标轴(即，左右轴ys)绕本车vh的水平轴yc的轴偏移角度。即，垂直轴偏移角θp为产生雷达装置2的绕左右轴ys的轴偏移时的轴偏移角度。此外，根据图5可知，垂直轴偏移角θp也可以是表示雷达装置2的坐标轴的前后轴xs与本车vh的坐标轴的行进方向轴xc之间的偏移的大小的角度。
[0059]
另一方面，侧倾轴偏移是指在雷达装置2的坐标轴的左右轴ys与本车vh的坐标轴的水平轴yc产生偏移的状态。将这样的侧倾轴偏移时的轴偏移角度称为侧倾角度θr。即，侧倾角度θr是雷达装置2的坐标轴(即，前后轴xs)绕本车vh的行进方向轴xc的轴偏移角度。即，侧倾角度θr是产生雷达装置2的绕前后轴xs的轴偏移时的轴偏移角度。
[0060]
例如图6表示产生垂直轴偏移、即雷达装置2的绕左右轴ys的轴偏移的情况。
[0061]
(c)高度方向的轴偏移
[0062]
如上述那样，雷达装置2在初始状态下，准确地安装在本车vh的预先决定的位置。以下所说的初始高度是指此时的雷达装置2与路面相距的高度。初始高度预先存储于例如rom43这样的存储器42。
[0063]
在初始状态以后，在本车vh中，在雷达装置2会产生高度方向的轴偏移(以下，高度偏移)。在图7中表示高度偏移的例子。虚线所示的雷达装置200表示设置于初始高度f时的位置。例如在用户将本车vh的轮胎更换为与存储初始高度时不同的轮胎直径的轮胎时、或将本车vh的悬架更换为与存储初始高度时不同的悬架时等，产生高度偏移。
[0064]
高度偏移是指在垂直方向上，在搭载高度h产生从预先决定的高度即初始高度的偏移的状态。搭载高度h是指搭载于本车vh的雷达装置2距路面的高度。高度偏移量d利用距离表示这样的高度偏移的大小。
[0065]
在本车vh的前方设置雷达装置2的本实施方式中，前后轴xs与中心轴ca相等。即，高度偏移量d相当于行进方向轴xc与雷达装置2的前后轴xs之间的垂直方向的距离。
[0066]
估计部46执行后述的轴偏移估计处理，估计上述的雷达装置2的轴偏移。
[0067]
[1-2.处理]
[0068]
(1-1)轴偏移估计处理
[0069]
接下来，使用图8的流程图对信号处理部4执行的轴偏移估计处理进行说明。本处理是以点火开关接通为契机开始的。此外，以下，对信号处理部4通过轴偏移估计处理来估计作为轴偏移角度的垂直轴偏移角度(即，俯仰角)θp和雷达装置2的搭载高度h的例子进行说明。
[0070]
若本处理起动，则信号处理部4在s10中，从雷达装置2获取反射点信息。如上述那样，反射点信息是指关于由搭载于本车vh的雷达装置2检测出的多个反射点的每个反射点的信息。在反射点信息中至少包含作为反射点的方位角的水平角度和垂直角度以及雷达装置2与反射点之间的距离。以下，将根据反射点信息确定的反射点称为获取反射点。另外，信号处理部4从车载传感器组3获取包含本车速cm等的各种检测结果。
[0071]
信号处理部4在s20中，执行路面反射提取处理。路面反射提取处理是用于从获取反射点中提取路面上的反射点亦即路面反射点的处理。路面反射点是指通过在路面的反射而检测出的反射点。关于路面反射提取处理的详细情况后述说明。
[0072]
信号处理部4在s30中执行计算处理。计算处理是至少基于路面反射点的位置来估计雷达装置2的轴偏移角度和雷达装置2的搭载高度h的处理。在本实施方式中，信号处理部4估计作为雷达装置2的轴偏移角度的垂直轴偏移角度θp以及雷达装置2的搭载高度h。关于计算处理的详细情况后述说明。
[0073]
信号处理部4在s40中，确定高度偏移量d。在本实施方式中，高度偏移量d是指在s30中估计出的搭载高度h与初始高度之差。估计部46将所确定的高度偏移量d存储于存储器42。
[0074]
信号处理部4在s50中，判断在s30中估计出的轴偏移角度、以及在s40中估计出的高度偏移量d是否需要基于搭载高度调整装置52的调整。在满足垂直轴偏移角度θp为预先决定的角度即阈值角度以上的情况、以及高度偏移量d为预先决定的距离即阈值距离以上的情况中的至少一方的情况下，信号处理部4判断为需要调整。这里，信号处理部4在判断为
不需要调整的情况下，即在垂直轴偏移角度θp小于阈值角度且高度偏移量d小于阈值距离的情况下，使处理移至s90。另一方面，信号处理部4在判断为需要调整的情况下，使处理移至s60。
[0075]
信号处理部4在s60中，判断在s30中估计出的轴偏移角度以及在s40中估计出的高度偏移量d双方是否处于基于调整装置52的可调整范围内。这里，信号处理部4在垂直轴偏移角度θp和高度偏移量d双方处于可调整范围内的情况下使处理移至s70。另一方面，在垂直轴偏移角度θp和高度偏移量d中的至少一方处于可调整范围外的情况下，信号处理部4使处理移至s80。
[0076]
信号处理部4在s70中，通过调整装置52将雷达搭载角调整在s30中估计出的轴偏移角度。即，信号处理部4使雷达装置2以雷达装置2的左右轴ys为中心绕该左右轴ys旋转垂直轴偏移角度θp，来调整雷达装置2的搭载角度。另外，信号处理部4通过调整装置52将搭载高度h调整在s40中估计出的高度偏移量d。即，信号处理部4使雷达装置2以雷达装置2的前后轴xs为中心在车高方向上上下移动高度偏移量d，来调整搭载高度h。然后，信号处理部4结束轴偏移估计处理。
[0077]
此外，信号处理部4也可以在与本轴偏移估计处理不同的处理中，计算将在s10中获取的反射点的方位角校正了在s30中估计出的轴偏移角度而得的方位角。而且，信号处理部4也可以基于校正后的方位角，使识别部45执行。
[0078]
信号处理部4在s80中，向信号处理部4的外部装置输出表示雷达装置2产生轴偏移的诊断信息。以下，将表示雷达装置2产生轴偏移的诊断信息称为轴偏移诊断。外部装置也可以是轴偏移通知装置51。信号处理部4例如也可以向轴偏移通知装置51输出轴偏移诊断。轴偏移通知装置51也可以根据轴偏移诊断而输出警告音。
[0079]
信号处理部4在s90中判断点火开关是否断开。这里，信号处理部4在点火开关未断开的情况下使处理移至s10。另一方面，信号处理部4在点火开关断开的情况下，至此结束本轴偏移估计处理。
[0080]
(2-2)路面反射提取处理
[0081]
接下来，使用图9的流程图对信号处理部4在轴偏移估计处理的s20中执行的路面反射提取处理进行说明。
[0082]
信号处理部4在s100中，从车载传感器组3获取基于各种传感器的本车vh的状态等检测结果。这里所说的检测结果能够包含本车vh的车速、加速度、横摆角等。
[0083]
信号处理部4在s110中，基于从车载传感器组3获取的本车vh的状态等检测结果，判断是否提取路面反射点。
[0084]
具体而言，信号处理部4基于本车vh的状态等检测结果，判断本车vh的车体是否相对于路面稳定，在本车vh的车体处于相对于路面稳定的状态的情况下，判断为提取路面反射点。
[0085]
所谓本车vh的车体相对于路面稳定的状态，可以是本车vh的车体相对于路面不倾斜的状态、本车vh的车体相对于路面上下不移动的状态。换言之，所谓本车vh的车体相对于路面稳定的状态，可以是不在曲率较大的弯道道路上行驶的状态、不在凹凸较大的路面行驶的状态。
[0086]
这里，不在凹凸较大的路面行驶时可以说是在平坦的路面行驶时。在该情况下，认
为与在凹凸较大的路面行驶时相比，速度和加速度较大。另一方面，所谓不在曲率较大的弯道道路行驶时，可以说是接近在直线道路行驶的状态时。在该情况下，与在曲率较大的弯道道路行驶时相比，速度和加速度较大，与在曲率较大的弯道道路行驶时相比，横摆角的变化速度较小的情况较多。
[0087]
因此，也可以是，在本车vh的车速为预先决定的车速阈值以上的情况下，信号处理部4判断为本车vh的车体处于相对于路面稳定的状态，判断为提取路面反射点。即，也可以是，在本车vh的车速小于车速阈值的情况下，信号处理部4判断为本车vh的车体处于相对于路面不稳定的状态，判断为不提取路面反射点。
[0088]
同样，也可以是，在本车vh的加速度为预先决定的加速度阈值以上的情况下，信号处理部4判断为本车vh的车体处于相对于路面稳定的状态，判断为提取路面反射点。另外，同样，也可以是，在本车vh的横摆角的变化速度小于预先决定的阈值的情况下，信号处理部4判断为本车vh的车体处于相对于路面稳定的状态，判断为提取路面反射点。
[0089]
信号处理部4在判断为提取路面反射点的情况下使处理移至s120，在判断为不提取路面反射点的情况下使处理移至s180。
[0090]
信号处理部4在s120中，从全部的获取反射点中选择一个获取反射点。信号处理部4对于所选择的获取反射点(以下，简称为获取反射点)，执行s130-s195的处理。
[0091]
信号处理部4在s130中，判断获取反射点是否位于在水平方向上包含中心轴ca的规定的方位范围即提取范围内。在获取反射点位于该方位范围内的情况下，信号处理部4使处理移至s140，在所选择的获取反射点不位于该方位范围内的情况下使处理移至s190。
[0092]
即，信号处理部4从多个获取反射点中提取位于提取范围内的获取反射点。提取范围例如也可以决定为在水平方向上包含中心轴ca的
±
几
°
至几十
°
的范围。换言之，在雷达装置2设置在本车vh的前方的本实施方式中，提取范围也可以决定为本车vh的行进方向附近的规定的范围。提取范围也可以通过实验等预先决定。提取范围预先存储于存储器42。
[0093]
信号处理部4在s140中，判断所选择的获取反射点与雷达装置2相距的距离是否小于规定的距离阈值。信号处理部4在关于所选择的获取反射点的距离小于距离阈值的情况下使处理移至s150，在关于所选择的获取反射点的距离为距离阈值以上的情况下使处理移至s190。
[0094]
即，信号处理部4提取与雷达装置2相距的距离小于距离阈值的获取反射点。距离阈值预先存储于存储器42。
[0095]
信号处理部4在s150中，判断获取反射点是否是静止反射点。信号处理部4在获取反射点是静止反射点的情况下使处理移至s160，在获取反射点不是静止反射点的情况下使处理移至s190。静止反射点是指由静止物反射雷达波的反射点。
[0096]
即，信号处理部4提取获取反射点中的静止反射点。具体而言，信号处理部4也可以使用在s10中获取的本车速cm，将反射点信息中包含的相对速度设为q、将预先设定的下限的速度阈值设为ε1、将上限的速度阈值设为ε2，将满足ε1≤q/cm＜ε2的获取反射点提取为静止反射点。即，将本车速cm相对于相对速度q之比处于ε1以上且小于ε2的预先决定的速度阈值范围内的获取反射点提取为静止反射点。
[0097]
在从静止反射点朝向雷达装置2的方向与波束方向一致的情况下，该本车速cm与反射点的相对速度q为相同的大小，并且相对速度q的方向与本车速cm相反，因此q/cm＝-1。
这样，q/cm＝-1的反射点被认为是静止反射点。
[0098]
其中，从车载传感器组3获取的本车速cm由于车轮的打滑等而未必与实际的车速一致。另外，由雷达装置2检测的相对速度q也包含误差。因此，即使是静止反射点，有时也未必限于q/cm＝-1。下限的速度阈值ε1和上限的速度阈值ε2也可以使用考虑这些影响而适当地设定的值。
[0099]
信号处理部4在s160中，判断获取反射点的反射功率是否小于预先决定的功率阈值。信号处理部4在获取反射点的反射功率小于功率阈值的情况下使处理移至s170，在获取反射点的反射功率为功率阈值以上的情况下使处理移至s190。
[0100]
即，信号处理部4提取反射功率小于功率阈值的获取反射点。认为来自路面的反射功率例如比来自其他车辆的反射功率小。也可以基于这样的来自路面的反射功率而适当地决定功率阈值。例如功率阈值也可以通过实验等预先决定。功率阈值预先存储于存储器42。
[0101]
信号处理部4在s170中，判断获取反射点在相机的拍摄图像中是否被识别为路面。信号处理部4在获取反射点在拍摄图像中被估计为路面的情况下使处理移至s180，在获取反射点在拍摄图像中不被估计为路面的情况下使处理移至s195。
[0102]
即，信号处理部4提取在拍摄图像中被识别为路面的获取反射点。此外，信号处理部4也可以被构成为在与本轴偏移估计处理不同的处理中，获取相机的拍摄图像，估计在拍摄图像中被识别为路面的方位范围。
[0103]
信号处理部4在s180中，判断为获取反射点是路面反射点，将该获取反射点的三维坐标作为路面反射点存储于存储器42，使处理移至s195。
[0104]
信号处理部4在s190中，判断为获取反射点不是路面反射点，不存储于存储器42，而使处理移至s195。
[0105]
信号处理部4在s195中，判断是否对全部的获取反射点结束了是否是路面反射点的确认。这里，信号处理部4在未结束确认的情况下使处理移至s110，反复s110-s195的处理。另一方面，信号处理部4在结束确认的情况下，结束本路面反射提取处理。
[0106]
即，在本实施方式的路面提取处理中，将获取反射点中的、满足下面的全部的(a)-(d)的获取反射点提取为路面反射点。
[0107]
(a)位于在水平方向上包含中心轴ca的提取范围内。
[0108]
(b)与雷达装置2相距的距离小于距离阈值。
[0109]
(c)是静止反射点。
[0110]
(d)反射功率小于功率阈值。
[0111]
(e)在相机的拍摄图像中被识别为路面。
[0112]
此外，路面反射提取处理也可以被构成为满足上述(a)-(e)中的至少(a)。即，路面反射提取处理也可以被构成为满足(a)，并且进一步满足(b)-(e)中的至少一个。或者，路面反射提取处理也可以被构成为至少满足(a)和(b)。即，也可以被构成为路面反射提取处理满足(a)和(b)，路面反射提取处理进一步满足(c)-(e)中的至少一个。
[0113]
[2-3.计算处理]
[0114]
接下来，使用图10的流程图对信号处理部4在轴偏移估计处理的s30中执行的计算处理进行说明。信号处理部4通过计算处理来估计垂直轴偏移角度θp和搭载高度h。
[0115]
信号处理部4在s210中，基于反射点信息，使用反射点信息中包含的距离和方位
角，计算关于路面反射点的装置系坐标。装置系坐标是指基于雷达装置2的坐标轴的三维坐标。装置系坐标是将与波束方向正交的平面上的水平距离(以下，ys)、垂直距离(以下，zs)和波束方向的距离(以下，xs)作为元素的坐标。信号处理部4对全部的路面反射点计算装置系坐标(xs，ys，zs)，并存储于存储器42。
[0116]
信号处理部4在s220中，估计垂直轴偏移角度θp和雷达装置2的搭载高度h。具体而言，信号处理部4使用在作为未知参数的垂直轴偏移角度θp、作为未知参数的搭载高度h、以及装置系坐标所包含的两个元素(即，xs和zs)之间成立的关系式(即，式(1))来进行估计。
[0117]
[数学式1]
[0118][0119]
[数学式2]
[0120]
其中，
[0121][0122]
另外，
[0123][0124]
式(1)中的a和b如式(2)所示。另外，在检测出多个(即，n个)的情况下，每个路面反射点的装置系坐标像(xsn，ysn，zsn)那样表示。其中，n为2以上的整数。每个路面反射点中的xs、ys、zs像式(3)那样表示。即，a为n
×
2矩阵，b为n
×
1矩阵。
[0125]
信号处理部4基于式(1)，计算垂直轴偏移角度θp和搭载高度h，将计算出的垂直轴偏移角度θp和搭载高度h存储于存储器42，结束本计算处理。
[0126]
[2-4.关系式的导出]
[0127]
对关系式(即，在本实施方式中为式(1))的导出进行说明。
[0128]
此外，首先，对关系式中的轴偏移角度与装置系坐标所包含的两个元素之间的对应进行说明。
[0129]
若将作为本车vh的坐标轴的水平轴yc和行进方向轴xc中的一个设为对象轴，则轴偏移角度可以说是雷达装置2的坐标轴绕对象轴的偏移角度。例如，垂直轴偏移角度θp为雷达装置2的坐标轴绕作为对象轴的水平轴yc的轴偏移角度，侧倾角度θr为雷达装置2的坐标轴绕作为对象轴的行进方向轴xc的轴偏移角度。
[0130]
若将与该对象轴对应的雷达装置2的坐标轴设为对应轴，则与水平轴yc对应的对
应轴为左右轴ys，与行进方向轴xc对应的对应轴为前后轴xs。
[0131]
上述的装置系坐标所包含的两个元素是指与包含于与雷达装置2的三个坐标轴中的对应轴垂直的平面的、雷达装置2的两个坐标轴相关的元素。换言之，上述的装置系坐标所包含的两个元素相当于将路面反射点投影到与雷达装置2的三个坐标轴中的对应轴垂直的平面即投影面上的投影点的坐标。
[0132]
在估计垂直轴偏移角度θp的本实施方式中，对象轴为水平轴yc，对应轴为左右轴ys。由此，与包含于与对应轴即左右轴ys垂直的平面的、雷达装置2的上下轴zs以及前后轴xs相关的元素(即，zs和xs)相当于包含于上述的装置系坐标的两个元素。换言之，包含于装置系坐标的两个元素zs和xs相当于将路面反射点投影到与左右轴ys垂直的投影面上的投影点的坐标。
[0133]
此外，在估计侧倾角度θr的例子(即，后述的变形例1)中，对象轴为行进方向轴xc，对应轴为前后轴xs。由此，与包含于与对应轴即前后轴xs垂直的平面的、雷达装置2的左右轴ys和上下轴zs相关的元素(即，ys和zs)相当于包含于上述的装置系坐标的两个元素。换言之，包含于装置系坐标的两个元素ys和zs相当于将路面反射点投影到与前后轴xs垂直的投影面上的投影点的坐标。
[0134]
这样，确定关系式中的两个元素。
[0135]
接下来，对关系式的导出进行说明。以下，对估计垂直轴偏移角度θp的关系式(即，式(1))的导出进行说明。
[0136]
如图11所示，路面反射点位于路面上。即，路面反射点位于路面这样的同一平面上。由此，认为多个路面反射点在上述的投影面上呈直线状排列。
[0137]
这里，若假定雷达装置2未产生高度偏移，则在投影面上，使雷达装置2的坐标轴即前后轴xs和上下轴zs旋转垂直轴偏移角度θp，由此与本车vh的坐标轴即行进方向轴xc和垂直轴zc一致。
[0138]
即，在投影面上，使雷达装置2的坐标轴绕行进方向轴xc偏移垂直轴偏移角度θp，从而装置系坐标的两个元素(xs，zs)与车辆系坐标的两个元素(xc，zc)一致。这里，车辆系坐标是指基于本车vh的坐标轴的三维坐标(xc，yc，zc)。
[0139]
换言之，在投影面上，使雷达装置2绕前后轴xs旋转垂直轴偏移角度θp，从而装置系坐标的两个元素(xs，zs)与车辆系坐标的两个元素(xc，zc)一致。即，如下所示的式(4)成立。
[0140]
[数学式3]
[0141][0142]
另一方面，根据图9可知，车辆系坐标的(zc)的大小与搭载高度h相等，符号为负。由此，得到式(5)。
[0143]
[数学式4]
[0144]
[zc]＝[-h]
ꢀꢀꢀ
(5)
[0145]
而且，根据式(4)和式(5)得到式(6)的关系。
[0146]
[数学式5]
[0147]
[zc]＝[sinθ
p
×
xs cosθ
p
×zs
]＝[-h]
ꢀꢀꢀ
(6)
[0148]
而且，根据式(6)得到式(7)的关系，根据式(7)得到式(8)、式(9)。
[0149]
[数学式6]
[0150]
[sinθ
p
×
xs h]＝[-cosθ
p
×zs
]
ꢀꢀꢀ
(7)
[0151][0152][0153]
在式(9)中，像式(2)那样表示a、b，能够得到式(1)。
[0154]
[1-3.效果]
[0155]
根据以上详述的第一实施方式，起到以下的效果。
[0156]
(1a)信号处理部4在s10中，针对由雷达装置2检测出的多个反射点中的每个反射点，反复获取反射点信息。水平角度和垂直角度是以波束方向为基准而求出的。信号处理部4在s20中，至少基于反射点信息，从多个反射点中提取多个路面反射点。
[0157]
信号处理部4在s210中，基于反射点信息，针对路面反射点中的每个路面反射点，确定装置系坐标。信号处理部4在s220中，使用关系式(即，式(1)-(3))来估计垂直轴偏移角度θp和搭载高度h。式(1)是在两个未知参数(即，垂直轴偏移角度θp和搭载高度h)与包含于路面反射点的装置系坐标的两个元素(即，xs和zs)之间成立的关系式。
[0158]
通过雷达装置2高精度地检测各个反射点的装置系坐标。信号处理部4基于路面反射点的装置系坐标，算术地估计作为轴偏移角度的垂直轴偏移角度θp和搭载高度h。
[0159]
以往，没有同时估计轴偏移角度和搭载高度的技术。
[0160]
信号处理部4能够同时估计作为轴偏移角度的垂直轴偏移角度θp和搭载高度h。其结果为，信号处理部4能够估计轴偏移角度和基于搭载高度h的高度偏移量d。另外，信号处理部4能够校正垂直轴偏移角度θp和搭载高度h双方。
[0161]
然而，基于在产生轴偏移时来自车辆附近的反射波的接收强度成为最大的情况来估计轴偏移角度的现有的装置(以下，比较装置)以在搭载高度h不产生偏移为前提。即，比较装置将本来不知道产生了绕装置坐标轴的轴偏移和高度偏移中的哪个的情况假定为未产生高度偏移来估计轴偏移角度。因此，在比较装置中，即使在假设仅产生高度偏移而未产生绕装置坐标轴的轴偏移的情况下，也有可能估计绕装置坐标轴的轴偏移角度。即，在比较装置中，有可能产生轴偏移角度的估计误差。
[0162]
由于信号处理部4估计轴偏移角度和搭载高度双方，因此能够估计搭载高度，并且能够抑制轴偏移角度的估计误差。
[0163]
(1b)包含于上述的装置系坐标的两个元素(即，xs和zs)是与包含于与雷达装置2的三个坐标轴中的对应轴垂直的平面的、雷达装置2的两个坐标轴(即，前后轴xs、上下轴zs)相关的元素。这里所说的对应轴为左右轴ys。对应轴是指与对象轴(即，yc)对应的雷达装置2的坐标轴。由此，基于二维坐标来估计轴偏移角度，因此与使用作为三维坐标的装置
系坐标的情况相比，能够降低信号处理部4的处理负荷。
[0164]
(1c)信号处理部4也可以被构成为在s110中，从检测本车vh的状态的车载传感器组3获取本车vh的状态的检测结果，基于检测结果来判断本车vh的车体是否相对于路面稳定。而且，信号处理部4也可以被构成为在判断为本车vh的车体相对于路面稳定的情况下，在s20中，从多个反射点中提取至少一个路面反射点。由此，很难将斜面、凹凸面这样的不是平面的路面上的反射点作为路面反射点来提取。即，由于容易将平坦路面上的反射点作为路面反射点来提取，因此基于路面反射点位于同一平面上的情况，能够高精度地估计轴偏移角度。
[0165]
(1d)信号处理部4也可以被构成为基于反射点信息，在s130中，从多个反射点中，提取位于在水平方向上包含雷达波束的中心轴ca的规定的方位范围内的至少一个反射点作为路面反射点。
[0166]
其结果为，认为路面至少位于本车vh的行进方向(即，雷达波束的中心轴ca的方向)的正正面附近，因此通过适当地决定规定的方位范围，能够提高提取路面上的获取反射点的精度。
[0167]
(1e)信号处理部4也可以被构成为基于反射点信息，在s140中，从多个反射点中，提取与雷达装置2相距的距离小于距离阈值的至少一个反射点作为路面反射点。其结果为，认为路面至少位于本车vh的最近处，因此通过适当地决定距离阈值，能够进一步提高提取路面上的反射点的精度。
[0168]
(1f)在反射点信息中也可以包含反射点相对于本车vh的相对速度。信号处理部4也可以被构成为基于该反射点信息，在s150中，从多个反射点中，提取作为静止反射点的至少一个反射点作为路面反射点。其结果为，由于路面相对于本车vh静止，因此能够进一步提高提取路面上的反射点的精度。
[0169]
(1g)在反射点信息中也可以包含反射点的接收强度。信号处理部4也可以被构成为基于该反射点信息，在s160中，提取反射功率小于功率阈值的至少一个反射点作为路面反射点。其结果为，由于认为来自路面的反射功率例如比来自其他车辆的反射功率小，因此通过基于来自路面的反射功率适当地决定功率阈值，能够进一步提高提取路面上的反射点的精度。
[0170]
(1h)信号处理部4也可以被构成为获取相机的拍摄图像，估计在拍摄图像中被识别为路面的方位范围。信号处理部4也可以被构成为在s170中，从多个反射点中，提取位于在拍摄图像中被估计为路面的方位范围内的至少一个反射点作为路面反射点。由此，能够进一步提高提取路面反射点的精度。
[0171]
此外，在上述实施方式中，本车vh的坐标轴相当于移动体的坐标轴。另外，垂直轴偏移角度θp相当于轴偏移角度。垂直轴偏移角度θp和搭载高度h相当于包含轴偏移角度的两个未知参数以及至少两个未知参数，xs和zs相当于装置系坐标所包含的两个元素以及至少两个元素。水平轴yc相当于对象轴，左右轴ys相当于对应轴，与对应轴垂直的平面中包含的雷达装置2的两个坐标轴相当于前后轴xs和上下轴zs。
[0172]
[1-4.变形例]
[0173]
(变形例1)在变形例1中，信号处理部4也可以取代垂直轴偏移角度θp，将侧倾角度θr估计为轴偏移角度。具体而言，信号处理部4也可以执行图12所示的计算处理来取代图10
所示的计算处理。在图12所示的计算处理中，图10中的s220被置换为s230。
[0174]
信号处理部4在s210中，与图10所示的s210同样，基于反射点信息，针对路面反射点分别确定装置系坐标。
[0175]
信号处理部4在s230中，估计作为轴偏移角度的侧倾角度θr和搭载高度h。具体而言，信号处理部4使用关系式(即，式(10))进行估计。关系式(即，式(10))是在作为未知参数的侧倾角度θr、作为未知参数的雷达装置2的搭载高度h以及装置系坐标所包含的两个元素(即，ys和zs)之间成立的关系式。
[0176]
[数学式7]
[0177][0178]
[数学式8]
[0179][0180]
其中，式(11)中的a和b如式(11)所示。此外，式(11)中的ys、zs如式(3)所示。
[0181]
信号处理部4基于式(10)，计算侧倾角度θr和搭载高度h，将计算出的侧倾角度θr和搭载高度h存储于存储器42，结束本计算处理。
[0182]
此外，如图13所示，路面反射点位于路面这样的同一平面上。由此，认为多个路面反射点在与前后轴xs垂直的投影面(即，ys-zs平面)上呈直线状排列。关系式(即，式(10))与上述的式(4)-(9)同样，能够通过将上述的式(4)-(9)中的垂直轴偏移角度θp置换为侧倾角度θr，将xs置换为ys而得到。
[0183]
这样，变形例1中的轴偏移估计装置即信号处理部4将行进方向轴xc作为对象轴，将绕行进方向轴xc的轴偏移角度即侧倾角度θr和搭载高度h作为未知参数。另外，信号处理部4将路面反射点的装置系坐标中的xs和ys作为两个元素。在信号处理部4中，估计部46被构成为通过基于上述的式(10)-(11)和(3)的运算，决定侧倾角度θr和搭载高度h。
[0184]
其结果为，信号处理部4能够同时估计作为轴偏移角度的侧倾角度θr和搭载高度h。
[0185]
此外，在变形例1中，侧倾角度θr相当于轴偏移角度，侧倾角度θr和搭载高度h相当于包含轴偏移角度的两个未知参数以及至少两个未知参数。ys和zs相当于装置系坐标所包含的两个元素以及至少两个元素。前后轴xs相当于对应轴，与对应轴垂直的平面中包含的雷达装置2的两个坐标轴相当于左右轴ys和上下轴zs。
[0186]
(变形例2)信号处理部4也可以将垂直轴偏移角度θp和侧倾角度θr作为轴偏移角度，估计垂直轴偏移角度θp和侧倾角度θr以及搭载高度h。具体而言，信号处理部4也可以执行在图10所示的计算处理的s220之后追加了图12所示的计算处理的s230的处理。此外，作为搭载高度h，也可以使用基于s220和s230分别计算出的值的平均值。
[0187]
(变形例3)信号处理部4也可以利用与(变形例2)不同的计算方法，将垂直轴偏移
角度θp和侧倾角度θr作为轴偏移角度，估计垂直轴偏移角度θp和侧倾角度θr、以及搭载高度h。具体而言，信号处理部4也可以执行图14所示的计算处理来取代图10所示的计算处理。在图14所示的计算处理中，图10中的s220被置换为s240。
[0188]
信号处理部4在s240中，估计作为轴偏移角度的垂直轴偏移角度θp和侧倾角度θr、以及搭载高度h。具体而言，信号处理部4使用关系式(即，式(12))进行估计。关系式(即，式(12))是在作为未知参数的垂直轴偏移角度θp、作为未知参数的侧倾角度θr、作为未知参数的雷达装置2的搭载高度h、以及装置系坐标所包含的3个元素(即，xs、ys和zs)之间成立的关系式。
[0189]
[数学式9]
[0190][0191]
信号处理部4基于式(12)，计算垂直轴偏移角度θp和侧倾角度θr、以及搭载高度h，将计算出的垂直轴偏移角度θp和侧倾角度θr以及搭载高度h存储于存储器42，结束本计算处理。
[0192]
此外，如图15所示，基于通过使雷达装置2的坐标轴绕左右轴ys旋转垂直轴偏移角度θp、以及绕前后轴xs旋转侧倾角度θr从而与本车vh的坐标轴一致的情况，而得到式(12)。即，得到式(13)-式(14)。
[0193]
[数学式10]
[0194][0195]
这里，根据上述的式(5)所表示的关系式和式(14)，得到式(15)。另外，通过将式(15)除以cosθrcosθp，而得到式(16)。而且，根据式(16)导出式(12)。
[0196]
[数学式11]
[0197]
[zc]＝[cosθrsinθ
p
x
s-sinθrys cosθrcosθ
p
z5]＝[-h]
ꢀꢀꢀ
(15)
[0198][0199]
其结果为，信号处理部4能够同时估计作为轴偏移角度的垂直轴偏移角度θp和侧倾角度θr、以及搭载高度h。
[0200]
[2.第二实施方式]
[0201]
[2-1.结构]
[0202]
第二实施方式的基本的结构与第一实施方式同样，因此以下对不同点进行说明。此外，与第一实施方式相同的符号表示相同的结构，参照在先的说明。
[0203]
在第一实施方式中，基于路面反射点的位置，估计轴偏移角度和搭载高度h。与此相对，在第二实施方式中，计算路面平坦度wc，基于路面反射点的位置，进行基于路面平坦度wc的加权来估计轴偏移角度和搭载高度h，在这方面与第一实施方式不同。路面平坦度wc是表示路面平坦的程度的数值。这里，路面越平坦，则路面平坦度wc由越大的数值表示。
[0204]
[2-2.处理]
[0205]
[2-2-1.轴偏移估计处理]
[0206]
接下来，使用图16的流程图对第二实施方式的信号处理部4取代图8所示的第一实施方式的轴偏移估计处理而执行的轴偏移估计处理进行说明。此外，图16中的s25-s27以外的处理与图8中的s10-s20、s30-s90的处理同样，因此将说明一部分简化。
[0207]
信号处理部4在s20之后的s25中，执行后述的平坦度处理，计算路面平坦度wc。
[0208]
信号处理部4在平坦判断部s26中，基于路面平坦度wc来判断路面是否平坦。具体而言，信号处理部4在路面平坦度wc为预先决定的平坦度阈值wt以上的情况下判断为路面平坦。平坦度阈值wt预先存储于存储器42。
[0209]
这里，信号处理部4在判断为路面平坦的情况下使处理移至s30，在s30以后执行与图8所示的处理同样的处理。另一方面，信号处理部4在判断为路面不平坦的情况下使处理移至s27。
[0210]
信号处理部4在s27中，执行后述的加权处理，基于上述的关系式，进一步进行基于路面平坦度wc的加权来估计垂直轴偏移角度θ
p
和搭载高度h。而且，使处理移至s40，s40以后执行与图8所示的处理同样的处理。
[0211]
[2-2-2.平坦度处理]
[0212]
基于图17所示的流程图对信号处理部4在图16所示的轴偏移估计处理的s25中执行的平坦度处理进行说明。
[0213]
信号处理部4在s310中，获取加速度传感器的输出值，基于该输出值来计算第一系数w1。第一系数w1是表示路面的平坦度的数值，加速度传感器的输出值越大则第一系数w1被计算得越小。例如，也可以是，将加速度传感器的输出值和对应的第一系数w1作为表格形式的信息存储于存储器42，信号处理部4参照该表格形式的信息来计算与加速度传感器的输出值对应的第一系数w1。
[0214]
信号处理部4在s320中，获取多个路面反射点各自的反射功率的值，基于该反射功率的偏差来计算第二系数w2。第二系数w2是表示路面的平坦度的数值，表示反射功率的偏差的指数越大则第二系数w2被计算得越小。信号处理部4例如也可以将反射功率的标准偏差或方差作为表示偏差的指数来使用。例如，也可以将表示第二系数w2与表示偏差的指数的对应的表格形式的信息存储于存储器42，信号处理部4参照该表格而计算与表示偏差的指数对应的第二系数w2。
[0215]
信号处理部4在s330中，从导航装置获取本车vh的当前位置，基于本车vh的当前位置和地图信息来计算第三系数w3。第三系数w3是表示路面的平坦度的数值，包含于地图信息，路面越平坦则第三系数w3由越大的值表示。信号处理部4也可以基于地图信息，获取本车vh的当前位置处的道路的路面的平坦度，使用所获取的平坦度作为第三系数w3。
[0216]
信号处理部4在s340中，获取相机的拍摄图像，基于拍摄图像来计算第四系数w4。第四系数w4是表示路面的平坦度的数值，基于拍摄图像。路面越平坦则第四系数w4由越大
的值表示。在这里所说的拍摄图像中包含本车vh的前方的路面。信号处理部4也可以使用识别器来估计所获取的拍摄图像中包含的路面的平坦度，将估计出的平坦度作为第四系数w4使用，该识别器预先进行根据包含路面的多个图像来估计该图像中包含的路面的平坦度的学习。
[0217]
信号处理部4在s350中，使用第一系数w1-第四系数w4来计算路面平坦度wc。信号处理部4将第一系数w1-第四系数w4的平均值作为路面平坦度而存储于wc存储器42。信号处理部4至此结束平坦度处理。但是，本发明不限于此。信号处理部4也可以将第一系数w1-第四系数w4的最大值或者中央值等作为路面平坦度wc使用，并存储于存储器42。
[0218]
[2-2-3.加权处理]
[0219]
基于图18所示的流程图对信号处理部4在图16所示的轴偏移估计处理的s27中执行的加权处理进行说明。每次在轴偏移估计处理中处理移至s27时反复执行加权处理。此外，将加权处理中的从最初到最后的一系列的处理也称为“周期”。
[0220]
信号处理部4在s410中，与s210同样，计算当前周期中的路面反射点的装置系坐标。此外，多个(即，n个)路面反射点各自的xs、ys、zs像上述的式(3)那样表示。
[0221]
信号处理部4在s420-s470中，执行针对上述的式(1)的右边进行基于路面平坦度wc的加权的运算。由此，估计式(1)的左边、即基于路面平坦度wc的加权后的垂直轴偏移角度θp和搭载高度h。
[0222]
首先，信号处理部4在s420中，像式(17)、(18)那样，根据当前周期中的路面反射点的装置系坐标，计算用于计算式(1)的右边的参数ma和mb。
[0223]
[数学式12]
[0224]
ma＝a
taꢀꢀꢀ
(17)
[0225]
mb＝a
tbꢀꢀꢀ
(18)
[0226]
这里，参数a和b如上述的式(2)所示。参数ma为2
×
2矩阵，参数mb为2
×
1矩阵。
[0227]
信号处理部4在s430中，获取当前周期的路面平坦度wc。
[0228]
信号处理部4在s440中，像式(19)、(20)那样，计算当前周期的加权参数mwa、mwb。通过使当前周期的参数ma乘以当前周期的路面平坦度wc而得到当前周期的加权参数mwa。通过使当前周期的参数mb乘以当前周期的路面平坦度wc而得到当前周期的加权参数mwb。
[0229]
[数学式13]
[0230]
mwa＝wc
×
ma
ꢀꢀꢀ
(19)
[0231]
mwb＝wc
×
mb
ꢀꢀꢀ
(20)
[0232]
信号处理部4在s450中，将当前周期的总加权参数mcwa存储于存储器42。像式(21)那样，使当前周期的加权参数mwa加上存储于存储器42的过去的总加权参数mdcwa而得到当前周期的总加权参数mcwa。同样，信号处理部4将当前周期的总加权参数mcwb存储于存储器42。像式(22)那样，使当前周期的加权参数mwb加上存储于存储器42的过去的总加权参数mdcwb而得到当前周期的总加权参数mcwb。这里所说的过去意味着在前次周期中使用。
[0233]
[数学式14]
[0234]
mcwa＝mwa mdcwa
ꢀꢀꢀ
(21)
[0235]
mcwb＝mwb mdcwb
ꢀꢀꢀ
(22)
[0236]
信号处理部4在s460中，使用当前周期的总加权参数mcwa、mcwb，根据式(23)，估计
modulation(快速啁啾调制)的缩写。
[0251]
(3c)在上述实施方式中，表示信号处理部4执行轴偏移估计处理的例子，但也可以被构成为雷达装置2执行轴偏移估计处理。
[0252]
(3d)本发明所记载的信号处理部4及其方法也可以由专用计算机实现，该专用计算机通过构成被编程为执行由计算机程序具体化的一个至多个功能的处理器和存储器而被提供。或者，本发明所记载的信号处理部4及其方法也可以由专用计算机实现，该专用计算机通过由一个以上的专用硬件逻辑电路构成处理器而被提供。或者，本发明所记载的信号处理部4及其方法也可以由一个以上的专用计算机实现，该专用计算机通过被编程为执行一个至多个功能的处理器和存储器与由一个以上的硬件逻辑电路构成的处理器的组合而构成。另外，计算机程序也可以作为由计算机执行的指令，存储于计算机能够读取的非迁移有形记录介质。在实现信号处理部4所包含的各部的功能的方法中不一定需要包含软件，其全部的功能也可以使用一个或多个硬件来实现。
[0253]
(3e)也可以通过多个构成要素实现上述实施方式中的一个构成要素所具备的多个功能、或者通过多个构成要素实现一个构成要素所具备的一个功能。另外，也可以通过一个构成要素实现多个构成要素所具备的多个功能、或者通过一个构成要素实现由多个构成要素实现的一个功能。另外，也可以省略上述实施方式的结构的一部分。另外，也可以相对于其他的上述实施方式的结构附加或者置换上述实施方式的结构的至少一部分。
[0254]
(3f)除了上述的信号处理部4、雷达装置2、车辆控制系统1之外，还能够以用于使信号处理部4发挥功能的程序、记录了该程序的半导体存储器等非迁移实态记录介质、轴偏移估计方法等各种方式来实现本发明。
[0255]
此外，在上述实施方式中，本车vh相当于移动体，信号处理部4、估计部46相当于轴偏移估计装置。另外，s10相当于作为获取部的处理，s20相当于作为提取部的处理，s30、s210相当于作为装置系坐标部的处理，s30、s220、s230、s240相当于作为估计部46的处理。另外，s25相当于作为平坦度计算部的处理，s26相当于作为平坦判断部的处理，s27相当于作为加权处理部的处理。