WO2020088461A1 - Control method and system for walking robot - Google Patents

Control method and system for walking robot Download PDF

Info

Publication number
WO2020088461A1
WO2020088461A1 PCT/CN2019/114040 CN2019114040W WO2020088461A1 WO 2020088461 A1 WO2020088461 A1 WO 2020088461A1 CN 2019114040 W CN2019114040 W CN 2019114040W WO 2020088461 A1 WO2020088461 A1 WO 2020088461A1
Authority
WO
WIPO (PCT)
Prior art keywords
point
walking robot
narrow area
starting
narrow
Prior art date
Application number
PCT/CN2019/114040
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
Priority claimed from CN201811410347.8A external-priority patent/CN111198557B/en
Application filed by 苏州科瓴精密机械科技有限公司 filed Critical 苏州科瓴精密机械科技有限公司
Publication of WO2020088461A1 publication Critical patent/WO2020088461A1/en

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01DHARVESTING; MOWING
    • A01D43/00Mowers combined with apparatus performing additional operations while mowing
    • A01D43/12Mowers combined with apparatus performing additional operations while mowing with soil-working implements, e.g. ploughs
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions

Definitions

  • the invention relates to the field of intelligent control, in particular to a control method and processing system of a walking robot.
  • the object of the present invention is to provide a control method and system for a walking robot.
  • the method specifically includes: dividing the starting interval into a plurality of sub-intervals; and selecting at least one starting point corresponding to the sub-interval in each sub-interval.
  • "dividing the starting interval into multiple sub-intervals according to the ordered sequence” specifically includes: dividing the starting interval into multiple sub-intervals according to the ordered sequence, so that the length relationship between the sub-intervals is For example, at least one of the arithmetic sequence, the geometric sequence, the equal sum sequence, the Fibonacci sequence, the group sequence, the period sequence, and the step sequence.
  • the method further includes: automatically acquiring a frequency value corresponding to each starting point in the current line-travel route; the frequency value is the number of consecutive departures of the walking robot at the same starting point.
  • the method further includes: acquiring the state attributes of the walking robot in real time, the state attributes including: at least one of the battery pack power, the continuous working duration, and the continuous working walking distance; If the power of the battery pack of the walking robot is less than the preset power threshold, and / or the continuous working duration is greater than the preset working duration threshold, and / or the continuous walking distance is greater than the preset continuous walking distance threshold, the walking robot is driven Return to the base station.
  • the position value and / or frequency value of the starting point are newly determined.
  • FIG. 4 is a schematic flow chart of acquiring a position value corresponding to each starting point in any non-narrow area in an embodiment of the present invention
  • FIG. 8 is a schematic structural view of a walking route of a walking robot in a specific example of the present invention.
  • FIG. 10 is a schematic diagram of a work flow of a control system of a walking robot in an embodiment of the present invention.
  • the walking robot of the present invention may be an automatic lawn mower, or an automatic vacuum cleaner, etc., which automatically walks in the work area to perform grass cutting and vacuuming work.
  • the walking robot is used as a lawn mower as an example for specific description
  • the working area may be a lawn.
  • the base station is connected to a boundary line arranged along the peripheral side of the working area.
  • the base station transmits a pulse code signal to the boundary line
  • the pulse code signal is transmitted within the boundary line to form a magnetic field near the boundary line and generate an electromagnetic signal.
  • the control unit includes at least a status sensor, which is used to acquire various information obtained by the walking robot along the patrol route, for example: acquiring the electromagnetic signal strength on the patrol route; in this specific embodiment, the status sensor includes The boundary line sensor will be described in detail in the following content; the data storage is used to store various information obtained by the robot walking along the line patrol path, such as EPROM, Flash or SD card. There are various types of information obtained by the walking robot walking along the patrol route, which will be described in further detail below.
  • a method for controlling a walking robot includes:
  • At least one line patrol mode and one operation mode are configured for the walking robot; in the line patrol mode, the walking robot can be driven from the initial point, walk along the line patrol path for one week, and record the line patrol The perimeter of the path, the strength of the electromagnetic signal actually received by the walking robot, etc.
  • the walking robot may also be driven from the initial point and reach a specific starting point along the line patrol path to enter the work mode.
  • the walking robot can be driven to walk along a straight line or a curve in the working area and cut grass. When the walking robot reaches a certain posture (such as encountering a boundary line), it turns to enter the direction of the working area. In the work mode, you can also drive the walking robot to walk along the boundary line and cut the grass.
  • the boundary line sensor detects the electromagnetic signal actually received on the walking robot.
  • the method further includes: S3, dividing the area formed by the current patrol route into at least one narrow area formed by at least one narrow channel, and at least two connected at both ends of the at least one narrow area Non-narrow area.
  • the step S4 specifically includes: S41, acquiring a critical point formed between a narrow area and a non-narrow area, and the position value corresponding to each critical point; In the extending direction of the line path, the critical points formed are the critical point P 1 , the critical point P 2 , the critical point P 3 , and the critical point P 4.
  • the position values corresponding to each critical point are L P1 , L P2 , L P3 , L P4 ; S42, obtain the perimeter of each non-narrowed area according to the position value corresponding to each critical point; or obtain the perimeter of each non-narrowed area according to the obtained position value corresponding to the critical point and the perimeter of the route path; S43 .According to the perimeter of each non-narrow area, the position value corresponding to each starting point in the non-narrow area is independently obtained.
  • step S41 after determining the position of the narrow passage, the walking robot can automatically identify the critical point, that is, the position of the critical point can be determined.
  • the present invention places the critical point in the extending direction of the patrol path (ie, direction D1) ) Is represented by the critical point P 1 , the critical point P 2 , the critical point P 3 , and the critical point P 4 according to the order of arrival; in other embodiments of the present invention, the coil can also be manually laid at the corresponding position of the critical point The method increases the accuracy of identifying the critical point, which will not be described in detail here.
  • the present invention describes a specific example to facilitate understanding;
  • the line-traveling path starts from the initial point (base station position in this embodiment), extends in the direction of arrow D1, and returns To the end of the initial point;
  • the working area includes the non-narrow area A, the non-narrow area B, and the narrow area C that divides the working area into the non-narrow area A and the non-narrow area B;
  • the walking robot After walking along the boundary line (that is, the patrol route) for one week, the perimeter of the patrol route is obtained as l sum , and the critical points formed by the non-narrow area A and the narrow area C in the extension direction of the patrol route are P 1 and Critical point P 4 , the order of the critical points formed by the non-narrow area B and the narrow area C in the extending direction of the line-travel path is P 2 and the critical point P 3 , and the position values corresponding to each critical point in the extending direction of the line
  • the present invention describes a specific example to facilitate understanding.
  • the perimeter of the current non-narrowed area A is accumulated from the initial point along the extension direction of the route, when the critical point is reached At P 1 , stop accumulating the perimeter of the current non-stenosis area A.
  • stop accumulating the perimeter of the current non-stenosis area A When reaching P 4 , continue to accumulate the perimeter of the current non-stenosis area A until returning to the initial point; that is, the perimeter of the non-stenosis area A is equal to the patrol line The sum of the length from the initial point to P 1 and the length from P 4 to the initial point in the extending direction of the path.
  • the circumference of the current non-stenosis area B starts to accumulate until after reaching P 3 , the accumulation of the current non-stenosis area B's circumference is stopped; that is The perimeter of the non-narrow area B is equal to the length of P 2 to P 3 in the extending direction of the line-tracing path.
  • the starting point L S may be any point on the current line-tracking path.
  • the step S432 specifically includes: dividing the departure interval into a plurality of sub-intervals; selecting at least one departure point corresponding to the sub-interval in each sub-interval respectively.
  • the departure interval is divided into multiple sub-intervals according to an ordered sequence, so that the length relationship between the sub-intervals is represented as an equidistance sequence, At least one of the proportional sequence, the equal sum sequence, the Fibonacci sequence, the group sequence, the period sequence, the step sequence, etc.
  • n can be preset, or the length of each sub-interval can be specified, and the formula Obtain the number n of subintervals, where intD () is a rounding function down.
  • the step S432 specifically includes: obtaining at least one starting point in a random or pseudo-random manner within the starting interval.
  • the first departure interval is selected according to the first preset length, and the first one is randomly selected in the first departure interval Departure point; in turn take the selected departure point as the starting point, divide at least one second departure interval according to the second preset length, and randomly select the next departure point within the second departure interval until the entire departure interval is traversed.
  • the first preset length and the second preset length are both length preset constant values, and their sizes can be specifically set according to the length of the departure interval, for example: according to the length ratio corresponding to the departure interval, the This will not be described in detail; the departure interval is divided into a first departure interval and at least one second departure interval according to the first preset length, the second preset length, and the position of the selected departure point.
  • the two departure intervals are only distinguished according to the second preset length, and the true length is not specifically limited. Since each departure point is selected in a random or pseudo-random manner, when the second departure interval exceeds one, each second The length of the departure interval may vary.
  • the first starting point is within the range defined by the starting point S and the first preset length, and its specific position within the range can be arbitrarily specified, or it can be determined by a random or pseudo-random algorithm, and the next starting point is on the previous The position of the starting point is selected within the starting interval defined by the second preset length.
  • the method further includes: S5. Before reaching a preset condition, only the walking robot is allowed to select to enter the work mode at the starting point belonging to the same non-narrow area, and the walking robot is prohibited from entering The narrow area.
  • the frequency value corresponding to each starting point in the current line patrol route is automatically obtained; the frequency value is the number of consecutive departures from the same starting point.
  • the frequency value corresponding to each starting point can be specified arbitrarily, and can also be obtained according to a certain rule.
  • the frequency value of each starting point is configured to be equal within the preset frequency threshold range; or within the preset frequency threshold range, according to the distance between each starting point and its adjacent previous starting point on the patrol route The distance difference above is positively related to configuring the frequency value corresponding to each starting point; or within the preset frequency threshold range, randomly configuring any frequency value for each starting point.
  • the frequency threshold range is usually a numerical range, the minimum value is 1, the maximum value is M, and M is a positive integer; under normal circumstances, it can be specifically set according to the size of the work area and the length relationship between adjacent starting points, for example: When the obtained starting points are equidistantly set, the frequency values corresponding to the starting points are usually set to be equal. When the distance between adjacent starting points is greater, the frequency values of adjacent starting points are correspondingly set to be larger; of course You can also set the total frequency value, and then assign the frequency value in proportion to the position value corresponding to the starting point, which will not be described in detail here.
  • the method further includes: establishing a memory list for storing each starting point and its corresponding position value and frequency value; by querying the memory list, obtaining the position value corresponding to each starting point Sum frequency value.
  • the walking robot is driven to work in the current non-narrow area until a preset condition is reached, and then passes through the narrow area and enters the next non-narrow area to complete the work.
  • the walking robot is only allowed to enter the working state at the starting point belonging to the current non-narrow area, and the walking robot is prohibited from entering the narrow area.
  • the working order of the walking robot is slightly adjusted corresponding to the different positions of the starting point.
  • all the starting points in the current non-narrow area are on the same continuous line of patrol in the direction of the extension of the line of patrol, so that during the work, they continue to walk along the line of patrol, ie All starting points on the non-narrow area A and the non-narrow area B can be traversed separately.
  • the first preferred embodiment obtains the perimeter of each non-narrowed area according to the position value corresponding to each critical point, which is more applicable to all starting points on the non-narrowed area, and extends in the direction of the patrol route. It is on the same continuous line of patrol route.
  • the starting point on the current non-narrow area is on two consecutive line patrol paths in the extending direction of the line patrol path.
  • the walking robot does not complete the work of the current non-narrow area A, it needs to be avoided It enters the narrow area.
  • the walking robot accidentally enters the narrow area, it needs to return to the current non-narrow area A. After traversing all the starting points of the narrow area A, it then passes through the narrow area and enters the non-narrow area B.
  • the second preferred embodiment obtains the perimeter of each non-narrowed area according to the position value corresponding to each critical point, which is more suitable for the starting point on the non-narrowed area and is located at 2 On a continuous line of patrol route.
  • the walking direction of the robot can be adjusted to reach another boundary line corresponding to the current boundary line, and then Then adjust the walking direction of the robot to make it return to the current non-narrow area and continue to work.
  • control method of the walking robot of the present invention further includes: acquiring the state attributes of the walking robot in real time, the state attributes including: at least one of the battery pack power, the continuous working duration, and the continuous working walking distance; according to the walking robot State attribute to determine whether to execute the regression mode.
  • the walking robot If the power of the battery pack of the walking robot is less than the preset power threshold, and / or the continuous working duration is greater than the preset working duration threshold, and / or the continuous walking distance is greater than the preset continuous walking distance threshold, the walking robot is driven Perform regression mode.
  • the walking robot finds the position of the base station, and returns to the base station for charging, and after charging is completed, returns to the position where the return mode was executed and continues to work.
  • the position value and / or frequency value of the starting point is re-determined, which helps avoid The problem of grass abrasion is caused by too many steering turns in the same position.
  • the starting point position value and / or frequency value may also be re-determined according to other preset conditions, including but not limited to cumulative working time, cumulative working walking distance, cumulative charging times, whether it is specific The number of times of booting, etc.
  • the boundary line starts from the initial point, extends in the direction of arrow D1, and returns to the end of the initial point; line1 is the inner parallel line of the boundary line located on the lawn, and line2 is the outer parallel line of the boundary line located on the edge of the lawn.
  • the distance between the two from the boundary line is generally a body, and the distance between the inner boundary line1 can be appropriately widened; the walking robot can travel within the range between line1 and line2 on both sides of the boundary line; and it can be executed in a certain order: as in Move to the left once, move to the right one wheel wide position next time, and move to the next wheel wide position again. When reaching the extreme position on the right, turn to the left and drive back and forth from the charging station. A random or other method is used to drive the walking robot between the boundary lines line1 and line2 to achieve the purpose of protecting the lawn.
  • the control system of the walking robot includes: a configuration module 100, a patrol module 200, an area division module 300, a control processing module 400 and a storage module 500.
  • the patrol module 200 is used to drive the walking robot from the initial point, walk along the patrol route for one week, record the circumference of the patrol route and confirm the position of the narrow passage on the patrol route.
  • the configuration module 100 transmits a pulse-coded signal along the patrol route through a signal generating device provided in the base station to generate an electromagnetic signal on the patrol route.
  • the patrol module 200 is used to drive the walking robot to walk along the extension direction of the patrol line path, record the strength of the electromagnetic signal actually received by the walking robot, and confirm the narrow channel on the patrol path according to the strength of the electromagnetic signal actually received by the walking robot s position.
  • the area dividing module 300 is used to divide the area formed by the current patrol route into at least one narrow area formed by at least one narrow passage, and at least two non-narrow areas connected at both ends of the at least one narrow area. .
  • the control processing module 400 is used to: obtain the position value corresponding to each departure point in each non-narrow area according to the recorded perimeter of the tour route; the position value is the length of the current departure point from the initial point on the tour route.
  • control processing module 400 is specifically used to: obtain the critical point formed between the narrow area and the non-narrow area, and the position value corresponding to each critical point; wherein, along the extension direction of the patrol path, form The order of critical points is critical point P 1 , critical point P 2 , critical point P 3 , critical point P 4 , and the corresponding position values of each critical point are L P1 , L P2 , L P3 , L P4 in sequence; according to each critical point Obtain the perimeter of each non-narrowed area according to the corresponding position value; or obtain the perimeter of each non-narrowed area according to the obtained position value corresponding to the critical point and the perimeter of the route path; S43, according to the perimeter of each non-narrowed area Long independently obtains the position value corresponding to each starting point in the non-narrow area.
  • control processing module 400 is specifically used to obtain the perimeter of each non-narrow area using an accumulation algorithm, that is, to determine whether the initial point is on the current non-narrow area, and if so, to extend along the route direction, from the initial accumulation point on the perimeter of the current non-narrow region and reach the critical point P 1, stopping the accumulation of non-narrow region of the circumference of this, when P 4 reaches the critical point, the current continues to accumulate non narrow circumferential area Long until it returns to the initial point; if not, the current perimeter of the non-narrow area is the length from the critical point P 2 to the critical point P 3 along the extension direction of the route.
  • an accumulation algorithm that is, to determine whether the initial point is on the current non-narrow area, and if so, to extend along the route direction, from the initial accumulation point on the perimeter of the current non-narrow region and reach the critical point P 1, stopping the accumulation of non-narrow region of the circumference of this, when P 4 reaches the critical point, the current continues to accumulate non narrow circumferential area
  • control processing module 400 is specifically configured to divide the departure interval into a plurality of sub-intervals; at least one departure point corresponding to the sub-interval is selected in each sub-interval.
  • the control processing module 400 divides the departure interval into multiple sub-intervals.
  • the departure interval is divided into multiple sub-intervals according to an ordered sequence, so that the length relationship between the sub-intervals is, for example, Arithmetic series, isometric series, equal sum series, Fibonacci series, grouping series, periodic series, step series and so on.
  • control processing module 400 is also used to obtain at least one starting point in a random or pseudo-random manner within the starting interval.
  • control processing module 400 selects the first starting interval according to the first preset length from the position value L S of the starting point S in the starting interval, and randomly selects the first starting interval Set the first starting point; take the selected starting point as the starting point in sequence, divide at least one second starting interval according to the second preset length, and randomly select the next starting point within the second starting interval until the entire starting point is traversed Interval.
  • control processing module 400 is further configured to drive the walking robot to walk along the line-tracking path to traverse each starting point on each non-narrow area, and reach each starting point within the same non-narrow area according to the corresponding position value At this time, the walking robot is driven into a working state; wherein, before the work of each narrow area is completed, the walking robot is prevented from entering the narrow area.
  • control processing module 400 if the control processing module 400 confirms that a walking robot enters the narrow region by accident through a boundary line of the narrow region, it can adjust the walking direction of the robot to reach another corresponding to the current boundary line after entering the narrow region A boundary line, and then adjust the walking direction of the robot to make it return to the current non-narrow area and continue to work.
  • control processing module 400 automatically obtains the frequency value corresponding to each starting point in the current patrol route; the frequency value is the number of consecutive departures from the same starting point; only the walking is allowed until the preset conditions are reached
  • the robot chooses to enter the work mode at the starting point belonging to the same non-narrow area, and prohibits the walking robot from entering the narrow area.
  • At least one memory list is set in the storage module 500; the memory list is used to store each starting point and its corresponding position value and frequency value, and generate a position value sequence table according to the frequency value.
  • the disclosed system, system, and method may be implemented in other ways.
  • the system implementation described above is only schematic.
  • the division of the modules is only a division of logical functions.
  • there may be other divisions for example, multiple modules or components may be combined or Can be integrated into another system, or some features can be ignored, or not implemented.
  • the displayed or discussed mutual coupling or direct coupling or communication connection may be indirect coupling or communication connection through some interfaces, systems or modules, and may be in electrical, mechanical or other forms.
  • each functional module in each embodiment of the present application may be integrated into one processing module, or each module may exist alone physically, or two or more modules may be integrated into one module.
  • the above integrated modules can be implemented in the form of hardware, or in the form of hardware plus software function modules.
  • the above integrated modules implemented in the form of software function modules may be stored in a computer-readable storage medium.
  • the above software function modules are stored in a storage medium, and include several instructions to enable a computer system (which may be a personal computer, a server, or a network system, etc.) or a processor (processor) to perform the methods described in the various embodiments of the present application. Partial steps.
  • the aforementioned storage media include: U disk, mobile hard disk, read-only memory (Read-Only Memory, ROM), random access memory (Random Access Memory, RAM), magnetic disk or optical disk and other media that can store program code .
  • ST2 The robot enters the line patrol mode, starts from the initial point, walks along the boundary line and returns to the initial point after going around the boundary line once, and records the circumference of the boundary line and the position of the narrow area.
  • ST6 The robot starts from the initial point and walks along the boundary line to the starting point corresponding to the starting sequence number of the non-narrow area again in the patrol mode.
  • ST7 The robot turns from the starting point away from the boundary line, enters the non-narrow area and starts mowing, that is, enters the operation mode from the line patrol mode.
  • ST8 The robot maintains the operation mode and performs mowing operations in the work area.
  • the judgment condition is whether the cumulative working time in the non-narrow area reaches a threshold; in some embodiments, the judgment condition is whether the cumulative working walking distance in the non-narrow area reaches one Threshold. If yes, execute ST13, if no, execute ST14.
  • the judgment condition here may be a single condition, or a combination of multiple conditions, including but not limited to the conditions listed above in the form of examples.
  • ST15 The system is shut down and the work is ended.
  • the robot is usually located in the base station in a stored state, and the power of the robot and / or base station is automatically or artificially cut off.

Abstract

Disclosed are a control method and system for a walking robot. The system comprises: a configuration module (100), for supplying a closed line patrol path, wherein the line patrol path is a closed loop formed by a boundary line of a working area where a walking robot is located; a patrol module (200) for driving the walking robot to set out from a beginning point, walk along the line patrol path, record the perimeter of the line patrol path and determine the position of a narrow channel on the line patrol path; an area dividing module (300) for dividing an area formed by the current line patrol path into at least one narrow area formed by at least one narrow channel and at least two non-narrow areas connected to two ends of at least one narrow area; and a control processing module (400) for acquiring a position value corresponding to each starting point in each non-narrow area according to the recorded perimeter of the line patrol path, wherein the starting point is arranged on the line patrol path and each non-narrow area comprises at least one of the starting points, and the position value is equal to the length value of a distance on the line patrol path of the current starting point to the beginning point. Before a preset condition is met, the walking robot is only allowed to choose to enter into a working state at the starting point of the same non-narrow area and is forbidden from entering into the narrow area. Working spaces can be automatically divided to make a walking robot avoid entering into a narrow area during a working process thereof in each non-narrow area, improving working efficiency.

Description

行走机器人的控制方法及系统Control method and system of walking robot 技术领域Technical field
本发明涉及智能控制领域,尤其涉及一种行走机器人的控制方法及处理系统。The invention relates to the field of intelligent control, in particular to a control method and processing system of a walking robot.
背景技术Background technique
随着科学技术的不断进步,各种自动工作设备已经开始慢慢的走进人们的生活,例如:自动吸尘机器人、自动割草机器人等。这种自动工作设备具有行走装置、工作装置及自动控制装置,从而使得自动工作设备能够脱离人们的操作,在一定范围内自动行走并执行工作,在自动工作设备的储能装置能量不足时,其能够自动返回充电站装置进行充电,然后继续工作。With the continuous progress of science and technology, various automatic working equipment has begun to slowly enter people's lives, such as: automatic vacuum robots, automatic lawn mowing robots, etc. This automatic working equipment has a walking device, a working device and an automatic control device, so that the automatic working equipment can be separated from the operation of people, and it can automatically walk and perform work within a certain range. When the energy storage device of the automatic working equipment has insufficient energy, it It can automatically return to the charging station device for charging, and then continue to work.
以自动工作设备为割草机器人为例进行说明,割草机器人在工作过程中,用电子边界围住草坪四周及草坪内假山、喷泉等障碍物,在电子边界内的草坪上进行随机割草作业,以将用户从体力劳动中解放出来,并且由于其价格低廉而得到广泛使用。Taking the automatic working equipment as a mowing robot as an example, during the working process, the mowing robot uses the electronic boundary to surround the lawn and the rockery, fountains and other obstacles in the lawn, and performs random mowing on the lawn within the electronic boundary , In order to liberate users from manual labor, and is widely used because of its low price.
现有技术中,割草机器人的行走路径大多是基于非狭窄区域进行遍历作业,因此对于规则的工作区域,割草机器人通常都可以满足用户需求;然而,实际应用中,经常会出现复杂多样的割草区域,特别是带有狭窄区域的割草区域,现有技术中的割草机机器人随机进入狭窄区域并穿过狭窄区域以进入下一工作区域的概率较小,从而导致割草机器人长期偏离某些割草区域,进而导致该割草区域中的草长期没有打理,只能借助操作用户人工清除。In the prior art, the walking path of the mowing robot is mostly based on non-narrow areas for traversal operations, so for regular work areas, the mowing robot can usually meet user needs; however, in practical applications, often complex and diverse Mowing area, especially the mowing area with narrow area, the lawn mower robot in the prior art has a low probability of randomly entering the narrow area and passing through the narrow area to enter the next working area, resulting in a long-term mowing robot Deviating from certain mowing areas, which results in the grass in the mowing area being left unattended for a long time and can only be removed manually by the operating user.
发明内容Summary of the invention
为解决上述技术问题,本发明的目的在于提供一种行走机器人的控制方法及系统。In order to solve the above technical problems, the object of the present invention is to provide a control method and system for a walking robot.
为了实现上述发明目的之一,一种行走机器人的控制方法,包括:S1:提供一闭合的巡线路径,所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路;S2:驱动所述行走机器人从初始点出发、沿巡线路径行走一周,记录巡线路径的周长以及确认巡线路径上狭窄通道的位置;S3:将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域,以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域;S4:根据记录的巡线路径周长获取每个所述非狭窄区域中各个出发点对应的位置值;所述出发点设置在所述巡线路径上,且每个所述非狭窄区域中包括至少一个所述出发点;所述位置值等于当前出发点距离所述初始点在巡线路径上的长度值;S5:在达到预设条件之前,仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入作业模式,且禁止所述行走机器人进入所述狭窄区域。In order to achieve one of the above objects of the invention, a control method of a walking robot includes: S1: providing a closed line-traveling path, which is a closed loop formed by the boundary line of the working area where the walking robot is located; S2: driving The walking robot starts from the initial point and walks along the patrol route for one week, recording the circumference of the patrol route and confirming the position of the narrow channel on the patrol route; S3: dividing the area formed by the current patrol route into at least one narrow At least one narrow area formed by the channel, and at least two non-narrow areas connected at both ends of at least one of the narrow areas; S4: obtaining the position corresponding to each departure point in each of the non-narrow areas according to the recorded perimeter of the route Value; the starting point is set on the patrol route, and each of the non-narrow areas includes at least one of the starting points; the position value is equal to the length of the current starting point from the initial point on the patrol route ; S5: Before reaching the preset condition, only the walking robot is allowed to choose to belong to the same non-narrow area Enters the work mode at the starting point and prohibits the walking robot from entering the narrow area.
作为本发明一具体实施方式的优选方案,所述初始点设置在基站位置。As a preferred solution of a specific embodiment of the present invention, the initial point is set at a base station location.
作为本发明一具体实施方式的优选方案,所述预设条件为累计工作时长、累计工作行走的路程、电池包的电量中的至少一种。As a preferred solution of a specific embodiment of the present invention, the preset condition is at least one of cumulative working time, cumulative working distance traveled, and battery pack power.
作为本发明一具体实施方式的优选方案,所述方法还包括:S21:向边界线发射信号,以在所述边界线周围产生电磁信号;S22:驱动所述行走机器人沿巡线路径的延伸方向行走过程中,记录行走机器人实际接收到电磁信号的强度;S23:根据行走机器人实际接收到的电磁信号的强度确认巡线路径上狭窄通道的位置。As a preferred solution of a specific embodiment of the present invention, the method further includes: S21: transmitting a signal to the boundary line to generate an electromagnetic signal around the boundary line; S22: driving the walking robot along the extension direction of the patrol line path During the walking process, record the strength of the electromagnetic signal actually received by the walking robot; S23: confirm the position of the narrow channel on the line-tracking path according to the strength of the electromagnetic signal actually received by the walking robot.
作为本发明一具体实施方式的优选方案,“根据记录的巡线路径周长获取每个非狭窄区域中各个出发点对应的位置值”具体包括:S41:获取狭窄区域与非狭窄区域之间形成的临界点,以及各个临界点对应 的位置值;其中,沿巡线路径的延伸方向,形成的临界点顺序为临界点P1、临界点P2、临界点P3、临界点P4,各个临界点对应的位置值依次为L P1、L P2、L P3、L P4;S42:根据各个临界点对应的位置值获取各个非狭窄区域的周长;或根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长;S43:根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值。 As a preferred solution of a specific embodiment of the present invention, “Acquiring the position value corresponding to each departure point in each non-narrow area according to the recorded perimeter of the route for patrol” specifically includes: S41: acquiring the area formed between the narrow area and the non-narrow area Critical point, and the corresponding position value of each critical point; where, along the extending direction of the patrol route, the critical point sequence formed is the critical point P1, the critical point P2, the critical point P3, the critical point P4, the position corresponding to each critical point The values are L P1 , L P2 , L P3 , and L P4 in sequence; S42: Obtain the perimeter of each non-narrow area according to the position value corresponding to each critical point; or according to the obtained position value corresponding to the critical point and the line path Perimeter to obtain the perimeter of each non-stenosis area; S43: According to the perimeter of each non-stenosis area, independently obtain the position value corresponding to each starting point in the non-stenosis area.
作为本发明一具体实施方式的优选方案,“根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长”具体包括:判断所述初始点是否在当前非狭窄区域上,若是,则当前非狭窄区域的周长l A=l sum-(L P4-L P1);若否,则当前非狭窄区域的周长l A=L P3-L P2,其中,l sum表示巡线路径的周长,l A表示当前非狭窄区域的周长。 As a preferred solution of a specific embodiment of the present invention, “obtaining the perimeter of each non-narrow area according to the obtained position value corresponding to the critical point and the perimeter of the line-travel path” specifically includes: determining whether the initial point On the narrow area, if it is, the current perimeter of the non-narrow area l A = l sum- (L P4- L P1 ); if not, the perimeter of the current non-narrow area l A = L P3- L P2 , where, l sum indicates the perimeter of the line- tracking path, and l A indicates the perimeter of the current non-narrow area.
作为本发明一具体实施方式的优选方案,“根据各个临界点对应的位置值获取各个非狭窄区域的周长”具体包括:采用累加算法获得各个非狭窄区域的周长,即判断所述初始点是否在当前非狭窄区域上,若是,沿巡线路径的延伸方向,自初始点开始累加当前非狭窄区域的周长,并在到达临界点P1时,停止累加当前非狭窄区域的周长,当到达临界点P4时,继续累加当前非狭窄区域的周长,直至返回至初始点;若否,当前非狭窄区域的周长为沿巡线路径的延伸方向临界点P2至临界点P3之间的长度。As a preferred solution of a specific embodiment of the present invention, “obtaining the perimeter of each non-narrow area according to the position value corresponding to each critical point” specifically includes: using an accumulation algorithm to obtain the perimeter of each non-narrow area, that is, determining the initial point Whether it is in the current non-narrow area, if it is, along the extension direction of the patrol route, the circumference of the current non-narrow area is accumulated from the initial point, and when the critical point P1 is reached, the accumulation of the current non-narrow area is stopped. When reaching the critical point P4, continue to accumulate the perimeter of the current non-narrow area until returning to the initial point; if not, the perimeter of the current non-narrow area is between the critical point P2 and the critical point P3 along the extension direction of the patrol route length.
作为本发明一具体实施方式的优选方案,“根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值”具体包括:S431:依照非狭窄区域的周长l A获得起始点S的位置值L S、终点E的位置值L E和沿巡线路径从起始点S到终点E之间的出发区间的线长l SE;所述出发区间为依照巡线路径行走的轨迹,出发点均在所述出发区间内选取;则l SE=L E-L S,L S=x·l A,L E=y·l A,l SE≤l A,其中,x<y,x∈[0,1),y∈(0,1];S432:在出发区间内选取至少1个出发点。 As a preferred solution of a specific embodiment of the present invention, “According to the perimeter of each non-stenosis area to independently obtain the position value corresponding to each starting point in the non-stenosis area” specifically includes: S431: Obtained according to the perimeter of the non-stenosis area l A position of the starting point of the value of S L S, the position of the end point E of the values of the line section between the departure and along the transmission line L E path from the start point S to end point E length l SE; the departure interval in accordance with the transmission line path of travel The trajectory and the starting point are all selected within the starting interval; then l SE = L E- L S , L S = x · l A , L E = y · l A , l SE ≤ l A , where x <y, x∈ [0,1), y∈ (0,1]; S432: select at least one starting point within the starting interval.
作为本发明一具体实施方式的优选方案,所述方法还包括:判断所述初始点是否处于当前非狭窄区域上,若是,则将初始点设置为当前非狭窄区域的起始点S;若否,则将临界点P3设置为当前非狭窄区域的起始点S。As a preferred solution of a specific embodiment of the present invention, the method further includes: determining whether the initial point is on the current non-narrow area, and if so, setting the initial point as the starting point S of the current non-narrow area; if not, Then, the critical point P3 is set as the starting point S of the current non-narrow area.
作为本发明一具体实施方式的优选方案,所述方法具体包括:将出发区间划分为多个子区间;分别在每个子区间中选取对应于该子区间的至少1个出发点。As a preferred solution of a specific embodiment of the present invention, the method specifically includes: dividing the starting interval into a plurality of sub-intervals; and selecting at least one starting point corresponding to the sub-interval in each sub-interval.
作为本发明一具体实施方式的优选方案,“将出发区间划分为多个子区间”具体包括:将出发区间按照有序数列划分为多个子区间。As a preferred solution of a specific embodiment of the present invention, "dividing the departure interval into multiple sub-intervals" specifically includes: dividing the departure interval into multiple sub-intervals according to an ordered sequence.
作为本发明一具体实施方式的优选方案,“将出发区间按照有序数列划分为多个子区间”具体包括:将出发区间按照有序数列划分为多个子区间,使子区间之间的长度关系呈例如等差数列、等比数列、等和数列、斐波那契数列、分群数列、周期数列、阶差数列至少其中之一。As a preferred solution of a specific embodiment of the present invention, "dividing the starting interval into multiple sub-intervals according to the ordered sequence" specifically includes: dividing the starting interval into multiple sub-intervals according to the ordered sequence, so that the length relationship between the sub-intervals is For example, at least one of the arithmetic sequence, the geometric sequence, the equal sum sequence, the Fibonacci sequence, the group sequence, the period sequence, and the step sequence.
作为本发明一具体实施方式的优选方案,“在出发区间内选取至少1个出发点”具体包括:在出发区间内按照随机或伪随机的方式获得至少1个出发点。As a preferred solution of a specific embodiment of the present invention, "selecting at least one starting point in the starting interval" specifically includes: obtaining at least one starting point in the starting interval in a random or pseudo-random manner.
作为本发明一具体实施方式的优选方案,所述方法具体包括:在出发区间内,自起始点S的位置值L S开始,按照第一预设长度选取第一出发区间,并在该第一出发区间内随机选定第1个出发点;依次以选定的出发点为起始点,按照第二预设长度划分至少1个第二出发区间,并在该第二出发区间内随机选定下一个出发点,直至遍历整个出发区间。 As a preferred solution of a specific embodiment of the present invention, the method specifically includes: within the starting interval, starting from the position value L S of the starting point S, selecting the first starting interval according to the first preset length, and selecting the first starting interval Randomly select the first departure point within the departure interval; sequentially use the selected departure point as the starting point, divide at least one second departure interval according to the second preset length, and randomly select the next departure point within the second departure interval Until the entire starting interval is traversed.
作为本发明一具体实施方式的优选方案,所述方法还包括:自动获取当前巡线路径中各个出发点对应的频数值;所述频数值为所述行走机器人在同一出发点连续出发的次数。As a preferred solution of a specific embodiment of the present invention, the method further includes: automatically acquiring a frequency value corresponding to each starting point in the current line-travel route; the frequency value is the number of consecutive departures of the walking robot at the same starting point.
作为本发明一具体实施方式的优选方案,所述方法还包括:在预设频数阈值范围内,配置每个出发 点的频数值相等;或在预设频数阈值范围内,按照各个出发点距离其相邻的上一出发点在巡线路径上的距离差正相关于配置各个出发点对应的频数值;或在预设频数阈值范围内,对各个出发点随机配置任一频数值。As a preferred solution of a specific embodiment of the present invention, the method further includes: configuring the frequency value of each starting point to be equal within a preset frequency threshold range; or within the preset frequency threshold range, according to the distance between each starting point The distance difference of the previous departure point on the patrol route is positively related to configuring the frequency value corresponding to each departure point; or within the preset frequency threshold range, randomly configuring any frequency value for each departure point.
作为本发明一具体实施方式的优选方案,所述方法还包括:实时获取行走机器人的状态属性,所述状态属性包括:电池包的电量、连续工作时长以及连续工作行走的路程至少其中之一;若行走机器人电池包的电量小于预设电量阈值,和/或连续工作时长大于预设的工作时长阈值,和/或连续行走的路程大于预设的连续行走的路程阈值,则驱动所述行走机器人返回至所述基站。As a preferred solution of a specific embodiment of the present invention, the method further includes: acquiring the state attributes of the walking robot in real time, the state attributes including: at least one of the battery pack power, the continuous working duration, and the continuous working walking distance; If the power of the battery pack of the walking robot is less than the preset power threshold, and / or the continuous working duration is greater than the preset working duration threshold, and / or the continuous walking distance is greater than the preset continuous walking distance threshold, the walking robot is driven Return to the base station.
作为本发明一具体实施方式的优选方案,当所述行走机器人达到预设情况时,重新确定出发点的位置值和/或频数值。As a preferred solution of a specific embodiment of the present invention, when the walking robot reaches a preset condition, the position value and / or frequency value of the starting point are newly determined.
为了实现上述发明目的另一,本发明一实施方式提供一种行走机器人的控制系统,所述系统包括:配置模块,用于提供一闭合的巡线路径,所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路;巡查模块,用于驱动所述行走机器人从初始点出发、沿巡线路径行走一周,记录巡线路径的周长以及确认巡线路径上狭窄通道的位置;区域划分模块,用于将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域,以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域;控制处理模块,用于根据记录的巡线路径周长获取每个所述非狭窄区域中各个出发点对应的位置值;所述出发点设置在所述巡线路径上,且每个所述非狭窄区域中包括至少一个所述出发点;所述位置值等于当前出发点距离所述初始点在巡线路径上的长度值;在达到预设条件之前,仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入工作状态,且禁止所述行走机器人进入所述狭窄区域。In order to achieve another object of the invention described above, an embodiment of the present invention provides a control system for a walking robot. The system includes: a configuration module for providing a closed line-traveling path for the line-traveling robot to work A closed loop formed by the boundary of the area; a patrol module for driving the walking robot from the initial point, walking along the patrol route for one week, recording the circumference of the patrol route and confirming the location of the narrow passage on the patrol route; area A dividing module for dividing the area formed by the current patrol route into at least one narrow area formed by at least one narrow passage, and at least two non-narrow areas connected at both ends of the at least one narrow area; the control processing module uses In order to obtain the position value corresponding to each departure point in each of the non-narrow areas according to the recorded perimeter of the tour route; the departure point is set on the tour route, and each of the non-narrow areas includes at least one location The starting point; the position value is equal to the length of the current starting point from the initial point on the route Value; before reaching the preset condition, only allowing the walking robot at said selected starting point in the same area belonging to the non-narrowed into the working state and prohibits the walking robot enters the narrow regions.
与现有技术相比,本发明行走机器人的控制方法及系统,对于具有狭窄通道的工作空间,自动对工作区域进行划分,以形成狭窄区域和非狭窄区域,并使行走机器人在工作过程中,根据需要自由穿过狭窄区域以遍历每个非狭窄区域,进而提升行走机器人在工作区间内的遍历性,提高工作效率。Compared with the prior art, the control method and system of the walking robot of the present invention automatically divide the working area for the working space with a narrow channel to form a narrow area and a non-narrow area, and make the walking robot in the working process, According to the need to freely pass through the narrow area to traverse each non-narrow area, and thus improve the traversal of the walking robot in the working area, improve work efficiency.
附图说明BRIEF DESCRIPTION
图1是本发明一实施方式中行走机器人的结构示意图;FIG. 1 is a schematic structural diagram of a walking robot in an embodiment of the present invention;
图2是本发明一实施方式中行走机器人的控制方法的流程示意图;2 is a schematic flowchart of a method for controlling a walking robot in an embodiment of the present invention;
图3是本发明一实施方式中工作区域中狭窄通道判断方法的流程示意图;3 is a schematic flowchart of a method for judging a narrow channel in a working area according to an embodiment of the present invention;
图4是本发明一实施方式中获取任一非狭窄区域中各个出发点对应的位置值的流程示意图;4 is a schematic flow chart of acquiring a position value corresponding to each starting point in any non-narrow area in an embodiment of the present invention;
图5、图6分别是本发明在具体应用环境下的具体示例的效果图;FIG. 5 and FIG. 6 are respectively effect diagrams of specific examples of the present invention in a specific application environment;
图7是本发明一实施方式中出发点选取方法的流程示意图;7 is a schematic flowchart of a starting point selection method in an embodiment of the present invention;
图8是本发明一具体示例中行走机器人行走路线的结构示意图;8 is a schematic structural view of a walking route of a walking robot in a specific example of the present invention;
图9是本发明一实施方式中行走机器人的控制系统的模块示意图;9 is a block diagram of a control system of a walking robot in an embodiment of the present invention;
图10是本发明一实施方式中行走机器人的控制系统的工作流程示意图。FIG. 10 is a schematic diagram of a work flow of a control system of a walking robot in an embodiment of the present invention.
具体实施方式detailed description
以下将结合附图所示的各实施方式对本发明进行详细描述。但这些实施方式并不限制本发明,本领域的普通技术人员根据这些实施方式所做出的结构、方法、或功能上的变换均包含在本发明的保护范围内。The present invention will be described in detail below with reference to the embodiments shown in the drawings. However, these embodiments do not limit the present invention, and structural, method, or functional changes made by those of ordinary skill in the art according to these embodiments are included in the protection scope of the present invention.
本发明的行走机器人可以是自动割草机,或者自动吸尘器等,其自动行走于工作区域以进行割草、吸尘工作,本发明具体示例中,以行走机器人为割草机为例做具体说明,相应的,所述工作区域可为草坪。The walking robot of the present invention may be an automatic lawn mower, or an automatic vacuum cleaner, etc., which automatically walks in the work area to perform grass cutting and vacuuming work. In the specific example of the present invention, the walking robot is used as a lawn mower as an example for specific description Correspondingly, the working area may be a lawn.
如图1所示,在本发明的一较佳实施方式提供一种行走机器人,所述行走机器人包括:本体10,设 置于本体10上的行走单元、控制单元;以及供行走机器人停靠并充电的基站。As shown in FIG. 1, in a preferred embodiment of the present invention, a walking robot is provided. The walking robot includes: a body 10, a walking unit and a control unit provided on the body 10; and a walking robot for docking and charging Base station.
所述基站连接一沿工作区域的周侧布置的边界线,基站向边界线发射脉冲编码信号时,该脉冲编码信号在边界线内传输,以在边界线附近形成磁场并产生电磁信号。The base station is connected to a boundary line arranged along the peripheral side of the working area. When the base station transmits a pulse code signal to the boundary line, the pulse code signal is transmitted within the boundary line to form a magnetic field near the boundary line and generate an electromagnetic signal.
所述行走单元包括:主动轮21、被动轮23以及用于驱动主动轮21的电机25;所述电机25可为带减速箱的无刷电机;电机25启动后,可通过减速箱带动主动轮21行走,并控制主动轮21的转速,进一步的,配合主动轮21调整,带动整个行走机器人实现前进、后推、转弯等动作。所述被动轮23可为万向轮,其主要起支撑平衡的作用。The walking unit includes: a driving wheel 21, a passive wheel 23, and a motor 25 for driving the driving wheel 21; the motor 25 may be a brushless motor with a reduction box; after the motor 25 is started, the driving wheel may be driven through the reduction box 21 Walking, and controlling the rotation speed of the driving wheel 21, further, in conjunction with the adjustment of the driving wheel 21, the entire walking robot is driven to realize forward, backward, turning and other actions. The passive wheel 23 may be a universal wheel, which mainly serves to support balance.
所述控制单元至少包括:状态传感器,用于获取行走机器人沿巡线路径行走过程中获得的各种信息,例如:获取巡线路径上的电磁信号强度;在本具体实施方式中,状态传感器包括边界线传感器,以下内容中将会详细描述;数据存储器,用于存储机器行走机器人沿巡线路径行走过程中获得的各种信息,所述数据存储器例如:EPROM、Flash或SD卡等。行走机器人沿巡线路径行走过程中获得的各种信息有多种,以下内容中将会进一步的详细描述。The control unit includes at least a status sensor, which is used to acquire various information obtained by the walking robot along the patrol route, for example: acquiring the electromagnetic signal strength on the patrol route; in this specific embodiment, the status sensor includes The boundary line sensor will be described in detail in the following content; the data storage is used to store various information obtained by the robot walking along the line patrol path, such as EPROM, Flash or SD card. There are various types of information obtained by the walking robot walking along the patrol route, which will be described in further detail below.
由于基站沿边界线发射脉冲编码信号,以在边界线附近形成电磁信号,故,控制单元可根据边界线附近电磁信号的强弱变化以及其通过状态传感器获取到的边界线内外信号的差异来控制电机运行,从而使行走机器人始终沿边界线运行或沿距离边界线具有等距的边界线内或外运行。Because the base station transmits pulse-coded signals along the boundary line to form an electromagnetic signal near the boundary line, the control unit can control the motor according to the change of the electromagnetic signal strength near the boundary line and the difference between the internal and external signals obtained by the status sensor Operation, so that the walking robot always runs along the boundary line or runs inside or outside along the boundary line with an equal distance from the boundary line.
所述行走机器人还包括:用于工作的工作机构,在本实施例中,工作机构为割草刀盘,用于感应行走机器人的行走状态的各种传感器,例如:倾倒、离地、碰撞传感器等,在此不做具体赘述。The walking robot further includes: a working mechanism for working. In this embodiment, the working mechanism is a lawn mower disk, and various sensors for sensing the walking state of the walking robot, such as: dumping, leaving the ground, collision sensor Wait, no more details here.
本发明的具体应用环境中,所述工作区域(草坪)可能为一整块非狭窄区域,也可能是由至少一个狭窄通道形成的至少一个狭窄区域、以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域。In the specific application environment of the present invention, the working area (lawn) may be a whole non-narrow area, or may be at least one narrow area formed by at least one narrow passage, and connected at both ends of the at least one narrow area At least two non-narrow areas.
结合图2所示,本发明一较佳实施提供的行走机器人的控制方法,所述方法包括:With reference to FIG. 2, a method for controlling a walking robot according to a preferred embodiment of the present invention includes:
S1、提供一呈闭合的巡线路径,所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路。S1. Provide a closed patrol route, which is a closed loop formed by the boundary line of the working area where the walking robot is located.
S2、驱动所述行走机器人从初始点出发、沿巡线路径行走一周,记录巡线路径的周长以及确认巡线路径上狭窄通道的位置。S2. Drive the walking robot from the initial point to walk along the patrol route for one week, record the circumference of the patrol route and confirm the position of the narrow channel on the patrol route.
本发明一较佳实施方式中,为行走机器人至少配置一巡线模式和一作业模式;巡线模式下,可以驱动所述行走机器人从初始点出发、沿巡线路径行走一周,记录所述巡线路径的周长、行走机器人实际接收到电磁信号的强度等。巡线模式下,还可以驱动所述行走机器人从初始点出发、沿巡线路径到达特定出发点后进入作业模式。作业模式下,可以驱动行走机器人在工作区域内沿直线或曲线行走并割草,当行走机器人达到特定姿态(如遇到边界线)时朝向进入工作区域内部的方向转向。作业模式下,还可以驱动行走机器人沿边界线行走并割草。In a preferred embodiment of the present invention, at least one line patrol mode and one operation mode are configured for the walking robot; in the line patrol mode, the walking robot can be driven from the initial point, walk along the line patrol path for one week, and record the line patrol The perimeter of the path, the strength of the electromagnetic signal actually received by the walking robot, etc. In the line patrol mode, the walking robot may also be driven from the initial point and reach a specific starting point along the line patrol path to enter the work mode. In the work mode, the walking robot can be driven to walk along a straight line or a curve in the working area and cut grass. When the walking robot reaches a certain posture (such as encountering a boundary line), it turns to enter the direction of the working area. In the work mode, you can also drive the walking robot to walk along the boundary line and cut the grass.
本发明一可实现方式中,所述状态传感器还包括:里程传感器,用于记录巡线路径的周长,即行走机器人的行驶距离;所述里程传感器也可为里程计、惯性传感器、霍尔或光电传感器等。In an implementable mode of the present invention, the status sensor further includes: a mileage sensor, which is used to record the circumference of the line patrol path, that is, the travel distance of the walking robot; the mileage sensor may also be an odometer, inertial sensor, Hall Or photoelectric sensors.
本发明较佳实施方式中,结合图3所示,所述步骤S2具体包括:S21、沿巡线路径发射脉冲编码信号,以在所述巡线路径上产生电磁信号;S22、驱动所述行走机器人沿巡线路径的延伸方向行走过程中,记录行走机器人实际接收到电磁信号的强度;S23、根据行走机器人实际接收到的电磁信号的强度确认巡线路径上狭窄通道的位置。In a preferred embodiment of the present invention, as shown in FIG. 3, the step S2 specifically includes: S21, transmitting a pulse code signal along the patrol route to generate an electromagnetic signal on the patrol route; S22, driving the walk During the robot walking along the extension direction of the patrol route, record the strength of the electromagnetic signal actually received by the walking robot; S23. Confirm the position of the narrow channel on the patrol route according to the strength of the electromagnetic signal actually received by the walking robot.
本发明较佳实施方式中,通过边界线传感器检测行走机器人上实际接收到的电磁信号。In a preferred embodiment of the present invention, the boundary line sensor detects the electromagnetic signal actually received on the walking robot.
本发明一较佳实施方式中,沿行走机器人的中线对称设置一对边界线传感器,行走机器人沿巡线路径行走过程中,一对边界线传感器分别检测巡线路径两侧的电磁信号强度;所述狭窄区域因为相对边界线产生的磁场叠加而使狭窄区域之间的磁场强度加强,使狭窄区域外侧的磁场强度减弱,如此,可将两 个边界线传感器实际接收到电磁信号强度与发射脉冲编号信号产生的电磁强度进行对比,或根据两个边界线传感器实际接收到的电磁信号强度的变化,确认狭窄区域的位置及范围。In a preferred embodiment of the present invention, a pair of boundary line sensors are symmetrically arranged along the center line of the walking robot. During the walking robot walks along the patrol path, the pair of boundary line sensors respectively detect the electromagnetic signal strength on both sides of the patrol path; In the narrow area, the magnetic field strength between the narrow areas is strengthened due to the superposition of the magnetic fields generated relative to the boundary line, so that the magnetic field strength outside the narrow area is weakened. Compare the electromagnetic intensity generated by the signal, or confirm the position and range of the narrow area according to the change of the electromagnetic signal intensity actually received by the two boundary line sensors.
在确认存在狭窄通道后,所述方法还包括:S3、将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域,以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域。After confirming that there is a narrow channel, the method further includes: S3, dividing the area formed by the current patrol route into at least one narrow area formed by at least one narrow channel, and at least two connected at both ends of the at least one narrow area Non-narrow area.
需要说明的是,若确认不存在狭窄通道,则直接在当前巡线路径形成的工作区域完成工作。It should be noted that if it is confirmed that there is no narrow passage, the work is completed directly in the working area formed by the current patrol route.
S4、根据记录的巡线路径周长获取每个非狭窄区域中各个出发点对应的位置值;所述出发点设置在所述巡线路径上,且每个所述非狭窄区域中包括至少一个所述出发点;所述位置值等于当前出发点距离所述初始点在巡线路径上的长度值。行走机器人从初始点出发,以巡线模式沿边界线行走至指定出发点后,向工作区域内转向并进入作业模式。对于初始点与出发点重合的情况,则行走机器人直接在初始点向工作区域内转向并进入作业模式。S4. Acquire the position value corresponding to each departure point in each non-narrow area according to the recorded perimeter of the patrol route; the departure point is set on the patrol route, and each of the non-narrow areas includes at least one Departure point; the position value is equal to the length value of the current departure point from the initial point on the patrol route. Starting from the initial point, the walking robot walks along the boundary line in the patrol line mode to the specified starting point, then turns into the work area and enters the work mode. For the case where the initial point coincides with the starting point, the walking robot directly turns into the work area at the initial point and enters the work mode.
结合图4所示,本发明一具体实施方式中,所述步骤S4具体包括:S41、获取狭窄区域与非狭窄区域之间形成的临界点,以及各个临界点对应的位置值;其中,沿巡线路径的延伸方向,形成的临界点顺序为临界点P 1、临界点P 2、临界点P 3、临界点P 4,各个临界点对应的位置值依次为L P1、L P2、L P3、L P4;S42、根据各个临界点对应的位置值获取各个非狭窄区域的周长;或根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长;S43、根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值。 With reference to FIG. 4, in a specific embodiment of the present invention, the step S4 specifically includes: S41, acquiring a critical point formed between a narrow area and a non-narrow area, and the position value corresponding to each critical point; In the extending direction of the line path, the critical points formed are the critical point P 1 , the critical point P 2 , the critical point P 3 , and the critical point P 4. The position values corresponding to each critical point are L P1 , L P2 , L P3 , L P4 ; S42, obtain the perimeter of each non-narrowed area according to the position value corresponding to each critical point; or obtain the perimeter of each non-narrowed area according to the obtained position value corresponding to the critical point and the perimeter of the route path; S43 .According to the perimeter of each non-narrow area, the position value corresponding to each starting point in the non-narrow area is independently obtained.
需要说明的是,所述步骤S4可选择在巡线模式下完成,也可以选择在作业模式下完成,亦可以在两种模式下配合完成;所述初始点为行走机器人沿巡线路径行走一周过程中的起始出发点。本发明具体实施方式中,行走机器人通常由基站出发沿巡线路径行走一周后回到基站,如此,可将基站的位置作为初始点。It should be noted that the step S4 can be selected to be completed in the line patrol mode, can also be completed in the operation mode, or can be completed in two modes; the initial point is that the walking robot walks along the line patrol path for a week The starting point in the process. In the specific embodiment of the present invention, the walking robot usually starts from the base station and walks along the patrol route for one week before returning to the base station. In this way, the position of the base station can be used as an initial point.
步骤S41中,当确定狭窄通道位置后,行走机器人可自动识别出所述临界点,即可以确定临界点的位置,为了便于理解,本发明将临界点在巡线路径的延伸方向(即方向D1)上按照到达的顺序分别以临界点P 1、临界点P 2、临界点P 3、临界点P 4进行表示;本发明其他实施方式中,还可以在临界点的对应位置通过人工敷设线圈的方式增加对临界点的识别精度,在此不做详细赘述。 In step S41, after determining the position of the narrow passage, the walking robot can automatically identify the critical point, that is, the position of the critical point can be determined. For ease of understanding, the present invention places the critical point in the extending direction of the patrol path (ie, direction D1) ) Is represented by the critical point P 1 , the critical point P 2 , the critical point P 3 , and the critical point P 4 according to the order of arrival; in other embodiments of the present invention, the coil can also be manually laid at the corresponding position of the critical point The method increases the accuracy of identifying the critical point, which will not be described in detail here.
本发明第一种较佳实施方式中,所述步骤S42具体包括:判断初始点是否在当前非狭窄区域上,若是,则当前非狭窄区域的周长l A=l sum-(L P4-L P1);若否,则当前非狭窄区域的周长l A=L P3-L P2,其中,l sum表示巡线路径的周长,l A表示当前非狭窄区域的周长。 In the first preferred embodiment of the present invention, the step S42 specifically includes: judging whether the initial point is on the current non-stenosis area, and if so, the perimeter of the current non-stenosis area l A = l sum- (L P4 -L P1 ); if not, the current perimeter of the non-narrowed area l A = L P3- L P2 , where l sum represents the perimeter of the patrol route, and l A represents the perimeter of the current non-narrowed area.
为了便于理解,结合图5所示,本发明描述一具体示例以方便理解;该示例中,巡线路径自初始点(在本实施例中为基站位置)开始,沿箭头D1方向延伸,并还回至初始点结束;工作区域包括非狭窄区域A、非狭窄区域B,以及将工作区域分隔为非狭窄区域A、非狭窄区域B的狭窄区域C;该示例中,在巡线模式下,行走机器人沿边界线(即巡线路径)行走一周后,获得该巡线路径的周长以l sum表示,非狭窄区域A与狭窄区域C在巡线路径的延伸方向上形成的临界点顺序为P 1和临界点P 4,非狭窄区域B与狭窄区域C在巡线路径的延伸方向上形成的临界点顺序为P 2和临界点P 3,在巡线路径的延伸方向上各个临界点对应的位置值顺序以L P1、L P2、L P3、L P4表示。 For ease of understanding, with reference to FIG. 5, the present invention describes a specific example to facilitate understanding; in this example, the line-traveling path starts from the initial point (base station position in this embodiment), extends in the direction of arrow D1, and returns To the end of the initial point; the working area includes the non-narrow area A, the non-narrow area B, and the narrow area C that divides the working area into the non-narrow area A and the non-narrow area B; in this example, in the line patrol mode, the walking robot After walking along the boundary line (that is, the patrol route) for one week, the perimeter of the patrol route is obtained as l sum , and the critical points formed by the non-narrow area A and the narrow area C in the extension direction of the patrol route are P 1 and Critical point P 4 , the order of the critical points formed by the non-narrow area B and the narrow area C in the extending direction of the line-travel path is P 2 and the critical point P 3 , and the position values corresponding to each critical point in the extending direction of the line-track path The order is represented by L P1 , L P2 , L P3 , and L P4 .
相应的,初始点处于非狭窄区域A上,所以非狭窄区域A的周长可表示为l A=l sum-(L P4-L P1),非狭窄区域B的周长可以表示为l B=L P3-L P2Correspondingly, the initial point is on the non-stenosis area A, so the perimeter of the non-stenosis area A can be expressed as l A = l sum- (L P4- L P1 ), and the perimeter of the non-stenosis area B can be expressed as l B = L P3 -L P2 .
本发明第二种较佳实施方式中,所述步骤S42具体包括:采用累加算法获得各个非狭窄区域的周长, 即判断初始点是否在当前非狭窄区域上,若是,沿巡线路径的延伸方向,自初始点开始累加当前非狭窄区域的周长,并在到达临界点P 1时,停止累加当前非狭窄区域的周长,当到达临界点P 4时,继续累加当前非狭窄区域的周长,直至返回至初始点;若否,当前非狭窄区域的周长为沿巡线路径的延伸方向临界点P 2至临界点P 3之间的长度。 In the second preferred embodiment of the present invention, the step S42 specifically includes: using an accumulation algorithm to obtain the circumference of each non-narrow area, that is, to determine whether the initial point is on the current non-narrow area, and if so, to extend along the patrol route direction, from the initial accumulation point on the perimeter of the current non-narrow region and reach the critical point P 1, stopping the accumulation of non-narrow region of the circumference of this, when P 4 reaches the critical point, the current continues to accumulate non narrow circumferential area Long until it returns to the initial point; if not, the current perimeter of the non-narrow area is the length from the critical point P 2 to the critical point P 3 along the extension direction of the route.
为了便于理解,结合图6所示,本发明描述一具体示例以方便理解。For ease of understanding, with reference to FIG. 6, the present invention describes a specific example to facilitate understanding.
需要说明的是,图6所示示例与图5所示示例中,巡线路径周长、区域划分、初始点、临界点以及临界点对应的位置值的表达方式均与图5相同,因此不再具体赘述。It should be noted that, in the example shown in FIG. 6 and the example shown in FIG. 5, the perimeter, area division, initial point, critical point, and position value corresponding to the critical point are all expressed in the same way as in FIG. 5, so they are not More details.
该较佳实施方式中,由于初始点处于非狭窄区域A上,故对于非狭窄区域A,沿巡线路径的延伸方向,自初始点开始累加当前非狭窄区域A的周长,当到达临界点P 1时,停止累加当前非狭窄区域A的周长,当到达P 4时,继续累加当前非狭窄区域A的周长,直至返回至初始点;即非狭窄区域A的周长等于在巡线路径的延伸方向上初始点至P 1的长度与P 4至初始点的长度之和。 In the preferred embodiment, since the initial point is on the non-narrowed area A, for the non-narrowed area A, the perimeter of the current non-narrowed area A is accumulated from the initial point along the extension direction of the route, when the critical point is reached At P 1 , stop accumulating the perimeter of the current non-stenosis area A. When reaching P 4 , continue to accumulate the perimeter of the current non-stenosis area A until returning to the initial point; that is, the perimeter of the non-stenosis area A is equal to the patrol line The sum of the length from the initial point to P 1 and the length from P 4 to the initial point in the extending direction of the path.
对于非狭窄区域B,由于初始点不在非狭窄区域B上,当到达P 2时开始累加当前非狭窄区域B的周长,直至到达P 3后,停止累加当前非狭窄区域B的周长;即非狭窄区域B的周长等于在巡线路径的延伸方向上P 2至P 3的长度。 For the non-stenosis area B, since the initial point is not on the non-stenosis area B, when P 2 is reached, the circumference of the current non-stenosis area B starts to accumulate until after reaching P 3 , the accumulation of the current non-stenosis area B's circumference is stopped; that is The perimeter of the non-narrow area B is equal to the length of P 2 to P 3 in the extending direction of the line-tracing path.
本发明较佳实施方式中,结合图7所示,所述步骤S43具体包括:S431、依照非狭窄区域的周长l A获得出发区间的线长l SE,起始点S的位置值L S和终点E的位置值L E,所述出发区间为依照巡线路径行走的轨迹,则l SE=L E-L S,L S=x·l A,L E=y·l A,l SE≤l A,其中,x<y,x∈[0,1),y∈(0,1];S432、在出发区间内选取至少1个出发点。 In a preferred embodiment of the present invention, as shown in FIG. 7, the step S43 specifically includes: S431, obtaining the line length l SE of the departure interval according to the circumference l A of the non-narrow area, the position value L S of the starting point S and The position value L E of the end point E, the starting interval is a trajectory following the patrol route, then l SE = L E- L S , L S = x · l A , L E = y · l A , l SE ≤ l A , where x <y, x∈ [0,1), y∈ (0,1]; S432, select at least one starting point in the starting interval.
需要说明的是,起始点L S可为当前巡线路径上的任一点,本发明一较佳实施方式中,判断所述初始点是否处于当前非狭窄区域上,若是,则将初始点设置为当前非狭窄区域的起始点S;若否,则将临界点P 3设置为当前非狭窄区域的起始点S。 It should be noted that the starting point L S may be any point on the current line-tracking path. In a preferred embodiment of the present invention, it is determined whether the initial point is on the current non-narrow area, and if so, the initial point is set to The starting point S of the current non-narrow area; if not, the critical point P 3 is set as the starting point S of the current non-narrow area.
本发明具体实施方式中,所述步骤S432具体包括:将出发区间划分为多个子区间;分别在每个子区间中选取对应于该子区间的至少1个出发点。In a specific embodiment of the present invention, the step S432 specifically includes: dividing the departure interval into a plurality of sub-intervals; selecting at least one departure point corresponding to the sub-interval in each sub-interval respectively.
将出发区间划分为多个子区间的方式有多种,其中一种较佳实施方式中,将出发区间按照有序数列划分为多个子区间,使子区间之间的长度关系呈例如等差数列、等比数列、等和数列、斐波那契数列、分群数列、周期数列、阶差数列等至少其中之一。There are many ways to divide the departure interval into multiple sub-intervals. In a preferred embodiment, the departure interval is divided into multiple sub-intervals according to an ordered sequence, so that the length relationship between the sub-intervals is represented as an equidistance sequence, At least one of the proportional sequence, the equal sum sequence, the Fibonacci sequence, the group sequence, the period sequence, the step sequence, etc.
本发明一具体实施方式中,将出发区间划分为n个子区间,n为正整数,则每个子区间的长度具有确定的关系,其可以表示为:L Ai=Rt(i,l Subi)+L S,其中,i∈[1,n],且i为整数;l Subi表示对应第i个子区间的长度,L Ai表示第i个子区间中的出发点的位置值,Rt(i,l Subi)为关系函数。 In a specific embodiment of the present invention, the starting interval is divided into n sub-intervals, n is a positive integer, then the length of each sub-interval has a certain relationship, which can be expressed as: L Ai = Rt (i, l Subi ) + L S , where i ∈ [1, n], and i is an integer; l Subi represents the length of the corresponding i-th sub-interval, L Ai represents the position value of the starting point in the i-th sub-interval, and Rt (i, l Subi ) is Relationship function.
该具体示例中,可预设n的值,也可以指定每个子区间的长度,并通过公式
Figure PCTCN2019114040-appb-000001
获得子区间的数量n,其中,intD()为向下取整函数。
In this specific example, the value of n can be preset, or the length of each sub-interval can be specified, and the formula
Figure PCTCN2019114040-appb-000001
Obtain the number n of subintervals, where intD () is a rounding function down.
作为该具体实施方式的一个特例,采用等差数列将出发区间划分为多个子区间,取其公差为0,并设定n的具体数值;则Rt(i,l Subi)=(k+i-1)·l Subi
Figure PCTCN2019114040-appb-000002
k∈[0,1],L Ai=(k+i-1)·l Subi+L S。例如:当k=0时,表示取每个子区间的起点为当前子区间的起始点,当k=0.5时,表示取每个子区间的中点为当前子区间的起始点,当k=1时,表示取每个子区间的终点为当前子区间的起始点。
As a special example of this specific embodiment, the starting interval is divided into multiple sub-intervals using an arithmetic sequence, the tolerance is 0, and a specific value of n is set; then Rt (i, l Subi ) = (k + i- 1) · l Subi ,
Figure PCTCN2019114040-appb-000002
k∈ [0,1], L Ai = (k + i-1) · l Subi + L S. For example: when k = 0, it means that the starting point of each sub-interval is taken as the starting point of the current sub-interval, when k = 0.5, it means that the midpoint of each sub-interval is taken as the starting point of the current sub-interval, when k = 1 , Indicating that the end point of each sub-interval is taken as the starting point of the current sub-interval.
继续参照图5所示,该实施方式中,为了避免赘述,本发明仅以区域A为例做具体介绍;该示例中,获得的非狭窄区域A的周长l A=300m,经过查询获得x=0,y=0.5,n=10,k=1,且采用等差数列的方式分隔区域A形成多个子区间,公差为0;则l SE=0.5×300m-0=150m,l Subi=150m÷10=15m,l A1=15m,
Figure PCTCN2019114040-appb-000003
......,l A10=150m。
With continued reference to FIG. 5, in this embodiment, in order to avoid redundant description, the present invention will only take the area A as an example for specific introduction; in this example, the obtained non-narrow area A has a perimeter l A = 300m, which is obtained by query = 0, y = 0.5, n = 10, k = 1, and the area A is separated by an arithmetic sequence to form multiple sub-intervals with a tolerance of 0; then l SE = 0.5 × 300m-0 = 150m, l Subi = 150m ÷ 10 = 15m, l A1 = 15m,
Figure PCTCN2019114040-appb-000003
..., l A10 = 150m.
本发明另一较佳实施方式中,所述步骤S432具体包括:在出发区间内,按照随机或伪随机的方式获得至少1个出发点。In another preferred embodiment of the present invention, the step S432 specifically includes: obtaining at least one starting point in a random or pseudo-random manner within the starting interval.
本发明一具体实施方式中,在出发区间内,自起始点S的位置值L S开始,按照第一预设长度选取第一出发区间,并在该第一出发区间内随机选定第1个出发点;依次以选定的出发点为起始点,按照第二预设长度划分至少1个第二出发区间,并在该第二出发区间内随机选定下一个出发点,直至遍历整个出发区间。 In a specific embodiment of the present invention, in the departure interval, starting from the position value L S of the starting point S, the first departure interval is selected according to the first preset length, and the first one is randomly selected in the first departure interval Departure point; in turn take the selected departure point as the starting point, divide at least one second departure interval according to the second preset length, and randomly select the next departure point within the second departure interval until the entire departure interval is traversed.
所述第一预设长度、第二预设长度均为长度预设常数值,其大小可以根据出发区间的长度具体设定,例如:按照其对应于出发区间的长度占比进行设定,在此不做详细赘述;所述出发区间按照第一预设长度、第二预设长度、选择的出发点的位置分为第一出发区间以及至少一个第二出发区间,所述第一出发区间和第二出发区间仅按照第二预设长度进行区分,其真实长度并不做具体限定,由于各个出发点随机或伪随机的方式进行选定,如此,当第二出发区间超过一个时,每个第二出发区间的长度可能会不等。The first preset length and the second preset length are both length preset constant values, and their sizes can be specifically set according to the length of the departure interval, for example: according to the length ratio corresponding to the departure interval, the This will not be described in detail; the departure interval is divided into a first departure interval and at least one second departure interval according to the first preset length, the second preset length, and the position of the selected departure point. The two departure intervals are only distinguished according to the second preset length, and the true length is not specifically limited. Since each departure point is selected in a random or pseudo-random manner, when the second departure interval exceeds one, each second The length of the departure interval may vary.
作为该具体实施方式的一个示例,设定第一预设长度的范围为[a 1,b 1],第二预设长度的范围为[a 2,b 2],则L A1=RND(i)+L S,其中RND(i)为随机/伪随机函数,且RND(i)∈[a 1,b 1],L Aj=L A(j-1)+RND(j),其中RND(j)∈[a 2,b 2],j为整数且j∈[2,c],c满足使L Ac≤L E且L A(c+1)>L E。即第1个出发点位于起始点S与第一预设长度限定的范围内,其在该范围内的具体位置可以任意指定,也可以通过随机或伪随机的算法进行确定,下一个出发点在上一个出发点的位置与第二预设长度限定的出发区间内选定。 As an example of this specific implementation, the range of the first preset length is set to [a 1 , b 1 ], and the range of the second preset length is [a 2 , b 2 ], then L A1 = RND (i ) + L S , where RND (i) is a random / pseudo-random function, and RND (i) ∈ [a 1 , b 1 ], L Aj = L A (j-1) + RND (j), where RND ( j) ∈ [a 2 , b 2 ], j is an integer and j ∈ [2, c], c satisfies L Ac ≤ L E and L A (c + 1) > L E. That is, the first starting point is within the range defined by the starting point S and the first preset length, and its specific position within the range can be arbitrarily specified, or it can be determined by a random or pseudo-random algorithm, and the next starting point is on the previous The position of the starting point is selected within the starting interval defined by the second preset length.
进一步的,所述方法还包括:S5、在达到预设条件之前,仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入作业模式,且禁止所述行走机器人进入所述狭窄区域。Further, the method further includes: S5. Before reaching a preset condition, only the walking robot is allowed to select to enter the work mode at the starting point belonging to the same non-narrow area, and the walking robot is prohibited from entering The narrow area.
本发明较佳实施方式中,自动获取当前巡线路径中各个出发点对应的频数值;所述频数值为同一出发点连续出发的次数。In a preferred embodiment of the present invention, the frequency value corresponding to each starting point in the current line patrol route is automatically obtained; the frequency value is the number of consecutive departures from the same starting point.
本发明中对应各个出发点的频数值可以任意指定,也可以按照一定的规则进行获取。本发明一较佳实施方式中,在预设频数阈值范围内,配置每个出发点的频数值相等;或在预设频数阈值范围内,按照各个出发点距离其相邻的上一出发点在巡线路径上的距离差正相关于配置各个出发点对应的频数值;或在预设频数阈值范围内,对各个出发点随机配置任一频数值。In the present invention, the frequency value corresponding to each starting point can be specified arbitrarily, and can also be obtained according to a certain rule. In a preferred embodiment of the present invention, the frequency value of each starting point is configured to be equal within the preset frequency threshold range; or within the preset frequency threshold range, according to the distance between each starting point and its adjacent previous starting point on the patrol route The distance difference above is positively related to configuring the frequency value corresponding to each starting point; or within the preset frequency threshold range, randomly configuring any frequency value for each starting point.
频数阈值范围通常为一数值范围,其最小值为1,最大值为M,M为正整数;通常情况下,可根据工作区域的大小、相邻出发点之间的长度关系具体设定,例如:获得的各个出发点为等距设置时,通常将各个出发点对应的频数值设置为相等,当相邻出发点之间的间距越大时,相邻的出发点其频数值也相应的设置为较大;当然,也可以设定总的频数值,之后通过出发点对应的位置值,按比例分配频数值,在此不做详细赘述。The frequency threshold range is usually a numerical range, the minimum value is 1, the maximum value is M, and M is a positive integer; under normal circumstances, it can be specifically set according to the size of the work area and the length relationship between adjacent starting points, for example: When the obtained starting points are equidistantly set, the frequency values corresponding to the starting points are usually set to be equal. When the distance between adjacent starting points is greater, the frequency values of adjacent starting points are correspondingly set to be larger; of course You can also set the total frequency value, and then assign the frequency value in proportion to the position value corresponding to the starting point, which will not be described in detail here.
本发明一较佳实施方式中,所述方法还包括:建立一存储器列表,用于存储各个出发点以及其所对应的位置值和频数值;通过查询所述存储器列表,获得各个出发点对应的位置值和频数值。In a preferred embodiment of the present invention, the method further includes: establishing a memory list for storing each starting point and its corresponding position value and frequency value; by querying the memory list, obtaining the position value corresponding to each starting point Sum frequency value.
驱动所述行走机器人在当前非狭窄区域内工作,直到达到预设条件,再穿过狭窄区域并进入到下一 个非狭窄区域内完成工作。在当前非狭窄区域内工作时,行走机器人仅被允许在属于当前非狭窄区域中的出发点处进入工作状态,且禁止行走机器人进入狭窄区域。本发明较佳实施方式中,对应于出发点的位置不同,行走机器人工作顺序也稍有调整。The walking robot is driven to work in the current non-narrow area until a preset condition is reached, and then passes through the narrow area and enters the next non-narrow area to complete the work. When working in the current non-narrow area, the walking robot is only allowed to enter the working state at the starting point belonging to the current non-narrow area, and the walking robot is prohibited from entering the narrow area. In the preferred embodiment of the present invention, the working order of the walking robot is slightly adjusted corresponding to the different positions of the starting point.
结合参照图5所示,当前非狭窄区域上的所有出发点,在巡线路径的延伸方向上均处于同一段连续的巡线路径上,如此,在工作过程中,持续沿巡线路径行走,即可以分别遍历非狭窄区域A和非狭窄区域B上的所有出发点。需要说明的是,第一种较佳实施方式的根据各个临界点对应的位置值获取各个非狭窄区域的周长,更适用于非狭窄区域上的所有出发点,在巡线路径的延伸方向上均处于同一段连续的巡线路径。With reference to FIG. 5, all the starting points in the current non-narrow area are on the same continuous line of patrol in the direction of the extension of the line of patrol, so that during the work, they continue to walk along the line of patrol, ie All starting points on the non-narrow area A and the non-narrow area B can be traversed separately. It should be noted that the first preferred embodiment obtains the perimeter of each non-narrowed area according to the position value corresponding to each critical point, which is more applicable to all starting points on the non-narrowed area, and extends in the direction of the patrol route. It is on the same continuous line of patrol route.
结合图6所示,当前非狭窄区域上的出发点,在巡线路径的延伸方向上处于2段连续的巡线路径上,如此,行走机器人在未完成当前非狭窄区域A的工作时,需要避免其进入狭窄区域,此时,若行走机器人意外进入狭窄区域,需要其重新返回当前非狭窄区域A,并在遍历狭窄区域A的所有出发点后,再穿过狭窄区域进入非狭窄区域B。需要说明的是,第二种较佳实施方式的根据各个临界点对应的位置值获取各个非狭窄区域的周长,更适用于非狭窄区域上的出发点,在巡线路径的延伸方向上处于2段连续的巡线路径上。With reference to FIG. 6, the starting point on the current non-narrow area is on two consecutive line patrol paths in the extending direction of the line patrol path. Thus, when the walking robot does not complete the work of the current non-narrow area A, it needs to be avoided It enters the narrow area. At this time, if the walking robot accidentally enters the narrow area, it needs to return to the current non-narrow area A. After traversing all the starting points of the narrow area A, it then passes through the narrow area and enters the non-narrow area B. It should be noted that the second preferred embodiment obtains the perimeter of each non-narrowed area according to the position value corresponding to each critical point, which is more suitable for the starting point on the non-narrowed area and is located at 2 On a continuous line of patrol route.
本发明一种可实现方式中,若通过狭窄区域的一条边界线使行走机器人意外进入狭窄区域,可在进入狭窄区域后,调整机器人的行走方向以到达当前边界线对应的另一条边界线,之后再调整机器人的行走方向,使其重新返回当前非狭窄区域继续工作。In a realizable manner of the present invention, if a walking robot accidentally enters a narrow area through a boundary line of a narrow area, after entering the narrow area, the walking direction of the robot can be adjusted to reach another boundary line corresponding to the current boundary line, and then Then adjust the walking direction of the robot to make it return to the current non-narrow area and continue to work.
进一步的,本发明的行走机器人的控制方法还包括:实时获取行走机器人的状态属性,所述状态属性包括:电池包的电量、连续工作时长以及连续工作行走的路程至少其中之一;根据行走机器人的状态属性,判断是否执行回归模式。Further, the control method of the walking robot of the present invention further includes: acquiring the state attributes of the walking robot in real time, the state attributes including: at least one of the battery pack power, the continuous working duration, and the continuous working walking distance; according to the walking robot State attribute to determine whether to execute the regression mode.
若行走机器人电池包的电量小于预设电量阈值,和/或连续工作时长大于预设的工作时长阈值,和/或连续行走的路程大于预设的连续行走的路程阈值,则驱动所述行走机器人执行回归模式。回归模式下,行走机器人查找基站位置,并返回至基站进行充电,并在充电完成后,返回至执行回归模式时的位置,继续工作。If the power of the battery pack of the walking robot is less than the preset power threshold, and / or the continuous working duration is greater than the preset working duration threshold, and / or the continuous walking distance is greater than the preset continuous walking distance threshold, the walking robot is driven Perform regression mode. In the return mode, the walking robot finds the position of the base station, and returns to the base station for charging, and after charging is completed, returns to the position where the return mode was executed and continues to work.
需要说明的是,在行走机器人在巡线路径上所有的出发点均按照获取的频数值完成工作后,其也需要执行回归模式,此后,若下一次执行工作的工作区域与上一次执行的工作区域相同,则直接巡线至出发点后进入到作业模式,或重新确定出发点和/或频数值后,在巡线至新的出发点;若不同,需要重新进入到巡线模式,在此不做详细赘述。优选的,当行走机器人按照获取的频数值遍历所有出发点完成工作后回到基站,再下次从基站出发开始工作前,重新确定出发点的位置值和/或频数值,有助于避免行走机器人在相同位置过多此处的转向出发而造成草地磨损的问题。在其他优选实施方式中,也可根据其他预设情况重新确定出发点位置值和/或频数值,所述预设情况包括但不限于累计工作时间、累计工作行走路程、累计充电次数、是否为特定次数的开机等。It should be noted that after all the starting points of the walking robot on the patrol route have completed the work according to the obtained frequency value, it also needs to execute the regression mode. After that, if the work area for the next execution and the work area for the previous execution Same, you will directly enter the operation mode after patrol the line to the starting point, or re-determine the starting point and / or frequency value, then patrol the line to the new starting point; if they are different, you need to re-enter the patrol line mode, and will not repeat them in detail here . Preferably, when the walking robot traverses all starting points to complete the work according to the obtained frequency value, and then returns to the base station, before re-starting the work from the base station, the position value and / or frequency value of the starting point is re-determined, which helps avoid The problem of grass abrasion is caused by too many steering turns in the same position. In other preferred embodiments, the starting point position value and / or frequency value may also be re-determined according to other preset conditions, including but not limited to cumulative working time, cumulative working walking distance, cumulative charging times, whether it is specific The number of times of booting, etc.
进一步的,在同一工作区域下,为了避免行走机器人总是在边界线两侧的同一位置行走而走出车辙,破坏草坪,可以采取沿边界线平行区域不同位置轮流行驶的方法驱动行走机器人行走,如图8所示,边界线自初始点开始,沿箭头D1方向延伸,并还回至初始点结束;line1为边界线line位于草坪的内平行线,line2为边界线line位于草坪边沿的外平行线,二者距边界线line的距离一般为一个车身,内边界线line1的距离可以适当加宽;行走机器人可以行驶在边界line两侧line1和line2之间范围内;并可以按一定顺序执行:如第一次靠左,下一次向右移动一个车轮宽的位置,再下一次再移动一个车轮宽位置,当到达右边极限位置时,再转为靠左行驶,如此往复驶出充电站;也可以在边界线line1和line2之间按随 机或者其他方法驱动行走机器人行走,以达到保护草坪的目的。Further, in the same working area, in order to avoid that the walking robot always walks at the same position on both sides of the boundary line to get out of ruts and damage the lawn, you can take the method of driving the walking robot to walk in different positions along the parallel area of the boundary line, as shown As shown in 8, the boundary line starts from the initial point, extends in the direction of arrow D1, and returns to the end of the initial point; line1 is the inner parallel line of the boundary line located on the lawn, and line2 is the outer parallel line of the boundary line located on the edge of the lawn. The distance between the two from the boundary line is generally a body, and the distance between the inner boundary line1 can be appropriately widened; the walking robot can travel within the range between line1 and line2 on both sides of the boundary line; and it can be executed in a certain order: as in Move to the left once, move to the right one wheel wide position next time, and move to the next wheel wide position again. When reaching the extreme position on the right, turn to the left and drive back and forth from the charging station. A random or other method is used to drive the walking robot between the boundary lines line1 and line2 to achieve the purpose of protecting the lawn.
如图9所示,在本发明的第一实施方式中,所述行走机器人的控制系统包括:配置模块100、巡查模块200、区域划分模块300、控制处理模块400以及存储模块500。As shown in FIG. 9, in the first embodiment of the present invention, the control system of the walking robot includes: a configuration module 100, a patrol module 200, an area division module 300, a control processing module 400 and a storage module 500.
配置模块100用于提供一呈闭合的巡线路径,所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路。The configuration module 100 is used to provide a closed line patrol path, which is a closed loop formed by the boundary line of the working area where the walking robot is located.
巡查模块200用于驱动所述行走机器人从初始点出发、沿巡线路径行走一周,记录巡线路径的周长以及确认巡线路径上狭窄通道的位置。The patrol module 200 is used to drive the walking robot from the initial point, walk along the patrol route for one week, record the circumference of the patrol route and confirm the position of the narrow passage on the patrol route.
基站开启后,配置模块100通过设置在基站内的信号发生装置沿巡线路径发射脉冲编码信号,以在所述巡线路径上产生电磁信号。After the base station is turned on, the configuration module 100 transmits a pulse-coded signal along the patrol route through a signal generating device provided in the base station to generate an electromagnetic signal on the patrol route.
巡查模块200用于驱动所述行走机器人沿巡线路径的延伸方向行走过程中,记录行走机器人实际接收到电磁信号的强度,根据行走机器人实际接收到的电磁信号的强度确认巡线路径上狭窄通道的位置。The patrol module 200 is used to drive the walking robot to walk along the extension direction of the patrol line path, record the strength of the electromagnetic signal actually received by the walking robot, and confirm the narrow channel on the patrol path according to the strength of the electromagnetic signal actually received by the walking robot s position.
区域划分模块300用于将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域,以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域。。The area dividing module 300 is used to divide the area formed by the current patrol route into at least one narrow area formed by at least one narrow passage, and at least two non-narrow areas connected at both ends of the at least one narrow area. .
控制处理模块400用于:根据记录的巡线路径周长获取每个非狭窄区域中各个出发点对应的位置值;所述位置值为当前出发点距离初始点在巡线路径上的长度。The control processing module 400 is used to: obtain the position value corresponding to each departure point in each non-narrow area according to the recorded perimeter of the tour route; the position value is the length of the current departure point from the initial point on the tour route.
本发明一具体实施方式中,控制处理模块400具体用于:获取狭窄区域与非狭窄区域之间形成的临界点,以及各个临界点对应的位置值;其中,沿巡线路径的延伸方向,形成的临界点顺序为临界点P 1、临界点P 2、临界点P 3、临界点P 4,各个临界点对应的位置值依次为L P1、L P2、L P3、L P4;根据各个临界点对应的位置值获取各个非狭窄区域的周长;或根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长;S43、根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值。 In a specific embodiment of the present invention, the control processing module 400 is specifically used to: obtain the critical point formed between the narrow area and the non-narrow area, and the position value corresponding to each critical point; wherein, along the extension direction of the patrol path, form The order of critical points is critical point P 1 , critical point P 2 , critical point P 3 , critical point P 4 , and the corresponding position values of each critical point are L P1 , L P2 , L P3 , L P4 in sequence; according to each critical point Obtain the perimeter of each non-narrowed area according to the corresponding position value; or obtain the perimeter of each non-narrowed area according to the obtained position value corresponding to the critical point and the perimeter of the route path; S43, according to the perimeter of each non-narrowed area Long independently obtains the position value corresponding to each starting point in the non-narrow area.
本发明第一种较佳实施方式中,控制处理模块400具体用于判断初始点是否在当前非狭窄区域上,若是,则当前非狭窄区域的周长l A=l sum-(L P4-L P1);若否,则当前非狭窄区域的周长l A=L P3-L P2,其中,l sum表示巡线路径的周长,l A表示当前非狭窄区域的周长。 In the first preferred embodiment of the present invention, the control processing module 400 is specifically used to determine whether the initial point is on the current non-narrow area, and if so, the perimeter of the current non-narrow area l A = l sum- ( LP4- L P1 ); if not, the current perimeter of the non-narrowed area l A = L P3- L P2 , where l sum represents the perimeter of the patrol route, and l A represents the perimeter of the current non-narrowed area.
本发明第二种较佳实施方式中,控制处理模块400具体用于采用累加算法获得各个非狭窄区域的周长,即判断初始点是否在当前非狭窄区域上,若是,沿巡线路径的延伸方向,自初始点开始累加当前非狭窄区域的周长,并在到达临界点P 1时,停止累加当前非狭窄区域的周长,当到达临界点P 4时,继续累加当前非狭窄区域的周长,直至返回至初始点;若否,当前非狭窄区域的周长为沿巡线路径的延伸方向临界点P 2至临界点P 3之间的长度。 In the second preferred embodiment of the present invention, the control processing module 400 is specifically used to obtain the perimeter of each non-narrow area using an accumulation algorithm, that is, to determine whether the initial point is on the current non-narrow area, and if so, to extend along the route direction, from the initial accumulation point on the perimeter of the current non-narrow region and reach the critical point P 1, stopping the accumulation of non-narrow region of the circumference of this, when P 4 reaches the critical point, the current continues to accumulate non narrow circumferential area Long until it returns to the initial point; if not, the current perimeter of the non-narrow area is the length from the critical point P 2 to the critical point P 3 along the extension direction of the route.
进一步的,控制处理模块400具体用于依照非狭窄区域的周长l A获得出发区间的线长l SE,起始点S的位置值L S和终点E的位置值L E,所述出发区间为依照巡线路径行走的轨迹,则l SE=L E-L S,L S=x·l A,L E=y·l A,l SE≤l A,其中,x<y,x∈[0,1),y∈(0,1];在出发区间内选取至少1个出发点。。 Further, the control processing module 400 is configured to obtain the start position value the position value in accordance with the interval of non-narrow region peripheral length l A line length l SE, the start point S and end point E L S E L, the departure interval According to the trajectory of the line-travel path, then l SE = L E- L S , L S = x · l A , L E = y · l A , l SE ≤ l A , where x <y, x ∈ [0 , 1), y∈ (0,1]; select at least one starting point in the starting interval ...
进一步的,本发明具体实施方式中,控制处理模块400具体用于将出发区间划分为多个子区间;分别在每个子区间中选取对应于该子区间的至少1个出发点。Further, in a specific embodiment of the present invention, the control processing module 400 is specifically configured to divide the departure interval into a plurality of sub-intervals; at least one departure point corresponding to the sub-interval is selected in each sub-interval.
控制处理模块400将出发区间划分为多个子区间的方式有多种,其中一种较佳实施方式中,将出发区间按照有序数列划分为多个子区间,使子区间之间的长度关系呈例如等差数列、等比数列、等和数列、 斐波那契数列、分群数列、周期数列、阶差数列等至少其中之一。The control processing module 400 divides the departure interval into multiple sub-intervals. In a preferred embodiment, the departure interval is divided into multiple sub-intervals according to an ordered sequence, so that the length relationship between the sub-intervals is, for example, Arithmetic series, isometric series, equal sum series, Fibonacci series, grouping series, periodic series, step series and so on.
进一步的,控制处理模块400还用于在出发区间内,按照随机或伪随机的方式获得至少1个出发点。Further, the control processing module 400 is also used to obtain at least one starting point in a random or pseudo-random manner within the starting interval.
本发明一具体实施方式中,控制处理模块400在出发区间内,自起始点S的位置值L S开始,按照第一预设长度选取第一出发区间,并在该第一出发区间内随机选定第1个出发点;依次以选定的出发点为起始点,按照第二预设长度划分至少1个第二出发区间,并在该第二出发区间内随机选定下一个出发点,直至遍历整个出发区间。 In a specific embodiment of the present invention, the control processing module 400 selects the first starting interval according to the first preset length from the position value L S of the starting point S in the starting interval, and randomly selects the first starting interval Set the first starting point; take the selected starting point as the starting point in sequence, divide at least one second starting interval according to the second preset length, and randomly select the next starting point within the second starting interval until the entire starting point is traversed Interval.
进一步的,控制处理模块400还用于驱动所述行走机器人按照所述巡线路径行走以遍历每个非狭窄区域上的每个出发点,在同一非狭窄区域内依照对应的位置值到达每个出发点时,驱动所述行走机器人进入工作状态;其中,在每个狭窄区域工作完成之前,阻止行走机器人进入狭窄区域。Further, the control processing module 400 is further configured to drive the walking robot to walk along the line-tracking path to traverse each starting point on each non-narrow area, and reach each starting point within the same non-narrow area according to the corresponding position value At this time, the walking robot is driven into a working state; wherein, before the work of each narrow area is completed, the walking robot is prevented from entering the narrow area.
本发明一种可实现方式中,控制处理模块400若确认通过狭窄区域的一条边界线使行走机器人意外进入狭窄区域,可在进入狭窄区域后,调整机器人的行走方向以到达当前边界线对应的另一条边界线,之后再调整机器人的行走方向,使其重新返回当前非狭窄区域继续工作。In one possible implementation of the present invention, if the control processing module 400 confirms that a walking robot enters the narrow region by accident through a boundary line of the narrow region, it can adjust the walking direction of the robot to reach another corresponding to the current boundary line after entering the narrow region A boundary line, and then adjust the walking direction of the robot to make it return to the current non-narrow area and continue to work.
本发明较佳实施方式中,控制处理模块400自动获取当前巡线路径中各个出发点对应的频数值;所述频数值为同一出发点连续出发的次数;在达到预设条件之前,仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入作业模式,且禁止所述行走机器人进入所述狭窄区域。。In a preferred embodiment of the present invention, the control processing module 400 automatically obtains the frequency value corresponding to each starting point in the current patrol route; the frequency value is the number of consecutive departures from the same starting point; only the walking is allowed until the preset conditions are reached The robot chooses to enter the work mode at the starting point belonging to the same non-narrow area, and prohibits the walking robot from entering the narrow area. .
本发明中对应各个出发点的频数值可以任意指定,也可以按照一定的规则进行获取。本发明一较佳实施方式中,控制处理模块400在预设频数阈值范围内,配置每个出发点的频数值相等;或在预设频数阈值范围内,按照各个出发点距离其相邻的上一出发点在巡线路径上的距离差正相关于配置各个出发点对应的频数值;或在预设频数阈值范围内,对各个出发点随机配置任一频数值。In the present invention, the frequency value corresponding to each starting point can be specified arbitrarily, and can also be obtained according to a certain rule. In a preferred embodiment of the present invention, the control processing module 400 configures the frequency value of each starting point to be equal within the preset frequency threshold range; or within the preset frequency threshold range, according to the distance between each starting point and its adjacent previous starting point The distance difference on the patrol route is positively related to configuring the frequency value corresponding to each starting point; or within the preset frequency threshold range, randomly configuring any frequency value for each starting point.
所述存储模块500中设置至少一存储器列表;所述存储器列表用于存储各个出发点以及其所对应的位置值和频数值,并根据频数值生成位置值序列表,具体地,位置值序列表包括出发序列号及其对应的位置值。例如,在一个实施例中,出发点PA1的位置值L PA1=0m,频数值F PA1=1;出发点PA2的位置值L PA2=15m,频数值F PA2=3;出发点PA3的位置值L PA3=30m,频数值F PA3=2;出发点PA4的位置值L PA4=45m,频数值F PA4=2。那么,生成的出发序列号-位置值列表{(index,L PAi)}为{(1,0),(2,15),(3,15),(4,15),(5,30),(6,30),(7,45),(8,45)},其中index为出发序列号,L PAi为出发点PA i的位置值。控制处理模块400可通过查询所述存储器列表中存储的位置值序列表和当次出发序列号,获得当次出发所选择的出发点对应的位置值和频数值。 At least one memory list is set in the storage module 500; the memory list is used to store each starting point and its corresponding position value and frequency value, and generate a position value sequence table according to the frequency value. Specifically, the position value sequence table includes The starting serial number and its corresponding position value. For example, in one embodiment, the position value of the starting point PA1 L PA1 = 0m, frequency value F PA1 = 1; the position value of the starting point PA2 L PA2 = 15m, the frequency value F PA2 = 3; the position value of the starting point PA3 L PA3 = 30m, the frequency value F PA3 = 2; the starting point PA4 position value L PA4 = 45m, the frequency value F PA4 = 2. Then, the generated starting sequence number-position value list {(index, L PAi )} is {(1,0), (2,15), (3,15), (4,15), (5,30) , (6,30), (7,45), (8,45)}, where index is the starting sequence number and L PAi is the position value of the starting point PA i . The control processing module 400 may obtain the position value and frequency value corresponding to the selected starting point of the current departure by querying the position value sequence table and the current departure sequence number stored in the memory list.
当进入到作业模式后,行走机器人在到达任一出发点时,按照该出发点对应的频数值进入工作区域进行割草。After entering the work mode, when the walking robot reaches any starting point, it enters the working area according to the frequency value corresponding to the starting point for mowing.
进一步的,控制处理模块400还用于实时获取行走机器人的状态属性,所述状态属性包括:电池包的电量、连续工作时长以及连续行走的路程至少其中之一;根据行走机器人的状态属性,判断是否执行回归模式。若行走机器人电池包的电量小于预设电量阈值,和/或连续工作时长大于预设的工作时长阈值,和/或连续行走的路程大于预设的连续行走的路程阈值,则驱动所述行走机器人执行回归模式。Further, the control processing module 400 is further used to obtain real-time state attributes of the walking robot. The state attributes include: at least one of the battery pack power, continuous working time, and continuous walking distance; according to the state attributes of the walking robot, the judgment Whether to execute the regression mode. If the power of the battery pack of the walking robot is less than the preset power threshold, and / or the continuous working duration is greater than the preset working duration threshold, and / or the continuous walking distance is greater than the preset continuous walking distance threshold, the walking robot is driven Perform regression mode.
与现有技术相比,本发明行走机器人的控制方法及系统,对于具有狭窄通道的工作空间,自动对工作区域进行划分,以形成狭窄区域和非狭窄区域,并使行走机器人在工作过程中,根据需要自由穿过狭窄区域以遍历每个非狭窄区域,进而提升行走机器人在工作区间内的遍历性,提高工作效率。Compared with the prior art, the control method and system of the walking robot of the present invention automatically divide the working area for the working space with a narrow channel to form a narrow area and a non-narrow area, and make the walking robot in the working process, According to the need to freely pass through the narrow area to traverse each non-narrow area, and thus improve the traversal of the walking robot in the working area, improve work efficiency.
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统中模块的具体工作过程,可以参考前述方法实施方式中的对应过程,在此不再赘述。Those skilled in the art can clearly understand that, for the convenience and conciseness of description, the specific working process of the modules in the system described above can refer to the corresponding process in the foregoing method embodiment, which will not be repeated here.
在本申请所提供的几个实施方式中,应该理解到,所揭露的系统,系统和方法,可以通过其它的方式实现。例如,以上所描述的系统实施方式仅仅是示意性的,例如,所述模块的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个模块或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,系统或模块的间接耦合或通信连接,可以是电性,机械或其它的形式。In the several embodiments provided in this application, it should be understood that the disclosed system, system, and method may be implemented in other ways. For example, the system implementation described above is only schematic. For example, the division of the modules is only a division of logical functions. In actual implementation, there may be other divisions, for example, multiple modules or components may be combined or Can be integrated into another system, or some features can be ignored, or not implemented. In addition, the displayed or discussed mutual coupling or direct coupling or communication connection may be indirect coupling or communication connection through some interfaces, systems or modules, and may be in electrical, mechanical or other forms.
所述作为分离部件说明的模块可以是或者也可以不是物理上分开的,作为模块显示的部件可以是或者也可以不是物理模块,即可以位于一个地方,或者也可以分布到多个网络模块上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施方式方案的目的。The modules described as separate components may or may not be physically separated, and the components displayed as modules may or may not be physical modules, that is, they may be located in one place, or may be distributed on multiple network modules. Some or all of the modules may be selected according to actual needs to achieve the objectives of the solutions of the embodiments.
另外,在本申请各个实施方式中的各功能模块可以集成在一个处理模块中,也可以是各个模块单独物理存在,也可以2个或2个以上模块集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用硬件加软件功能模块的形式实现。In addition, each functional module in each embodiment of the present application may be integrated into one processing module, or each module may exist alone physically, or two or more modules may be integrated into one module. The above integrated modules can be implemented in the form of hardware, or in the form of hardware plus software function modules.
上述以软件功能模块的形式实现的集成的模块,可以存储在一个计算机可读取存储介质中。上述软件功能模块存储在一个存储介质中,包括若干指令用以使得一台计算机系统(可以是个人计算机,服务器,或者网络系统等)或处理器(processor)执行本申请各个实施方式所述方法的部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(Random Access Memory,RAM)、磁碟或者光盘等各种可以存储程序代码的介质。The above integrated modules implemented in the form of software function modules may be stored in a computer-readable storage medium. The above software function modules are stored in a storage medium, and include several instructions to enable a computer system (which may be a personal computer, a server, or a network system, etc.) or a processor (processor) to perform the methods described in the various embodiments of the present application. Partial steps. The aforementioned storage media include: U disk, mobile hard disk, read-only memory (Read-Only Memory, ROM), random access memory (Random Access Memory, RAM), magnetic disk or optical disk and other media that can store program code .
为了更加清楚全面地阐释本发明的技术方案,参考图10,上述任意一个实施例所述的行走机器人的控制系统,按照以下步骤进行工作。In order to explain the technical solution of the present invention more clearly and comprehensively, referring to FIG. 10, the control system of the walking robot according to any one of the above embodiments works according to the following steps.
ST1:系统初始化并开始工作。具体地,基站上电,向边界线发送信号以在边界线附近产生电磁信号。此时,机器人位于基站内,即位于初始位置,且出发序列号初始值为0。ST1: The system initializes and starts to work. Specifically, the base station is powered on and sends a signal to the boundary line to generate an electromagnetic signal near the boundary line. At this time, the robot is located in the base station, that is, at the initial position, and the initial value of the starting sequence number is 0.
ST2:机器人进入巡线模式,从初始点开始、沿边界线行走并绕边界线一周后回到初始点,并记录边界线的周长及狭窄区域的位置。具体方法在前文中已详细说明,在此不再赘述。ST2: The robot enters the line patrol mode, starts from the initial point, walks along the boundary line and returns to the initial point after going around the boundary line once, and records the circumference of the boundary line and the position of the narrow area. The specific method has been described in detail in the foregoing, and will not be repeated here.
ST3:根据边界线的周长,分别确定每个非狭窄区域的边界线上各个出发点的位置值及各个出发点对应的频数值,并根据频数值形成针对各个非狭窄区域的位置值序列,进而形成出发序列号-位置值列表。其中,位置值、频数值及出发序列号列表的确定方法依照上述方法实现,这里不再赘述;每个非狭窄区域的出发序列号-位置值列表是各自独立的。ST3: According to the perimeter of the boundary line, determine the position value of each starting point and the frequency value corresponding to each starting point on the boundary line of each non-narrow area, and form the position value sequence for each non-narrow area according to the frequency value, and then form Departure serial number-position value list. Wherein, the method of determining the position value, frequency value and starting sequence number list is implemented according to the above method, which will not be repeated here; the starting sequence number-position value list of each non-narrow area is independent.
ST4:调取并使用一非狭窄区域的出发序列号-位置值列表。ST4: Retrieve and use the starting sequence number-position value list of a non-narrow area.
ST5:出发序列号的值增加1。ST5: The value of the starting sequence number is increased by 1.
ST6:机器人以巡线模式,再次从初始点开始、沿边界线行走到达该一非狭窄区域的出发序列号对应的出发点。ST6: The robot starts from the initial point and walks along the boundary line to the starting point corresponding to the starting sequence number of the non-narrow area again in the patrol mode.
ST7:机器人从该出发点转向离开边界线,进入该一非狭窄区域并开始割草作业,即从巡线模式进入作业模式。ST7: The robot turns from the starting point away from the boundary line, enters the non-narrow area and starts mowing, that is, enters the operation mode from the line patrol mode.
ST8:机器人保持作业模式,在工作区域内进行割草作业。ST8: The robot maintains the operation mode and performs mowing operations in the work area.
ST9:判断机器人是否满足特定的状态属性。具体地,在一些实施例中,判断电池包的剩余电量满足小于等于一阈值,若是,则机器人执行ST10回到基站,若否,则执行ST8继续在工作区域内进行割草作业。在一些实施例中,判断机器人累计割草时间是否满足大于等于一阈值,若是,则机器人执行ST10回到基站,若否,则执行ST8继续在工作区域内进行割草作业。在一些实施例中,判断机器人累计作业行走路程是否满足大于等于一阈值,若是,则机器人执行ST10回到基站,若否,则执行ST8继续在工作区域内进行割草作业。这里的特定的状态属性,可以是单一的状态属性,也可以是综合考虑多个状态属性, 包括但不限于上述以举例形式列出的状态属性。ST9: Determine whether the robot satisfies specific state attributes. Specifically, in some embodiments, it is determined that the remaining power of the battery pack satisfies a threshold or less. If yes, the robot executes ST10 to return to the base station. If not, executes ST8 to continue mowing in the work area. In some embodiments, it is determined whether the cumulative mowing time of the robot satisfies a threshold value or greater. If it is, the robot performs ST10 to return to the base station. If not, it executes ST8 to continue mowing in the work area. In some embodiments, it is determined whether the cumulative walking distance of the robot satisfies a threshold or greater. If it is, the robot executes ST10 to return to the base station. If not, it executes ST8 to continue mowing in the work area. The specific state attribute here may be a single state attribute or a combination of multiple state attributes, including but not limited to the state attributes listed above in the form of examples.
ST10:机器人回到初始点。具体地,驱动机器人回到基站,并进行充电和/或维护。ST10: The robot returns to the initial point. Specifically, the robot is driven back to the base station, and is charged and / or maintained.
ST11:判断是否继续工作。具体地,在充电和/或维护完成后,判断是否完成当前工作计划,即是否继续工作。若继续工作,则执行ST2,若不继续工作,则执行ST15。ST11: Determine whether to continue working. Specifically, after the charging and / or maintenance is completed, it is determined whether the current work plan is completed, that is, whether to continue working. If you continue to work, execute ST2, if you do not continue to work, execute ST15.
ST12:判断是否允许机器人进入另一非狭窄区域。具体地,在一些实施例中,判断条件为在该一非狭窄区域内累计作业时间是否达到一阈值;在一些实施例中,判断条件为在该一非狭窄区域内累计作业行走路程是否达到一阈值。若是,则执行ST13,若否,则执行ST14。这里的判断条件,可以是单一的条件,也可以是综合考虑多个条件,包括但不限于上述以举例形式列出的条件。ST12: Determine whether to allow the robot to enter another non-narrow area. Specifically, in some embodiments, the judgment condition is whether the cumulative working time in the non-narrow area reaches a threshold; in some embodiments, the judgment condition is whether the cumulative working walking distance in the non-narrow area reaches one Threshold. If yes, execute ST13, if no, execute ST14. The judgment condition here may be a single condition, or a combination of multiple conditions, including but not limited to the conditions listed above in the form of examples.
ST13:调取并使用另一非狭窄区域的出发序列号-位置值列表,并将出发序列号的值设为0。ST13: Recall and use the starting sequence number-position value list of another non-narrow area, and set the starting sequence number value to 0.
ST14:继续使用当前非狭窄区域的出发序列号-位置值列表。ST14: Continue to use the starting sequence number-position value list of the current non-narrow area.
ST15:系统关闭,结束工作。在该步骤,机器人通常以存储状态位于基站内,机器人和/或基站的电源自动地或人为地切断。ST15: The system is shut down and the work is ended. In this step, the robot is usually located in the base station in a stored state, and the power of the robot and / or base station is automatically or artificially cut off.
最后应说明的是:以上实施方式仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施方式对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施方式所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施方式技术方案的精神和范围。Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present application, not to limit them; although the present application has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that they can still Modifications to the technical solutions described in the foregoing embodiments, or equivalent replacements of some of the technical features; and these modifications or replacements do not deviate from the spirit and scope of the technical solutions of the embodiments of the present application.

Claims (19)

  1. 一种行走机器人的控制方法,包括:A control method of a walking robot, including:
    S1:提供一闭合的巡线路径,所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路;S1: Provide a closed line-tracking path, which is a closed loop formed by the boundary line of the working area where the walking robot is located;
    S2:驱动所述行走机器人从初始点出发、沿巡线路径行走一周,记录巡线路径的周长以及确认巡线路径上狭窄通道的位置;S2: driving the walking robot from the initial point, walking along the patrol route for one week, recording the circumference of the patrol route and confirming the position of the narrow channel on the patrol route;
    S3:将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域,以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域;S3: Divide the area formed by the current patrol route into at least one narrow area formed by at least one narrow passage, and at least two non-narrow areas connected at both ends of the at least one narrow area;
    S4:根据记录的巡线路径周长获取每个所述非狭窄区域中各个出发点对应的位置值;所述出发点设置在所述巡线路径上,且每个所述非狭窄区域中包括至少一个所述出发点;所述位置值等于当前出发点距离所述初始点在巡线路径上的长度值;S4: Obtaining the position value corresponding to each departure point in each of the non-narrow areas according to the recorded perimeter of the tour route; the departure point is set on the tour route and each of the non-narrow areas includes at least The starting point; the position value is equal to the length value of the current starting point from the initial point on the line-tracking path;
    S5:在达到预设条件之前,仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入作业模式,且禁止所述行走机器人进入所述狭窄区域。S5: Before reaching the preset condition, only the walking robot is allowed to select to enter the work mode at the starting point belonging to the same non-narrow area, and the walking robot is prohibited from entering the narrow area.
  2. 根据权利要求1所述的行走机器人的控制方法,其特征在于,所述初始点设置在基站位置。The method for controlling a walking robot according to claim 1, wherein the initial point is set at a base station position.
  3. 根据权利要求2所述的行走机器人的控制方法,其特征在于,所述预设条件为累计工作时长、累计工作行走的路程、电池包的电量中的至少一种。The control method of a walking robot according to claim 2, wherein the preset condition is at least one of cumulative working time, cumulative working walking distance, and battery pack power.
  4. 根据权利要求2所述的行走机器人的控制方法,其特征在于,所述方法还包括:The method for controlling a walking robot according to claim 2, wherein the method further comprises:
    S21:向边界线发射信号,以在所述边界线周围产生电磁信号;S21: Send a signal to the boundary line to generate an electromagnetic signal around the boundary line;
    S22:驱动所述行走机器人沿巡线路径的延伸方向行走过程中,记录行走机器人实际接收到电磁信号的强度;S22: During driving the walking robot to walk along the extension direction of the patrol line path, record the intensity of the electromagnetic signal actually received by the walking robot;
    S23:根据行走机器人实际接收到的电磁信号的强度确认巡线路径上狭窄通道的位置。S23: According to the strength of the electromagnetic signal actually received by the walking robot, confirm the position of the narrow channel on the line patrol path.
  5. 根据权利要求2所述的行走机器人的控制方法,其特征在于,“根据记录的巡线路径周长获取每个非狭窄区域中各个出发点对应的位置值”具体包括:The method for controlling a walking robot according to claim 2, wherein "acquiring the position value corresponding to each starting point in each non-narrow area according to the recorded perimeter of the line-traveling route" specifically includes:
    S41:获取狭窄区域与非狭窄区域之间形成的临界点,以及各个临界点对应的位置值;其中,沿巡线路径的延伸方向,形成的临界点顺序为临界点P 1、临界点P 2、临界点P 3、临界点P 4,各个临界点对应的位置值依次为L P1、L P2、L P3、L P4S41: Obtain the critical point formed between the narrow area and the non-narrow area, and the position value corresponding to each critical point; where, along the extending direction of the line-tracking path, the critical points are formed in the order of critical point P 1 and critical point P 2 , Critical point P 3 , critical point P 4 , and the corresponding position values of each critical point are L P1 , L P2 , L P3 , and L P4 in sequence;
    S42:根据各个临界点对应的位置值获取各个非狭窄区域的周长;或根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长;S42: Obtain the perimeter of each non-narrow area according to the position value corresponding to each critical point; or obtain the perimeter of each non-narrow area according to the obtained position value corresponding to the critical point and the perimeter of the line-travel path;
    S43:根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值。S43: Acquire the position value corresponding to each starting point in the non-narrow area independently according to the perimeter of each non-narrow area.
  6. 根据权利要求5所述的行走机器人的控制方法,其特征在于,“根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长”具体包括:The control method of a walking robot according to claim 5, characterized in that "obtaining the perimeter of each non-narrow area according to the obtained position value corresponding to the critical point and the perimeter of the line-traveling path" specifically includes:
    判断所述初始点是否在当前非狭窄区域上,Determine whether the initial point is on the current non-narrow area,
    若是,则当前非狭窄区域的周长l A=l sum-(L P4-L P1); If yes, the current perimeter of the non-narrow area l A = l sum- (L P4- L P1 );
    若否,则当前非狭窄区域的周长l A=L P3-L P2,其中,l sum表示巡线路径的周长,l A表示当前非狭窄区域的周长。 If not, the perimeter of the current non-narrow area l A = L P3- L P2 , where l sum represents the perimeter of the line-travel path, and l A represents the perimeter of the current non-narrow area.
  7. 根据权利要求5所述的行走机器人的控制方法,其特征在于,“根据各个临界点对应的位置值获取各个非狭窄区域的周长”具体包括:The control method of a walking robot according to claim 5, characterized in that "acquiring the perimeter of each non-narrow area according to the position value corresponding to each critical point" specifically includes:
    采用累加算法获得各个非狭窄区域的周长,即Use the accumulation algorithm to obtain the perimeter of each non-narrow area, namely
    判断所述初始点是否在当前非狭窄区域上,Determine whether the initial point is on the current non-narrow area,
    若是,沿巡线路径的延伸方向,自初始点开始累加当前非狭窄区域的周长,并在到达临界点P 1时,停止累加当前非狭窄区域的周长,当到达临界点P 4时,继续累加当前非狭窄区域的周长,直至返回至初始点; If it is, along the extension direction of the patrol route, the perimeter of the current non-narrow area is accumulated from the initial point, and when the critical point P 1 is reached, the perimeter of the current non-narrow area is stopped. When the critical point P 4 is reached, Continue to accumulate the circumference of the current non-narrow area until it returns to the initial point;
    若否,当前非狭窄区域的周长为沿巡线路径的延伸方向临界点P 2至临界点P 3之间的长度。 If not, the current perimeter of the non-narrow area is the length from the critical point P 2 to the critical point P 3 along the extending direction of the route.
  8. 根据权利要求5至7任一项所述的行走机器人的控制方法,其特征在于,“根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值”具体包括:The control method of a walking robot according to any one of claims 5 to 7, characterized in that "acquiring the position value corresponding to each starting point in the non-narrow area independently according to the perimeter of each non-narrow area" specifically includes
    S431:依照非狭窄区域的周长l A获得起始点S的位置值L S、终点E的位置值L E和沿巡线路径从起始点S到终点E之间的出发区间的线长l SE;所述出发区间为依照巡线路径行走的轨迹,出发点均在所述出发区间内选取;则l SE=L E-L S,L S=x·l A,L E=y·l A,l SE≤l A,其中,x<y,x∈[0,1),y∈(0,1]; S431: obtaining the starting point position value S L S in accordance with the circumferential length of the non-narrow region l A, the value of the position of the end point E and L E along the transmission line path from the start point S to the starting interval between the end point E of the line length l SE The starting interval is a trajectory that follows the patrol route, and the starting points are all selected within the starting interval; then l SE = L E- L S , L S = x · l A , L E = y · l A , l SE ≤ l A , where x <y, x∈ [0,1), y∈ (0,1];
    S432:在出发区间内选取至少1个出发点。S432: Select at least one starting point in the starting interval.
  9. 根据权利要求8所述的行走机器人的控制方法,其特征在于,所述方法还包括:The method for controlling a walking robot according to claim 8, wherein the method further comprises:
    判断所述初始点是否处于当前非狭窄区域上,Determine whether the initial point is on the current non-narrow area,
    若是,则将初始点设置为当前非狭窄区域的起始点S;If yes, set the initial point to the starting point S of the current non-narrow area;
    若否,则将临界点P 3设置为当前非狭窄区域的起始点S。 If not, the critical point P 3 is set as the starting point S of the current non-narrow area.
  10. 根据权利要求8所述的行走机器人的控制方法,其特征在于,所述方法具体包括:The method for controlling a walking robot according to claim 8, wherein the method specifically comprises:
    将出发区间划分为多个子区间;Divide the starting interval into multiple sub-intervals;
    分别在每个子区间中选取对应于该子区间的至少1个出发点。At least one starting point corresponding to the sub-interval is selected in each sub-interval.
  11. 根据权利要求10所述的行走机器人的控制方法,其特征在于,“将出发区间划分为多个子区间”具体包括:The method for controlling a walking robot according to claim 10, wherein "dividing the starting interval into a plurality of sub-intervals" specifically includes:
    将出发区间按照有序数列划分为多个子区间。The starting interval is divided into multiple sub-intervals according to the ordered sequence.
  12. 根据权利要求11所述的行走机器人的控制方法,其特征在于,“将出发区间按照有序数列划分为多个子区间”具体包括:The method for controlling a walking robot according to claim 11, wherein "dividing the starting interval into multiple sub-intervals according to an ordered sequence" specifically includes:
    将出发区间按照有序数列划分为多个子区间,使子区间之间的长度关系呈例如等差数列、等比数列、等和数列、斐波那契数列、分群数列、周期数列、阶差数列至少其中之一。The starting interval is divided into multiple sub-intervals according to the ordered sequence, so that the length relationship between the sub-intervals is, for example, the arithmetic sequence, the geometric sequence, the equal sum sequence, the Fibonacci sequence, the group sequence, the period sequence, the order sequence At least one of them.
  13. 根据权利要求8所述的行走机器人的控制方法,其特征在于,“在出发区间内选取至少1个出发点”具体包括:The method for controlling a walking robot according to claim 8, wherein "selecting at least one starting point in the starting interval" specifically includes:
    在出发区间内按照随机或伪随机的方式获得至少1个出发点。At least one starting point is obtained in a random or pseudo-random manner within the starting interval.
  14. 根据权利要求13所述的行走机器人的控制方法,其特征在于,所述方法具体包括:The method for controlling a walking robot according to claim 13, wherein the method specifically comprises:
    在出发区间内,自起始点S的位置值L S开始,按照第一预设长度选取第一出发区间,并在该第一出发区间内随机选定第1个出发点; In the departure interval, starting from the position value L S of the starting point S, the first departure interval is selected according to the first preset length, and the first departure point is randomly selected in the first departure interval;
    依次以选定的出发点为起始点,按照第二预设长度划分至少1个第二出发区间,并在该第二出发区间内随机选定下一个出发点,直至遍历整个出发区间。Taking the selected starting point as the starting point in sequence, at least one second starting interval is divided according to the second preset length, and the next starting point is randomly selected within the second starting interval until the entire starting interval is traversed.
  15. 根据权利要求5所述的行走机器人的控制方法,其特征在于,所述方法还包括:The method for controlling a walking robot according to claim 5, wherein the method further comprises:
    自动获取当前巡线路径中各个出发点对应的频数值;所述频数值为所述行走机器人在同一出发点连续出发的次数。Automatically obtain the frequency value corresponding to each starting point in the current patrol route; the frequency value is the number of times the walking robot continuously starts at the same starting point.
  16. 根据权利要求15所述的行走机器人的控制方法,其特征在于,所述方法还包括:The method for controlling a walking robot according to claim 15, wherein the method further comprises:
    在预设频数阈值范围内,配置每个出发点的频数值相等;Within the preset frequency threshold range, configure the frequency value of each starting point to be equal;
    或在预设频数阈值范围内,按照各个出发点距离其相邻的上一出发点在巡线路径上的距离差正相关于配 置各个出发点对应的频数值;Or within the preset frequency threshold range, according to the distance difference between each starting point and its adjacent previous starting point on the patrol route, it is positively related to configuring the frequency value corresponding to each starting point;
    或在预设频数阈值范围内,对各个出发点随机配置任一频数值。Or, within the preset frequency threshold range, randomly configure any frequency value for each starting point.
  17. 根据权利要求2所述的行走机器人的控制方法,其特征在于,所述方法还包括:The method for controlling a walking robot according to claim 2, wherein the method further comprises:
    实时获取行走机器人的状态属性,所述状态属性包括:电池包的电量、连续工作时长以及连续工作行走的路程至少其中之一;Real-time acquisition of the state attributes of the walking robot, the state attributes including: at least one of the battery pack power, the duration of continuous working, and the distance of continuous working walking;
    若行走机器人电池包的电量小于预设电量阈值,和/或连续工作时长大于预设的工作时长阈值,和/或连续行走的路程大于预设的连续行走的路程阈值,则驱动所述行走机器人返回至所述基站。If the power of the battery pack of the walking robot is less than the preset power threshold, and / or the continuous working duration is greater than the preset working duration threshold, and / or the continuous walking distance is greater than the preset continuous walking distance threshold, the walking robot is driven Return to the base station.
  18. 根据权利要求1所述的行走机器人的控制方法,其特征在于,当所述行走机器人达到预设情况时,重新确定出发点的位置值和/或频数值。The method for controlling a walking robot according to claim 1, wherein when the walking robot reaches a preset condition, the position value and / or frequency value of the starting point are newly determined.
  19. 一种行走机器人的控制系统,其特征在于,所述系统包括:A control system for a walking robot, characterized in that the system includes:
    配置模块,用于提供一闭合的巡线路径,所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路;The configuration module is used to provide a closed line patrol path, which is a closed loop formed by the boundary line of the working area where the walking robot is located;
    巡查模块,用于驱动所述行走机器人从初始点出发、沿巡线路径行走一周,记录巡线路径的周长以及确认巡线路径上狭窄通道的位置;The patrol module is used to drive the walking robot from the initial point, walk along the patrol route for one week, record the circumference of the patrol route and confirm the position of the narrow channel on the patrol route;
    区域划分模块,用于将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域,以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域;An area dividing module, configured to divide the area formed by the current patrol route into at least one narrow area formed by at least one narrow passage, and at least two non-narrow areas connected at both ends of the at least one narrow area;
    控制处理模块,用于根据记录的巡线路径周长获取每个所述非狭窄区域中各个出发点对应的位置值;所述出发点设置在所述巡线路径上,且每个所述非狭窄区域中包括至少一个所述出发点;所述位置值等于当前出发点距离所述初始点在巡线路径上的长度值;A control processing module, configured to obtain the position value corresponding to each departure point in each of the non-narrow areas according to the recorded perimeter of the tour route; the departure point is set on the tour route and each of the non-narrow areas Includes at least one of the starting points; the position value is equal to the length value of the current starting point from the initial point on the line-tracking path;
    在达到预设条件之前,仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入工作状态,且禁止所述行走机器人进入所述狭窄区域。Before reaching the preset condition, only the walking robot is allowed to choose to enter the working state at the starting point belonging to the same non-narrow area, and the walking robot is prohibited from entering the narrow area.
PCT/CN2019/114040 2018-10-31 2019-10-29 Control method and system for walking robot WO2020088461A1 (en)

Applications Claiming Priority (6)

Application Number Priority Date Filing Date Title
CN201811281652 2018-10-31
CN201811281641 2018-10-31
CN201811281652.1 2018-10-31
CN201811281641.3 2018-10-31
CN201811410347.8 2018-11-23
CN201811410347.8A CN111198557B (en) 2018-10-31 2018-11-23 Control method and control system for walking robot

Publications (1)

Publication Number Publication Date
WO2020088461A1 true WO2020088461A1 (en) 2020-05-07

Family

ID=70462535

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/114040 WO2020088461A1 (en) 2018-10-31 2019-10-29 Control method and system for walking robot

Country Status (1)

Country Link
WO (1) WO2020088461A1 (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102844722A (en) * 2010-04-14 2012-12-26 胡斯华纳有限公司 Robotic garden tool following wires at distance using multiple signals
US20160231749A1 (en) * 2015-02-10 2016-08-11 Honda Motor Co., Ltd. Control apparatus for autonomously navigating utility vehicle
JP2016207158A (en) * 2015-04-28 2016-12-08 シャープ株式会社 Autonomous work vehicle
US9945677B1 (en) * 2015-07-23 2018-04-17 X Development Llc Automated lane and route network discovery for robotic actors
CN108444489A (en) * 2018-03-07 2018-08-24 北京工业大学 A kind of paths planning method improving RRT algorithms
JP2018164425A (en) * 2017-03-28 2018-10-25 工機ホールディングス株式会社 Self-propelled working machine

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102844722A (en) * 2010-04-14 2012-12-26 胡斯华纳有限公司 Robotic garden tool following wires at distance using multiple signals
US20160231749A1 (en) * 2015-02-10 2016-08-11 Honda Motor Co., Ltd. Control apparatus for autonomously navigating utility vehicle
JP2016207158A (en) * 2015-04-28 2016-12-08 シャープ株式会社 Autonomous work vehicle
US9945677B1 (en) * 2015-07-23 2018-04-17 X Development Llc Automated lane and route network discovery for robotic actors
JP2018164425A (en) * 2017-03-28 2018-10-25 工機ホールディングス株式会社 Self-propelled working machine
CN108444489A (en) * 2018-03-07 2018-08-24 北京工业大学 A kind of paths planning method improving RRT algorithms

Similar Documents

Publication Publication Date Title
CN111198557B (en) Control method and control system for walking robot
US8666554B2 (en) System and method for area coverage using sector decomposition
US11126193B2 (en) Automatic beacon position determination
EP2590495B1 (en) Communication and safety device for boundary aided systems
EP2390741A2 (en) Method for controlling an autonomous machine across multiple sub-areas
GB2585312A (en) Robotic mower navigation system
AU2010252311A1 (en) System and method for deploying portable landmarks
JP5917747B1 (en) Autonomous work vehicle
US20230071262A1 (en) Robotic mower and method, system and device of path planning thereof
CN113766825A (en) Energy-saving lawn maintenance vehicle
WO2020088461A1 (en) Control method and system for walking robot
WO2023246802A1 (en) Mowing method and apparatus, robotic lawn mower, and storage medium
WO2024017032A1 (en) Mowing robot recharging method, mowing robot and storage medium
WO2020088460A1 (en) Walking robot control method and system
WO2024016958A1 (en) Mowing method and device, mowing robot, and storage medium
CN111308994B (en) Robot control method and robot system
US20230085538A1 (en) Robotic mower and method, system and device of path planning thereof
WO2021249366A1 (en) Autonomous operation device and system, control method, and readable storage medium
WO2021012525A1 (en) Method for controlling automatic locomotion device to return to station, and automatic locomotion device
CN116360443A (en) Route planning method, device, mowing robot and storage medium

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: 19878381

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: 19878381

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 19878381

Country of ref document: EP

Kind code of ref document: A1

32PN Ep: public notification in the ep bulletin as address of the adressee cannot be established

Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205 DATED 16.12.2022)

122 Ep: pct application non-entry in european phase

Ref document number: 19878381

Country of ref document: EP

Kind code of ref document: A1