WO2016045596A1 - Method for detecting balance of car body , control method of balance state of car body and dynamic balance car - Google Patents

Method for detecting balance of car body , control method of balance state of car body and dynamic balance car Download PDF

Info

Publication number
WO2016045596A1
WO2016045596A1 PCT/CN2015/090487 CN2015090487W WO2016045596A1 WO 2016045596 A1 WO2016045596 A1 WO 2016045596A1 CN 2015090487 W CN2015090487 W CN 2015090487W WO 2016045596 A1 WO2016045596 A1 WO 2016045596A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle body
steering angle
angle
steering
pitch angle
Prior art date
Application number
PCT/CN2015/090487
Other languages
French (fr)
Chinese (zh)
Inventor
陈中元
王野
张辉
Original Assignee
鼎力联合(北京)科技有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 鼎力联合(北京)科技有限公司 filed Critical 鼎力联合(北京)科技有限公司
Publication of WO2016045596A1 publication Critical patent/WO2016045596A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/02Control of vehicle driving stability
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/11Pitch movement
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D11/00Steering non-deflectable wheels; Steering endless tracks or the like
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62KCYCLES; CYCLE FRAMES; CYCLE STEERING DEVICES; RIDER-OPERATED TERMINAL CONTROLS SPECIALLY ADAPTED FOR CYCLES; CYCLE AXLE SUSPENSIONS; CYCLE SIDE-CARS, FORECARS, OR THE LIKE
    • B62K11/00Motorcycles, engine-assisted cycles or motor scooters with one or two wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • B60W2050/146Display means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/06Direction of travel
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/16Pitch

Definitions

  • the invention belongs to the technical field of dynamic balance vehicles, and in particular to a method for detecting vehicle body balance, a control method for a vehicle body balance state, and a dynamic balance vehicle.
  • the dynamic balance vehicle directly uses electric energy as power, and by sensing the posture state of the vehicle body, the control command is calculated by the high speed processor, and the motor is driven to move the vehicle body.
  • the vehicle body posture is dynamically and frequently adjusted in real time to maintain the dynamic balance of the vehicle; when the dynamic balance vehicle is not in the working state, the vehicle body posture cannot be adjusted and the vehicle posture cannot be maintained. dynamic equilibrium.
  • the dynamic balance vehicle in order to respond quickly to the user's operation, the dynamic balance vehicle usually has to quickly adjust the posture of the vehicle body from the current attitude (CA) to the Dynamic Balance Steady Attitude (DBSA).
  • CA current attitude
  • DBSA Dynamic Balance Steady Attitude
  • the pitch angle and steering angle of the body to keep the occupant and the vehicle in a dynamic state and not fall.
  • the time for adjusting the posture of the vehicle body is very short, for example, usually less than 500ms, and the pitch angle and the steering angle cannot be changed too much in this process. Otherwise, if the change is too large, the vehicle will be strenuously moved, moved quickly or turned, and may be around. Object or person causes damage.
  • the prior art method enables the dynamic balance vehicle to enter the dynamic balance Steady Attitude (DBSA) from the current attitude (CA), including:
  • the present invention has been made in order to provide a method for detecting vehicle body balance, a vehicle body balance state control method, and a dynamic balance vehicle that overcome the above problems or at least partially solve the above problems.
  • a method of detecting vehicle body balance comprising:
  • the attitude sensor and the steering sensor respectively monitor the pitch angle and the steering angle of the vehicle body
  • the plurality of light emitting units are regularly illuminated according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle.
  • driving the plurality of illumination units to regularly emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle comprises:
  • the plurality of light emitting units are respectively driven to emit light according to the driving signal, and the light emitting areas of the plurality of light emitting units are regularly adjusted according to the pitch angle and the steering angle to simulate a vehicle body balance state.
  • driving the plurality of illumination units to regularly emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle comprises:
  • the plurality of light emitting units are respectively driven to emit light according to the driving signal, and the brightness of the plurality of light emitting units is regularly adjusted according to the pitch angle and the steering angle to simulate a vehicle body balance state.
  • generating a driving signal to drive the lighting unit to emit light according to the monitored pitch angle and the steering angle comprises:
  • the method further includes: setting a pitch angle threshold and a steering angle threshold in advance; generating, according to the monitored pitch angle and the steering angle, driving signals to drive the plurality of light emitting units to include According to the monitored pitch angle and pitch angle threshold, the steering angle and the steering angle threshold, a driving signal is generated to drive the plurality of light emitting units to emit light.
  • the method further includes displaying, in a human-computer interaction interface, a regular state of illumination of the illumination unit in real time to present a simulated vehicle body balance state to the driver.
  • a method of controlling a vehicle body balance state which includes: According to the simulated vehicle body balance state obtained by any of the above methods, the pitch and steering attitude of the vehicle body are adjusted.
  • a dynamic balance vehicle comprising: an attitude sensor, a steering sensor, a driving unit, an illumination unit, an attitude sensor and a steering sensor for respectively monitoring a pitch angle and a steering angle of the vehicle body; And generating a driving signal to drive the plurality of lighting units to emit light according to the monitored pitch angle and the steering angle; and the lighting unit is configured to periodically emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle.
  • the method further includes: a human-machine interaction interface for displaying a regular state of the illumination of the illumination unit in real time to present the simulated vehicle body balance state to the driver.
  • a human-machine interaction interface for displaying a regular state of the illumination of the illumination unit in real time to present the simulated vehicle body balance state to the driver.
  • the lighting unit is regularly arranged at the pedal position of the balance vehicle according to the vehicle body balance state corresponding to the pitch angle and the steering angle.
  • the pitch angle and the steering angle of the vehicle body are respectively monitored by the attitude sensor and the steering sensor; and the driving signal is generated according to the monitored pitch angle and the steering angle to drive the plurality of light emitting units to emit light; Driving a plurality of illumination units to regularly emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle, so that the occupant can grasp the balance state of the vehicle body in real time, and quickly and effectively enter the dynamic balance from the current posture CA.
  • Steady-state DBSA as far as possible to avoid damage to the surrounding objects or people.
  • FIG. 1 is a schematic flow chart of a method for detecting balance of a vehicle body according to an embodiment of the present invention
  • FIG. 2 is a schematic flowchart of generating a driving signal according to Embodiment 2 of the present invention
  • FIG. 3 is a schematic flow chart of a method for detecting vehicle body balance according to Embodiment 3 of the present invention.
  • FIG. 4 is a schematic flow chart of a method for detecting balance of a vehicle body according to Embodiment 4 of the present invention.
  • FIG. 5 is a schematic diagram showing the regular arrangement of four light emitting units according to an embodiment of the present invention.
  • FIG. 6 is a schematic diagram showing a regular arrangement of five light emitting units according to an embodiment of the present invention.
  • FIG. 7 is a schematic diagram showing display of a vehicle body balance state in an LCD liquid crystal display interface according to an embodiment of the present invention.
  • FIG. 8 is a block diagram showing the functional structure of a dynamic balance vehicle according to an embodiment of the present invention.
  • the pitch angle and the steering angle of the vehicle body are separately monitored by the attitude sensor and the steering sensor; and the driving signal is generated according to the monitored pitch angle and the steering angle to drive the plurality of light emitting units to emit light; Driving a plurality of illumination units to regularly emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle, so that the occupant can grasp the balance state of the vehicle body in real time, and quickly and effectively enter the dynamic balance from the current posture CA.
  • Steady-state DBSA as far as possible to avoid damage to the surrounding objects or people.
  • the attitude sensor and the steering sensor respectively monitor the pitch angle and the steering angle of the vehicle body
  • the plurality of light emitting units are regularly illuminated according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle.
  • FIG. 1 is a schematic flowchart of a method for detecting a balance of a vehicle body according to an embodiment of the present invention; as shown in FIG. 1 , the method may specifically include:
  • an attitude sensor and a steering sensor respectively monitor a pitch angle and a steering angle of the vehicle body
  • the pitch angle may refer to different states of the vehicle body tilting forward and backward
  • the steering angle may refer to different states of the vehicle body turning left and right.
  • the pitch angle includes a forward tilt angle and a rear elevation angle
  • the steering angle includes a left steering angle and a right steering angle.
  • the attitude sensor can be designed according to the actual structure of the product and fixed at the center of gravity of the vehicle body.
  • the attitude sensor can include a gyroscope and an accelerometer.
  • the gyroscope tracks the rotation of the vehicle along the X and Y axes, ie the angle of the car body, and the accelerometer measures the acceleration along the angular velocity.
  • Three-axis gyroscopes and three-axis accelerometers are available for specific product applications.
  • the pitch angle of the vehicle body is calculated according to the angle of the vehicle body, the acceleration of the vehicle body, and the angular velocity.
  • the steering sensor is coupled to the steering device, and the steering sensor may be a potentiometer or a Hall sensor.
  • the Hall sensor moves in the magnetic field, and a Hall voltage is output to determine the steering angle of the steering mechanism based on the Hall voltage.
  • FIG. 2 is a schematic flowchart of generating a driving signal according to Embodiment 2 of the present invention, which may specifically include:
  • S112. Generate, according to the monitored pitch angle, a first group of driving signals, where the first group of driving signals includes a first driving signal to drive the plurality of lighting units of the first group of lighting units in the analog pitch state to emit light;
  • S122 Generate a second group of driving signals according to the monitored steering angle, where the second group of driving signals includes a second driving signal to drive the plurality of lighting units of the second group of lighting units in the analog steering state to emit light.
  • the first group of light emitting units are disposed in a vertical direction to simulate a front and rear tilting state of the vehicle body according to a pitch angle of the vehicle body, and a second group of light emitting units are disposed in a horizontal direction according to the body of the vehicle body.
  • the steering angle simulates the left and right steering state of the vehicle body. Therefore, when generating the driving signal, a first group of driving signals for driving the first group of light emitting units are respectively generated, and a second group of driving signals for the second group of light emitting units are driven.
  • the LEDs included in the first group of the light-emitting units and the second group of the light-emitting units are not specifically limited, such as three or five.
  • first group of driving signals may include a plurality of independent driving signals to drive each of the first group of lighting units one by one.
  • the second set of drive signals may also include a plurality of independent drive signals to drive each of the second set of illumination units one by one.
  • first group of driving signals may also include only one driving signal, and the driving signals are shared between the respective lighting units in the first group of lighting units.
  • the second set of drive signals may also include only one drive signal that is shared between the light-emitting units of the second set of light-emitting units.
  • the plurality of light emitting units are respectively driven to emit light according to the driving signal, and the light emitting areas of the plurality of light emitting units are regularly adjusted according to the pitch angle and the steering angle to simulate a vehicle body balance state.
  • step S102 if a plurality of independent first group driving signals are generated, selectively driving a partial driving signal to selectively drive a part of the first group of light emitting units to emit light. Regularly adjusting a certain number of LEDs in the light-emitting unit group to emit light, thereby adjusting the light-emitting area of the light-emitting unit.
  • a first group of driving signals including a driving signal is generated, by selectively sharing the driving signals between the partial lighting unit groups in the first group of lighting units, a plurality of LEDs in the group of lighting units are regularly adjusted to emit light, Thereby, the light-emitting area of the light-emitting unit is adjusted.
  • FIG. 3 is a schematic flowchart of a method for detecting a balance of a vehicle body according to a third embodiment of the present invention. As shown in FIG. 3, the method may specifically include:
  • an attitude sensor and a steering sensor respectively monitor a pitch angle and a steering angle of the vehicle body
  • the plurality of light emitting units are respectively driven to emit light according to the driving signal, and the light emitting brightness of the plurality of light emitting units is regularly adjusted according to the pitch angle and the steering angle to simulate a vehicle body balance state.
  • this embodiment simulates the vehicle body balance state by regularly adjusting the light-emitting brightness of the light-emitting unit.
  • step S102 if a plurality of independent first group driving signals are generated, the driving units in the first group of lighting units are driven to emit light by selectively generating driving signals of different sizes, and the lighting is regularly adjusted.
  • the brightness of the LEDs in the unit if a plurality of independent first group driving signals are generated, the driving units in the first group of lighting units are driven to emit light by selectively generating driving signals of different sizes, and the lighting is regularly adjusted. The brightness of the LEDs in the unit.
  • a first group of driving signals including a driving signal is generated, by selectively sharing the driving signals between the partial lighting unit groups in the first group of lighting units, a plurality of LEDs in the group of lighting units are regularly adjusted to emit light, Thereby, the luminance of the entire illumination unit is adjusted.
  • the first embodiment or the first embodiment shown in FIG. 1 can be used.
  • another embodiment is formed, which includes an additional step of displaying the regular state of the illumination of the illumination unit in real time in the human-computer interaction interface to present the simulated vehicle body balance state to the driver. This step can be performed after step S103 or step S303.
  • the human-computer interaction interface may be an LCD liquid crystal display interface, in which a solid circular pattern is displayed to simulate a bubble of a horizontal ruler.
  • another embodiment may be formed on the basis of the first embodiment shown in FIG. 1 or the third embodiment shown in FIG. 3, which includes the added steps: pre-set The pitch angle threshold and the steering angle threshold are determined; this step may precede step S101 or S301.
  • the pitch angle threshold and the steering angle threshold may refer to a pitch angle and a steering angle when the vehicle body is in a self-balancing state.
  • the driving signal is generated in this embodiment.
  • a driving signal is generated to drive the regular illumination of the plurality of illumination units.
  • the pitch angle threshold includes a forward tilt angle threshold and a backward tilt angle threshold
  • the steering angle threshold includes a left steering angle threshold and a right steering angle threshold.
  • the pitch angle threshold and the steering angle threshold can be set based on the vehicle's inertia, dynamics model, and experimental experience values.
  • a further embodiment may be formed on the basis of the first embodiment shown in FIG. 1 or the third embodiment shown in FIG. 3, which includes the added steps: pre-set The pitch angle difference threshold and the steering angle difference threshold are determined; this step may be before step S101 or S301.
  • the pitch angle difference ⁇ p is the difference between the pitch angle detected in real time and the pitch angle when the vehicle body is completely in the self-balancing state.
  • the pitch angle difference includes the forward tilt angle difference and the backward tilt angle difference threshold, and the steering
  • the angle difference ⁇ r is the difference between the steering angle detected in real time and the steering angle when the vehicle body is completely in the self-balancing state, including the left steering angle difference and the right steering angle difference.
  • the pitch angle difference threshold ⁇ ps is the theoretical difference between the pitch angle detected when the vehicle body is in the dynamic balance state and the pitch angle when the vehicle body is completely in the self-balancing state.
  • the steering angle difference threshold ⁇ rs refers to the theoretical difference between the steering angle detected when the vehicle body is in the dynamic balance state and the steering angle when the vehicle body is completely in the self-balancing state.
  • the pitch angle difference and the steering angle difference threshold can be set according to the vehicle's inertia, dynamics model, and experimental experience values.
  • the occupant can intuitively or the balance state of the vehicle body through the regular illumination of the illumination unit, so as to adjust the balance state of the vehicle body in real time, such as if the illumination state of the first group of illumination units is passed. It is judged that the forward tilt angle in the pitch angle exceeds the forward tilt angle threshold in the pitch angle threshold, and the vehicle reclining needs to be appropriately adjusted to reduce the forward tilt angle. For details, refer to the description of the subsequent embodiments.
  • FIG. 4 is a schematic flow chart of a method for detecting the balance of a vehicle body according to Embodiment 4 of the present invention. for details, please refer to FIG. 4, and details are not repeated herein.
  • each group of illumination units includes an LED lamp, and LED1, LED2, and LED3 indicate the pitch state of the vehicle body, and LED4, LED2, and LED5 indicate The steering state of the car body. This embodiment will be described by taking the example of setting the pitch angle threshold and the steering angle threshold.
  • LED1 is extinguished, LED2 brightness ⁇ LED3 brightness, indicating that the vehicle body forward tilt angle exceeds the forward tilt angle threshold, the occupant needs to properly lean back the vehicle body;
  • LED4 is extinguished, LED2 brightness ⁇ LED5 brightness, indicating that the left steering angle of the handle exceeds the left steering angle threshold, and the occupant needs to adjust the steering device to the right;
  • FIG. 5 is specifically described by using the pitch angle threshold and the steering angle threshold as an example.
  • the actual example can also be applied to the pitch angle difference threshold and the steering angle difference threshold, as follows:
  • the light-emitting unit includes a first group of light-emitting units 501 and a second group of light-emitting units 502, and a first group of light-emitting units.
  • the second group of light-emitting units respectively comprise a plurality of light-emitting unit groups, namely, LED1 light group, LED2 light group, LED3 light group, LED4 light group, LED5 light group, and the first group of light-emitting units includes LED1 light group, LED2 light group, LED3
  • the light group, the second group of light-emitting units comprises an LED4 lamp group, an LED2 lamp group, an LED5 lamp group, an LED1 lamp group, an LED2 lamp group, an LED3 lamp group, an LED4 lamp group, and an LED5 lamp group each including a plurality of LED lamps.
  • the balance state of the vehicle body can also be determined by the light-emitting area of the light-emitting unit. This embodiment details the determination of the light-emitting area To explain.
  • FIG. 7 is a schematic diagram showing the display of the balance state of the vehicle body in the LCD liquid crystal display interface according to the embodiment of the present invention; as shown in FIG. 7, a solid circular pattern is drawn on the LCD liquid crystal screen to simulate the bubble of the level, according to the brightness of the LED lamp or The area of illumination changes the size and diameter of the circular pattern.
  • the drawing formula of the solid circular pattern in this embodiment is as follows:
  • Xd is the X-axis coordinate of the center of the solid circle
  • Yd is the Y-axis coordinate of the center of the solid circle
  • ⁇ d is the diameter of the solid circle.
  • K1, K2, K3, K4, and K5 are constants that are customized according to experience and LCD resolution.
  • the liquid crystal display interface can be defined as a four quadrant, and the counterclockwise is the first quadrant, the second quadrant, the third quadrant, and the fourth quadrant respectively, and the circular pattern is in the quadrant position by the light emitting area or the brightness of the light emitting unit. Definition.
  • the forward tilt angle of the vehicle body exceeds the forward tilt angle threshold
  • the right steering angle of the handle exceeds the right steering angle threshold
  • the forward tilt angle of the vehicle body exceeds the forward tilt angle threshold, and the left steering angle of the handle exceeds the left steering angle threshold, and is in an unbalanced state.
  • the vehicle body reclining angle exceeds the reclining angle threshold, and the left steering angle of the handle exceeds the left steering angle threshold.
  • the vehicle body reclining angle exceeds the reclining angle threshold, and the right steering angle of the handle exceeds the right steering angle threshold, and is in an unbalanced state.
  • the front and rear elevation angles of the vehicle body do not exceed the front and rear elevation angle thresholds, but the right steering angle of the handle exceeds the right steering angle threshold.
  • the front and rear elevation angles of the vehicle body do not exceed the front and rear elevation angle thresholds, but the left steering angle of the handle exceeds the left steering angle threshold and is in an unbalanced state.
  • the forward tilt angle of the vehicle body exceeds the forward tilt angle threshold, but the left and right steering angles of the handle exceed the left and right steering angle thresholds, and are in an unbalanced state.
  • the vehicle body reclining angle exceeds the reclining angle threshold, but the left and right steering angles of the handle exceed the left and right steering angle thresholds, and are in an unbalanced state.
  • the front and rear elevation angles of the car body do not exceed the front and rear elevation angle thresholds, and the left and right steering angles of the handlebars do not exceed the left and right steering angle thresholds. At this time, the car body is actually in equilibrium.
  • circular pattern in FIG. 6 may also be replaced by other shape patterns such as a polygon.
  • FIG. 8 is a block diagram showing the functional structure of the dynamic balancing vehicle according to the seventh embodiment of the present invention; as shown in FIG. 8 , it may specifically include: an attitude sensor 701, a steering sensor 702, a driving unit 703, and a lighting unit 704. among them:
  • the attitude sensor 701 and the steering sensor 702 are respectively used for monitoring the pitch angle and the steering angle of the vehicle body;
  • the driving unit 703 is configured to generate a driving signal according to the monitored pitch angle and the steering angle to drive the plurality of light emitting units 704 to emit light;
  • the 704 is configured to emit light according to the driving signal regularly to simulate the pitch angle and the body balance state corresponding to the steering angle.
  • a human-computer interaction interface may be further included for displaying the regular state of the illumination of the illumination unit in real time to present the simulated vehicle body balance state to the driver.
  • the human-computer interaction interface can be an LCD liquid crystal display interface.
  • the lighting unit 704 is regularly arranged at the pedal position of the dynamic balance vehicle according to the vehicle body balance state corresponding to the pitch angle and the steering angle.
  • the first group of light emitting units 714 and the second group of light emitting units 724 are respectively arranged according to the simulated pitch state and the steering state.
  • LED1, LED2, and LED3 constitute a first group of light emitting units
  • LED4, LED2 and LED5 constitute a second group of light emitting units.
  • the driving unit 703 generates a plurality of independent first group driving signals, driving the lighting units in the first group of lighting units to emit light by selectively generating driving signals of different sizes, and regularly adjusting the LEDs in the lighting unit. Brightness.
  • the lighting unit comprises a first group of lighting units and a second group of lighting units
  • the first group of lighting units further comprises a plurality of groups of lighting units, each of which generates a first group of driving signals including a driving signal
  • the driving signal By selectively sharing the driving signal between the partial lighting unit groups in the first group of light emitting units, a certain number of LEDs in the light emitting unit group are regularly adjusted to emit light, thereby adjusting the light emitting brightness or the light emitting area of the entire light emitting unit.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Human Computer Interaction (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Lighting Device Outwards From Vehicle And Optical Signal (AREA)

Abstract

A method for detecting the balance of a car body, a control method of the balance state of the car body and a dynamic balance car. The method for detecting the balance of a car body comprises: monitoring the pitching angle and the steering angle of the car body respectively by an attitude sensor and a steering sensor; generating driving signals to drive a plurality of light-emitting units to emit light according to the monitored pitching angle and steering angle; driving the plurality of light-emitting units to regularly emit light according to the driving signals to simulate the balance state of the car body corresponding to the pitching angle and the steering angle. The control method of the balance state of the car body uses the simulated balance state of the car body obtained by the method for detecting the balance of the car body to adjust the pitching and steering attitudes of the car body. The dynamic balance car can enable a passenger to master the balance state of the car body in real time, and get into a dynamic balance steady attitude DBSA from the current attitude CA quickly and effectively to prevent the car from damaging the surrounding objects or people as much as possible.

Description

检测车体平衡的方法、车体平衡状态的控制方法及动平衡车Method for detecting vehicle body balance, control method for vehicle body balance state, and dynamic balance vehicle 技术领域Technical field
本发明属于动平衡车技术领域,具体地说,涉及一种检测车体平衡的方法、车体平衡状态的控制方法及动平衡车。The invention belongs to the technical field of dynamic balance vehicles, and in particular to a method for detecting vehicle body balance, a control method for a vehicle body balance state, and a dynamic balance vehicle.
背景技术Background technique
动平衡车辆直接利用电能作为动力,并通过感测车身的姿势状态,通过高速处理器计算出控制指令,驱动马达来移动车身。动平衡车辆在工作状态时根据车辆姿态的变化,实时动态高频率地调整车身姿态,以保持车辆的动态平衡;当动平衡车辆不处于工作状态时,则无法调整车身姿态进而也就无法保持自身动态平衡。The dynamic balance vehicle directly uses electric energy as power, and by sensing the posture state of the vehicle body, the control command is calculated by the high speed processor, and the motor is driven to move the vehicle body. When the dynamic balance vehicle is in the working state, according to the change of the vehicle attitude, the vehicle body posture is dynamically and frequently adjusted in real time to maintain the dynamic balance of the vehicle; when the dynamic balance vehicle is not in the working state, the vehicle body posture cannot be adjusted and the vehicle posture cannot be maintained. dynamic equilibrium.
在动态平衡调节过程中,为了迅速响应用户的操作,动平衡车辆通常必须迅速从当前姿态(current attitude,简称CA)进入动平衡稳态(Dynamic Balance Steady Attitude,DBSA)调整车身的姿态,调整车体的俯仰角度和转向角度,以保持乘员和车辆处于动平衡状态,不至于摔倒。该调整车身姿态的时间很短比如通常小于500ms,且这个过程中俯仰角度和转向角度改变不能过大,否则一旦改变过大,则会造成车辆的剧烈动作,迅速移动或转向,可能对周围的物体或者人员造成伤害。In the process of dynamic balance adjustment, in order to respond quickly to the user's operation, the dynamic balance vehicle usually has to quickly adjust the posture of the vehicle body from the current attitude (CA) to the Dynamic Balance Steady Attitude (DBSA). The pitch angle and steering angle of the body to keep the occupant and the vehicle in a dynamic state and not fall. The time for adjusting the posture of the vehicle body is very short, for example, usually less than 500ms, and the pitch angle and the steering angle cannot be changed too much in this process. Otherwise, if the change is too large, the vehicle will be strenuously moved, moved quickly or turned, and may be around. Object or person causes damage.
现有技术中方法使动平衡车从当前姿态(current attitude,简称CA)进入动平衡稳态(Dynamic Balance Steady Attitude,DBSA)的实现方法包括:The prior art method enables the dynamic balance vehicle to enter the dynamic balance Steady Attitude (DBSA) from the current attitude (CA), including:
1)不检测乘员是否上车,只要动平衡车辆开机时即立即进入动平衡稳态DBSA,但是这种方法由于动平衡车辆开机时立即迅速从当前姿态CA进入动平衡稳态DBSA,车身状态调整的过度时间太短,车辆容易迅速移动或转向,可能对周围的物体或者人员造成伤害。1) It is not detected whether the occupant gets on the train. As long as the dynamic balance vehicle starts up, it immediately enters the dynamic balance steady-state DBSA. However, this method quickly enters the dynamic balance steady-state DBSA from the current attitude CA immediately after the dynamic balancing vehicle is turned on, and the vehicle body state is adjusted. The excessive time is too short, and the vehicle is easy to move or turn quickly, which may cause damage to surrounding objects or people.
2)不检测乘员是否上车,延长动平衡车辆从当前姿态进入动平衡稳态DBSA的时间比如大于2s,以降低车辆在此过程中移动的速度和角度变化,降低安全危险。但是,该方法中,如果乘员已经上车而车辆还没有完全进入动平衡稳态DBSA,车辆可能失去平衡而导致乘员摔倒受伤。2) It is not detected whether the occupant gets on the vehicle or not, and the time for the dynamic balance vehicle to enter the dynamic balance steady state DBSA from the current posture is more than 2 s, for example, to reduce the speed and angle change of the vehicle moving in the process, thereby reducing the safety hazard. However, in this method, if the occupant has got on the vehicle and the vehicle has not fully entered the dynamic balance steady state DBSA, the vehicle may lose balance and cause the occupant to fall and be injured.
发明人在实现本发明的过程中发现,无论是上述那种方式,其原因是乘员在动平衡车辆从当前姿态CA进入动平衡稳态DBSA,无法直观的了解车身平衡状态,未参与到动平衡稳态的调整。因此,亟待提供一种技术方案,使乘员参与到动平衡稳态调整的过程中,实时掌握车体的平衡状态,快速有效地从当前 姿态CA进入动平衡稳态DBSA,尽可能地避免车辆对周围的物体或者人员造成伤害。The inventor found in the process of implementing the present invention that, in the above manner, the reason is that the occupant enters the dynamic balance steady state DBSA from the current posture CA in the dynamic balance vehicle, and cannot intuitively understand the balance state of the vehicle body, and does not participate in the dynamic balance. Steady state adjustment. Therefore, it is urgent to provide a technical solution for the occupant to participate in the process of dynamic balance steady state adjustment, real-time grasp of the balance state of the vehicle body, and quickly and effectively from the current The attitude CA enters the dynamic balance steady-state DBSA, avoiding the damage to the surrounding objects or personnel as much as possible.
发明内容Summary of the invention
鉴于上述问题,提出了本发明以便提供一种克服上述问题或者至少部分地解决上述问题的检测车体平衡的方法、车体平衡状态的控制方法以及动平衡车。In view of the above problems, the present invention has been made in order to provide a method for detecting vehicle body balance, a vehicle body balance state control method, and a dynamic balance vehicle that overcome the above problems or at least partially solve the above problems.
依据本发明的一个方面,提供了一种检测车体平衡的方法,其包括:According to one aspect of the invention, a method of detecting vehicle body balance is provided, comprising:
姿态传感器和转向传感器分别监测车体的俯仰角度以及转向角度;The attitude sensor and the steering sensor respectively monitor the pitch angle and the steering angle of the vehicle body;
根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元发光;Generating a driving signal to drive the plurality of light emitting units to emit light according to the monitored pitch angle and the steering angle;
根据驱动信号驱动多个发光单元规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态。The plurality of light emitting units are regularly illuminated according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle.
优选地,在本发明的一实施例中,根据驱动信号驱动多个发光单元规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态包括:Preferably, in an embodiment of the invention, driving the plurality of illumination units to regularly emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle comprises:
根据驱动信号分别驱动多个发光单元发光,并按照所述俯仰角度和转向角度,规律性调整多个发光单元的发光面积,以模拟车体平衡状态。The plurality of light emitting units are respectively driven to emit light according to the driving signal, and the light emitting areas of the plurality of light emitting units are regularly adjusted according to the pitch angle and the steering angle to simulate a vehicle body balance state.
优选地,在本发明的一实施例中,根据驱动信号驱动多个发光单元规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态包括:Preferably, in an embodiment of the invention, driving the plurality of illumination units to regularly emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle comprises:
根据驱动信号分别驱动多个发光单元发光,并按照所述俯仰角度和转向角度,规律性调整多个发光单元的亮度,以模拟车体平衡状态。The plurality of light emitting units are respectively driven to emit light according to the driving signal, and the brightness of the plurality of light emitting units is regularly adjusted according to the pitch angle and the steering angle to simulate a vehicle body balance state.
优选地,在本发明的一实施例中,根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动发光单元发光包括:Preferably, in an embodiment of the invention, generating a driving signal to drive the lighting unit to emit light according to the monitored pitch angle and the steering angle comprises:
根据监测到的俯仰角度,生成第一组驱动信号,所述第一组驱动信号包括第一驱动信号,以驱动模拟俯仰状态的第一组发光单元中多个发光单元发光;Generating, according to the monitored pitch angle, a first group of driving signals, the first group of driving signals including a first driving signal to drive the plurality of lighting units of the first group of lighting units in the analog pitch state to emit light;
根据监测到的转向角度,生成第二组驱动信号,所述第二组驱动信号包括第二驱动信号,以驱动模拟转向状态的第二组发光单元中多个发光单元发光。And generating, according to the monitored steering angle, a second set of driving signals, the second group of driving signals including a second driving signal to drive the plurality of lighting units of the second group of lighting units in the analog steering state to emit light.
优选地,在本发明的一实施例中,还包括:预先设定俯仰角度阈值和转向角度阈值;所述根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元发光包括:根据监测到的俯仰角度及俯仰角度阈值,转向角度及转向角度阈值,生成驱动信号,以驱动多个发光单元发光。Preferably, in an embodiment of the present invention, the method further includes: setting a pitch angle threshold and a steering angle threshold in advance; generating, according to the monitored pitch angle and the steering angle, driving signals to drive the plurality of light emitting units to include According to the monitored pitch angle and pitch angle threshold, the steering angle and the steering angle threshold, a driving signal is generated to drive the plurality of light emitting units to emit light.
优选地,在本发明的一实施例中,还包括:在人机交互界面中实时显示发光单元发光的规律性状态,以向驾驶者呈现模拟的车体平衡状态。Preferably, in an embodiment of the present invention, the method further includes displaying, in a human-computer interaction interface, a regular state of illumination of the illumination unit in real time to present a simulated vehicle body balance state to the driver.
根据本发明的另一方面,提供了一种车体平衡状态的控制方法,其包括: 根据上述任意所述方法获得的模拟车体平衡状态,调整车体的俯仰以及转向姿态。According to another aspect of the present invention, a method of controlling a vehicle body balance state is provided, which includes: According to the simulated vehicle body balance state obtained by any of the above methods, the pitch and steering attitude of the vehicle body are adjusted.
根据本发明的再一方面,提供了动平衡车,其包括:姿态传感器、转向传感器、驱动单元、发光单元,姿态传感器和转向传感器分别用于监测车体的俯仰角度以及转向角度;驱动单元用于根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元发光;发光单元用于根据驱动信号规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态。According to still another aspect of the present invention, a dynamic balance vehicle is provided, comprising: an attitude sensor, a steering sensor, a driving unit, an illumination unit, an attitude sensor and a steering sensor for respectively monitoring a pitch angle and a steering angle of the vehicle body; And generating a driving signal to drive the plurality of lighting units to emit light according to the monitored pitch angle and the steering angle; and the lighting unit is configured to periodically emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle.
优选地,在本发明的一实施例中,还包括:人机交互界面,用于实时显示发光单元发光的规律性状态,以向驾驶者呈现模拟的车体平衡状态。Preferably, in an embodiment of the present invention, the method further includes: a human-machine interaction interface for displaying a regular state of the illumination of the illumination unit in real time to present the simulated vehicle body balance state to the driver.
优选地,在本发明的一实施例中,所述发光单元根据模拟所述俯仰角度以及转向角度对应的车体平衡状态有规律地布置在动平衡车的踏板位置处。Preferably, in an embodiment of the invention, the lighting unit is regularly arranged at the pedal position of the balance vehicle according to the vehicle body balance state corresponding to the pitch angle and the steering angle.
与现有的方案相比,由于通过姿态传感器和转向传感器分别监测车体的俯仰角度以及转向角度;再根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元发光;最后,根据驱动信号驱动多个发光单元规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态,从而使乘员实时掌握车体的平衡状态,快速有效地从当前姿态CA进入动平衡稳态DBSA,尽可能地避免车辆对周围的物体或者人员造成伤害。Compared with the existing solution, the pitch angle and the steering angle of the vehicle body are respectively monitored by the attitude sensor and the steering sensor; and the driving signal is generated according to the monitored pitch angle and the steering angle to drive the plurality of light emitting units to emit light; Driving a plurality of illumination units to regularly emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle, so that the occupant can grasp the balance state of the vehicle body in real time, and quickly and effectively enter the dynamic balance from the current posture CA. Steady-state DBSA, as far as possible to avoid damage to the surrounding objects or people.
上述说明仅是本发明技术方案的概述,为了能够更清楚了解本发明的技术手段,而可依照说明书的内容予以实施,并且为了让本发明的上述和其它目的、特征和优点能够更明显易懂,以下特举本发明的具体实施方式。The above description is only an overview of the technical solutions of the present invention, and the above-described and other objects, features and advantages of the present invention can be more clearly understood. Specific embodiments of the invention are set forth below.
附图说明DRAWINGS
通过阅读下文优选实施方式的详细描述,各种其他的优点和益处对于本领域普通技术人员将变得清楚明了。本实施例的附图仅用于示出优选实施方式的目的,而并不认为是对本发明的限制。而且在整个附图中,用相同的参考符号表示相同的部件。在附图中:Various other advantages and benefits will become apparent to those skilled in the art from a The drawings of the present embodiments are only for the purpose of illustrating the preferred embodiments and are not intended to limit the invention. Throughout the drawings, the same reference numerals are used to refer to the same parts. In the drawing:
图1为本发明实施例一检测车体平衡的方法流程示意图;。1 is a schematic flow chart of a method for detecting balance of a vehicle body according to an embodiment of the present invention;
图2为本发明实施例二生成驱动信号的流程示意图;2 is a schematic flowchart of generating a driving signal according to Embodiment 2 of the present invention;
图3为本发明实施例三检测车体平衡的方法流程示意图;3 is a schematic flow chart of a method for detecting vehicle body balance according to Embodiment 3 of the present invention;
图4为本发明实施例四检测车体平衡的方法一详细流程示意图4 is a schematic flow chart of a method for detecting balance of a vehicle body according to Embodiment 4 of the present invention;
图5为本发明实施例四发光单元的规律性布置示意图;FIG. 5 is a schematic diagram showing the regular arrangement of four light emitting units according to an embodiment of the present invention; FIG.
图6为本发明实施例五发光单元的规律性布置示意图;6 is a schematic diagram showing a regular arrangement of five light emitting units according to an embodiment of the present invention;
图7为本发明实施例六LCD液晶显示界面中车体平衡状态的显示示意图;7 is a schematic diagram showing display of a vehicle body balance state in an LCD liquid crystal display interface according to an embodiment of the present invention;
图8为本发明实施例七动平衡车的功能结构框图。 FIG. 8 is a block diagram showing the functional structure of a dynamic balance vehicle according to an embodiment of the present invention.
具体实施方式detailed description
下面将参照附图更详细地描述本公开的示例性实施例。虽然附图中显示了本公开的示例性实施例,然而应当理解,可以以各种形式实现本公开而不应被这里阐述的实施例所限制。相反,提供这些实施例是为了能够更透彻地理解本公开,并且能够将本公开的范围完整的传达给本领域的技术人员。Exemplary embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. While the embodiments of the present invention have been shown in the drawings, the embodiments Rather, these embodiments are provided so that this disclosure will be more fully understood and the scope of the disclosure will be fully disclosed.
本发明下述实施例中,由于通过姿态传感器和转向传感器分别监测车体的俯仰角度以及转向角度;再根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元发光;最后,根据驱动信号驱动多个发光单元规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态,从而使乘员实时掌握车体的平衡状态,快速有效地从当前姿态CA进入动平衡稳态DBSA,尽可能地避免车辆对周围的物体或者人员造成伤害。In the following embodiments of the present invention, the pitch angle and the steering angle of the vehicle body are separately monitored by the attitude sensor and the steering sensor; and the driving signal is generated according to the monitored pitch angle and the steering angle to drive the plurality of light emitting units to emit light; Driving a plurality of illumination units to regularly emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle, so that the occupant can grasp the balance state of the vehicle body in real time, and quickly and effectively enter the dynamic balance from the current posture CA. Steady-state DBSA, as far as possible to avoid damage to the surrounding objects or people.
本发明下述实施例提供的检测车体平衡的方法,其核心思想在于包括如下步骤:The core idea of the method for detecting vehicle body balance provided by the following embodiments of the present invention is to include the following steps:
姿态传感器和转向传感器分别监测车体的俯仰角度以及转向角度;The attitude sensor and the steering sensor respectively monitor the pitch angle and the steering angle of the vehicle body;
根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元发光;Generating a driving signal to drive the plurality of light emitting units to emit light according to the monitored pitch angle and the steering angle;
根据驱动信号驱动多个发光单元规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态。The plurality of light emitting units are regularly illuminated according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle.
图1为本发明实施例一检测车体平衡的方法流程示意图;如图1所示,其具体可以包括:FIG. 1 is a schematic flowchart of a method for detecting a balance of a vehicle body according to an embodiment of the present invention; as shown in FIG. 1 , the method may specifically include:
S101、姿态传感器和转向传感器分别监测车体的俯仰角度以及转向角度;S101, an attitude sensor and a steering sensor respectively monitor a pitch angle and a steering angle of the vehicle body;
本实施例中,俯仰角度可以指车体前后仰斜的不同状态,而转向角度可以指车体左右转向的不同状态。俯仰角度包括前倾角、后仰角,转向角度包括左转向角度、右转向角度。In this embodiment, the pitch angle may refer to different states of the vehicle body tilting forward and backward, and the steering angle may refer to different states of the vehicle body turning left and right. The pitch angle includes a forward tilt angle and a rear elevation angle, and the steering angle includes a left steering angle and a right steering angle.
本实施例中,姿态传感器可以根据产品的实际结构设计,固定在车体的重心位置处。姿态传感器可以包括陀螺仪以及加速度计。陀螺仪来跟踪车辆沿着X和Y轴的旋转即车体的角度,加速度计测量沿加速度和角速度。在具体产品应用中,可以使用三轴陀螺仪和三轴加速度计。根据车体的角度、车体的加速度以及角速度计算车体的俯仰角度。In this embodiment, the attitude sensor can be designed according to the actual structure of the product and fixed at the center of gravity of the vehicle body. The attitude sensor can include a gyroscope and an accelerometer. The gyroscope tracks the rotation of the vehicle along the X and Y axes, ie the angle of the car body, and the accelerometer measures the acceleration along the angular velocity. Three-axis gyroscopes and three-axis accelerometers are available for specific product applications. The pitch angle of the vehicle body is calculated according to the angle of the vehicle body, the acceleration of the vehicle body, and the angular velocity.
本实施例中,转向传感器耦接在转向装置上,转向传感器可以是电位器或者霍尔传感器。In this embodiment, the steering sensor is coupled to the steering device, and the steering sensor may be a potentiometer or a Hall sensor.
如果是电位器的话,由于在平衡车转向的过程中,电位器的电刷会沿着电位器的电阻体移动,从而获得与位移量对应的电阻变化、电流变化,据此获得 车体的转向角度。If it is a potentiometer, since the brush of the potentiometer moves along the resistor body of the potentiometer during the steering of the balance car, the resistance change and the current change corresponding to the displacement amount are obtained, thereby obtaining The steering angle of the car body.
如果是霍尔传感器的话,在转向过程中,霍尔传感器在磁场中运动,输出了霍尔电压,以根据所述霍尔电压确定所述转向机构的转向角度。In the case of a Hall sensor, during the steering, the Hall sensor moves in the magnetic field, and a Hall voltage is output to determine the steering angle of the steering mechanism based on the Hall voltage.
S102、根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元发光;S102. Generate a driving signal to drive the plurality of light emitting units to emit light according to the monitored pitch angle and the steering angle.
本实施例中,步骤S102的具体流程示意图可以如图2所示,图2为本发明实施例二生成驱动信号的流程示意图,其具体可以包括:In this embodiment, the specific flow chart of step S102 can be as shown in FIG. 2. FIG. 2 is a schematic flowchart of generating a driving signal according to Embodiment 2 of the present invention, which may specifically include:
S112、根据监测到的俯仰角度,生成第一组驱动信号,所述第一组驱动信号包括第一驱动信号,以驱动模拟俯仰状态的第一组发光单元中多个发光单元发光;S112. Generate, according to the monitored pitch angle, a first group of driving signals, where the first group of driving signals includes a first driving signal to drive the plurality of lighting units of the first group of lighting units in the analog pitch state to emit light;
S122、根据监测到的转向角度,生成第二组驱动信号,所述第二组驱动信号包括第二驱动信号,以驱动模拟转向状态的第二组发光单元中多个发光单元发光。S122. Generate a second group of driving signals according to the monitored steering angle, where the second group of driving signals includes a second driving signal to drive the plurality of lighting units of the second group of lighting units in the analog steering state to emit light.
在本实施例中,在竖直方向上设置第一组发光单元,以根据车体的俯仰角度模拟车体的前后仰斜状态,在水平方向上设置第二组发光单元,以根据车体的转向角度模拟车体的左右转向状态。因此,在生成驱动信号时,分别生成驱动第一组发光单元的第一组驱动信号,驱动第二组发光单元的第二组驱动信号。需要说明的是,第一组发光单元和第二组发光单元中包括的发光单元包括的LED并无具体限定,比如是3个或5个等等。In this embodiment, the first group of light emitting units are disposed in a vertical direction to simulate a front and rear tilting state of the vehicle body according to a pitch angle of the vehicle body, and a second group of light emitting units are disposed in a horizontal direction according to the body of the vehicle body. The steering angle simulates the left and right steering state of the vehicle body. Therefore, when generating the driving signal, a first group of driving signals for driving the first group of light emitting units are respectively generated, and a second group of driving signals for the second group of light emitting units are driven. It should be noted that the LEDs included in the first group of the light-emitting units and the second group of the light-emitting units are not specifically limited, such as three or five.
需要说明的是,第一组驱动信号可以包括若干个独立的驱动信号,以对第一组发光单元中的每个发光单元一一驱动。第二组驱动信号也可以包括若干个独立的驱动信号,以对第二组发光单元中的每个发光单元一一驱动。It should be noted that the first group of driving signals may include a plurality of independent driving signals to drive each of the first group of lighting units one by one. The second set of drive signals may also include a plurality of independent drive signals to drive each of the second set of illumination units one by one.
需要说明的是,第一组驱动信号也可以只包括一个驱动信号,该驱动信号在第一组发光单元中的各发光单元之间共用。第二组驱动信号也可以只包括一个驱动信号,该驱动信号在第二组发光单元中的各发光单元之间共用。It should be noted that the first group of driving signals may also include only one driving signal, and the driving signals are shared between the respective lighting units in the first group of lighting units. The second set of drive signals may also include only one drive signal that is shared between the light-emitting units of the second set of light-emitting units.
S103、根据驱动信号分别驱动多个发光单元发光,并按照所述俯仰角度和转向角度,规律性调整多个发光单元的发光面积,以模拟车体平衡状态。S103. The plurality of light emitting units are respectively driven to emit light according to the driving signal, and the light emitting areas of the plurality of light emitting units are regularly adjusted according to the pitch angle and the steering angle to simulate a vehicle body balance state.
本实施例中,参见上述步骤S102,如果生成多个独立的第一组驱动信号,通过有选择地生成部分驱动信号,以有选择地驱动第一组发光单元中的部分发光单元组发光,有规律地调整发光单元组中某几个LED进行发光,从而调整发光单元的发光面积。In this embodiment, referring to step S102 above, if a plurality of independent first group driving signals are generated, selectively driving a partial driving signal to selectively drive a part of the first group of light emitting units to emit light. Regularly adjusting a certain number of LEDs in the light-emitting unit group to emit light, thereby adjusting the light-emitting area of the light-emitting unit.
如果生成包括一个驱动信号的第一组驱动信号,通过有选择地在第一组发光单元中的部分发光单元组之间公用该驱动信号,规律地调整发光单元组中某几个LED进行发光,从而调整发光单元的发光面积。 If a first group of driving signals including a driving signal is generated, by selectively sharing the driving signals between the partial lighting unit groups in the first group of lighting units, a plurality of LEDs in the group of lighting units are regularly adjusted to emit light, Thereby, the light-emitting area of the light-emitting unit is adjusted.
对于第二组发光单元的驱动可以参照上述对第一组发光单元的驱动,详细不再赘述。For the driving of the second group of light-emitting units, reference may be made to the above-mentioned driving of the first group of light-emitting units, and details are not described herein again.
图3为本发明实施例三检测车体平衡的方法流程示意图;如图3所示,其具体可以包括:FIG. 3 is a schematic flowchart of a method for detecting a balance of a vehicle body according to a third embodiment of the present invention; as shown in FIG. 3, the method may specifically include:
S301、姿态传感器和转向传感器分别监测车体的俯仰角度以及转向角度;S301, an attitude sensor and a steering sensor respectively monitor a pitch angle and a steering angle of the vehicle body;
S302、根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元发光;S302. Generate a driving signal according to the monitored pitch angle and the steering angle to drive the plurality of light emitting units to emit light;
有关步骤S301-S302详细可参见上述图1所示的实施例,在此不再赘述。For details about the steps S301-S302, refer to the embodiment shown in FIG. 1 above, and details are not described herein again.
S303、根据驱动信号分别驱动多个发光单元发光,并按照所述俯仰角度和转向角度,规律性调整多个发光单元的发光亮度,以模拟车体平衡状态。S303. The plurality of light emitting units are respectively driven to emit light according to the driving signal, and the light emitting brightness of the plurality of light emitting units is regularly adjusted according to the pitch angle and the steering angle to simulate a vehicle body balance state.
与上述图1所示实施例不同的是,本实施例是通过规律性的调整发光单元的发光亮度,模拟车体平衡状态。Different from the embodiment shown in FIG. 1 above, this embodiment simulates the vehicle body balance state by regularly adjusting the light-emitting brightness of the light-emitting unit.
本实施例中,参见上述步骤S102,如果生成多个独立的第一组驱动信号,通过有选择地生成大小不同的驱动信号,驱动第一组发光单元中的发光单元发光,有规律地调整发光单元中LED的亮度。In this embodiment, referring to the above step S102, if a plurality of independent first group driving signals are generated, the driving units in the first group of lighting units are driven to emit light by selectively generating driving signals of different sizes, and the lighting is regularly adjusted. The brightness of the LEDs in the unit.
如果生成包括一个驱动信号的第一组驱动信号,通过有选择地在第一组发光单元中的部分发光单元组之间公用该驱动信号,规律地调整发光单元组中某几个LED进行发光,从而调整整个发光单元的发光亮度。If a first group of driving signals including a driving signal is generated, by selectively sharing the driving signals between the partial lighting unit groups in the first group of lighting units, a plurality of LEDs in the group of lighting units are regularly adjusted to emit light, Thereby, the luminance of the entire illumination unit is adjusted.
对于第二组发光单元的驱动可以参照上述对第一组发光单元的驱动,详细不再赘述。For the driving of the second group of light-emitting units, reference may be made to the above-mentioned driving of the first group of light-emitting units, and details are not described herein again.
如果是两轮的动平衡车的话,乘员一般都是双手握把处于站立姿势,因此,为了便于乘员便捷地观察到车体的平衡状态,可以在上述图1所示实施例一或图3所示实施例三的基础上,形成另一实施例,其包括了增加的步骤:在人机交互界面中实时显示发光单元发光的规律性状态,以向驾驶者呈现模拟的车体平衡状态。该步骤可以在步骤S103或者步骤S303之后执行。If it is a two-wheeled dynamic balance car, the occupant generally has the two-hand grip in the standing position. Therefore, in order to facilitate the occupant to conveniently observe the balance state of the vehicle body, the first embodiment or the first embodiment shown in FIG. 1 can be used. Based on the third embodiment, another embodiment is formed, which includes an additional step of displaying the regular state of the illumination of the illumination unit in real time in the human-computer interaction interface to present the simulated vehicle body balance state to the driver. This step can be performed after step S103 or step S303.
在具体实施时,该人机交互界面可以是一LCD液晶显示界面,在该界面中显示一实心圆形图案,模拟水平尺的液泡。In a specific implementation, the human-computer interaction interface may be an LCD liquid crystal display interface, in which a solid circular pattern is displayed to simulate a bubble of a horizontal ruler.
为了向乘员提供车体平衡状态调整的参考,可以在上述图1所示实施例一或图3所示的实施例三的基础上,形成另外一实施例,其包括增加了的步骤:预先设定俯仰角度阈值和转向角度阈值;该步骤可以在步骤S101或者S301之前。In order to provide the occupant with a reference for adjusting the vehicle body balance state, another embodiment may be formed on the basis of the first embodiment shown in FIG. 1 or the third embodiment shown in FIG. 3, which includes the added steps: pre-set The pitch angle threshold and the steering angle threshold are determined; this step may precede step S101 or S301.
本实施例中,俯仰角度阈值和转向角度阈值可以指车体处于自平衡状态时的俯仰角度和转向角度。In this embodiment, the pitch angle threshold and the steering angle threshold may refer to a pitch angle and a steering angle when the vehicle body is in a self-balancing state.
当设定了俯仰角度阈值和转向角度阈值后,在本实施例中在生成驱动信号 时,根据监测到的俯仰角度及俯仰角度阈值,转向角度及转向角度阈值,生成驱动信号,以驱动多个发光单元规律性的发光。When the pitch angle threshold and the steering angle threshold are set, the driving signal is generated in this embodiment. At the time, according to the monitored pitch angle and pitch angle threshold, the steering angle and the steering angle threshold, a driving signal is generated to drive the regular illumination of the plurality of illumination units.
俯仰角度阈值包括前倾角度阈值和后仰角度阈值,转向角度阈值包括左转向角度阈值和右转向角度阈值。俯仰角度阈值和转向角度阈值可以根据车辆的惯量、动力学模型和实验经验值进行设置。The pitch angle threshold includes a forward tilt angle threshold and a backward tilt angle threshold, and the steering angle threshold includes a left steering angle threshold and a right steering angle threshold. The pitch angle threshold and the steering angle threshold can be set based on the vehicle's inertia, dynamics model, and experimental experience values.
为了向乘员提供车体平衡状态调整的参考,可以在上述图1所示实施例一或图3所示的实施例三的基础上,形成再一实施例,其包括增加了的步骤:预先设定俯仰角度差值阈值和转向角度差值阈值;该步骤可以在步骤S101或者S301之前。In order to provide the occupant with a reference for adjusting the body balance state, a further embodiment may be formed on the basis of the first embodiment shown in FIG. 1 or the third embodiment shown in FIG. 3, which includes the added steps: pre-set The pitch angle difference threshold and the steering angle difference threshold are determined; this step may be before step S101 or S301.
俯仰角度差值Δp是指实时监测到的俯仰角度与车体完全处于自平衡状态时的俯仰角度之间的差值,俯仰角度差值包括前倾角度差值和后仰角度差值阈值,转向角度差值Δr是指实时监测到的转向角度与车体完全处于自平衡状态时的转向角度之间的差值,包括左转向角度差值和右转向角度差值。俯仰角度差值阈值Δps指如果车体处于动平衡状态时监测到的俯仰角度与车体完全处于自平衡状态时俯仰角度的理论差值。转向角度差值阈值Δrs指如果车体处于动平衡状态时监测到的转向角度与车体完全处于自平衡状态时转向角度的理论差值。俯仰角度差值和转向角度差值阈值可以根据车辆的惯量、动力学模型和实验经验值进行设置。The pitch angle difference Δp is the difference between the pitch angle detected in real time and the pitch angle when the vehicle body is completely in the self-balancing state. The pitch angle difference includes the forward tilt angle difference and the backward tilt angle difference threshold, and the steering The angle difference Δr is the difference between the steering angle detected in real time and the steering angle when the vehicle body is completely in the self-balancing state, including the left steering angle difference and the right steering angle difference. The pitch angle difference threshold Δps is the theoretical difference between the pitch angle detected when the vehicle body is in the dynamic balance state and the pitch angle when the vehicle body is completely in the self-balancing state. The steering angle difference threshold Δrs refers to the theoretical difference between the steering angle detected when the vehicle body is in the dynamic balance state and the steering angle when the vehicle body is completely in the self-balancing state. The pitch angle difference and the steering angle difference threshold can be set according to the vehicle's inertia, dynamics model, and experimental experience values.
在设置了阈值或者差值阈值之后,通过发光单元的规律性发光,使乘员可以直观地或者车体的平衡状态,以便实时调整车体的平衡状态,比如如果通过第一组发光单元的发光状态判断得知,俯仰角度中的前倾角超过了俯仰角度阈值中的前倾角阈值,则需要适当调整车辆后仰,减小前倾角。详细可参见后续实施例说明。After the threshold or the difference threshold is set, the occupant can intuitively or the balance state of the vehicle body through the regular illumination of the illumination unit, so as to adjust the balance state of the vehicle body in real time, such as if the illumination state of the first group of illumination units is passed. It is judged that the forward tilt angle in the pitch angle exceeds the forward tilt angle threshold in the pitch angle threshold, and the vehicle reclining needs to be appropriately adjusted to reduce the forward tilt angle. For details, refer to the description of the subsequent embodiments.
图4为本发明实施例四检测车体平衡的方法一详细流程示意图;详细请参见图4记载,在此不再重述。FIG. 4 is a schematic flow chart of a method for detecting the balance of a vehicle body according to Embodiment 4 of the present invention; for details, please refer to FIG. 4, and details are not repeated herein.
图5为本发明实施例四发光单元的规律性布置示意图;如图5所示,每一组发光单元包括一个LED灯,LED1、LED2、LED3指示车体的俯仰状态,LED4、LED2、LED5指示车体的转向状态。本实施例以设定俯仰角度阈值和转向角度阈值为例进行说明。5 is a schematic diagram showing the regular arrangement of four illumination units according to an embodiment of the present invention; as shown in FIG. 5, each group of illumination units includes an LED lamp, and LED1, LED2, and LED3 indicate the pitch state of the vehicle body, and LED4, LED2, and LED5 indicate The steering state of the car body. This embodiment will be described by taking the example of setting the pitch angle threshold and the steering angle threshold.
(1)当LED1亮度<LED2亮度<LED3亮度时,处于非平衡状态,指示车体前倾角度超过前倾角度阈值,乘员需将车体适当后仰;(1) When the brightness of LED1 <LED2 brightness <LED3 brightness, it is in a non-equilibrium state, indicating that the forward tilt angle of the vehicle body exceeds the forward tilt angle threshold, and the occupant needs to properly lean back the vehicle body;
(2)当LED1亮度>LED2亮度>LED3亮度时,处于非平衡状态,指示车体后仰角度超过后仰角度阈值,乘员需将车体适当前倾; (2) When LED1 brightness>LED2 brightness>LED3 brightness, it is in a non-equilibrium state, indicating that the vehicle body reclining angle exceeds the back-tilt angle threshold, and the occupant needs to lean forward properly;
(3)当LED4<LED2亮度<LED5亮度时,处于非平衡状态,指示手把左转向角度超过左转向角度阈值,乘员需将转向装置朝右侧调整;(3) When LED4<LED2 brightness <LED5 brightness, it is in a non-equilibrium state, indicating that the left steering angle of the handle exceeds the left steering angle threshold, and the occupant needs to adjust the steering device to the right;
(4)当LED4亮度>LED2亮度>LED5亮度时,处于非平衡状态,指示手把右转向角度超过右转向角度阈值,乘员需将转向装置朝左侧调整;(4) When LED4 brightness>LED2 brightness>LED5 brightness, it is in non-equilibrium state, indicating that the right steering angle of the handle exceeds the right steering angle threshold, and the occupant needs to adjust the steering device to the left side;
(5)五颗LED亮度越接近,表示俯仰角度和转向角度更接近其对应阈值,也就表明车体的当前姿态越接近动平衡稳态。(5) The closer the brightness of the five LEDs is, the more the pitch angle and the steering angle are closer to their corresponding thresholds, which means that the current attitude of the car body is closer to the steady state of the dynamic balance.
图5实施例在具体应用时,可以通过某个灯的熄灭来直观的进行上述判断:In the specific application of the embodiment of FIG. 5, the above judgment can be intuitively performed by extinguishing a certain lamp:
(1)LED1熄灭,LED2亮度<LED3亮度时,指示车体前倾角度超过前倾角度阈值,乘员需将车体适当后仰;(1) LED1 is extinguished, LED2 brightness <LED3 brightness, indicating that the vehicle body forward tilt angle exceeds the forward tilt angle threshold, the occupant needs to properly lean back the vehicle body;
(2)LED1亮度>LED2亮度,LED3熄灭,指示车体后仰角度超过后仰角度阈值,乘员需将车体适当前倾;(2) LED1 brightness>LED2 brightness, LED3 is off, indicating that the car body reclining angle exceeds the back-tilt angle threshold, the occupant needs to lean forward properly;
(3)LED4熄灭,LED2亮度<LED5亮度时,指示手把左转向角度超过左转向角度阈值,乘员需将转向装置朝右侧调整;(3) LED4 is extinguished, LED2 brightness <LED5 brightness, indicating that the left steering angle of the handle exceeds the left steering angle threshold, and the occupant needs to adjust the steering device to the right;
(4)当LED4亮度>LED2亮度,LED5熄灭,指示手把右转向角度超过右转向角度阈值,乘员需将转向装置朝左侧调整。(4) When LED4 brightness>LED2 brightness, LED5 goes out, indicating that the right steering angle of the handle exceeds the right steering angle threshold, the occupant needs to adjust the steering device to the left.
需要说明的是,上述图5的实施例具体以俯仰角度阈值和转向角度阈值为例进行说明,但是,其实际也可以应用于俯仰角度差值阈值和转向角度差值阈值,详细如下:It should be noted that the embodiment of FIG. 5 is specifically described by using the pitch angle threshold and the steering angle threshold as an example. However, the actual example can also be applied to the pitch angle difference threshold and the steering angle difference threshold, as follows:
(1)当LED1亮度<LED2亮度<LED3亮度时,指示车体前倾角度差值超过前倾角度差值阈值,乘员需将车体适当后仰;(1) When LED1 brightness <LED2 brightness <LED3 brightness, indicating that the vehicle body forward tilt angle difference exceeds the forward tilt angle difference threshold value, the occupant needs to properly lean back the vehicle body;
(2)当LED1亮度>LED2亮度>LED3,比如LED3灭时,指示车体后仰角度差值超过后仰角度差值阈值,乘员需将车体适当前倾;(2) When LED1 brightness>LED2 brightness>LED3, such as LED3 off, indicating that the vehicle body reclining angle difference exceeds the back-angle angle difference threshold, the occupant needs to lean forward properly;
(3)当LED4<LED2亮度<LED5亮度时,指示手把左转向角度差值超过左转向角度差值阈值,乘员需将转向装置朝右侧调整;(3) When LED4<LED2 brightness <LED5 brightness, indicating that the left steering angle difference of the handle exceeds the left steering angle difference threshold, the occupant needs to adjust the steering device to the right;
(4)当LED4亮度>LED2亮度>LED5亮度,指示手把右转向角度差值超过右转向角度差值阈值,乘员需将转向装置朝左侧调整;(4) When LED4 brightness>LED2 brightness>LED5 brightness, indicating that the right steering angle difference of the handle exceeds the right steering angle difference threshold, the occupant needs to adjust the steering device to the left side;
图6为本发明实施例五发光单元的规律性布置示意图;如图5所示,与上述图5不同,发光单元包括第一组发光单元501和第二组发光单元502,第一组发光单元和第二组发光单元又各自包括若干个发光单元组即LED1灯组、LED2灯组、LED3灯组、LED4灯组、LED5灯组,第一组发光单元包括LED1灯组、LED2灯组、LED3灯组,第二组发光单元包括LED4灯组、LED2灯组、LED5灯组,LED1灯组、LED2灯组、LED3灯组、LED4灯组、LED5灯组各自包括若干个LED灯,此时,除了可以通过上述图4说是的不同亮度来判断车体的平衡状态,也可以通过发光单元的发光面积判断车体的平衡状态。本实施例详细以发光面积的判断 来进行说明。6 is a schematic diagram of a regular arrangement of a light-emitting unit according to Embodiment 5 of the present invention; as shown in FIG. 5, the light-emitting unit includes a first group of light-emitting units 501 and a second group of light-emitting units 502, and a first group of light-emitting units. And the second group of light-emitting units respectively comprise a plurality of light-emitting unit groups, namely, LED1 light group, LED2 light group, LED3 light group, LED4 light group, LED5 light group, and the first group of light-emitting units includes LED1 light group, LED2 light group, LED3 The light group, the second group of light-emitting units comprises an LED4 lamp group, an LED2 lamp group, an LED5 lamp group, an LED1 lamp group, an LED2 lamp group, an LED3 lamp group, an LED4 lamp group, and an LED5 lamp group each including a plurality of LED lamps. In addition to determining the balance state of the vehicle body by the different brightness described in FIG. 4 above, the balance state of the vehicle body can also be determined by the light-emitting area of the light-emitting unit. This embodiment details the determination of the light-emitting area To explain.
(1)当LED1灯组亮度<LED2灯组亮度<LED3灯组亮度时,指示车体前倾角度超过前倾角度阈值,乘员需将车体适当后仰;(1) When the LED1 lamp group brightness <LED2 lamp group brightness <LED3 lamp group brightness, indicating that the car body forward tilt angle exceeds the forward tilt angle threshold, the occupant needs to properly lean back the vehicle body;
(2)当LED1灯组发光面积>LED2灯组发光面积>LED3灯组发光面积时,指示车体后仰角度超过后仰角度阈值,乘员需将车体适当前倾;(2) When the LED1 light group's light-emitting area>LED2 light group light-emitting area>LED3 light-group light-emitting area indicates that the vehicle body reclining angle exceeds the back-hanging angle threshold, the occupant needs to lean forward properly;
(3)当LED4灯组发光面积<LED2灯组发光面积<LED5灯组发光面积时,指示手把左转向角度超过左转向角度阈值,乘员需将转向装置朝右侧调整;(3) When the LED4 lamp group illumination area <LED2 lamp group illumination area <LED5 lamp group illumination area, indicating that the left steering angle of the handle exceeds the left steering angle threshold, the occupant needs to adjust the steering device to the right side;
(4)当LED4灯组发光面积>LED2灯组发光面积>LED5灯组发光面积时,指示手把右转向角度超过右转向角度阈值,乘员需将转向装置朝左侧调整;(4) When the LED4 lamp group lighting area>LED2 lamp group lighting area>LED5 lamp group lighting area, indicating that the right steering angle of the handle exceeds the right steering angle threshold, the occupant needs to adjust the steering device to the left side;
(5)五颗LED灯组发光面积越接近,表示俯仰角度和转向角度更接近其对应阈值,也就表明车体的当前姿态越接近动平衡稳态。(5) The closer the illumination area of the five LED groups is, the more the pitch angle and the steering angle are closer to their corresponding thresholds, which indicates that the current attitude of the vehicle body is closer to the steady state of the dynamic balance.
有关各个灯组发光面积的控制,可参见上述方法实施例,详细不再赘述。For the control of the illumination area of each lamp group, refer to the above method embodiment, and details are not described in detail.
图7为本发明实施例六LCD液晶显示界面中车体平衡状态的显示示意图;如图7所示,在LCD液晶屏上绘制实心圆形图案,模拟水平尺的液泡,根据LED灯的亮度或者发光面积来改变圆形图案大小以及直径。本实施例中实心圆形图案的绘制公式如下:7 is a schematic diagram showing the display of the balance state of the vehicle body in the LCD liquid crystal display interface according to the embodiment of the present invention; as shown in FIG. 7, a solid circular pattern is drawn on the LCD liquid crystal screen to simulate the bubble of the level, according to the brightness of the LED lamp or The area of illumination changes the size and diameter of the circular pattern. The drawing formula of the solid circular pattern in this embodiment is as follows:
Figure PCTCN2015090487-appb-000001
Figure PCTCN2015090487-appb-000001
上式中,Xd是该实心圆形的圆心X轴坐标,Yd是该实心圆形的圆心Y轴坐标,φd是该实心圆形的直径。K1、K2、K3、K4、K5分别为根据经验和LCD液晶屏分辨率而自定义的常数。In the above formula, Xd is the X-axis coordinate of the center of the solid circle, Yd is the Y-axis coordinate of the center of the solid circle, and φd is the diameter of the solid circle. K1, K2, K3, K4, and K5 are constants that are customized according to experience and LCD resolution.
可以把液晶显示界面定义为一个四个象限,逆时针分别为第一象限、第二象限、第三象限、第四象限,通过上述发光单元的发光面积或者亮度来进行圆形图案在象限中位置的定义。The liquid crystal display interface can be defined as a four quadrant, and the counterclockwise is the first quadrant, the second quadrant, the third quadrant, and the fourth quadrant respectively, and the circular pattern is in the quadrant position by the light emitting area or the brightness of the light emitting unit. Definition.
(1)位于第一象限(1) in the first quadrant
车体前倾角度超过前倾角度阈值,手把右转向角度超过右转向角度阈值。The forward tilt angle of the vehicle body exceeds the forward tilt angle threshold, and the right steering angle of the handle exceeds the right steering angle threshold.
(2)位于第二象限(2) in the second quadrant
车体前倾角度超过前倾角度阈值,手把左转向角度超过左转向角度阈值,处于非平衡状态。The forward tilt angle of the vehicle body exceeds the forward tilt angle threshold, and the left steering angle of the handle exceeds the left steering angle threshold, and is in an unbalanced state.
(3)位于第三象限(3) in the third quadrant
车体后仰角度超过后仰角度阈值,手把左转向角度超过左转向角度阈值。 The vehicle body reclining angle exceeds the reclining angle threshold, and the left steering angle of the handle exceeds the left steering angle threshold.
(4)位于第四象限(4) Located in the fourth quadrant
车体后仰角度超过后仰角度阈值,手把右转向角度超过右转向角度阈值,处于非平衡状态。The vehicle body reclining angle exceeds the reclining angle threshold, and the right steering angle of the handle exceeds the right steering angle threshold, and is in an unbalanced state.
(5)位于象限交界水平正向(5) At the quadrant level of the quadrant
车体前、后仰角度未超过前、后仰角度阈值,但手把右转向角度超过右转向角度阈值。The front and rear elevation angles of the vehicle body do not exceed the front and rear elevation angle thresholds, but the right steering angle of the handle exceeds the right steering angle threshold.
(6)位于象限交界水平负向(6) Negative at the level of the quadrant
车体前、后仰角度未超过前、后仰角度阈值,但手把左转向角度超过左转向角度阈值,处于非平衡状态。The front and rear elevation angles of the vehicle body do not exceed the front and rear elevation angle thresholds, but the left steering angle of the handle exceeds the left steering angle threshold and is in an unbalanced state.
(7)位于象限交界垂直正向(7) Vertically at the quadrant boundary
车体前倾角度超过前倾角度阈值,但手把左、右转向角度超过左、右转向角度阈值,处于非平衡状态。The forward tilt angle of the vehicle body exceeds the forward tilt angle threshold, but the left and right steering angles of the handle exceed the left and right steering angle thresholds, and are in an unbalanced state.
(8)位于象限交界垂直负向(8) Vertical negative direction at the quadrant boundary
车体后仰角度超过后仰角度阈值,但手把左、右转向角度超过左、右转向角度阈值,处于非平衡状态。The vehicle body reclining angle exceeds the reclining angle threshold, but the left and right steering angles of the handle exceed the left and right steering angle thresholds, and are in an unbalanced state.
(9)位于象限交界中心位置(9) Located at the center of the quadrant junction
车体前、后仰角度未超过前、后仰角度阈值,手把左、右转向角度未超过左、右转向角度阈值,此时,车体实际刚好处于平衡状态。The front and rear elevation angles of the car body do not exceed the front and rear elevation angle thresholds, and the left and right steering angles of the handlebars do not exceed the left and right steering angle thresholds. At this time, the car body is actually in equilibrium.
需要说明的是,上述情况(1)-(9)并非群举,还包括其他各种情形,详细不再赘述。It should be noted that the above cases (1)-(9) are not group groups, and various other situations are also included, and details are not described in detail.
需要说明的是,图6中的圆形图案也可以由其他形状图案比如多边形代替。It should be noted that the circular pattern in FIG. 6 may also be replaced by other shape patterns such as a polygon.
图8为本发明实施例七动平衡车的功能结构框图;如图8所示,其具体可以包括:姿态传感器701、转向传感器702、驱动单元703、发光单元704。其中:FIG. 8 is a block diagram showing the functional structure of the dynamic balancing vehicle according to the seventh embodiment of the present invention; as shown in FIG. 8 , it may specifically include: an attitude sensor 701, a steering sensor 702, a driving unit 703, and a lighting unit 704. among them:
姿态传感器701和转向传感器702分别用于监测车体的俯仰角度以及转向角度;驱动单元703用于根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元704发光;发光单元704用于根据驱动信号规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态。The attitude sensor 701 and the steering sensor 702 are respectively used for monitoring the pitch angle and the steering angle of the vehicle body; the driving unit 703 is configured to generate a driving signal according to the monitored pitch angle and the steering angle to drive the plurality of light emitting units 704 to emit light; The 704 is configured to emit light according to the driving signal regularly to simulate the pitch angle and the body balance state corresponding to the steering angle.
本实施例中,还可以包括人机交互界面,用于实时显示发光单元发光的规律性状态,以向驾驶者呈现模拟的车体平衡状态。该人机交互界面可以为一LCD液晶显示界面。In this embodiment, a human-computer interaction interface may be further included for displaying the regular state of the illumination of the illumination unit in real time to present the simulated vehicle body balance state to the driver. The human-computer interaction interface can be an LCD liquid crystal display interface.
本实施例中,发光单元704根据模拟所述俯仰角度以及转向角度对应的车体平衡状态有规律地布置在动平衡车的踏板位置处。In this embodiment, the lighting unit 704 is regularly arranged at the pedal position of the dynamic balance vehicle according to the vehicle body balance state corresponding to the pitch angle and the steering angle.
按照模拟俯仰状态和转向状态分别布置了第一组发光单元714和第二组发光单元724,比如如图4所示,LED1、LED2、LED3组成第一组发光单元,LED4、 LED2、LED5组成第二组发光单元。The first group of light emitting units 714 and the second group of light emitting units 724 are respectively arranged according to the simulated pitch state and the steering state. For example, as shown in FIG. 4, LED1, LED2, and LED3 constitute a first group of light emitting units, and LED4, LED2 and LED5 constitute a second group of light emitting units.
可选地,如果驱动单元703生成多个独立的第一组驱动信号,通过有选择地生成大小不同的驱动信号,驱动第一组发光单元中的发光单元发光,有规律地调整发光单元中LED的亮度。Optionally, if the driving unit 703 generates a plurality of independent first group driving signals, driving the lighting units in the first group of lighting units to emit light by selectively generating driving signals of different sizes, and regularly adjusting the LEDs in the lighting unit. Brightness.
可选地,如果发光单元包括第一组发光单元和第二组发光单元,第一组发光单元又包括若干个发光单元组,以每个驱动单元生成包括一个驱动信号的第一组驱动信号,通过有选择地在第一组发光单元中的部分发光单元组之间公用该驱动信号,规律地调整发光单元组中某几个LED进行发光,从而调整整个发光单元的发光亮度,或者发光面积。Optionally, if the lighting unit comprises a first group of lighting units and a second group of lighting units, the first group of lighting units further comprises a plurality of groups of lighting units, each of which generates a first group of driving signals including a driving signal, By selectively sharing the driving signal between the partial lighting unit groups in the first group of light emitting units, a certain number of LEDs in the light emitting unit group are regularly adjusted to emit light, thereby adjusting the light emitting brightness or the light emitting area of the entire light emitting unit.
上述说明示出并描述了本发明的若干优选实施例,但如前所述,应当理解本发明并非局限于本文所披露的形式,不应看作是对其他实施例的排除,而可用于各种其他组合、修改和环境,并能够在本文所述发明构想范围内,通过上述教导或相关领域的技术或知识进行改动。而本领域人员所进行的改动和变化不脱离本发明的精神和范围,则都应在本发明所附权利要求的保护范围内。 The above description illustrates and describes several preferred embodiments of the present invention, but as described above, it should be understood that the invention is not limited to the forms disclosed herein, and should not be construed as Other combinations, modifications, and environments are possible and can be modified by the above teachings or related art or knowledge within the scope of the inventive concept described herein. All changes and modifications made by those skilled in the art are intended to be within the scope of the appended claims.

Claims (10)

  1. 一种检测车体平衡的方法,其特征在于,包括:A method for detecting vehicle body balance, characterized in that it comprises:
    姿态传感器和转向传感器分别监测车体的俯仰角度以及转向角度;The attitude sensor and the steering sensor respectively monitor the pitch angle and the steering angle of the vehicle body;
    根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元发光;Generating a driving signal to drive the plurality of light emitting units to emit light according to the monitored pitch angle and the steering angle;
    根据驱动信号驱动多个发光单元规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态。The plurality of light emitting units are regularly illuminated according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle.
  2. 根据权利要求1所述的方法,其特征在于,根据驱动信号驱动多个发光单元规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态包括:The method according to claim 1, wherein the driving the plurality of light-emitting units to regularly emit light according to the driving signal to simulate the pitch angle and the body balance state corresponding to the steering angle comprises:
    根据驱动信号分别驱动多个发光单元发光,并按照所述俯仰角度和转向角度,规律性调整多个发光单元的发光面积,以模拟车体平衡状态。The plurality of light emitting units are respectively driven to emit light according to the driving signal, and the light emitting areas of the plurality of light emitting units are regularly adjusted according to the pitch angle and the steering angle to simulate a vehicle body balance state.
  3. 根据权利要求1所述的方法,其特征在于,根据驱动信号驱动多个发光单元规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态包括:The method according to claim 1, wherein the driving the plurality of light-emitting units to regularly emit light according to the driving signal to simulate the pitch angle and the body balance state corresponding to the steering angle comprises:
    根据驱动信号分别驱动多个发光单元发光,并按照所述俯仰角度和转向角度,规律性调整多个发光单元的亮度,以模拟车体平衡状态。The plurality of light emitting units are respectively driven to emit light according to the driving signal, and the brightness of the plurality of light emitting units is regularly adjusted according to the pitch angle and the steering angle to simulate a vehicle body balance state.
  4. 根据权利要求1所述的方法,其特征在于,根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动发光单元发光包括:The method according to claim 1, wherein generating a driving signal to drive the light emitting unit to emit light according to the monitored pitch angle and the steering angle comprises:
    根据监测到的俯仰角度,生成第一组驱动信号,所述第一组驱动信号包括第一驱动信号,以驱动模拟俯仰状态的第一组发光单元中多个发光单元发光;Generating, according to the monitored pitch angle, a first group of driving signals, the first group of driving signals including a first driving signal to drive the plurality of lighting units of the first group of lighting units in the analog pitch state to emit light;
    根据监测到的转向角度,生成第二组驱动信号,所述第二组驱动信号包括第二驱动信号,以驱动模拟转向状态的第二组发光单元中多个发光单元发光。And generating, according to the monitored steering angle, a second set of driving signals, the second group of driving signals including a second driving signal to drive the plurality of lighting units of the second group of lighting units in the analog steering state to emit light.
  5. 根据权利要求1所述的方法,其特征在于,还包括:预先设定俯仰角度阈值和转向角度阈值;所述根据监测到的俯仰角度和转向角度,生成驱动信号,以驱动多个发光单元发光包括:根据监测到的俯仰角度及俯仰角度阈值,转向角度及转向角度阈值,生成驱动信号,以驱动多个发光单元发光。The method according to claim 1, further comprising: setting a pitch angle threshold and a steering angle threshold in advance; generating a driving signal to drive the plurality of light emitting units to emit light according to the monitored pitch angle and the steering angle The method includes: generating a driving signal to drive the plurality of light emitting units to emit light according to the monitored pitch angle and the pitch angle threshold, the steering angle and the steering angle threshold.
  6. 根据权利要求1所述的方法,其特征在于,还包括:在人机交互界面中实时显示发光单元发光的规律性状态,以向驾驶者呈现模拟的车体平衡状态。The method according to claim 1, further comprising: displaying a regular state of illumination of the illumination unit in real time in the human-computer interaction interface to present the simulated vehicle body balance state to the driver.
  7. 一种车体平衡状态的控制方法,其特征在于,包括:根据权利要求1-6任意所述方法获得的模拟车体平衡状态,调整车体的俯仰以及转向姿态。A method for controlling a vehicle body balance state, comprising: simulating a vehicle body balance state obtained by the method according to any one of claims 1-6, and adjusting a pitch and a steering posture of the vehicle body.
  8. 一种动平衡车,其特征在于,包括:姿态传感器、转向传感器、驱动单元、发光单元,姿态传感器和转向传感器分别用于监测车体的俯仰角度以及转向角度;驱动单元用于根据监测到的俯仰角度和转向角度,生成驱动信号, 以驱动多个发光单元发光;发光单元用于根据驱动信号规律性发光,以模拟所述俯仰角度以及转向角度对应的车体平衡状态。A dynamic balance vehicle, comprising: an attitude sensor, a steering sensor, a driving unit, a lighting unit, an attitude sensor and a steering sensor respectively for monitoring a pitch angle and a steering angle of the vehicle body; the driving unit is configured to be used according to the monitoring Pitch angle and steering angle to generate drive signals, The plurality of light emitting units are driven to emit light; the light emitting unit is configured to regularly emit light according to the driving signal to simulate the pitch angle and the vehicle body balance state corresponding to the steering angle.
  9. 根据权利要求8所述的动平衡车,其特征在于,还包括:人机交互界面,用于实时显示发光单元发光的规律性状态,以向驾驶者呈现模拟的车体平衡状态。The dynamic balance vehicle according to claim 8, further comprising: a human-machine interaction interface for displaying a regular state of illumination of the illumination unit in real time to present a simulated vehicle body balance state to the driver.
  10. 根据权利要求8所述的动平衡车,其特征在于,所述发光单元根据模拟所述俯仰角度以及转向角度对应的车体平衡状态有规律地布置在动平衡车的踏板位置处。 The dynamic balance vehicle according to claim 8, wherein the lighting unit is regularly arranged at a pedal position of the balance vehicle in accordance with a vehicle body balance state corresponding to the pitch angle and the steering angle.
PCT/CN2015/090487 2014-09-26 2015-09-24 Method for detecting balance of car body , control method of balance state of car body and dynamic balance car WO2016045596A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201410504554.5 2014-09-26
CN201410504554.5A CN104401322A (en) 2014-09-26 2014-09-26 Method for detecting balance of car body and dynamic balance car

Publications (1)

Publication Number Publication Date
WO2016045596A1 true WO2016045596A1 (en) 2016-03-31

Family

ID=52639015

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2015/090487 WO2016045596A1 (en) 2014-09-26 2015-09-24 Method for detecting balance of car body , control method of balance state of car body and dynamic balance car

Country Status (2)

Country Link
CN (1) CN104401322A (en)
WO (1) WO2016045596A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115900636A (en) * 2021-08-23 2023-04-04 中国航天科工飞航技术研究院(中国航天海鹰机电技术研究院) Suspension sledge attitude measurement device and method

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104401322A (en) * 2014-09-26 2015-03-11 纳恩博(天津)科技有限公司 Method for detecting balance of car body and dynamic balance car
CN105955256B (en) * 2016-04-28 2019-02-26 石家庄求实通信设备有限公司 A kind of Detecting Robot and its control system
CN106933235B (en) * 2016-12-01 2021-02-26 美国锐哲有限公司 Self-balancing method after balance car is started
CN108762266B (en) * 2018-05-28 2021-07-02 深圳市卓兴半导体科技有限公司 Electric scooter control method and device, storage medium and electric scooter

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE202007004010U1 (en) * 2007-03-14 2008-07-17 Wittenbauer, Rudolf, Dipl.-Ing. (FH) Stand for an invidual mobility vehicle
JP2012224260A (en) * 2011-04-21 2012-11-15 Honda Motor Co Ltd Inverted pendulum type uni-cycle
CN102815357A (en) * 2012-06-27 2012-12-12 北京工业大学 Self-balancing manned solowheel based on inertia balance wheel
CN203381739U (en) * 2013-05-28 2014-01-08 中国科学院金属研究所 Self-balance two-wheel electric vehicle
CN104401322A (en) * 2014-09-26 2015-03-11 纳恩博(天津)科技有限公司 Method for detecting balance of car body and dynamic balance car

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6324446B1 (en) * 1999-12-21 2001-11-27 Ford Global Technologies, Inc. Roll over stability control for an automotive vehicle
US6718248B2 (en) * 2002-06-19 2004-04-06 Ford Global Technologies, Llc System for detecting surface profile of a driving road
US7222007B2 (en) * 2004-01-07 2007-05-22 Ford Global Technologies, Llc Attitude sensing system for an automotive vehicle relative to the road
KR101836490B1 (en) * 2010-07-29 2018-03-08 히다치 오토모티브 시스템즈 가부시키가이샤 Vehicle body posture control apparatus
JP5571519B2 (en) * 2010-09-27 2014-08-13 日立オートモティブシステムズ株式会社 Body posture control device

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE202007004010U1 (en) * 2007-03-14 2008-07-17 Wittenbauer, Rudolf, Dipl.-Ing. (FH) Stand for an invidual mobility vehicle
JP2012224260A (en) * 2011-04-21 2012-11-15 Honda Motor Co Ltd Inverted pendulum type uni-cycle
CN102815357A (en) * 2012-06-27 2012-12-12 北京工业大学 Self-balancing manned solowheel based on inertia balance wheel
CN203381739U (en) * 2013-05-28 2014-01-08 中国科学院金属研究所 Self-balance two-wheel electric vehicle
CN104401322A (en) * 2014-09-26 2015-03-11 纳恩博(天津)科技有限公司 Method for detecting balance of car body and dynamic balance car

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115900636A (en) * 2021-08-23 2023-04-04 中国航天科工飞航技术研究院(中国航天海鹰机电技术研究院) Suspension sledge attitude measurement device and method

Also Published As

Publication number Publication date
CN104401322A (en) 2015-03-11

Similar Documents

Publication Publication Date Title
WO2016045596A1 (en) Method for detecting balance of car body , control method of balance state of car body and dynamic balance car
US20170038595A1 (en) Head-up display device
JP2015512825A5 (en)
JP2015507283A5 (en)
JP2015202842A5 (en)
TWI589477B (en) Method and system for providing warning signals of bicycle
JP2014197066A5 (en)
EP2514636A3 (en) Control device for vehicle lamp and vehicle lamp system
TW201429418A (en) Helmet apparatus for automated vehicle heading direction alert
US20210349465A1 (en) Autonomous scooter
WO2019244644A1 (en) Mobile body control device, mobile body control method, and program
JP2010195063A (en) Speed sense control device
JP6804416B2 (en) Monitoring system
JP2016177568A5 (en)
JP5691827B2 (en) Inverted two-wheeled vehicle, its operating method, and program
WO2023051818A1 (en) Indication device and method for riding comfort
JP2014076718A (en) Mobile entity control unit
WO2016075954A1 (en) Display device and display method
CN103744427B (en) Acceleration sensing gesture operation system and operational approach
JP2010149577A (en) Coaxial motorcycle
CN110271626B (en) Bicycle taillight and brake lighting method, device and equipment thereof
JP6225869B2 (en) Inverted two-wheeled mobile system
JP2007094082A (en) Mobile object simulator system, control method and control program thereof
TW201623090A (en) Variable speed control device and variable speed control method using the same
KR20140118956A (en) Method of controlling bicycle and apparatus performing the same

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 15845386

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 15845386

Country of ref document: EP

Kind code of ref document: A1