CN111308490B - Balance car indoor positioning and navigation system based on single-line laser radar - Google Patents
Balance car indoor positioning and navigation system based on single-line laser radar Download PDFInfo
- Publication number
- CN111308490B CN111308490B CN202010080571.6A CN202010080571A CN111308490B CN 111308490 B CN111308490 B CN 111308490B CN 202010080571 A CN202010080571 A CN 202010080571A CN 111308490 B CN111308490 B CN 111308490B
- Authority
- CN
- China
- Prior art keywords
- unit
- balance car
- data
- module
- information
- Prior art date
- Legal status (The legal status 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 status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/66—Tracking systems using electromagnetic waves other than radio waves
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C22/00—Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/50—Systems of measurement based on relative movement of target
- G01S17/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Traffic Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
一种基于单线激光雷达的平衡车室内定位与导航巡回系统，包括服务器、上位机、传感器、运动控制器与运动执行器构成；首先，操作人员在服务器中输入目标点坐标；服务器将目标点坐标发送给上位机，上位机利用传感器信息完成平衡车自身定位与路径规划，上位机再将由路径规划出的期望角速度与期望线速度发送给运动控制器；运动控制器接收上位机发送的信息，并同时采集传感器信息，利用这些信息结合自抗扰控制的方法计算出运动执行器所需要的PWM波占空比，然后把PWM波发送给运动执行器；运动执行器接收到PWM波后，完成平衡车自平衡的同时驱动平衡车向目标点行驶；最终操作人员能在服务器看到地图与平衡车的实时位置、状态信息。
An indoor positioning and navigation system for a self-balancing vehicle based on a single-line laser radar, comprising a server, a host computer, a sensor, a motion controller and a motion actuator; first, the operator inputs the coordinates of the target point in the server; the server stores the coordinates of the target point Send it to the host computer, the host computer uses the sensor information to complete the self-positioning and path planning of the self-balancing vehicle, and the host computer sends the desired angular velocity and desired linear velocity planned by the path to the motion controller; the motion controller receives the information sent by the host computer, and Collect sensor information at the same time, use this information combined with the active disturbance rejection control method to calculate the PWM wave duty cycle required by the motion actuator, and then send the PWM wave to the motion actuator; after the motion actuator receives the PWM wave, it completes the balance When the vehicle is self-balancing, it drives the balance vehicle to the target point; finally, the operator can see the map and the real-time position and status information of the balance vehicle on the server.
Description
Technical Field
The invention relates to a service and logistics scene system of an indoor mobile robot, in particular to a balance car positioning and navigation system based on a single-line laser radar.
Background
With the rapid development of robot technology in recent years, robots can replace people to complete work in many dangerous workplaces and help people to complete many repetitive works. For example, in the application scenarios of medical treatment, fire protection, logistics, and the like, the robot is often guided to a destination by setting a track (placing markers such as magnetic guide wires, two-dimensional codes, and the like) of the robot in advance. Although this is the simplest and most effective and low cost method, it ignores problems that often occur in practice, such as the presence of obstacles on a preset track, the inability to fully utilize robot resources, and the like. Therefore, the self-positioning is sensed through the sensor carried by the robot, and the navigation scheme can be more suitable for the change of indoor environment, the situation that dynamic obstacles appear in front of the running of the robot and the like. In the process of robot navigation, data collected by the robot are uploaded to a server for data analysis, and the task is completed by utilizing the multiple robots with the highest efficiency.
At present, chassis with four-wheel chassis, two-wheel differential and one universal wheel are mostly available in the market. However, the chassis have respective defects, and firstly, the four wheels have small turning radius, and the indoor moving space is limited; although the combination of the second two-wheel differential and the universal wheel has higher freedom of movement, the speed is limited, and the movement efficiency is not high.
Therefore, in order to solve the above problems, various chassis-based positioning and navigation systems have been developed. The Liao Louis has proposed an indoor navigation vehicle (Lilao Louis) based on laser SLAM, an indoor navigation vehicle (P) based on laser SLAM, Chinese patent CN110207705A,2019-09-06) uses Mecanum wheels as a trolley chassis, but due to terrain limitation, the trolley of the Mecanum wheels can not be decomposed at a speed and can not move transversely when encountering rugged ground, so the trolley of the Mecanum wheel chassis has higher requirements on the road surface, and therefore the method has certain limitations. Meanwhile, because the vision mapping and navigation based on the camera are easy to change by ambient light, the navigation effect is unstable, and therefore the two-dimensional laser radar is adopted for positioning mapping and navigation of the robot in consideration of the stability and cost control of the navigation.
Disclosure of Invention
The invention overcomes the problems in the prior art and provides a balance car indoor positioning and navigation itinerant system based on a single line laser radar.
The technical scheme adopted by the invention for solving the problems in the prior art is as follows:
a balance car indoor positioning and navigation itinerant system based on a single line laser radar comprises: the system comprises a server, an upper computer, a sensor, a motion controller and a motion actuator. Firstly, an operator inputs coordinates of a target point in a server; the server sends the coordinates of the target point to an upper computer, the upper computer completes self positioning and path planning of the balance car by using sensor information, and the upper computer sends expected angular speed and expected linear speed planned by the path to the motion controller; the motion controller receives information sent by the upper computer, simultaneously collects sensor information, calculates PWM wave duty ratio required by the motion actuator by using the information and combining an active disturbance rejection control method, and then sends the PWM wave to the motion actuator; after receiving the PWM wave, the motion actuator completes the self-balancing of the balance car and drives the balance car to travel to a target point; finally, the operator can see the map and the real-time position and state information of the balance car at the server.
The server has the functions of displaying the map and the real-time position state information of the balance car, generating a target point, sending and the like, and the functions are realized by the cooperation of three software modules in the server, wherein the three software modules respectively comprise: the device comprises a communication module, a target generation module and a display module. The following is a detailed functional description of three modules in the server:
the communication module is mainly used for Socket communication between the server and the upper computer, wherein a Socket communication unit of the upper computer subscribes a map from a mapping unit, obtains real-time balance car pose and state information from a positioning unit, converts the information into a json format, sends the json format to the communication module of the server in a byte stream mode in a Socket communication mode, and finally outputs the data to the display module for displaying to an operator; and the communication module of the server is responsible for sending the coordinates of the target point obtained from the target generation module to a Socket communication unit of the communication module of the upper computer.
And the target generation module is used for enabling an operator to observe the map in the display module and the real-time pose of the balance car and then inputting the coordinates of a target point which the balance car is expected to reach. And then the coordinates are sent to a Socket communication unit in a communication module of the upper computer through a communication module of the server and finally input to a global path planning unit of a navigation module in the upper computer.
And the display module acquires information such as an environment map of the balance car, the pose and the state of the balance car from the communication module of the server and displays the information in real time.
The upper computer establishes a map for the surrounding environment by using the sensor information and realizes self-positioning of the balance car in the two-dimensional map, and then combines the coordinates of the target point sent by the server, the upper computer can plan a reasonable shortest path from the position of the balance car to the target point, and converts the path information into an expected angular velocity and an expected linear velocity and sends the expected angular velocity and the expected linear velocity to the motion controller. The host computer includes: the device comprises a two-dimensional laser SLAM module, a navigation module and a communication module. These three functional modules are explained in detail below:
the two-dimensional laser SLAM module comprises three units, namely a data processing unit, a mapping unit and a positioning unit. The data processing unit consists of an encoder data processing subunit, an IMU data processing subunit and a laser radar data processing subunit. Three sub-units in the data processing unit are described first below:
an encoder data processing subunit: firstly, the serial port communication unit in the upper computer communication module is utilized to obtain the encoder data of the left wheel and the right wheel, and the speed of the right wheel is defined as VrAnd the left wheel speed is VlAnd a distance parameter d between two wheels of the balance car. Substituting the left wheel speed, the right wheel speed and the wheel spacing data into the formula (1) to calculate the instantaneous linear velocity and the instantaneous angular velocity of the balance car, wherein the linear velocity in the y direction is always 0 because the balance car cannot move transversely:
and (3) substituting the instantaneous linear velocity and the instantaneous angular velocity obtained by the formula (1) into the motion model (2) to calculate the wheel type odometer.
And finally, outputting the wheel type odometer to an IMU data processing subunit.
An IMU data processing subunit: the wheel odometer steering angle is larger than the yaw angle error measured by the IMU because the magnetic field interferes with the IMU data and the yaw angle information calculated by the IMU is corrected by the magnetometer. For the translation amount, the accelerometer of the IMU is easily interfered by high-frequency noise, so that the translation amount error of the wheel type odometer is smaller. And then, the IMU data obtained from the serial port communication unit in the upper computer communication module is fused with the wheel type odometer output by the encoder data processing subunit by selecting the extended Kalman filtering to obtain the odometer with higher precision, and the IMU data and the odometer data are output to the laser radar data processing subunit, the positioning unit and the map building unit.
The laser radar data processing subunit: because the laser radar is used for rotatably measuring the depth information of surrounding obstacles, the data of the laser radar is distorted due to the movement of the balance car, and therefore, the original data of the laser radar is corrected by using the odometer, so that the data of the laser radar is not distorted in a moving state. Therefore, laser radar data are obtained from a serial port communication unit in the upper computer communication module and are used as input of the laser radar data processing subunit, mileometer data output by the IMU data processing subunit are used for correcting the laser radar data, a corrected result is output through the likelihood field model, and the set bit unit, the graph building unit and the navigation module are output.
The drawing establishing unit specifically comprises the following operation steps:
1) and acquiring the odometer information and the laser radar data from the data processing unit. And carrying out time synchronization on the odometer information and the laser radar data.
2) The particle filter is first initialized so that the weight of each particle is equal and uniformly distributed.
3) And calculating the coordinate of the laser radar on the odometer, and substituting the particle pose at the last moment into the motion model for calculation to obtain the estimated particle pose.
4) The predicted sampling distribution of the particles is updated with the matching results by substituting the laser data into each particle for matching.
5) The target distribution and the predicted distribution are used to determine the weight of each particle.
6) And resampling the particles according to the weight of the particles, traversing the information stored by the particles on the whole track, updating the grid map, and returning to the third step to update the pose of the particles.
7) And finally, outputting the map to a Socket communication unit in the navigation module, the positioning unit and the upper computer communication module.
The positioning unit adopts a Monte Carlo method, and takes the built map, radar and odometer data as input to obtain the pose of the robot, and the specific operation steps are as follows
1) And acquiring the odometer information and the laser radar data from the data processing unit. And carrying out time synchronization on the odometer information and the laser radar data, and then taking the map output by the map building unit as the input of the positioning unit.
2) Initializing the particle swarm. The initial pose is set manually, namely the distribution of the particle swarm is initialized.
3) And (4) updating the pose of each particle by sampling the kinematic model by using the odometer.
4) And substituting the radar information and the map into the pose corresponding to each particle, calculating the weight corresponding to each particle, and selecting the pose with the highest weight as the robot.
5) After the weight calculation is finished, there are many low-weight particles, and these particles occupy computer resources, so it is necessary to discard these low-weight particles appropriately and perform resampling according to the weights corresponding to the particles: the particles with high weight are copied, and the particles with low weight are discarded. And ending one iteration, returning to the third step and continuing the iteration.
The navigation module comprises a global path planning unit and a local path planning unit. A reasonable and shortest running route from the real-time pose of the balance car to the destination is planned through the global path planning unit; and then a local path planning unit is used for controlling the balance car to follow the global track and realizing the functions of avoiding obstacles and the like. The global path planning unit and the local path planning unit are introduced as follows:
and the global path planning unit is used for subscribing a map from the map building unit, acquiring the real-time pose of the balance car from the positioning unit, the position of a target point sent from the communication module of the server and other information, inputting the data into the global path planning unit, searching a reasonable shortest path from the position of the balance car to the target point from the map by using an A-x algorithm, outputting the path and outputting the path to the local path planning unit.
The local path planning unit takes the output path of the global path planning unit as the input of the local path planning unit; and subscribing the laser radar information output by the laser radar data processing subunit in the data processing unit. Firstly, initializing a path; adding constraint conditions: 1) the method has the advantages that a global path can be tracked, 2) obstacles are avoided, 3) the method conforms to the motion mode of the balance car, 4) the acceleration and speed limits are met, the constraint conditions are converted into graph optimization edges, time intervals are used as graph optimization nodes, then the solution is carried out through an optimization algorithm of a large-scale sparse matrix in a g2o optimization library, and a local optimal track is planned. And finally, calculating the expected angular velocity and acceleration according to the balance car kinematic model, and sending the expected angular velocity and acceleration to a serial port communication unit in the upper computer communication module.
The upper computer communication module comprises a serial communication unit and a Socket communication unit, wherein the serial communication unit also comprises serial communication between the motion controller and the upper computer, and serial communication between the sensor and the upper computer:
serial port communication between the motion controller and the upper computer: a serial port communication unit of the upper computer subscribes to an expected angular velocity and an expected linear velocity output by a local path planning unit in the navigation module, then sends the expected angular velocity and the expected linear velocity to the motion controller through a serial port, and after receiving the expected angular velocity and the expected linear velocity, a communication module of the motion controller outputs data to a direction control unit and a speed control unit of the motion control module; the motion controller collects data of the encoder, the encoder data are sent to a serial port communication unit of the upper computer communication module through a communication module of the motion controller by utilizing a serial port, and after the serial port communication unit of the upper computer communication module receives the encoder data, the encoder data are sent to an encoder data processing subunit of the data processing unit for odometer calculation.
Serial port communication between sensor and host computer: the serial port communication unit of the upper computer communication module obtains laser radar and IMU data from the laser radar and the 100D2 IMU through a serial port, then sends the laser radar data to the laser radar data processing subunit of the data processing unit, and sends the IMU data to the IMU data processing subunit of the data processing unit.
And after the upper computer completes the construction of a balance car map, self positioning and path planning, the expected angular velocity and the expected linear velocity are sent to the motion controller.
The motion controller can complete the calculation of the duty ratio of the PWM wave required by the balance car to reach the destination by collecting the information of the sensor in real time and combining the data sent by the upper computer with an active disturbance rejection control method, and sends the PWM wave to the motion actuator in real time. The motion controller completes the functions through the cooperative work of the three functional modules. Wherein three functional modules are respectively: the device comprises a motion control module, an active disturbance rejection control module and a communication module.
The motion control module comprises an upright control unit, a direction control unit and a speed control unit. The deviation between the real-time angle of the balance car and the expected balance angle is calculated through the vertical control unit, and the balance car has a good balance effect at a balance position by combining with the active disturbance rejection control module; calculating the deviation between the real-time angular speed and the expected angular speed by using a direction control unit, and enabling the balance car to run along the planned path by combining an active disturbance rejection control module; and calculating the deviation between the real-time speed and the expected speed by using a speed control unit, and driving the balance car at the calculated speed by combining an active disturbance rejection control module. The respective functions of the three units in the motion control module are set forth below:
an upright control unit: first, the motion controller collects data of the sensor MPU6050, which includes information of angular velocity and acceleration of the pitch angle of the balance car. Because the acceleration information is easily annihilated by high-frequency noise, the acceleration information is filtered by a Butterworth low-pass filter, then the angular velocity gyro in the pitch Angle direction of the balance car is fused with the acceleration acc by a complementary filtering formula (3), and the calibration is carried out after the weight x is adjusted, so that the Angle information Angle can be obtained, wherein dt is the period of Angle calculation:
Angle＝x*(Angle+gyro*dt)+(1-x)*acc； (3)
and then the real-time Angle is deviated from the expected balance Angle and is input to the active disturbance rejection control module.
A direction control unit: the desired angular velocity is obtained from the communication module of the motion controller, then the angular velocity of the yaw angle of the balance car is collected in real time from the sensor MPU6050, the units of the angular velocity and the yaw angle are unified, and then the subtraction result is input to the active disturbance rejection control module.
A speed control unit: first, a motion controller is used for collecting data of a sensor encoder, and the data of the encoder represents the rotating speed of left and right wheels of the balance car. And calculating the real-time speed of the balance car through encoder data. Unifying the real-time speed and the expected linear speed unit obtained from the communication module of the motion controller, performing subtraction, and inputting the result to the active disturbance rejection control module.
Finally, the results of the three units, the upright control unit, the directional control unit and the speed control unit are all input to the active disturbance rejection control module.
The active disturbance rejection control module adopts a control method of active disturbance rejection control, and comprises a differential tracking unit, an expansion state observation unit and a nonlinear control rate unit. The following are the roles of the individual units:
a differential tracking unit: the method is used for solving the problem that discontinuous or random noise signals are generated by a navigation module or a communication module, and reasonably extracting the expected angular speed and speed signals and differential signals from the discontinuous or random noise signals, so that the expected signals are smooth. And three deviation values input from the motion control module are smoothed to prevent sudden change of signals from influencing the stability of the system, and the results are respectively output to the expansion observation unit and the nonlinear control rate unit.
An expanded state observation unit: the expansion state observation unit is mainly used for observing and offsetting the disturbance of the system. The expansion state observation unit obtains three deviation amounts from the differential tracking unit: the angular deviation, the angular speed deviation and the speed deviation of the balance car. The system is characterized in that the system is expanded into new state variables, expanded total disturbance signals are observed through a special feedback mechanism, the total disturbance is constructed into a state variable and a second-order system through input and output, an expansion observer of the system reaches the third order, the state of the total disturbance of the whole balance car system is added, the finally observed total disturbance output is differed with a signal output to a nonlinear control rate unit by a differential tracking unit, the signal is used for eliminating the disturbance, and the system is more stable.
A nonlinear control rate unit: the nonlinear control method is constructed by a steepest control synthesis function Fhan. The method is mainly used for solving the problem that the linear controller cannot control nonlinear systems such as a balance car and the like to obtain better effects. And taking the result of the difference between the output of the differential tracking unit and the output of the expansion state observation unit as the input of the nonlinear control rate unit, calculating the duty ratios of pwm waves required by the vertical control, the direction control and the speed control respectively through calculation, and linearly overlapping the duty ratios and outputting the duty ratios to the motion actuator.
The communication module in the motion controller is used for realizing serial communication between the motion controller and the upper computer: a serial port communication unit of the upper computer subscribes to an expected angular velocity and an expected linear velocity output by a local path planning unit in the navigation module, then sends the expected angular velocity and the expected linear velocity to the motion controller through a serial port, and after receiving the expected angular velocity and the expected linear velocity, a communication module of the motion controller outputs data to a direction control unit and a speed control unit of the motion control module; the motion controller collects data of the encoder, the encoder data are sent to a serial port communication unit of the upper computer communication module through a communication module of the motion controller by utilizing a serial port, and after the serial port communication unit of the upper computer communication module receives the encoder data, the encoder data are sent to an encoder data processing subunit of the data processing unit for odometer calculation.
Finally, the motion actuator is a direct current motor in the system, and can receive the PMW waves sent by the motion controller and convert the PWM waves into driving force to control the balance of the balance car and the thrust reaching the destination.
The invention has the advantages that: according to the invention, the active disturbance rejection control is adopted as a basic motion control method, so that the balance car has better stability and the capability of tracking the track and speed planned by the navigation module in time, an effective dynamic obstacle avoidance effect is achieved, and the robustness of the balance car is increased. In addition, the invention adopts a mode of combining the chassis of the two-wheeled balance vehicle and the two-dimensional laser radar positioning and navigation, effectively improves the flexibility of the vehicle, can effectively avoid obstacles and reach a destination more quickly in a complex environment, and increases the efficiency of the robot in completing tasks.
Drawings
FIG. 1 is a schematic diagram of the system architecture of the present invention.
Fig. 2 is a two-dimensional map created by the present invention.
Fig. 3 is a window in which the server displays the location of the balance car.
Fig. 4 is a display window of the upper computer communicating with the motion controller.
Fig. 5 is a window in which the server displays balance car status information.
Detailed Description
The following examples are further detailed in conjunction with the accompanying drawings:
a balance car indoor positioning and navigation itinerant system based on a single line laser radar comprises: the system comprises a server, an upper computer, a sensor, a motion controller and a motion actuator.
The server can obtain real-time position and state information of the two-dimensional map and the balance car through Socket communication, and the information is displayed on a screen and observed by an operator. Then, an operator can input the target position of the balance car into the server, and the server can send the coordinates of the target point to the upper computer through Socket communication.
The upper computer firstly reads sensor information such as IMU (inertial measurement Unit), laser radar and the like and encoder data by using a serial port, and then calculates the information by using a two-dimensional laser SLAM (simultaneous localization and mapping) algorithm, so that a two-dimensional map and real-time pose information of the surrounding environment of the balance car can be obtained. Meanwhile, the upper computer obtains coordinates of a target point sent by the server through Socket communication, combines a two-dimensional map, the real-time pose of the balance car and sensor information, can plan a reasonable shortest path to a destination through a navigation module in the upper computer, and sends an expected path to a motion controller through a serial port in the form of an expected angular velocity and an expected linear velocity.
And the motion controller is used for controlling the motion of the balance car. The method comprises the steps of firstly collecting MPU6050 data, converting the data into real-time pitching angle data of the balance car, and then receiving expected angular velocity data and expected linear velocity data sent from an upper computer by adopting serial port communication. And then, the angle of the balance car, the expected angular speed and the linear speed are used as input quantities and are input to an active disturbance rejection control module, the duty ratio of a PWM wave required by the motion actuator is obtained through calculation, and then the PWM wave is sent to the motion actuator.
The motion actuator consists of a chassis of the two-wheel differential balance car and is used for receiving the PWM waves sent by the motion controller and driving the balance car to a destination.
In the motion control module, an active disturbance rejection controller is adopted to simultaneously control three state quantities of an angle, a driving direction and a driving speed of the balance car. The active disturbance rejection controller is composed of a differential tracker, an extended state observer and a nonlinear state error feedback control law:
the differential tracker is used for solving the problem that discontinuous or random noise signals are generated by a navigation module or a communication module, and reasonably extracting expected angular velocity and velocity signals and differential signals from the discontinuous or random noise signals so as to smooth the expected signals.
The extended state observer expands the disturbance action of the angle, direction and speed of the balance vehicle into a new state variable, observes an expanded total disturbance signal through a special feedback mechanism, constructs a system with the total disturbance as a state variable and a second order through input and output, and reaches a third order and adds the state of the total disturbance of the whole balance vehicle system.
And the control and disturbance compensation are further carried out according to the given signal obtained by the tracking differentiator, the derivative of the given signal and the error of the derivative of the system output and the output observed by the state observer, and the nonlinear control method is constructed by a steepest control comprehensive function Fhan. The method is mainly used for solving the problem that the linear controller cannot control nonlinear systems such as a balance car and the like to obtain better effects.
A balance car indoor positioning and navigation system based on a single-line laser radar is characterized in that a platform mainly comprises a laser radar of a rpidar A2 model, a miniPC (a cpu of the miniPC uses an Inter Core i7-7567U), a single chip microcomputer development board carrying a master control stm32f103, a balance car chassis, an IMU of a 100D2 model, a lithium battery of 5000mAh, and a single chip microcomputer is communicated with the miniPC through a serial line.
The application mode of the invention is as follows:
the specific operation steps of using the balance car carrying the two-dimensional laser radar to construct the map are as follows:
1) firstly, the balance control (stable and non-shaking in situ), speed control and direction control of the vehicle are started, and simultaneously, the serial port function is started, and the wheel speed is sent to the upper computer and the expected angular speed and the expected linear speed are received, as shown in figure 4.
2) And the IMU and the computer, the laser radar and the computer, the singlechip and the computer are connected through serial port lines, and the information of the laser radar, the IMU and the wheel speed is read. And substituting the wheel speed information into the balance car kinematic model and the odometer model for solving, and calculating to obtain the wheel type odometer. And calibrating the wheel type odometer.
3) And fusing the wheel type odometer and IMU data to obtain a new odometer, inputting the new odometer and laser radar data to a mapping module, starting mapping by the balance car in situ, and mapping the result as shown in figure 2.
4) And opening the keyboard control node, and controlling the balance car to move by using the keyboard, so that the balance car can be completely built as much as possible.
The specific operation steps of positioning and navigating by using the balance car carrying the two-dimensional laser radar are as follows:
1) and closing the map building and keyboard control module, and opening the positioning, navigation and upper computer and server communication module.
2) And detecting whether the server side can successfully receive the map and the robot state information. After the detection is finished, the server side inputs destination coordinates to be reached, the balance car can autonomously plan a reasonable shortest path through the path planner, the planned path is shown in fig. 3, a red line is a global planned path, and a green line is a local planned path.
3) After the balance car arrives at the destination, the arrival information of the server is returned, and the server is allowed to perform the next target point setting, wherein the information obtained by the server is shown in fig. 5.
It is emphasized that the embodiments described herein are merely illustrative of implementations of the inventive concept and that the scope of the invention should not be considered limited to the specific forms set forth in the examples but rather the scope of the invention is to be accorded the full scope of equivalents that can occur to those skilled in the art upon reading the teachings herein.
Claims (2)
1. The utility model provides a balanced car indoor location and navigation itinerant system based on single line laser radar which characterized in that: the method comprises the following steps: the system comprises a server, an upper computer, a sensor, a motion controller and a motion actuator; when an operator inputs coordinates of a target point in the server, the server sends the coordinates of the target point to the upper computer, the upper computer completes self positioning and path planning of the balance car by using sensor information, and the upper computer sends expected angular speed and expected linear speed planned by the path to the motion controller; the motion controller receives information sent by the upper computer, simultaneously collects sensor information, calculates PWM wave duty ratio required by the motion actuator by using the information and combining an active disturbance rejection control method, and then sends the PWM wave to the motion actuator; after receiving the PWM wave, the motion actuator completes the self-balancing of the balance car and drives the balance car to travel to a target point; finally, an operator can see the real-time position and state information of the map and the balance car in the server;
the server displays the map and the real-time position state information of the balance car, generates a target point and sends the target point, and comprises a communication module, a target generation module and a display module;
the communication module is used for performing Socket communication between the server and the upper computer, wherein a Socket communication unit of the upper computer subscribes a map from a mapping unit, obtains real-time balance car pose and state information from a positioning unit, converts the information into a json format, sends the json format information to the communication module of the server in a byte stream mode in a Socket communication mode, and finally outputs the data to a display module for displaying to an operator; the communication module of the server is responsible for sending the coordinates of the target point obtained from the target generation module to a Socket communication unit of the communication module of the upper computer;
the target generation module is used for enabling an operator to observe the map in the display module and the real-time pose of the balance car and then inputting the coordinates of a target point which the balance car wants to reach; then the coordinates are sent to a Socket communication unit in a communication module of the upper computer through a communication module of the server and finally input to a global path planning unit of a navigation module in the upper computer;
the display module acquires information of an environment map, a balance car pose and a state of the balance car from the communication module of the server and displays the information in real time;
the upper computer establishes a map for the surrounding environment by using the sensor information and realizes self-positioning of the balance car in the two-dimensional map, then combines the coordinates of a target point sent by the server, plans a reasonable shortest path from the position of the balance car to the target point, converts the path information into an expected angular velocity and an expected linear velocity and sends the expected angular velocity and the expected linear velocity to the motion controller; the upper computer comprises a two-dimensional laser SLAM module, a navigation module and a communication module;
the two-dimensional laser SLAM module comprises a data processing unit, a mapping unit and a positioning unit; the data processing unit comprises an encoder data processing subunit, an IMU data processing subunit and a laser radar data processing subunit;
an encoder data processing subunit: firstly, the serial port communication unit in the upper computer communication module is utilized to obtain the encoder data of the left wheel and the right wheel, and the speed of the right wheel is defined as VrAnd the left wheel speed is VlDistance parameter d between two wheels of the balance car; substituting the left wheel speed, the right wheel speed and the wheel spacing data into the formula (1) to calculate the instantaneous linear velocity and the instantaneous angular velocity of the balance car, wherein the linear velocity in the y direction is always 0 because the balance car cannot move transversely:
substituting the instantaneous linear speed and the instantaneous angular speed obtained by the formula (1) into the motion model (2) to calculate a wheel type odometer;
finally, outputting the wheel type odometer to an IMU data processing subunit;
an IMU data processing subunit: because the magnetic field can interfere with IMU data, the yaw angle information calculated by the IMU is corrected through the magnetometer, and therefore the steering angle of the wheel type odometer is larger than the yaw angle error measured by the IMU; for the translation amount, because the accelerometer of the IMU is easily interfered by high-frequency noise, the translation amount error of the wheel type odometer is smaller; then, selecting extended Kalman filtering to fuse IMU data obtained from a serial port communication unit in an upper computer communication module and a wheel type odometer output by an encoder data processing subunit to obtain an odometer with higher precision, and outputting the IMU data and the odometer data to a laser radar data processing subunit, a positioning unit and a mapping unit;
the laser radar data processing subunit: because the laser radar is used for rotatably measuring the depth information of surrounding obstacles, the data of the laser radar is distorted due to the movement of the balance car, and the original data of the laser radar is corrected by using a milemeter, so that the data of the laser radar is not distorted in a moving state; therefore, laser radar data are obtained from a serial port communication unit in an upper computer communication module and are used as input of a laser radar data processing subunit, mileometer data output by an IMU data processing subunit are used for correcting the laser radar data, a corrected result is output through a likelihood field model, and a positioning unit, a mapping unit and a navigation module are output;
the drawing establishing unit specifically comprises the following operation steps:
s1) obtaining the odometry information and the laser radar data from the data processing unit; carrying out time synchronization on the odometer information and the laser radar data;
s2), firstly, initializing the particle filter to ensure that the weight of each particle is equal and is uniformly distributed;
s3) calculating the coordinate of the laser radar on the odometer, and substituting the particle pose at the last moment into the motion model for calculation to obtain the estimated particle pose;
s4) performing matching by substituting the laser data into each particle, updating the predicted sampling distribution of the particles with the matching result;
s5) determining the weight of each particle using the target distribution and the predicted distribution;
s6) resampling the particles according to the weight of the particles, traversing the information stored by the particles on the whole track, updating the grid map, and returning to the step S3 to update the pose of the particles;
s7) finally outputting the map to a Socket communication unit in the navigation module, the positioning unit and the upper computer communication module;
the positioning unit adopts a Monte Carlo method, and takes the built map, radar and odometer data as input to obtain the pose of the robot, and the specific operation steps are as follows
T1) obtaining odometry information and lidar data from a data processing unit; carrying out time synchronization on the odometer information and the laser radar data, and then taking the map output by the map building unit as the input of the positioning unit;
t2) initializing the particle population; setting an initial pose manually, namely initializing the distribution of particle swarms;
t3) updating the pose of each particle by performing kinematic model sampling using an odometer;
t4) substituting the radar information and the map into the pose corresponding to each particle, calculating the weight corresponding to each particle, and selecting the pose with the highest weight as the robot;
t5) since there are many low-weight particles after the weight calculation is finished, and these particles occupy computer resources, it is necessary to discard these low-weight particles appropriately and perform resampling according to the weight corresponding to the particles: copying the particles with high weight, and discarding the particles with low weight; ending one iteration, returning to the step T3 to continue the iteration;
the navigation module comprises a global path planning unit and a local path planning unit; a reasonable and shortest running route from the real-time pose of the balance car to the destination is planned through the global path planning unit; then, a local path planning unit is used for controlling the balance car to follow the global track and realizing the obstacle avoidance function; the global path planning unit and the local path planning unit are introduced as follows:
the global path planning unit is used for subscribing a map from the map building unit, acquiring the real-time pose of the balance car from the positioning unit and the position information of a target point sent from the communication module of the server, inputting the data into the global path planning unit, searching a reasonable shortest path from the position of the balance car to the target point from the map by using an A-algorithm, outputting the path and outputting the path to the local path planning unit;
the local path planning unit takes the output path of the global path planning unit as the input of the local path planning unit; subscribing laser radar information output by a laser radar data processing subunit in the data processing unit; firstly, initializing a path; adding constraint conditions: 1) the method comprises the steps of (1) tracking a global path, (2) avoiding obstacles, (3) conforming to a balance car motion mode, and (4) limiting acceleration and speed, converting constraint conditions into graph optimization edges, using time intervals as graph optimization nodes, solving the graph optimization nodes through an optimization algorithm of a large-scale sparse matrix in a g2o optimization library, and planning a local optimal track; finally, calculating the expected angular velocity and acceleration according to the balance car kinematic model, and sending the expected angular velocity and acceleration to a serial port communication unit in an upper computer communication module;
host computer communication module, contain serial communication unit and Socket communication unit, wherein contain the serial communication between motion controller and host computer, the serial communication between sensor and the host computer again in the serial communication unit:
serial port communication between the motion controller and the upper computer: a serial port communication unit of the upper computer subscribes to an expected angular velocity and an expected linear velocity output by a local path planning unit in the navigation module, then sends the expected angular velocity and the expected linear velocity to the motion controller through a serial port, and after receiving the expected angular velocity and the expected linear velocity, a communication module of the motion controller outputs data to a direction control unit and a speed control unit of the motion control module; the motion controller collects data of the encoder, the encoder data are sent to a serial port communication unit of a communication module of the upper computer through the communication module of the motion controller by using a serial port, and after the serial port communication unit of the communication module of the upper computer receives the encoder data, the encoder data are sent to an encoder data processing subunit of the data processing unit for odometer calculation;
serial port communication between sensor and host computer: the serial port communication unit of the upper computer communication module obtains lidar and IMU data from the lidar and the 100D2 IMU through a serial port, then sends the lidar data to a lidar data processing subunit of the data processing unit, and sends the IMU data to an IMU data processing subunit of the data processing unit;
after the upper computer completes the construction of a balance car map, self positioning and path planning, the expected angular velocity and the expected linear velocity are sent to the motion controller;
the motion controller can complete the calculation of the duty ratio of the PWM wave required by the balance car to reach the destination by collecting the information of the sensor in real time and combining the data sent by the upper computer with an active disturbance rejection control method, and sends the PWM wave to the motion actuator in real time; a motion controller; the device comprises a motion control module, an active disturbance rejection control module and a communication module;
the motion control module comprises an upright control unit, a direction control unit and a speed control unit; the deviation between the real-time angle of the balance car and the expected balance angle is calculated through the vertical control unit, and the balance car has a good balance effect at a balance position by combining with the active disturbance rejection control module; calculating the deviation between the real-time angular speed and the expected angular speed by using a direction control unit, and enabling the balance car to run along the planned path by combining an active disturbance rejection control module; calculating the deviation between the real-time speed and the expected speed by using a speed control unit, and driving the balance car at the calculated speed by combining an active disturbance rejection control module; the respective functions of the three units in the motion control module are set forth below:
an upright control unit: firstly, a motion controller is used for collecting data of a sensor MPU6050, wherein the data comprises angular speed and acceleration information of a pitching angle of a balance car; because the acceleration information is easily annihilated by high-frequency noise, the acceleration information is filtered by a Butterworth low-pass filter, then the angular velocity gyro in the pitch Angle direction of the balance car is fused with the acceleration acc by a complementary filtering formula (3), and the calibration is carried out after the weight x is adjusted, so that the Angle information Angle can be obtained, wherein dt is the period of Angle calculation:
Angle＝x*(Angle+gyro*dt)+(1-x)*acc； (3)
then, the real-time Angle and the expected balance Angle are subjected to deviation input to an active disturbance rejection control module;
a direction control unit: obtaining an expected angular velocity from a communication module of a motion controller, acquiring the angular velocity of the yaw angle of the balance car in real time from a sensor MPU6050, unifying the units of the angular velocity and the yaw angle, and inputting the subtraction result of the angular velocity and the yaw angle to an active disturbance rejection control module;
a speed control unit: firstly, a motion controller is used for acquiring data of a sensor encoder, wherein the encoder data represents the rotating speed of left and right wheels of the balance car; calculating the real-time speed of the balance car through encoder data; unifying the real-time vehicle speed and the expected linear speed unit obtained from the communication module of the motion controller, performing subtraction, and inputting the result to the active disturbance rejection control module;
finally, the results of the three units, namely the upright control unit, the direction control unit and the speed control unit are input to the active disturbance rejection control module;
the active disturbance rejection control module adopts a control method of active disturbance rejection control, and comprises a differential tracking unit, an expansion state observation unit and a nonlinear control rate unit;
a differential tracking unit: the method is used for solving the problems that a navigation module or a communication module generates discontinuous or random noise signals, and reasonably extracts expected angular velocity and velocity signals and differential signals from the discontinuous or random noise signals, so that the expected signals are smooth; three deviation values input from the motion control module are smoothed to prevent sudden change of signals from influencing the stability of the system, and the results are output to the expansion observation unit and the nonlinear control rate unit respectively;
an expanded state observation unit: the expansion state observation unit is mainly used for observing the disturbance of the system and offsetting the disturbance; the expansion state observation unit obtains three deviation amounts from the differential tracking unit: balancing the angular deviation, angular velocity deviation and speed deviation of the vehicle; expanding the total disturbance signals into new state variables, observing the expanded total disturbance signals through a special feedback mechanism, constructing a system with the total disturbance being one state variable and two orders through input and output, wherein an expansion observer of the system reaches three orders, the state of the total disturbance of the whole balance car system is added, and the finally observed total disturbance output is differed with a signal output to a nonlinear control rate unit by a differential tracking unit to eliminate the disturbance, so that the system is more stable;
a nonlinear control rate unit: the nonlinear control method is constructed by a steepest control comprehensive function Fhan; the problem that a linear controller cannot control a nonlinear system of the balance car to obtain a good effect is solved; taking the result of difference between the output of the differential tracking unit and the output of the expansion state observation unit as the input of the nonlinear control rate unit, calculating the duty ratios of pwm waves required by the vertical control, the direction control and the speed control through calculation, and linearly superposing and outputting the duty ratios to the motion actuator;
the communication module in the motion controller realizes serial communication between the motion controller and the upper computer: a serial port communication unit of the upper computer subscribes to an expected angular velocity and an expected linear velocity output by a local path planning unit in the navigation module, then sends the expected angular velocity and the expected linear velocity to the motion controller through a serial port, and after receiving the expected angular velocity and the expected linear velocity, a communication module of the motion controller outputs data to a direction control unit and a speed control unit of the motion control module; the motion controller collects data of the encoder, the encoder data are sent to a serial port communication unit of the upper computer communication module through a communication module of the motion controller by utilizing a serial port, and after the serial port communication unit of the upper computer communication module receives the encoder data, the encoder data are sent to an encoder data processing subunit of the data processing unit for odometer calculation.
2. The system of claim 1, wherein the balance car indoor positioning and navigation system based on the single line laser radar is characterized in that: the motion actuator adopts a direct current motor, receives PMW waves sent by the motion controller, and converts the PMW waves into driving force to control the balance of the balance car and the thrust reaching a destination.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010080571.6A CN111308490B (en) | 2020-02-05 | 2020-02-05 | Balance car indoor positioning and navigation system based on single-line laser radar |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010080571.6A CN111308490B (en) | 2020-02-05 | 2020-02-05 | Balance car indoor positioning and navigation system based on single-line laser radar |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111308490A CN111308490A (en) | 2020-06-19 |
| CN111308490B true CN111308490B (en) | 2021-11-19 |
Family
ID=71159910
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010080571.6A Active CN111308490B (en) | 2020-02-05 | 2020-02-05 | Balance car indoor positioning and navigation system based on single-line laser radar |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111308490B (en) |
Families Citing this family (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111976730B (en) * | 2020-08-27 | 2021-11-30 | 清华大学 | Chassis zone controller with driver-like visual angle and vehicle control method |
| CN112066982B (en) * | 2020-09-07 | 2021-08-31 | 成都睿芯行科技有限公司 | Industrial mobile robot positioning method in high dynamic environment |
| CN112268561A (en) * | 2020-10-12 | 2021-01-26 | 西北工业大学 | A Robot Monte Carlo Localization Method Based on Magnetic Field Information |
| CN112904841B (en) * | 2021-01-12 | 2023-11-03 | 北京布科思科技有限公司 | Non-horizontal single-line positioning obstacle avoidance method, device, equipment and storage medium |
| CN112882475A (en) * | 2021-01-26 | 2021-06-01 | 大连华冶联自动化有限公司 | Motion control method and device of Mecanum wheel type omnibearing mobile robot |
| CN112965494B (en) * | 2021-02-09 | 2024-06-14 | 武汉理工大学 | Control system and method for pure electric automatic driving special vehicle in fixed area |
| CN113029143B (en) * | 2021-02-24 | 2023-06-02 | 同济大学 | An indoor navigation method suitable for pepper robots |
| CN113280808A (en) * | 2021-05-25 | 2021-08-20 | 上海大学 | Method and system for improving positioning accuracy of mobile robot |
| CN113777990B (en) * | 2021-09-15 | 2023-04-07 | 广州安广电子科技股份有限公司 | Single-line debugging graphic terminal of single-chip microcomputer |
| CN114604233B (en) * | 2022-03-16 | 2025-06-13 | 坎德拉（深圳）科技创新有限公司 | A control method and system for a two-wheel drive independent steering motorcycle-type robot |
| CN115857509B (en) * | 2022-12-08 | 2025-09-19 | 成都四威高科技产业园有限公司 | Differential wheel type robot laser positioning and coordinated motion control method |
| CN116242348A (en) * | 2023-02-23 | 2023-06-09 | 南京邮电大学 | An indoor mobile robot automatic navigation system and its navigation method |
| CN117068207B (en) * | 2023-10-17 | 2024-01-12 | 合肥焕智科技有限公司 | Vehicle-mounted control system based on laser SLAM navigation |
Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106325275A (en) * | 2016-09-14 | 2017-01-11 | 广州今甲智能科技有限公司 | Robot navigation system, robot navigation method and robot navigation device |
| CN107065863A (en) * | 2017-03-13 | 2017-08-18 | 山东大学 | A kind of guide to visitors based on face recognition technology explains robot and method |
| CN107478214A (en) * | 2017-07-24 | 2017-12-15 | 杨华军 | A kind of indoor orientation method and system based on Multi-sensor Fusion |
| CN108733062A (en) * | 2018-06-25 | 2018-11-02 | 山东大学 | Family accompanies and attends to robot autonomous charging system and method |
| CN108759822A (en) * | 2018-04-12 | 2018-11-06 | 江南大学 | A 3D positioning system for a mobile robot |
| CN109276833A (en) * | 2018-08-01 | 2019-01-29 | 吉林大学珠海学院 | A kind of robot patrol fire-fighting system and its control method based on ROS |
| CN109460029A (en) * | 2018-11-29 | 2019-03-12 | 华南农业大学 | Livestock and poultry cultivation place inspection mobile platform and its control method |
| CN109507677A (en) * | 2018-11-05 | 2019-03-22 | 浙江工业大学 | A kind of SLAM method of combination GPS and radar odometer |
| CN109544638A (en) * | 2018-10-29 | 2019-03-29 | 浙江工业大学 | A kind of asynchronous online calibration method for Multi-sensor Fusion |
| CN109900280A (en) * | 2019-03-27 | 2019-06-18 | 浙江大学 | A kind of livestock and poultry information Perception robot and map constructing method based on independent navigation |
| CN109947103A (en) * | 2019-03-18 | 2019-06-28 | 深圳一清创新科技有限公司 | Unmanned control method, device, system and load bearing equipment |
| CN109959377A (en) * | 2017-12-25 | 2019-07-02 | 北京东方兴华科技发展有限责任公司 | A kind of robot navigation's positioning system and method |
| CN109955215A (en) * | 2017-12-14 | 2019-07-02 | 河北汇金机电股份有限公司 | Lidar self-adaptive adjustment device and adjustment method for two-wheeled self-balancing robot |
| CN110001840A (en) * | 2019-03-12 | 2019-07-12 | 浙江工业大学 | A kind of double-wheel self-balancing vehicle motion control method under various road conditions of view-based access control model sensor |
| CN110261870A (en) * | 2019-04-15 | 2019-09-20 | 浙江工业大学 | It is a kind of to synchronize positioning for vision-inertia-laser fusion and build drawing method |
| CN110632919A (en) * | 2019-08-28 | 2019-12-31 | 广东工业大学 | An autonomous positioning and navigation method based on a crawler rescue robot |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9020637B2 (en) * | 2012-11-02 | 2015-04-28 | Irobot Corporation | Simultaneous localization and mapping for a mobile robot |
| US10029708B2 (en) * | 2016-04-20 | 2018-07-24 | Gary Viviani | Autonomous railroad monitoring and inspection device |
| US10667980B2 (en) * | 2018-03-28 | 2020-06-02 | The Board Of Trustees Of The University Of Alabama | Motorized robotic walker guided by an image processing system for human walking assistance |
-
2020
- 2020-02-05 CN CN202010080571.6A patent/CN111308490B/en active Active
Patent Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106325275A (en) * | 2016-09-14 | 2017-01-11 | 广州今甲智能科技有限公司 | Robot navigation system, robot navigation method and robot navigation device |
| CN107065863A (en) * | 2017-03-13 | 2017-08-18 | 山东大学 | A kind of guide to visitors based on face recognition technology explains robot and method |
| CN107478214A (en) * | 2017-07-24 | 2017-12-15 | 杨华军 | A kind of indoor orientation method and system based on Multi-sensor Fusion |
| CN109955215A (en) * | 2017-12-14 | 2019-07-02 | 河北汇金机电股份有限公司 | Lidar self-adaptive adjustment device and adjustment method for two-wheeled self-balancing robot |
| CN109959377A (en) * | 2017-12-25 | 2019-07-02 | 北京东方兴华科技发展有限责任公司 | A kind of robot navigation's positioning system and method |
| CN108759822A (en) * | 2018-04-12 | 2018-11-06 | 江南大学 | A 3D positioning system for a mobile robot |
| CN108733062A (en) * | 2018-06-25 | 2018-11-02 | 山东大学 | Family accompanies and attends to robot autonomous charging system and method |
| CN109276833A (en) * | 2018-08-01 | 2019-01-29 | 吉林大学珠海学院 | A kind of robot patrol fire-fighting system and its control method based on ROS |
| CN109544638A (en) * | 2018-10-29 | 2019-03-29 | 浙江工业大学 | A kind of asynchronous online calibration method for Multi-sensor Fusion |
| CN109507677A (en) * | 2018-11-05 | 2019-03-22 | 浙江工业大学 | A kind of SLAM method of combination GPS and radar odometer |
| CN109460029A (en) * | 2018-11-29 | 2019-03-12 | 华南农业大学 | Livestock and poultry cultivation place inspection mobile platform and its control method |
| CN110001840A (en) * | 2019-03-12 | 2019-07-12 | 浙江工业大学 | A kind of double-wheel self-balancing vehicle motion control method under various road conditions of view-based access control model sensor |
| CN109947103A (en) * | 2019-03-18 | 2019-06-28 | 深圳一清创新科技有限公司 | Unmanned control method, device, system and load bearing equipment |
| CN109900280A (en) * | 2019-03-27 | 2019-06-18 | 浙江大学 | A kind of livestock and poultry information Perception robot and map constructing method based on independent navigation |
| CN110261870A (en) * | 2019-04-15 | 2019-09-20 | 浙江工业大学 | It is a kind of to synchronize positioning for vision-inertia-laser fusion and build drawing method |
| CN110632919A (en) * | 2019-08-28 | 2019-12-31 | 广东工业大学 | An autonomous positioning and navigation method based on a crawler rescue robot |
Non-Patent Citations (3)
| Title |
|---|
| Development of a multi-purpose unmanned surface vehicle and simulation comparison of path tracking methods;T. Kim, J. Choi, Y. Lee and H. Choi;《2016 13th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI), 2016》;20161107;447-451 * |
| SLAM 过程中的机器人位姿估计优化算法研究;禹鑫燚;《高技术通讯》;20181231;712-718 * |
| 一种无人机定向天线稳定跟踪系统;樊琼剑;《四川兵工学报》;20130430;84-86 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111308490A (en) | 2020-06-19 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111308490B (en) | Balance car indoor positioning and navigation system based on single-line laser radar | |
| Kim et al. | Vision aided dynamic exploration of unstructured terrain with a small-scale quadruped robot | |
| Gao et al. | Review of wheeled mobile robots’ navigation problems and application prospects in agriculture | |
| CN111982114B (en) | Rescue robot for estimating three-dimensional pose by adopting IMU data fusion | |
| CN109916393B (en) | Multi-grid-value navigation method based on robot pose and application thereof | |
| CN110471426B (en) | Automatic collision avoidance method for unmanned intelligent vehicles based on quantum wolf pack algorithm | |
| WO2021254367A1 (en) | Robot system and positioning navigation method | |
| CN112518739B (en) | Intelligent autonomous navigation method for reconnaissance of tracked chassis robot | |
| CN111522339A (en) | Automatic path planning and positioning method and device for inspection robot of livestock and poultry house | |
| Li et al. | Localization and navigation for indoor mobile robot based on ROS | |
| CN105487535A (en) | Mobile robot indoor environment exploration system and control method based on ROS | |
| JP2019501384A (en) | Autonomous positioning navigation equipment, positioning navigation method and autonomous positioning navigation system | |
| CN113093756A (en) | Indoor Navigation Robot Based on Laser SLAM on Raspberry Pi Platform | |
| CN117760407A (en) | A multi-positioning sensor fusion robot positioning and navigation system and method | |
| Teng et al. | Multi-sensor fusion based wheeled robot research on indoor positioning method | |
| CN115599099B (en) | An autonomous navigation robot based on ROS | |
| Liu et al. | Autonomous vehicle based on ros2 for indoor package delivery | |
| Martinez et al. | Rapidly exploring random trees for autonomous navigation in observable and uncertain environments | |
| He et al. | Research on mobile robot positioning and navigation system based on multi-sensor fusion | |
| CN118466484A (en) | Unmanned transport equipment and control method, device and medium thereof | |
| Gyanani et al. | Autonomous Mobile Vehicle Using ROS2 and 2D-Lidar and SLAM Navigation | |
| CN114995457A (en) | Autonomous navigation method and system of terrain-like city rescue robot | |
| Zheng et al. | Indoor Mobile Robot Map Construction Based on Improved Cartographer Algorithm | |
| Havås et al. | Optimized unmanned aerial vehicle (UAV) localization and autonomous navigation stack for tightly closed industrial spaces | |
| Boissé et al. | Cybernetic transportation systems design and development: Simulation software cybercars |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |