Method, device and program product for controlling vehicle having radio emission device

By combining the information of the inertial measurement unit and satellite navigation device, the vehicle's radio transmitting device is automatically disabled, which solves the interference problem of the radio transmitting device on the equipment in the disabled area, and realizes the reliable disabling of the radio transmitting device and precise position identification.

CN118915751APending Publication Date: 2024-11-08MERCEDES BENZ GRP
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410995773.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-24
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

The radio transmitting device of a vehicle may cause interference to nearby equipment during operation, and the prior art is difficult to effectively prevent such interference, especially when the vehicle enters the disabled area.

Method used

By combining the information of the inertial measurement unit and the satellite navigation device, the positional relationship between the vehicle and the disabled area is identified, and the radio transmitting device is automatically disabled when the vehicle enters the disabled area, ensuring that the radio signal does not interfere with the protected object.

Benefits of technology

It realizes that the radio transmitting device is automatically turned off when the vehicle enters the disabled area, prevents interference, and accurately recognizes the position relationship when the satellite signal is unreliable, ensuring the reliable disabling of the radio transmitting device.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118915751A_ABST
    Figure CN118915751A_ABST
Patent Text Reader

Abstract

The invention provides a control method of a vehicle with a radio emission device. The control method comprises the following steps: S1, acquiring first information of the vehicle (1) by means of an inertial measurement unit (12) of the vehicle (1), and acquiring second information of the vehicle (1) by means of a satellite navigation device (13) of the vehicle (1); s2, the first information and / or the second information are / is used for recognizing the position relation between the vehicle (1) and a forbidden area (3) set for the protected object (2); and S3, in response to recognizing that the vehicle (1) is located in the forbidden area (3), forbidding a radio emission device (11) of the vehicle (1). The invention further provides a corresponding control device, a vehicle and a computer program product. According to the invention, the interference caused by the radio emission device of the vehicle can be conveniently and reliably prevented.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to a control method for a vehicle with a radio transmitting device, a control device, a vehicle and a computer program product. Background Art

[0002] Vehicles are usually equipped with a radio transmitter capable of transmitting radio waves. For example, radars that use radio for measurement are widely used in vehicles. Many functions of the vehicle rely on the detection results of the radar.

[0003] However, the radio waves emitted by the vehicle's radio transmitter when in operation may interfere with equipment near the vehicle. For example, due to the similar operating frequency bands, the radio waves emitted by the millimeter-wave radar may interfere with the observation equipment of the radio astronomy observatory (such as a radio telescope). If artificial measures are taken to avoid such interference, it will be labor-intensive and difficult to ensure the effect.

[0004] The existing technology is still insufficient in preventing interference caused by the radio transmission device of the vehicle. Summary of the invention

[0005] The purpose of the present application is to provide an improved control method for a vehicle with a radio transmitting device and a corresponding control device, a vehicle and a computer program product, so as to conveniently and reliably prevent interference caused by the radio transmitting device of the vehicle.

[0006] According to a first aspect of the present application, a control method for a vehicle having a radio transmission device is provided. The control method comprises the following steps: S1, obtaining first information of the vehicle by means of an inertial measurement unit of the vehicle, and obtaining second information of the vehicle by means of a satellite navigation device of the vehicle; S2, using the first information and / or the second information, identifying the positional relationship between the vehicle and a prohibited area set for a protected object; and S3, in response to identifying that the vehicle is located in the prohibited area, disabling the radio transmission device of the vehicle.

[0007] Through the control method, it is possible to reliably identify that a vehicle has entered a prohibited area, and automatically shut down the vehicle's radio transmitter when the vehicle enters the prohibited area. As a result, it is possible to conveniently and reliably prevent the radio emitted by the radio transmitter from interfering with the protected object in the prohibited area. Even in the case where the satellite navigation device cannot reliably receive satellite signals for positioning (for example, when the vehicle is traveling in a dense forest or a tunnel), it is still possible to reliably identify that the vehicle has entered a prohibited area so that the radio transmitter can be disabled in time. In addition, by fusing the first signal and the second signal, it is also helpful to more accurately identify the positional relationship between the vehicle and the prohibited area set for the protected object.

[0008] In an exemplary embodiment, the control method may further include step S4, in which, in response to identifying that the vehicle is located in a warning area outside a prohibited area, the first information and the second information are used to predict the possibility of the vehicle entering the prohibited area, and based on the predicted possibility, it is determined whether to issue a warning message to the driver to indicate that the radio transmitting device will be disabled.

[0009] In an exemplary embodiment, in step S4, the possibility of a vehicle entering a prohibited area can be predicted in the following manner: using the first information and the second information, a predicted trajectory curve of the vehicle is predicted, and the length of a perpendicular line from the protected object to the predicted trajectory curve is calculated, and the possibility of the vehicle entering the prohibited area is determined based on the length of the perpendicular line.

[0010] In an exemplary embodiment, step S4 may include the following sub-steps:

[0011] S41, in the vehicle coordinate system, using at least the first information, to determine a predicted trajectory curve in the form of a ram's horn curve according to the following formula:

[0012]

[0013] Wherein, x and y represent the longitudinal coordinate and the lateral coordinate in the vehicle coordinate system, respectively, and Y0, θ, C0 and C1 are parameters determined using at least the first information;

[0014] S42, determining the position coordinates of the protected object in the vehicle coordinate system using at least the first information;

[0015] S43, calculating the length of a perpendicular line from the protected object to the predicted trajectory curve; and

[0016] S44, comparing the length L of the vertical line with a predetermined disabling distance D1 and a predetermined protection distance D3 to determine whether to disable the radio transmitting device and / or whether to issue a warning message to the driver indicating that the radio transmitting device will be disabled.

[0017] In an exemplary embodiment, in sub-step S41, Y0 may be determined to be 0. Alternatively, θ is determined to be the yaw angle of the vehicle determined by the first information. For example, θ may be determined as: θ=∫R y dt, where R y represents the rate of change of the yaw angle determined by the first information, and t represents time. C0 may be determined, for example, according to the turning radius of the vehicle. As an example, C1 may be determined according to the rate of change of the turning radius of the vehicle.

[0018] Optionally, in sub-step S41, a Kalman filter algorithm may be used to track the parameters θ, C0 and C1 of the predicted trajectory curve to determine the predicted trajectory curve of the vehicle at the current moment.

[0019] In an exemplary embodiment, in sub-step S44: if the length L of the vertical line is less than the disabled distance D1, the radio transmitter is disabled. Alternatively, if the length L of the vertical line is greater than the disabled distance D1 and less than the sum of the disabled distance D1 and the protection distance D3, the radio transmitter is not disabled, and a warning message indicating that the radio transmitter will be disabled is issued to the driver. Alternatively, if the length L of the vertical line is greater than the sum of the disabled distance D1 and the protection distance D3, the radio transmitter is not disabled, and a warning message indicating that the radio transmitter will be disabled is not issued to the driver.

[0020] In an exemplary embodiment, in sub-step S41, the predicted trajectory curve is determined using the Kalman filter algorithm in the following manner:

[0021] Setting a curve parameter vector including at least parameters θ, C0 and C1 of the predicted trajectory curve;

[0022] Determine the state covariance matrix P and the observation noise covariance matrix R of the curve parameter vector;

[0023] The gain parameter g is determined according to the following formula:

[0024] Determine the curve parameter vector at the current moment according to the following formula: X k =X k-1 +g·Y k-1 , where X k Represents the curve parameter vector at the current moment, X k-1 The curve parameter vector at the previous moment, Y k-1 A curve parameter vector representing the updated measurement residuals; and

[0025] The predicted trajectory curve is determined using the curve parameter vector at the current moment.

[0026] By using the Kalman filter algorithm to determine the predicted trajectory curve in the above manner, a more accurate prediction result can be obtained.

[0027] In an exemplary embodiment, in step S2, the position coordinates of the vehicle are determined using the first information and / or the second information; the distance between the vehicle and the protected object is calculated using the position coordinates of the vehicle; and it is determined whether the vehicle is located in the prohibited area based on the distance between the vehicle and the protected object and the scope of the prohibited area.

[0028] In an exemplary embodiment, the vehicle may be provided with a switch connected between the radio transmitter and the energy supply device. In step S3, the radio transmitter is disabled in the following manner: a shutdown signal is sent to the switch connected between the radio transmitter and the energy supply device, so that the switch disconnects the power supply connection between the radio transmitter and the energy supply device.

[0029] In an exemplary embodiment, the radio transmission device may include a millimeter wave radar. The radio transmission device may be configured to have a use frequency of 76-79 GHz.

[0030] The protected object may include, for example, a radio astronomy station, a meteorological observation station, a satellite tracking and control station, or an airport.

[0031] Optionally, the location information of the prohibited area is pre-stored, for example, in a control device of the vehicle. The location information of the prohibited area may include, for example, the location coordinates of the protected object, the radius of the prohibited area and / or the boundary position of the prohibited area.

[0032] In an exemplary embodiment, the first information may include at least one of the following information measured by an inertial measurement unit: the position of the vehicle, the yaw angle of the vehicle, the yaw angle change rate of the vehicle, the pitch angle of the vehicle, the pitch angle change rate of the vehicle, the roll angle of the vehicle, and the roll angle change rate of the vehicle.

[0033] In an exemplary embodiment, the second information may include the position of the vehicle determined by satellite navigation data of a satellite navigation device.

[0034] According to a second aspect of the present application, a control device is provided, wherein the control device includes a memory and a processor, the memory stores computer program instructions, and when the computer program instructions are executed by the processor, the processor is capable of executing the control method according to the present application.

[0035] According to a third aspect of the present application, a vehicle is provided, wherein the vehicle includes: a radio transmitting device; an inertial measurement unit configured to acquire first information of the vehicle; a satellite navigation device configured to acquire second information of the vehicle; and a control device configured to execute a control method according to the present application.

[0036] In an exemplary embodiment, the vehicle further includes a switch connected between the radio transmitter and the power supply device, the switch being communicatively connected to the control device and capable of disconnecting the power supply connection between the radio transmitter and the power supply device in response to receiving a shutdown signal from the control device.

[0037] According to a fourth aspect of the present application, a computer program product is provided, which includes computer program instructions, wherein when the computer program instructions are executed by one or more processors, the processors are capable of executing the control method according to the present application. BRIEF DESCRIPTION OF THE DRAWINGS

[0038] The present invention will be described in more detail below with reference to the accompanying drawings, so that the principles, features and advantages of the present invention can be better understood. The accompanying drawings include:

[0039] Figure 1 Schematically illustrates a vehicle according to an exemplary embodiment of the present application;

[0040] Figure 2 A flow chart schematically shows a method for controlling a vehicle having a radio transmission device according to an exemplary embodiment of the present application;

[0041] Figure 3 Schematically illustrates an application scenario of a control method according to an exemplary embodiment of the present application;

[0042] Figure 4 Schematically shows a flow chart of a control method according to an exemplary embodiment of the present application;

[0043] Figure 5 Schematically shows a flow chart of step S4 of the control method according to an exemplary embodiment of the present application;

[0044] Figure 6 schematically shows a predicted trajectory curve according to an exemplary embodiment of the present application; and

[0045] Figure 7 The structure block diagram of a vehicle according to an exemplary embodiment of the present application is schematically shown.

[0046] Reference numerals list

[0047] 1 Vehicle

[0048] 11 Radio transmitter

[0049] 12 Inertial Measurement Unit

[0050] 13 Satellite navigation device

[0051] 14 Control Devices

[0052] 15 Notification Device

[0053] 16 Switch

[0054] 17 Power supply lines

[0055] 18 Wake-up signal line

[0056] 2 Protected Objects

[0057] 3 Disabled Areas

[0058] 4 Warning areas

[0059] 5 Prediction trajectory curve DETAILED DESCRIPTION

[0060] In order to make the technical problems, technical solutions and beneficial technical effects to be solved by the present application clearer, the present application will be further described in detail below in conjunction with the accompanying drawings and multiple exemplary embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application, rather than to limit the scope of protection of the present application.

[0061] Figure 1 A vehicle 1 according to an exemplary embodiment of the present application is schematically shown.

[0062] like Figure 1 As shown, the vehicle 1 includes a radio transmitting device 11. The radio transmitting device 11 represents a device capable of transmitting radio. The radio transmitting device 11 may include, for example, a communication device and / or a detection device capable of transmitting radio.

[0063] The vehicle 1 also includes an inertial measurement unit 12 (IMU). For example, the inertial measurement unit 12 can be used to measure the three-axis attitude angle (or angular rate) and acceleration of the vehicle 1. The inertial measurement unit 12 can include, for example, three single-axis accelerometers and three single-axis gyroscopes. The accelerometer can be used to detect the acceleration of the vehicle 1 along three axial directions. The gyroscope can detect the angular velocity of the vehicle 1. By measuring the angular velocity and acceleration of the vehicle 1 in three-dimensional space, the attitude of the vehicle 1 can be determined.

[0064] The vehicle 1 further includes a satellite navigation device 13. The satellite navigation device 13 can determine the position of the vehicle 1 using signals from a navigation satellite or a navigation system (eg, BDS, GPS, or GLONASS, etc.).

[0065] The vehicle 1 further includes a control device 14 configured to be able to execute a control method according to an exemplary embodiment of the present application (which will be described in detail below).

[0066] The control device 14 is implemented as an electronic control unit (ECU) of the vehicle 1, for example. The control device 14 may include a memory and a processor, the memory storing computer program instructions, when the computer program instructions are executed by the processor, the processor can, for example, execute a control method of the vehicle 1 having the radio transmitter 11. The computer program product may be stored in a computer-readable storage medium. The computer-readable storage medium may include, for example, a high-speed random access memory, and may also include a non-volatile memory, such as a hard disk, a memory, a plug-in hard disk, a smart memory card, a secure digital card, a flash memory card, at least one disk storage device, a flash memory device, or other volatile solid-state storage devices. The processor may be a central processing unit, or may be other general-purpose processors, digital signal processors, application-specific integrated circuits, off-the-shelf programmable gate arrays or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. The control device 14 may be a dedicated controller, which is configured as a controller specifically for controlling operations of the vehicle 1 related to the radio transmitter 11. The control device 14 may also be integrated in a central controller of the vehicle 1, or the control device 14 may be implemented as the central controller.

[0067] The control device 14 may be communicatively connected to the inertial measurement unit 12 and the satellite navigation device 13 to receive data from the inertial measurement unit 12 and the satellite navigation device 13 .

[0068] Optionally, the vehicle may further include a notification device 15. By means of the notification device 15, a reminder may be issued to the driver. The notification device 15 may, for example, include a display device of the vehicle 1, a voice device of the vehicle 1, and / or a mobile device associated with the vehicle 1 (e.g., a mobile phone of the driver).

[0069] Figure 2 The flowchart of the control method of a vehicle with a radio transmission device according to an exemplary embodiment of the present application is schematically shown. The control method can be applied to Figure 1 Vehicle shown.

[0070] like Figure 2 As shown, the control method includes steps S1, S2 and S3.

[0071] In step S1 , first information of the vehicle is acquired by means of an inertial measurement unit of the vehicle, and second information of the vehicle is acquired by means of a satellite navigation device of the vehicle.

[0072] In step S2, the positional relationship between the vehicle and the prohibited area set for the protected object is identified using the first information and / or the second information.

[0073] In step S3, in response to recognizing that the vehicle is located in the prohibited area, the radio transmission device of the vehicle is disabled.

[0074] Through the control method, it is possible to reliably identify that a vehicle has entered a prohibited area, and automatically shut down the vehicle's radio transmitter when the vehicle enters the prohibited area. As a result, it is possible to prevent the radio emitted by the radio transmitter from interfering with the protected object in the prohibited area. Even in the case where the satellite navigation device cannot reliably receive satellite signals for positioning (for example, when the vehicle is traveling in a dense forest or a tunnel), it is still possible to reliably identify that the vehicle has entered a prohibited area so that the radio transmitter can be disabled in time. In addition, by fusing the first signal and the second signal, it is also helpful to more accurately identify the positional relationship between the vehicle and the prohibited area set for the protected object.

[0075] Accordingly, when it is recognized that the vehicle leaves the prohibited area, the prohibition of the radio transmission device can be released so that the radio transmission device can be enabled. By fusing the first signal and the second signal, the radio transmission device can be enabled in a timely manner when the vehicle leaves the prohibited area.

[0076] When the radio transmitter is disabled, a reminder may be sent to the driver via a notification device to remind the driver that the radio transmitter has been disabled and associated vehicle functions have failed (or performance has been degraded).

[0077] Optionally, the first information includes at least one of the following information measured by an inertial measurement unit: the position of the vehicle, the yaw angle of the vehicle, the yaw angle change rate of the vehicle, the pitch angle of the vehicle, the pitch angle change rate of the vehicle, the roll angle of the vehicle, and the roll angle change rate of the vehicle.

[0078] The second information may include in particular the position of the vehicle determined by satellite navigation data of the satellite navigation device. Optionally, the second information may also include the speed of the vehicle determined by satellite navigation data of the satellite navigation device, etc.

[0079] According to an exemplary implementation of the present application, in step S2, the first information and / or the second information may be used to determine the position coordinates of the vehicle. The position coordinates of the vehicle may be used to calculate the distance between the vehicle and the protected object. Then, based on the distance between the vehicle and the protected object and the range of the prohibited area, it may be determined whether the vehicle is located in the prohibited area.

[0080] Figure 3 The application scenario of the control method according to the exemplary embodiment of the present application is schematically illustrated.

[0081] In this embodiment, the radio transmission device of the vehicle 1 may include a millimeter wave radar, which is configured to have a usage frequency of 76-79 GHz, for example.

[0082] The protected object 2 is, for example, a radio astronomy station. The radio waves emitted by the millimeter-wave radar during operation may interfere with the equipment of the radio astronomy station. Through the above-mentioned control device, the millimeter-wave radar of the vehicle 1 can be reliably prevented from interfering with the equipment of the radio astronomy station. In some countries or regions, according to laws or regulations, vehicles 1 equipped with millimeter-wave radars are not allowed to enter the prohibited area 3 set for the radio astronomy station. However, in practice, it is difficult to ensure that this regulation is effectively implemented. A vehicle 1 equipped with a millimeter-wave radar may mistakenly enter the prohibited area 3. Alternatively, for special needs (such as transporting equipment or personnel), it is necessary to allow specific vehicles 1 equipped with millimeter-wave radars to enter the prohibited area 3. With the help of the control method of the exemplary embodiment of the present application, the millimeter-wave radar of the vehicle 1 can be reliably prevented from interfering with the equipment of the radio astronomy station.

[0083] The protected object 2 may also include, for example, a meteorological observation station, a satellite tracking and control station or an airport.

[0084] In order to avoid interference, a prohibited area 3 may be set for the protected object 2. The prohibited area 3 may represent an area surrounding the protected object 2. The prohibited area 3 may be, for example, a circular area centered on the protected object 2. Figure 3 In the figure, the area demarcated by the solid circle represents the prohibited area 3.

[0085] The position information of the prohibited area 3 may be pre-stored. The position information of the prohibited area 3 may optionally include the position coordinates of the protected object 2, the radius of the prohibited area 3 and / or the boundary position of the prohibited area 3, etc. The position information of the prohibited area 3 may be pre-stored in the control device of the vehicle 1, for example.

[0086] As an example, the longitude and latitude of the protected object 2 and the radius of the prohibited area 3 (for example, a predetermined prohibited distance D1) may be stored in the memory of the control device. The distance between the vehicle 1 and the protected object 2 may be calculated using the position coordinates of the vehicle 1 and the longitude and latitude of the protected object 2. If the distance between the vehicle 1 and the protected object 2 is greater than the prohibited distance D1, it may be determined that the vehicle 1 is outside the prohibited area 3. If the distance between the vehicle 1 and the protected object 2 is less than the prohibited distance D1, it may be determined that the vehicle 1 is within the prohibited area 3. In the case where the vehicle 1 is within the prohibited area 3, the radio transmitter may be disabled.

[0087] Combine the following Figure 3 and Figure 4 Exemplary embodiments of the present application are further described.

[0088] Figure 4 The flowchart of the control method according to the exemplary embodiment of the present application is schematically shown. Figure 2 Similar to the embodiment shown, Figure 4The control method shown may also include steps S1, S2 and S3, which will not be described in detail here.

[0089] In addition, Figure 4 In the illustrated embodiment, the control method may further include step S4.

[0090] In the step S4, in response to identifying that the vehicle 1 is located in the warning area 4 outside the prohibited area 3, the possibility of the vehicle 1 entering the prohibited area 3 is predicted using the first information and the second information, and based on the predicted possibility, it is determined whether to send a warning message to the driver indicating that the radio transmitter will be disabled. As a result, when the vehicle 1 may enter the prohibited area 3, the driver can be reminded in advance that the radio transmitter will be disabled. After the radio transmitter is disabled, the functions implemented by the radio transmitter will not be implemented. For example, after the millimeter wave radar is disabled, vehicle functions such as automatic emergency braking, lane departure warning, or automatic lane change assistance may fail (or performance may degrade). After receiving the warning message, the driver can know in advance that certain vehicle functions corresponding to the radio transmitter will fail, thereby avoiding the driver's sudden perception of a reduced driving experience or reduced safety caused by the failure of the vehicle function.

[0091] Optionally, the control device can send a notification to a notification device 15 (see Figure 1 ) sends a signal so that the notification device 15 sends a warning message to the driver indicating that the radio transmitting device will be disabled.

[0092] See also Figure 3 , the dotted circle schematically shows the warning area 4. Here, the warning area 4 is, for example, an annular area surrounding the prohibited area 3, and the width of the annular area can be set to a predetermined warning distance D2. In this embodiment, if the distance between the vehicle 1 and the protected object 2 is greater than the prohibited distance D1 and less than the sum of the prohibited distance D1 and the warning distance D2, it can be determined that the vehicle 1 is located in the warning area 4.

[0093] According to an exemplary embodiment of the present application, in step S4, the possibility of the vehicle 1 entering the prohibited area 3 can be predicted in the following manner: using the first information and the second information, predicting the predicted trajectory curve of the vehicle 1, and obtaining the length of the vertical line from the protected object 2 to the predicted trajectory curve, and determining the possibility of the vehicle 1 entering the prohibited area 3 based on the length of the vertical line. In this way, the possibility of the vehicle 1 entering the prohibited area 3 can be reliably identified by using the first information and the second information provided by the inertial measurement unit and the satellite navigation device.

[0094] Figure 5 The flowchart of step S4 of the control method according to the exemplary embodiment of the present application is schematically shown.

[0095] In this embodiment, step S4 may include sub-steps S41, S42, S43 and S44.

[0096] In sub-step S41, in the vehicle coordinate system, at least the first information is used to determine a predicted trajectory curve in the form of a ram's horn curve according to the following formula:

[0097]

[0098] Wherein, x and y represent the longitudinal coordinate and the lateral coordinate in the vehicle coordinate system respectively, and Y0, θ, C0 and C1 are parameters determined using at least the first information.

[0099] In sub-step S42, the position coordinates of the protected object in the vehicle coordinate system are determined using at least the first information.

[0100] In sub-step S43, the length of the perpendicular line from the protected object to the predicted trajectory curve is calculated.

[0101] In sub-step S44, the length L of the vertical line is compared with a predetermined disabling distance D1 and a predetermined protection distance D3 to determine whether to disable the radio transmitter and / or whether to issue a warning message to the driver indicating that the radio transmitter will be disabled.

[0102] In this way, when the vehicle is likely to enter a prohibited area, the driver can be reliably reminded in advance that the radio transmitting device will be disabled.

[0103] Figure 6 A predicted trajectory curve 5 according to an exemplary embodiment of the present application is schematically shown.

[0104] The predicted trajectory curve 5 is in the form of a ram-horn curve. The ram-horn curve has the characteristic of linear curvature change, so that the predicted trajectory curve 5 has good smoothness.

[0105] As an example, the first information may be used to obtain the predicted trajectory curve 5 through horn curve fitting.

[0106] The predicted trajectory curve 5 can be expressed as:

[0107]

[0108] Optionally, Y0 is determined to be 0.

[0109] θ may be determined as a yaw angle of the vehicle determined by the first information.

[0110] Alternatively, θ is determined as: θ = ∫R y dt, where R y represents the yaw angle change rate determined by the first information, and t represents time.

[0111] C0 can be determined according to the turning radius of the vehicle, for example. For example, C0 can be determined according to the quotient of the front wheel turning angle and the wheelbase of the vehicle.

[0112] C1 can be determined according to, for example, the rate of change of the turning radius of the vehicle.

[0113] Back to Figure 5 In sub-step S41, the Kalman filter algorithm can be used to track the parameters θ, C0 and C1 of the predicted trajectory curve to determine the predicted trajectory curve of the vehicle at the current moment. Thus, the predicted trajectory curve can be accurately and reliably determined.

[0114] For example, in order to determine the predicted trajectory curve using the Kalman filter algorithm, a curve parameter vector including at least parameters θ, C0, and C1 of the predicted trajectory curve may be set.

[0115] The curve parameter vector can be expressed as When Y0 is determined to be 0, the curve parameter vector can be expressed as

[0116] Then, the state covariance matrix P and the observation noise covariance matrix R of the curve parameter vector can be determined.

[0117] The state covariance matrix P can represent the covariance between the components in the curve parameter vector, that is, the degree of linear correlation between them. In the Kalman filter algorithm, the state covariance matrix P can be used to quantify the uncertainty of the state estimate. The state covariance matrix P is continuously updated during the iteration process of the Kalman filter algorithm to reflect the confidence of the current state estimate. The state covariance matrix P directly affects the calculation of the Kalman gain, thereby determining how to balance the impact of the predicted value and the observed value on the state estimate in the update step.

[0118] For the curve parameter vector The state covariance matrix P can be expressed as: Optionally, to simplify calculation, the state covariance matrix P can be expressed as:

[0119] In the prediction step of the Kalman filter algorithm, the state covariance matrix P is updated according to the state transfer matrix and the process noise covariance matrix; in the update step of the Kalman filter algorithm, the P matrix is ​​updated according to the Kalman gain and the observation noise covariance matrix R.

[0120] The observation noise covariance matrix R represents the covariance of the observation error with itself. In the Kalman filter algorithm, the observation noise covariance matrix R can be used to quantify the uncertainty of the observation data. The observation noise covariance matrix R affects the calculation of the Kalman gain in the update step of the Kalman filter algorithm, thereby determining the weight of the observation in the state update. Smaller R values ​​indicate that the observation data has a higher confidence and will affect the state update more; while larger R values ​​indicate that the observation data has a lower confidence and the state update will rely more on the predicted value.

[0121] The value of the observation noise covariance matrix R is usually based on the characteristics of the observation data, such as the accuracy of the sensor, the noise distribution, etc.

[0122] The gain parameter g can be determined according to the following formula:

[0123] If the observation noise is very large, the gain parameter g can be approximated as If the observation noise is very small, the gain parameter g can be approximated as

[0124] Then, the curve parameter vector at the current moment can be determined according to the following formula: k =X k-1 +g·Y k-1 , where X k Represents the curve parameter vector at the current moment, X k-1 The curve parameter vector at the previous moment, Y k-1 The curve parameter vector representing the updated measurement residuals. The predicted trajectory curve can be determined using the curve parameter vector at the current moment.

[0125] By using the Kalman filter algorithm to determine the predicted trajectory curve in the above manner, a more accurate prediction result can be obtained. In practical applications, the first signal and the second signal may be interfered by various noises. Using the Kalman filter algorithm, the influence of noise on the prediction result can be effectively reduced through its prediction update mechanism, thereby determining a more accurate predicted trajectory curve. In addition, even if the driving direction of the vehicle fluctuates frequently, the predicted trajectory curve can be reliably determined using the Kalman filter algorithm.

[0126] Sub-step S42 may be performed before, after or simultaneously with sub-step S41. In sub-step S42, at least the first information may be used to determine the position coordinates (x a ,y a ,z a ) Determine the position coordinates (x) of the protected object in the vehicle coordinate system b ,y b ,z b ).

[0127] Optionally, the first information and the second information are used to determine a transformation matrix for converting the position coordinates of the protected object in the world coordinate system into the position coordinates of the protected object in the vehicle coordinate system. For example, the first information may be used to determine a rotation matrix, and the second information may be used to determine a translation matrix. Further, the transformation matrix T may be determined.

[0128] According to an exemplary embodiment of the present application, the conversion matrix T can be determined according to the following formula:

[0129]

[0130] (Δx, Δy, Δz) is the position coordinate of the vehicle in the world coordinate system, which can be determined based on the second information. The position coordinate of the vehicle in the world coordinate system can also be determined by the first information or by fusing the first information and the second information. θ, and ω represent the yaw angle, pitch angle and roll angle of the vehicle, respectively. The yaw angle, pitch angle and roll angle of the vehicle may be determined based on the first information, for example. Optionally, ω may be set to 0.

[0131] Based on the following formula, the transformation matrix T can be used to transform the position coordinates of the protected object in the world coordinate system into the position coordinates of the protected object in the vehicle coordinate system:

[0132] b=T·a

[0133] in,

[0134] See also Figure 6 , after determining the position coordinates of the protected object 2 in the vehicle coordinate system and the predicted trajectory curve 5, the length L of the perpendicular line from the protected object 2 to the predicted trajectory curve 5 can be obtained in sub-step S43. Optionally, the position of the foot of the perpendicular can be determined first, and then the length L of the perpendicular line can be calculated. The foot of the perpendicular can be determined as a point on the predicted trajectory curve 5 that satisfies the following conditions: the direction of the tangent line of the predicted trajectory curve 5 at the point is perpendicular to the direction of the line connecting the point to the protected object 2, wherein the direction of the tangent line of the predicted trajectory curve 5 at the point can be determined by taking the derivative of the function of the predicted trajectory curve 5.

[0135] Optionally, in sub-step S44, if the length L of the vertical line is less than the disabled distance D1, the radio transmitting device is disabled. If the length L of the vertical line is greater than the disabled distance D1 and less than the sum of the disabled distance D1 and the protection distance D3, the radio transmitting device is not disabled, and a warning message indicating that the radio transmitting device will be disabled is issued to the driver. If the length L of the vertical line is greater than the sum of the disabled distance D1 and the protection distance D3, the radio transmitting device is not disabled, and no warning message indicating that the radio transmitting device will be disabled is issued to the driver.

[0136] Figure 7 The structure block diagram of the vehicle 1 according to an exemplary embodiment of the present application is schematically shown.

[0137] like Figure 7 As shown, the vehicle 1 includes a radio transmitter 11, an inertial measurement unit 12, a satellite navigation device 13 and a control device 14. The satellite navigation device 13 may include a plurality of radars, such as a front corner radar and / or a corner radar.

[0138] The vehicle 1 may further include a switch 16 connected between the radio transmitter 11 and the energy supply device. The switch 16 is, for example, a digital switch. The control device 14 is communicatively connected to the switch 16 so as to control the on and off of the switch 16 through a control signal. The radio transmitter 11 is connected to a power supply line 17 through the switch 16. Although not shown here, it should be understood that the power supply line 17 is connected to the energy supply device (e.g., a battery) of the vehicle 1.

[0139] According to an exemplary embodiment of the present application, in step S3 of the control method, the radio transmitting device 11 can be disabled in the following manner: a shutdown signal is sent to a switch 16 connected between the radio transmitting device 11 and the power supply device, so that the switch 16 disconnects the power supply connection between the radio transmitting device 11 and the power supply device. In this way, it can be ensured that the radio transmitting device 11 cannot be enabled when necessary.

[0140] The radio transmitter 11 may also be connected to the wake-up signal line 18. If the switch 16 is connected and the radio transmitter 11 is normally powered, the radio transmitter 11 may be activated when the radio transmitter 11 receives a wake-up signal from the wake-up signal line 18. Compared with disabling the radio transmitter 11 by simply prohibiting the transmission of a wake-up signal to the radio transmitter 11, by disconnecting the power supply connection between the radio transmitter 11 and the power supply device using the switch 16, it is possible to more reliably ensure that the radio transmitter 11 cannot be activated.

[0141] Although specific embodiments have been described above, these embodiments are not intended to limit the scope of the present disclosure, even when only a single embodiment is described with respect to specific features. The feature examples provided in the present disclosure are intended to be illustrative, not restrictive, unless otherwise stated. In specific implementations, multiple features may be combined with each other, depending on actual needs, where technically feasible. In particular, the features in different embodiments may also be combined with each other. Various replacements, changes, and modifications may also be conceived without departing from the spirit and scope of the present application.

Claims

1. A method for controlling a vehicle having a radio transmitting device, wherein: The control method comprises the following steps: S1, obtaining first information of the vehicle (1) by means of an inertial measurement unit (12) of the vehicle (1), and obtaining second information of the vehicle (1) by means of a satellite navigation device (13) of the vehicle (1); S2, using the first information and / or the second information, identifying a positional relationship between the vehicle (1) and a prohibited area (3) set for the protected object (2); as well as S3, in response to identifying that the vehicle (1) is located in the prohibited area (3), the radio transmission device (11) of the vehicle (1) is disabled.

2. The control method according to claim 1, wherein: The control method further comprises a step S4, in which, in response to identifying that the vehicle (1) is located in a warning area (4) outside a prohibited area (3), the possibility of the vehicle (1) entering the prohibited area (3) is predicted using the first information and the second information, and based on the predicted possibility, it is determined whether to send a warning message to the driver indicating that the radio transmitting device (11) will be disabled.

3. The control method according to claim 2, wherein: In step S4, the possibility of the vehicle (1) entering the prohibited area (3) is predicted in the following manner: The predicted trajectory curve (5) of the vehicle (1) is predicted using the first information and the second information, and the length of a perpendicular line from the protected object (2) to the predicted trajectory curve (5) is calculated, and the possibility of the vehicle (1) entering the prohibited area (3) is determined based on the length of the perpendicular line.

4. The control method according to claim 2 or 3, wherein: Step S4 includes the following sub-steps: S41, in the vehicle coordinate system, using at least the first information, to determine a predicted trajectory curve (5) in the form of a ram's horn curve according to the following formula: Wherein, x and y represent the longitudinal coordinate and the lateral coordinate in the vehicle coordinate system, respectively, and Y0, θ, C0 and C1 are parameters determined using at least the first information; S42, using at least the first information, determining the position coordinates of the protected object (2) in the vehicle coordinate system; S43, calculating the length of a perpendicular line from the protected object (2) to the predicted trajectory curve (5); and S44, comparing the length of the vertical line with a predetermined disabling distance and a predetermined protection distance to determine whether to disable the radio transmitting device (11) and / or whether to issue a warning message to the driver indicating that the radio transmitting device (11) will be disabled.

5. The control method according to claim 4, wherein: In sub-step S41, Y0 is determined to be 0; and / or θ is determined as the yaw angle of the vehicle (1) determined by the first information; and / or θ is determined as: θ = ∫R y dt, where R y represents the yaw angle change rate determined by the first information, and t represents time; and / or C0 is determined based on the turning radius of the vehicle (1); and / or C1 is determined according to the rate of change of the turning radius of the vehicle (1).

6. The control method according to claim 4 or 5, wherein: In sub-step S44: If the length of the vertical line is less than the disabling distance, the radio transmitting device (11) is disabled; and / or If the length of the vertical line is greater than the disabled distance and less than the sum of the disabled distance and the protection distance, the radio transmitting device (11) is not disabled, and a warning message indicating that the radio transmitting device (11) will be disabled is sent to the driver; and / or If the length of the vertical line is greater than the sum of the disabled distance and the protected distance, the radio transmitting device (11) is not disabled, and no warning message is sent to the driver indicating that the radio transmitting device (11) will be disabled.

7. The control method according to any one of claims 4 to 6, wherein: In sub-step S41, the predicted trajectory curve (5) is determined using the Kalman filter algorithm in the following manner: Setting a curve parameter vector including at least parameters θ, C0 and C1 of the predicted trajectory curve (5); Determine the state covariance matrix P and the observation noise covariance matrix R of the curve parameter vector; The gain parameter g is determined according to the following formula: Determine the curve parameter vector at the current moment according to the following formula: X k =X k-1 +g·Y k-1 , where X k Represents the curve parameter vector at the current moment, X k-1 The curve parameter vector at the previous moment, Y k-1 A curve parameter vector representing the updated measurement residuals; and The predicted trajectory curve (5) is determined using the curve parameter vector at the current moment.

8. The control method according to any one of claims 4 to 6, wherein: In sub-step S41, the parameters θ, C0 and C1 of the predicted trajectory curve (5) are tracked using a Kalman filter algorithm to determine the predicted trajectory curve (5) of the vehicle (1) at the current moment.

9. The control method according to any one of claims 1 to 8, wherein: In step S2, Determine the position coordinates of the vehicle (1) using the first information and / or the second information; Using the position coordinates of the vehicle (1), calculate the distance between the vehicle (1) and the protected object (2); as well as Whether the vehicle (1) is located in the prohibited area (3) is determined based on the distance between the vehicle (1) and the protected object (2) and the range of the prohibited area (3).

10. The control method according to any one of claims 1 to 9, wherein: The vehicle (1) is provided with a switch (16) connected between the radio transmitting device (11) and the energy supply device; In step S3, the radio transmitting device (11) is disabled in the following manner: a shut-off signal is sent to a switch (16) connected between the radio transmitting device (11) and the power supply device, so that the switch (16) disconnects the power supply connection between the radio transmitting device (11) and the power supply device.

11. The control method according to any one of claims 1 to 10, wherein: The radio transmitting device (11) includes a millimeter wave radar; and / or The radio transmitting device (11) is configured to have a usage frequency of 76-79 GHz; and / or Protected objects (2) include radio astronomy observatories; and / or The location information of the prohibited area (3) is pre-stored; and / or The location information of the prohibited area (3) includes the location coordinates of the protected object (2), the radius of the prohibited area (3) and / or the boundary position of the prohibited area (3).

12. The control method according to any one of claims 1 to 11, wherein: The first information includes at least one of the following information measured by the inertial measurement unit (12): the position of the vehicle (1), the yaw angle of the vehicle (1), the yaw angle change rate of the vehicle (1), the pitch angle of the vehicle (1), the pitch angle change rate of the vehicle (1), the roll angle of the vehicle (1), the roll angle change rate of the vehicle (1); and / or The second information includes the position of the vehicle (1) determined by satellite navigation data from a satellite navigation device (13).

13. A control device, wherein: The control device (14) comprises a memory and a processor, wherein the memory stores computer program instructions, and when the computer program instructions are executed by the processor, the processor is capable of executing the control method according to any one of claims 1 to 12.

14. A vehicle, wherein: The vehicle (1) comprises: A radio transmitter (11); An inertial measurement unit (12) configured to acquire first information of the vehicle (1); a satellite navigation device (13) configured to acquire second information of the vehicle (1); and A control device (14) configured to execute the control method according to any one of claims 1 to 12.

15. The vehicle of claim 14, wherein: The vehicle (1) further comprises a switch (16) connected between the radio transmitting device (11) and the energy supply device, wherein the switch (16) is communicatively connected to the control device (14) and is capable of disconnecting the power supply connection between the radio transmitting device (11) and the energy supply device in response to receiving a shutdown signal from the control device (14).

16. A computer program product comprising computer program instructions, wherein: When the computer program instructions are executed by one or more processors, the processors are capable of performing the control method according to any one of claims 1-12.