WO2018077160A1 - 自移动设备路径规划方法和系统 - Google Patents

自移动设备路径规划方法和系统 Download PDF

Info

Publication number
WO2018077160A1
WO2018077160A1 PCT/CN2017/107458 CN2017107458W WO2018077160A1 WO 2018077160 A1 WO2018077160 A1 WO 2018077160A1 CN 2017107458 W CN2017107458 W CN 2017107458W WO 2018077160 A1 WO2018077160 A1 WO 2018077160A1
Authority
WO
WIPO (PCT)
Prior art keywords
self
mobile device
working area
moving device
walking
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Ceased
Application number
PCT/CN2017/107458
Other languages
English (en)
French (fr)
Inventor
何明明
查亚红
赵凤丽
周昶
刘芳世
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Positec Power Tools Suzhou Co Ltd
Original Assignee
Positec Power Tools Suzhou Co Ltd
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 CN201610926272.3A external-priority patent/CN107974995B/zh
Priority claimed from CN201610937574.0A external-priority patent/CN107974996B/zh
Application filed by Positec Power Tools Suzhou Co Ltd filed Critical Positec Power Tools Suzhou Co Ltd
Publication of WO2018077160A1 publication Critical patent/WO2018077160A1/zh
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions

Definitions

  • the present invention relates to a self-mobile device and an automation control technology, and in particular to a self-mobile device path planning method and system.
  • snow sweepers are well known. By using snow sweepers, it is easy to clean the snow on the road surface, saving manpower, material resources and financial resources.
  • the traditional snow sweeper is inseparable from the user's control. For example, it is necessary to artificially control the snow sweeper to turn and continue to walk, which makes the operation complicated and is not conducive to the popularization of the snow blower.
  • walking equipment such as lawn mowers, snow sweepers, coal unloaders, etc. are divided into two categories of motorized and electric, wherein the power supply mode of electric walking equipment is divided into battery power supply and power supply by cable.
  • the battery-powered walking equipment needs to be recharged repeatedly, but its walking path is not restricted by the cable; the cable-powered walking equipment has sufficient power supply, long working time, and even can be powered by the mains, without worrying about insufficient power.
  • the travel of the equipment is limited.
  • the Chinese patent publication No. CN202016783U discloses a constant tension cable power supply device.
  • the power supply device When the power supply device is used for a coal unloader, one end of the cable is connected with a fixed power source, and the outer lead is connected with the power supply line of the coal unloader.
  • the coal unloader advances, the reel is discharged, and the reel is retracted when the reel is retracted, thereby realizing the power supply of the fixed power to the traveling motor.
  • the power supply device disclosed in the above document can ensure that the speed of the cable is synchronized with the traveling speed of the host vehicle, if the traveling speed of the main vehicle is too fast or the walking distance is greater than the cable length, the cable is subjected to excessive force and the cable is easily broken. Especially for self-moving devices that are automatically walking, it is more likely to cause the cable to be broken.
  • the technical problem solved by the present invention is to provide a self-mobile device path planning method and system, which can be automatically operated without manual control, and can prevent the cable from being stressed when the walking speed of the mobile device is too fast or the walking distance is greater than the cable length. If it is too large, it is easy to break the cable.
  • a self-mobile device path planning method comprising:
  • the self-mobile device When the self-mobile device walks to reach the boundary of the work area, the self-mobile device is controlled to change the walking direction.
  • the method comprises:
  • the self-moving device controls the walking direction when the distance traveled by the mobile device from the straight line reaches the length of the first side of the working area.
  • the method further includes:
  • the step of calculating the preset number of turns of the self-mobile device according to the length of the second side of the working area and the operating width of the self-moving device is:
  • the first distance is 0.8 to 1 times the operating width of the self-moving device.
  • the method further includes:
  • the self-moving device is oriented along the first side direction Walking on the side or the third side;
  • the step of calculating the preset number of turns of the self-mobile device according to the average length and the operation width of the self-mobile device is:
  • the first distance is 0.8 to 1 times the operating width of the self-moving device.
  • the method further includes:
  • the method for setting a boundary line of the working area comprises:
  • the method for setting a boundary line of the working area comprises:
  • the self-mobile device is provided with a signal receiver that receives a signal transmitted by the signal transmitter.
  • the method comprises:
  • the self-moving device is controlled to change the walking direction when the distance traveled by the mobile device at an angle to reach the length of the first side of the working area.
  • the determining method of the tilt angle comprises:
  • the tilt angle of the self-moving device is calculated according to the shape and length of the second side of the work area.
  • the method further includes:
  • the self-moving device walking toward or away from the second side along the first side direction, the boundary of the second side direction Setting a boundary line, when the self-moving device hits a boundary line, controlling the self-moving device to change a walking direction; when the self-moving device hits a boundary line, recording the self-moving device along the working area a walking distance in a first side direction; and controlling the self-moving device to change a walking direction such that the self-moving device again travels along a first side direction of the working area, the walking direction of the self-mobile device and the self-mobile device The last walking direction in the direction of the first side of the working area is opposite;
  • the method for setting a boundary line of the working area comprises:
  • the method for setting a boundary line of the working area comprises:
  • the self-mobile device is provided with a signal receiver that receives a signal transmitted by the signal transmitter.
  • the step of controlling the transition from the mobile device to the walking direction comprises:
  • the self-moving device After the self-moving device walks the second distance, controlling the self-moving device to be deflected by 90 degrees, and after the deflecting, the walking direction of the self-moving device and the self-moving device last along the working area
  • the direction of travel in the first side direction is opposite.
  • the self-mobile device is connected to a power source through a cable, and the cable is wound around an automatic take-up line.
  • the method further includes:
  • the self-moving device is controlled to reciprocate along a parallel path in the working area, wherein the manner in which the self-moving device changes the walking direction is backward walking.
  • the walking speed of the self-moving device is controlled according to the pulling force of the cable.
  • controlling the self-moving device to reciprocate along a parallel path in the working area comprises:
  • controlling the adjacent path from the mobile device to the current path includes:
  • the method further includes:
  • the self-moving device is controlled to go backward in a straight line from the current position to the vicinity of the automatic take-up cable reel.
  • the self-mobile device is an automatic snowplow.
  • a self-moving device path planning method the working area of the self-moving device includes a first side edge and a second side edge different from the first side edge, and at least part of the boundary of the second side direction direction is set with a boundary line.
  • the methods include:
  • the method for setting a boundary line of the working area comprises:
  • the method for setting a boundary line of the working area comprises:
  • the self-mobile device is provided with a signal receiver that receives a signal transmitted by the signal transmitter.
  • the length of the working area of the mobile device is different from the length of the second side of the first side;
  • the step of calculating the preset number of turns of the self-mobile device according to the length of the second side of the working area and the operating width of the self-moving device is:
  • the first distance is 0.8 to 1 times the operating width of the self-moving device.
  • the portion where the boundary line is disposed on the boundary of the second side direction of the working area corresponds to a portion where the length of the first side direction of the working area is not fixed.
  • the length of the unfixed portion of the first side direction of the working area is smaller than the length of the fixed portion of the length of the first side direction; and the length of the fixed portion of the length of the first side direction of the working area is obtained when the self-moving device The distance traveled straight along the first side of the work area to reach the work area When the length of the first side direction of the domain is a fixed portion, the self-moving device is controlled to change the walking direction.
  • the maximum length of the first side direction of the working area is obtained, and the boundary line is disposed on the boundary of the second side direction of the working area, and the length of the first side direction corresponding to the working area is smaller than the first side direction.
  • the self-moving device controls the walking direction when the distance traveled by the self-moving device in a straight line along the first side direction of the working area reaches a maximum length of the first side direction of the working area.
  • the step of controlling the steering from the mobile device comprises:
  • the self-moving device After the self-moving device walks the second distance, controlling the self-moving device to be deflected by 90 degrees, and after the deflecting, the walking direction of the self-moving device and the self-moving device last along the working area
  • the direction of travel in the first side direction is opposite.
  • the self-moving device is connected to the power source through a cable, and the cable is wound on the automatic take-up cable reel.
  • the method further includes:
  • the self-moving device is controlled to reciprocate along a parallel path in the working area, wherein the manner in which the self-moving device changes the walking direction is backward walking.
  • the walking speed of the self-moving device is controlled according to the pulling force of the cable.
  • controlling the self-moving device to reciprocate along a parallel path in the working area comprises:
  • controlling the adjacent path from the mobile device to the current path includes:
  • the method further includes:
  • the self-moving device is controlled to go backward in a straight line from the current position to the vicinity of the automatic take-up cable reel.
  • the self-mobile device is an automatic snowplow.
  • a self-mobile device path planning system the working area of the self-mobile device includes a first side edge and a second side edge different from the first side edge, the self-moving device facing or away from the second side along the first side direction While walking, at least a portion of the boundary of the second side direction is set with a boundary line, the system comprising:
  • a controller configured to obtain a maximum length of the first side direction of the working area
  • a diverter having an input end coupled to the first output of the controller, the diverter for achieving a distance as the distance traveled by the self-moving device in a direction along a first side of the work area Controlling the self-mobile device when the maximum length of the first side direction of the region, or when the self-moving device hits the boundary line
  • the controller is further configured to obtain a length of the second side of the working area, and calculate a preset number of turns of the self-mobile device according to the length of the second side and the operating width of the mobile device:
  • the self-mobile device path planning system further includes a driver, the input end of the driver being connected to the second output end of the controller, the driver for turning the number of times of the self-mobile device is equal to the self-mobile device
  • the preset number of turns is preset
  • the self-mobile device is controlled to be stopped, and when the number of turns of the self-mobile device is not equal to the preset number of turns of the self-moving device, the self-moving device is controlled to walk straight.
  • the controller calculates that the preset number of steerings of the self-mobile device is performed by dividing the length of the second side by the first distance and subtracting 1; wherein the first distance is the self-moving
  • the operating width of the device is 0.8 to 1 times.
  • the self-mobile device comprises:
  • a body of the fuselage connected to a cable, the cable for supplying electrical energy to the self-mobile device;
  • a tension detecting unit configured to detect a tensile force of the cable when the self-moving device walks
  • a device control unit configured to adjust a walking speed of the self-mobile device according to the pulling force detected by the tension detecting unit.
  • the self-mobile device further includes a power input unit connected to the power source through the cable for supplying power to the self-mobile device, wherein the cable is wound around the automatic take-up cable tray at the power source on.
  • the self-mobile device further includes a navigation and positioning module, configured to perform path planning on the self-mobile device.
  • the system includes an automatic take-up cable reel for the self-mobile device.
  • the automatic take-up cable reel comprises:
  • a spool for winding a cable that transmits electrical energy to the self-mobile device
  • bracket for supporting the reel, the bracket rotating in a direction from the mobile device such that an outlet opening of the reel faces the direction from the mobile device.
  • the automatic take-up cable reel further comprises:
  • a direction detecting unit configured to detect a pulling direction of the cable
  • the cable tray control unit is configured to horizontally rotate the bracket according to the direction of the tension detected by the direction detecting unit, so that the outlet port of the reel faces the pulling direction.
  • the automatic take-up cable reel further includes: a base on which a rotating shaft is disposed, the bracket is fixed on the rotating shaft, and the bracket rotates under the pulling force of the cable.
  • the automatic take-up cable reel further comprises:
  • An angle sensor for detecting an angle of rotation of the bracket.
  • the automatic take-up cable reel further comprises:
  • a cable length measuring device for detecting the outgoing or return length of the cable.
  • the cable length measuring device comprises:
  • a counter for counting the number of revolutions of the wheel.
  • the self-mobile device is an automatic snowplow.
  • a self-mobile device path planning method and system is provided.
  • a self-mobile device path planning method comprising:
  • the self-moving device is controlled to turn when the distance traveled by the mobile device in a straight line reaches the width of the working area.
  • the self-moving device when the distance traveled by the mobile device in a straight line reaches the width of the working area, the self-moving device is controlled to be steered without manual control, and the operation is simple and widely used.
  • the length of the work area obtained from the mobile device is obtained
  • the step of calculating the preset number of turns of the self-mobile device according to the length of the working area and the operating width of the self-moving device is:
  • the first distance is 0.8 to 1 times the operating width of the self-moving device.
  • the method further includes the step of setting a boundary line of the working area; and when the self-moving device hits a boundary line, controlling the step of turning from the mobile device;
  • the step of controlling the steering from the mobile device comprises:
  • the self-moving device After controlling the self-moving device to deflect 90 degrees in the direction of the unwalked working area, walking a second distance along the width direction of the working area; the second distance is less than or equal to the operating width of the self-moving device;
  • the self-moving device After the self-moving device walks the second distance, controlling the self-moving device to be deflected by 90 degrees, and after the deflecting, the walking direction of the self-moving device and the self-moving device last along the working area
  • the direction of travel in the width direction is opposite.
  • the self-mobile device is an automatic snowplow.
  • a self-mobile device path planning method the working area of the mobile device includes a length direction and a width direction, and at least part of a side boundary of the length direction of the working area is set with a boundary line, and the method includes:
  • the self-moving device is controlled to turn when the distance traveled by the self-moving device in a straight line along the width direction of the working area reaches a distance that the self-moving device travels in the width direction of the working area at a time.
  • a boundary line is set at least part of only one side boundary in the length direction of the working area of the mobile device, which reduces the use of the boundary line, reduces the cost, and when the self-mobile device hits the boundary
  • the line is in line, the steering from the mobile device is controlled, no manual control is required, the operation is simple, and the application is wide.
  • the step of calculating the preset number of turns of the self-mobile device according to the length of the working area and the operating width of the self-moving device is:
  • the first distance is 0.8 to 1 times the operating width of the self-moving device.
  • the portion of the boundary line where only one side boundary of the length direction of the working area is disposed corresponds to a portion where the width of the working area is not fixed.
  • the width of the portion of the working area that is not fixed is smaller than the width of the portion where the width is fixed; and the width of the portion of the fixed width of the working area is obtained when the self-moving device is along the width of the working area The self-moving device is controlled to turn when the distance traveled reaches the width of the fixed width portion of the working area.
  • the maximum width of the working area is obtained; the portion of the length of the working area that is only one side of the boundary that sets the boundary line corresponds to the portion of the working area whose width is less than the maximum width;
  • the self-moving device is controlled to turn when the distance traveled by the self-moving device in a straight line along the width direction of the working area reaches a maximum width of the working area.
  • the step of controlling the steering from the mobile device comprises:
  • the self-moving device After the self-moving device walks the second distance, controlling the self-moving device to be deflected by 90 degrees, and after the deflecting, the walking direction of the self-moving device and the self-moving device last along the working area
  • the direction of travel in the width direction is opposite.
  • the self-mobile device is an automatic snowplow.
  • a self-mobile device path planning system that sets a boundary line from at least a portion of a boundary of a length direction of a working area of a mobile device, the system comprising:
  • a controller configured to obtain a maximum width of the working area
  • a steering gear the input end of the steering gear being connected to a first output end of the controller, the diverter for reaching a maximum distance of the working area when the self-moving device travels straight along a width direction of the working area Width, or when the self-moving device hits a boundary line, controlling the self-moving device Ready to turn.
  • the controller is further configured to acquire a length of the working area, and calculate a preset number of steering times of the self-mobile device according to the length of the working area and the operating width of the mobile device;
  • the self-mobile device path planning system further includes a driver, the input end of the driver being connected to the second output end of the controller, the driver for turning the number of times of the self-mobile device is equal to the self-mobile device
  • the preset number of turns is preset
  • the self-mobile device is controlled to be stopped, and when the number of turns of the self-mobile device is not equal to the preset number of turns of the self-moving device, the self-moving device is controlled to walk straight.
  • the controller calculates that the preset number of turns of the self-mobile device is performed by dividing the length of the working area by the first distance and subtracting 1; wherein the first distance is The operating width of the self-moving device is 0.8 to 1 times.
  • the self-mobile device is an automatic snowplow.
  • the self-mobile device path planning system sets a boundary line at least part of only one side boundary in the length direction of the working area of the mobile device, reduces the use of the boundary line, reduces the cost, and when the self-mobile device encounters the boundary
  • a self-moving device and a control method thereof, and an automatic take-up cable reel are provided.
  • the technical problem to be solved by the present invention is that in the prior art, when the walking speed of the mobile device is too fast or the walking distance is greater than the cable length, the cable is too strong to easily break the cable, thereby providing a self-moving device and a control method thereof And automatic take-up cable reel.
  • An embodiment of the present invention provides a self-mobile device, including: a body, connected to a cable, the cable is used to provide power to the self-mobile device, and a tension detecting unit is configured to be used when the mobile device is walking Detecting a tensile force of the cable; and a device control unit, configured to adjust a walking speed of the self-moving device according to a tensile force detected by the tensile force detecting unit.
  • the method further includes: a power input unit connected to the power source through the cable, for supplying power to the self-mobile device, wherein the cable is wound on the automatic take-up cable tray at the power source.
  • the method further includes: a navigation and positioning module, configured to perform path planning on the self-mobile device.
  • a navigation and positioning module configured to perform path planning on the self-mobile device.
  • Embodiments of the present invention also provide an automatic take-up cable reel for the self-mobile device.
  • a reel for winding a cable for transmitting electrical energy to the self-moving device
  • a bracket for supporting the reel, the bracket rotating with the direction of the self-moving device, The outlet of the reel faces the direction of the self-moving device.
  • the method further includes: a direction detecting unit, configured to detect a pulling direction of the cable; and a cable tray control unit, configured to horizontally rotate the bracket according to the direction of the pulling force detected by the direction detecting unit, so as to The outlet of the reel is oriented in the direction of the pulling force.
  • a direction detecting unit configured to detect a pulling direction of the cable
  • a cable tray control unit configured to horizontally rotate the bracket according to the direction of the pulling force detected by the direction detecting unit, so as to The outlet of the reel is oriented in the direction of the pulling force.
  • the method further includes: a base on which the rotating shaft is disposed, the bracket is fixed on the rotating shaft, and the bracket rotates under the pulling force of the cable.
  • the method further includes: an angle sensor for detecting an angle of rotation of the bracket.
  • the method further includes: a cable length measuring device, configured to detect an outgoing line or a return line length of the cable.
  • the cable length measuring device comprises: a rotating wheel, which is rotated by the cable outlet or the return line; and a counter for counting the number of revolutions of the rotating wheel.
  • the embodiment of the present invention further provides a control method of a self-mobile device, wherein the self-mobile device is connected to a power source through a cable, and the cable is wound on an automatic take-up cable tray, and the control method includes: controlling the self-moving The apparatus reciprocates along a parallel path within the work area, wherein the self-mobile device returns in a reverse walking manner.
  • the walking speed of the self-moving device is controlled according to the pulling force of the cable.
  • controlling the self-moving device to reciprocate along a parallel path in the working area comprises: controlling the self-mobile device to advance along a current path to a boundary of the working area; controlling the self-mobile device along the current Moving the path backward from the boundary of the working area to an initial position of the current path; controlling the self-mobile device to go to the adjacent path of the current path, and returning the adjacent path as the current path Performing a step of controlling the self-mobile device to advance along a current path to a boundary of the work area.
  • controlling the ad hoc device to go to the adjacent path of the current path includes: controlling the self-mobile device to turn a predetermined distance in a preset direction, wherein the preset direction is perpendicular to The current path and the area that is not traveled by the mobile device, the ⁇ is greater than 0, less than or equal to 90; controlling the self-moving device to turn a degree to the opposite direction to the predetermined direction to the The adjacent path of the current path.
  • the method further includes: performing control when the walking path of the self-mobile device does not cover the working area The step of the self-moving device retreating from the boundary of the working area to the initial position of the current path along the current path.
  • the self-moving device is controlled to go backwards in a straight line from the current position to the vicinity of the automatic take-up cable reel.
  • the tension detecting unit is disposed on the body of the mobile device to detect the magnitude of the tensile force that the cable is subjected to, and the walking speed of the self-moving device is adjusted according to the pulling force, so that when the tensile force of the cable is greater than the upper limit threshold,
  • the walking speed of the mobile device can avoid the phenomenon that the cable is too fast due to the walking speed of the mobile device, the cable is easily broken, and the accident rate of automatic control of the automatic self-mobile device is reduced.
  • the embodiment of the present invention uses a cable to supply power from a mobile device.
  • a battery-powered self-mobile device is used.
  • the battery capacity is large, which means high cost and large volume.
  • the machine needs to have the function of automatically returning to the base station for charging, which is necessary to increase the cost of the base station, while the return and charging time sacrifices the working efficiency.
  • the above problem is not provided by the cable to supply energy from the mobile device, but the cable imposes restrictions on the mobile device: the cable is easily broken and easily entangled.
  • the self-moving device cable of the embodiment of the present invention is at the rear of the machine, and the cable is pulled forward from the mobile device, and the boundary is retracted, and the cable is automatically retracted by the cable reel, and the cable is not coiled on the ground. Pull the cable and go forward.
  • the bracket can be arranged horizontally so that the outlet of the reel always faces the self-moving device, which can avoid the wear between the cable and the side wall of the reel, prolong the service life of the cable, and is not self-moving. Only the walking of the equipment is a hindrance.
  • the reciprocating walking from the mobile device along the parallel path can ensure that the working area covers the entire working area, wherein when the vehicle is moving forward (ie, away from the automatic take-up cable reel), the cable is dragged forward; when returning, the reverse is adopted. Walk to the initial position.
  • the return mode of the embodiment is such that the self-moving device is not entangled by the cable, as compared with the self-moving device turning back.
  • FIG. 1 is a flow chart of a path planning method for a self-mobile device in an embodiment
  • FIG. 2 is an application scenario diagram of the self-mobile device path planning method shown in FIG. 1;
  • FIG. 3 is a further embodiment of the self-mobile device path planning method of FIG. 1;
  • Figure 5 is a working area of the self-mobile device in an embodiment
  • FIG. 6 is a flowchart of a path planning method for a self-mobile device in an embodiment
  • FIG. 7 is a further embodiment of the self-mobile device path planning method described in FIG. 6;
  • Figure 8 is a working area of the self-mobile device in an embodiment
  • FIG. 9 is a schematic structural diagram of a self-mobile device path planning system in an embodiment.
  • FIG. 10 is a schematic block diagram of a specific example of a self-mobile device according to an embodiment of the present invention.
  • FIG. 11 is a schematic block diagram of a specific example of a self-mobile device control system according to an embodiment of the present invention.
  • FIG. 12 is a schematic block diagram of another specific example of a self-mobile device according to an embodiment of the present invention.
  • FIG. 13 is a schematic block diagram of a specific example of an automatic take-up cable reel according to an embodiment of the present invention.
  • FIG. 14 is a schematic block diagram showing another specific example of an automatic take-up cable reel according to an embodiment of the present invention.
  • 15A to 15E are schematic diagrams showing a walking control route of a mobile device according to an embodiment of the present invention.
  • FIG. 16 is a flowchart of a specific example of a method for controlling a self-mobile device according to an embodiment of the present invention.
  • connection or integral connection; may be mechanical connection or electrical connection; may be directly connected, may also be indirectly connected through an intermediate medium, or may be internal communication of two components, may be wireless connection, or may be wired connection.
  • connection or integral connection; may be mechanical connection or electrical connection; may be directly connected, may also be indirectly connected through an intermediate medium, or may be internal communication of two components, may be wireless connection, or may be wired connection.
  • operating width of the mobile device may be approximated to the width of the mobile device, for example, when the mobile device is an automatic snowplow, the operating width of the mobile device refers to the snow sweep width from the mobile device, which may be approximated as The width of the automatic snowplow.
  • the working area of the self-moving device of the present invention comprises a first side edge, a second side edge different from the first side edge and a third side edge opposite to the second side edge position, the self-moving device is oriented along the first side direction Walking on the second side or the third side.
  • the first side direction may be the width direction of the work area or the length direction of the work area.
  • a self-mobile device path planning method includes:
  • the self-mobile device When the self-mobile device walks to reach the boundary of the work area, the self-mobile device is controlled to change the walking direction.
  • the working area is reached, and when the boundary line is set at the outermost side of the boundary, the boundary refers to the position of the boundary line.
  • the boundary line is not set, for example, through a GPS map, that is, a map of the work area is built in from the mobile device or the boundary is a boundary on the map.
  • the boundary is the side where the length is located or the side where the width is located.
  • the shape is irregular.
  • the boundary may be an arc-shaped arc edge position, and the boundary is also It can be considered as a position near the arc edge that is closer to the arc edge.
  • the motion trajectory of the self-moving device travels straight along the first side direction to reach the boundary or walks at an angle to the first side direction to reach the boundary.
  • the method includes:
  • the method further comprises:
  • the step of calculating the preset number of turns of the self-mobile device according to the length of the second side of the working area and the operating width of the self-moving device is:
  • the method further comprises:
  • boundary line of the working area There may be various methods for setting the boundary line of the working area, and one may directly lay a boundary line on the boundary of the working area, that is, an actual boundary line structure.
  • Another type may set a virtual boundary line, such as a plurality of signal transmitters at a boundary position of the working area, a plurality of the signal transmitters forming a boundary line; and the self-mobile device is provided with a signal transmitted by the receiving signal transmitter.
  • Signal receiver may be various methods for setting the boundary line of the working area, and one may directly lay a boundary line on the boundary of the working area, that is, an actual boundary line structure.
  • a virtual boundary line such as a plurality of signal transmitters at a boundary position of the working area, a plurality of the signal transmitters forming a boundary line; and the self-mobile device is provided with a signal transmitted by the receiving signal transmitter.
  • Signal receiver
  • the step of controlling the self-moving device to change the direction of travel include:
  • the self-moving device After the self-moving device walks the second distance, controlling the self-moving device to be deflected by 90 degrees, and after the deflecting, the walking direction of the self-moving device and the self-moving device last along the working area
  • the direction of travel in the first side direction is opposite.
  • the method includes:
  • the self-moving device is controlled to change the walking direction when the distance traveled by the mobile device at an angle to reach the length of the first side of the working area.
  • the method for determining the tilt angle in the method includes:
  • the tilt angle of the self-moving device is calculated according to the shape and length of the second side of the work area.
  • the method further comprises:
  • the self-moving device is oriented along the first side direction Walking on the side or the third side;
  • the step of calculating the preset number of turns of the self-mobile device according to the average length and the operation width of the self-mobile device is:
  • the preset number of steerings from the mobile device is calculated by dividing the average length by the first distance and subtracting 1 from the mobile device by 0.8 to 1 times the operating width of the mobile device.
  • the method further comprises:
  • the self-moving device walking toward or away from the second side along the first side direction, the boundary of the second side direction Setting a boundary line, when the self-moving device hits a boundary line, controlling the self-mobile device to change a walking direction;
  • boundary line of the working area There may be various methods for setting the boundary line of the working area, and one may directly lay a boundary line on the boundary of the working area, that is, an actual boundary line structure.
  • Another type may set a virtual boundary line, such as a plurality of signal transmitters at a boundary position of the working area, a plurality of the signal transmitters forming a boundary line; and the self-mobile device is provided with a signal transmitted by the receiving signal transmitter.
  • Signal receiver may be various methods for setting the boundary line of the working area, and one may directly lay a boundary line on the boundary of the working area, that is, an actual boundary line structure.
  • a virtual boundary line such as a plurality of signal transmitters at a boundary position of the working area, a plurality of the signal transmitters forming a boundary line; and the self-mobile device is provided with a signal transmitted by the receiving signal transmitter.
  • Signal receiver
  • the step of controlling the transition from the mobile device to the walking direction comprises:
  • the self-moving device After the self-moving device walks the second distance, controlling the self-moving device to be deflected by 90 degrees, and after the deflecting, the walking direction of the self-moving device and the self-moving device last along the working area
  • the direction of travel in the first side direction is opposite.
  • the self-moving device travels straight along the first side direction of the working area, and may set a boundary line or not, and may not directly set a boundary line.
  • the steering is controlled by calculating the distance traveled along the first side, and in the third embodiment, the boundary line is provided, the working area of the self-moving device includes a first side and a second side different from the first side, A boundary line is provided at least in part of the boundary of the second side direction.
  • the method includes:
  • boundary line of the working area There may be various methods for setting the boundary line of the working area, and one may directly lay a boundary line on the boundary of the working area, that is, an actual boundary line structure.
  • Another type may set a virtual boundary line, such as a plurality of signal transmitters at a boundary position of the working area, a plurality of the signal transmitters forming a boundary line; and the self-mobile device is provided with a signal transmitted by the receiving signal transmitter.
  • Signal receiver may be various methods for setting the boundary line of the working area, and one may directly lay a boundary line on the boundary of the working area, that is, an actual boundary line structure.
  • a virtual boundary line such as a plurality of signal transmitters at a boundary position of the working area, a plurality of the signal transmitters forming a boundary line; and the self-mobile device is provided with a signal transmitted by the receiving signal transmitter.
  • Signal receiver
  • the step of calculating the preset number of turns of the self-mobile device according to the length of the second side of the working area and the operating width of the self-moving device is:
  • the first distance is 0.8 to 1 times the operating width of the self-moving device.
  • the edge is set on the boundary of the second side of the working area
  • the portion of the boundary corresponds to a portion of the working area that is not fixed in the length of the first side.
  • the length of the unfixed portion of the first side direction of the working area is smaller than the length of the fixed portion of the length of the first side direction; and the length of the fixed portion of the length of the first side of the working area is obtained, when the self-moving device is along the working area
  • the self-moving device is controlled to change the traveling direction.
  • the step of controlling the steering from the mobile device comprises:
  • the self-moving device After the self-moving device walks the second distance, controlling the self-moving device to be deflected by 90 degrees, and after the deflecting, the walking direction of the self-moving device and the self-moving device last along the working area
  • the direction of travel in the first side direction is opposite.
  • the steering can be realized by rotating a certain angle.
  • the steering can be realized by direct reverse .
  • the direct reverse implementation steering is also applicable to the self-mobile device path planning method of the above three embodiments.
  • the self-moving device is connected to a power source via a cable that is wound around an automatic take-up cable reel.
  • the self-mobile device path planning method of this embodiment includes:
  • the self-moving device When the self-moving device walks to reach the boundary of the working area, the self-moving device is controlled to change the walking direction; wherein the self-moving device changes the walking direction by means of backward walking.
  • the walking speed of the self-moving device is controlled according to the pulling force of the cable.
  • controlling the self-moving device to reciprocate along a parallel path within the work area comprises:
  • controlling the ad hoc device to go to the adjacent path of the current path comprises:
  • the method further comprises:
  • the self-moving device is controlled to go backwards in a straight line from the current position to the vicinity of the automatic take-up cable reel.
  • the first side is set to be a width
  • the second side and the third side are lengths for further description of the embodiments of the present invention.
  • FIG. 1 is a flowchart of a path planning method for a self-mobile device in an embodiment.
  • the method includes:
  • S102 Obtain a width W of a work area of the mobile device.
  • the application scenario of the automatic snowplow is a road, and the automatic snowplow starts to sweep the snow along the width of the road, so here is the width W of the working area obtained from the mobile device.
  • the automatic snowplow is along the length of the work area When walking in the direction of the degree, the length L of the working area can be first obtained.
  • S104 Control walking from the mobile device in a straight line along the width direction of the work area.
  • S106 Determine whether the distance traveled by the mobile device in a straight line reaches the width of the working area.
  • the self-moving device when the distance traveled by the mobile device in a straight line reaches the width W of the working area, the self-moving device is controlled to be steered without manual control, and the operation is simple and widely used.
  • FIG. 2 is an application scenario diagram of the self-mobile device path planning method shown in FIG. 1.
  • the working area of the self-moving device is a rectangle having a width W and a length L. Since the mobile device walks in the direction of the width W, when the distance traveled by the straight line reaches the width W, the mobile device is turned to walk. For details, refer to the arrow shown in FIG. 2.
  • FIG. 3 is a further embodiment of the self-mobile device path planning method illustrated in FIG. 1.
  • the method in this embodiment may include the following steps:
  • S302 Obtain a length L and a width W of the working area of the mobile device.
  • the width of the working area is W to control the steering from the mobile device, and the length L of the working area is to obtain the preset number of steerings from the mobile device, thereby controlling the shutdown after the mobile device is completed.
  • S304 Calculate the preset number of turns from the mobile device according to the length L of the work area and the operation width a of the mobile device.
  • S306 Control walking from the mobile device in a straight line along the width W direction of the working area.
  • S308 Determine whether the distance traveled by the mobile device in a straight line reaches the width W of the working area.
  • step S310 When the distance traveled by the mobile device from the straight line reaches the width W of the working area, then the control is turned from the mobile device, otherwise returning to step S306, the control continues to walk straight from the mobile device.
  • S314 Determine whether the number of turns from the mobile device is equal to the preset number of turns.
  • step S316 If yes, controlling the self-mobile device to stop, otherwise returning to the step of controlling the straight-line walking of the self-moving device along the width direction of the working area, that is, step S306.
  • the self-mobile device not only can the work of the self-mobile device be automatically controlled, but also whether the work of the mobile device in the work area is completed accurately, and after the work is completed, the self-mobile device is controlled. Standby down.
  • the operation width of the mobile device is a
  • the preset number of steerings from the mobile device is calculated in step S304, which can be calculated by W/a-1.
  • FIG. 4 is a schematic diagram of a working area of the mobile device in an embodiment.
  • the side c in Fig. 3 is provided with a boundary line, and the boundary line is not provided on the side d and the side e, which can reduce the use of the boundary line and reduce the cost.
  • the method further includes the steps of setting a boundary line of the work area; and controlling the steering from the mobile device when the mobile device encounters the boundary line.
  • FIG. 5 is a schematic diagram of a working area of the mobile device in an embodiment.
  • a boundary line is laid on the side AB, and the working area is further divided into a triangle ABE and a rectangular AECD by the auxiliary line AE.
  • the auxiliary line does not exist in actual use, and is merely for convenience of explanation.
  • the self-moving device can travel in the direction of the arrow in Figure 5, when the boundary line is encountered or when the walking distance reaches the width W of the working area, then the self-moving device is turned.
  • the step of controlling the steering from the mobile device may include: controlling to move the second distance along the width direction of the working area after the mobile device deflects 90 degrees in the direction of the unwalked working area; the second distance is less than or equal to the operation of the mobile device. Width or the first distance described above. After the second distance is traveled from the mobile device, the control is deflected by 90 degrees from the mobile device, and the direction of travel from the mobile device after the deflection is opposite to the direction of travel from the last direction of the mobile device in the width direction of the working area. Specifically, it can be divided into two situations. One is that the distance traveled by the mobile device in a straight line reaches the width W of the working area, and one is that the moving device hits the boundary line.
  • the step of controlling the steering from the mobile device includes: when the length of the straight line from the mobile device reaches the working area
  • the width W is controlled, after the mobile device is deflected by 90 degrees in the direction of the unwalked working area, the second distance is traveled along the width W direction of the working area; the second distance is less than or equal to the operating width a of the mobile device or the first distance
  • the distance W of the walking working area after the deflection of the mobile device is controlled by 90 degrees, and the walking direction of the self-moving device after deflection and the width of the last working area of the self-moving device
  • the traveling direction in the W direction is reversed; after the distance from the width W of the working area of the mobile device is controlled, after the movement is shifted by 90 degrees from the mobile device to the unworked working area, the third distance is traveled along the length L of the working
  • the sum of the second distance and the third distance may be the first distance b or the operation width a from the mobile device; when the third distance is traveled from the mobile device After controlling the deflection from the mobile device to continue running 90 degrees, and the direction deflected from a mobile device traveling from the traveling direction along the width W direction of the last working area opposite to the mobile device. That is, as shown in FIG. 5, firstly, the distance from the K point in the KM direction, that is, the width W of the working area in the width W direction of the working area, reaches the M point, and the second distance is traveled after the mobile device is deflected by 90 degrees.
  • the distance W of the walking working area After reaching the N point, and then deflecting 90 degrees, the distance W of the walking working area reaches 0 point, and then deflects 90 degrees, then walks the third distance to reach the point P and then deflects 90 degrees, once for the cycle, reciprocating until the last deflection,
  • the sum of the second distance MN and the third distance OP is the first distance b or the operating width a from the mobile device.
  • the step of controlling the steering from the mobile device includes: when the mobile device touches the boundary line, the self-moving device is recorded along the working area. a walking distance in the width W direction; and controlling the distance from the mobile device to the unwalked working area by 90 degrees, walking a second distance along the length L of the working area; the second distance is less than or equal to the operating width of the mobile device a Or a first distance b; after the second distance is moved from the mobile device, the distance traveled from the mobile device to the width W direction of the working area after the deflection of the mobile device by 90 degrees, and the deflection from the mobile device
  • the traveling direction is opposite to the walking direction of the mobile device last time along the width W direction of the working area; when the distance traveled from the mobile device reaches the walking distance from the mobile device last time along the width W of the working area, the control is from the mobile device to Unworked work area After the direction is deflected by 90 degrees, the third distance
  • the mobile device walks from the F point in the FG direction, that is, the width W direction of the working area to reach the G point.
  • the second distance is reached to the Q point, and then the 90 degree is deflected and the last edge is taken.
  • the distance traveled in the width direction of the working area reaches the I point, and after the deflection of 90 degrees, the third distance is extended to reach the J point and then deflected by 90 degrees, once for the period, reciprocating until the last deflection, wherein the second distance GQ and the third distance
  • the sum of the IJs may be the first distance b or the operational width a from the mobile device. Referring to FIG. 6, FIG.
  • a working area of the self-mobile device includes a length direction and a width direction, and only a length direction of the working area
  • a boundary line is provided at least in part of one side boundary, and the method may include:
  • S602 Control walking from the mobile device in a straight line along the width direction of the work area. As indicated by the arrows in Figure 4.
  • S604 Determine whether the mobile device touches the boundary line. Specifically, as shown in FIG. 4, when the mobile device encounters a boundary line disposed on the side c, it is turned from the mobile device.
  • Step S606 when the mobile device touches the boundary line, record the walking distance from the mobile device along the width direction of the working area, and control the steering from the mobile device, so that the self-moving device walks straight along the width direction of the working area again; otherwise, returns Step S602, controlling the linear walking from the mobile device to continue along the width direction of the working area.
  • S608 Controlling the steering from the mobile device when the distance traveled by the mobile device in a straight line along the width direction of the working area reaches a distance from the mobile device last time walking in the width direction of the working area.
  • a boundary line is set at least part of only one side boundary in the length direction of the working area of the mobile device, which reduces the use of the boundary line, reduces the cost, and when the self-mobile device hits the boundary
  • the line is in line, the steering from the mobile device is controlled, no manual control is required, the operation is simple, and the application is wide.
  • FIG. 7 is a further embodiment of the self-mobile device path planning method described in FIG. The method in this embodiment may include the following steps:
  • S702 Obtain a length L of a work area of the mobile device.
  • S704 Calculate a preset number of steerings from the mobile device according to the length L of the work area and the operation width a of the mobile device.
  • S706 Control walking from the mobile device in a straight line along the width direction of the work area.
  • S708 Determine whether the mobile device touches the boundary line.
  • step S710 When the mobile device touches the boundary line, the control is turned from the mobile device, otherwise returning to step S706, the control continues to walk straight from the mobile device.
  • S714 Determine whether the number of steerings of the self-mobile device is equal to the preset number of steerings.
  • the above self-mobile device path planning method controls the steering from the mobile device when the mobile device hits the boundary line, does not require manual control, is easy to operate, and is widely used.
  • FIG. 8 is an application scenario diagram of the self-mobile device path planning method shown in FIG. 7 .
  • the working area of the self-moving device has a width W and a length L. Since the operation width of the mobile device is a, the preset number of turns from the mobile device is calculated in step S604, which can be calculated by W/a-1. In an embodiment, the preset number of steerings from the mobile device may also be calculated by dividing the width of the working area by the first distance b and subtracting 1; the first distance b is 0.8 to 1 from the operating width of the mobile device.
  • the portion of the boundary line where only one side boundary of the length direction of the region is disposed corresponds to a portion where the width of the working region is not fixed.
  • the size of the width of the working area is changed, so that on one side in the longitudinal direction, a boundary line is provided at AB, and at the rectangular AECD of FIG. 5, the width of the working area is fixed. , so there is no need to set a boundary line.
  • the width of the working area at the side GH and the side HI in Fig. 8 is changed, so that boundary lines are provided at both the side GH and the side HI.
  • the width of the portion where the width of the working area is not fixed is smaller than the width of the portion where the width is fixed; and the width of the portion where the width of the working area is fixed, when the distance travels straight from the moving device along the width direction of the working area
  • the self-moving device is controlled to turn when the width of the fixed portion of the working area is reached.
  • the method may further include: obtaining a maximum width of the working area; a portion of the length boundary of the working area that is only one side of the boundary, and a portion of the working area corresponding to a width of the working area that is smaller than a maximum width; Controls the steering from the mobile device when the distance traveled by the mobile device in a straight line along the width of the work area reaches the maximum width of the work area.
  • each steering in the walking process of the mobile device is judged based on whether the boundary line is touched, and it is not necessary to determine according to the length of the working area of the mobile device.
  • the step of controlling the steering from the mobile device includes: when the mobile device touches the boundary line, recording the walking distance from the mobile device along the width W direction of the working area; and controlling the self-mobile device After being deflected by 90 degrees in the direction of the unwalked work area, the second distance is traveled along the length L of the work area; the second distance is less than or equal to the first distance b or the operation width a from the mobile device; After two distances, the distance traveled from the mobile device to the width W direction of the working area after being deflected by the mobile device by 90 degrees, and the walking direction of the self-moving device after deflection and the width of the last working area of the self-moving device The walking direction in the W direction is opposite; when the distance traveled by the mobile device reaches the walking distance in
  • the length of the working area is a third distance in the L direction, and the sum of the second distance and the third distance may be the first distance b or the self-moving setting
  • FIG. 9 is a schematic structural diagram of a self-mobile device path planning system according to an embodiment.
  • a boundary line is provided from at least a portion of the boundary of the length direction of the working area of the mobile device, the system including the controller 100 and the diverter 200; the input of the diverter 200 and the first output of the controller 100 Connected.
  • the controller 100 is configured to acquire a maximum width of the working area; the redirector 200 is configured to control the self-moving when the length of the straight traveling path from the mobile device reaches the maximum width of the working area, or when the mobile device hits the boundary line Equipment steering.
  • the self-mobile device path planning system sets a boundary line at least part of only one side boundary in the length direction of the working area of the mobile device, reduces the use of the boundary line, reduces the cost, and when the self-mobile device encounters the boundary
  • the controller is further configured to acquire the length of the work area, and calculate the preset number of turns from the mobile device according to the length L of the work area and the operation width a of the mobile device.
  • the self-mobile device path planning system further includes a driver 300, the input end of the driver 300 is connected to the second output end of the controller, and the driver 300 is used for the steering number of the self-mobile device is not equal to the preset steering from the mobile device When the number of times, the control moves from the mobile device. When the number of turns from the mobile device is equal to the preset number of turns from the mobile device, the control is stopped from the mobile device, and the number of turns from the mobile device is not equal to the preset steering from the mobile device.
  • the controller 100 calculates that the preset number of turns from the mobile device is performed by dividing the width of the work area by the first distance b and subtracting 1; wherein the first distance b is an operation from the mobile device. 0.8 to 1 times the width a.
  • the self-moving device includes a body main body 101, a tension detecting unit 102, and a device control unit 103.
  • the fuselage main body 101 is connected to the cable 20 for supplying electric power to the self-moving device;
  • the tensile force detecting unit 102 is configured to detect the tensile force of the cable 20 when the mobile device is walking, and the tensile force detecting unit 102 can perform the pulling force by using the stress sensor.
  • the device control unit 103 is configured to adjust the walking speed of the self-moving device according to the pulling force detected by the tension detecting unit 102.
  • One end of the cable 20 of the embodiment of the present invention is connected to the body main body 101, and the other end is connected to an external power source, which may be an AC power source (such as a commercial power source) or a DC power source.
  • an AC power source such as a commercial power source
  • a DC power source for safety reasons, the AC power supply can be stepped down by AC/AC, or AC/DC step-down to a safe voltage; high power
  • the DC power supply can be stepped down by DC/AC, or DC/DC stepped down to a safe voltage.
  • the walking speed of the mobile device is controlled by its own control strategy from the mobile device itself.
  • the speed is too fast, it is easy to appear: the cable 20 is released at a lower speed than the moving device, and the cable 20 is subjected to excessive pulling force.
  • the cable 20 is torn or the cable connector is detached.
  • a speed control feedback mechanism is adopted, by setting a tension detecting unit 102 on the body main body 101 of the mobile device to detect the tensile force of the cable 20, and adjusting the walking speed of the self-moving device according to the pulling force, so that When the tensile force of the cable 20 is greater than the upper limit threshold, the walking speed of the self-moving device is lowered.
  • the walking speed of the self-moving device it is also possible to increase the walking speed of the self-moving device to a certain value when the tensile force of the cable 20 is less than the lower limit threshold. In this way, it is possible to avoid the phenomenon that the moving speed of the mobile device is too fast, the cable is subjected to excessive force, the cable is easily broken, and the accident rate of automatic control from the mobile device is reduced.
  • the embodiment of the present invention uses a cable to supply power from a mobile device.
  • a battery-powered self-mobile device is used.
  • the battery capacity is large, which means high cost and large volume.
  • the above problem is not provided by the cable to supply energy from the mobile device, but the cable imposes restrictions on the mobile device: the cable is easily broken and easily entangled.
  • the self-moving device cable of the embodiment of the present invention is at the rear of the machine, and the cable is pulled forward from the mobile device, and the boundary is retracted, and the cable is automatically retracted by the cable reel, and the cable is not coiled on the ground. Pull the cable and go forward.
  • the self-mobile device of the embodiment of the present invention further includes: a power input unit 104, which is disposed on the body 101, and the power input unit 104 is connected to the power source through the cable 20.
  • a power input unit 104 For supplying power to the self-moving device, wherein the cable 20 is wound around the automatic take-up cable reel 30 at the power source.
  • the cable 20 is retracted by the automatic take-up cable reel 30.
  • the cable plug 105 is connected to the cable 20. Pulling force is generated along the cable 20, and the pulling force acts on the reel of the automatic take-up cable reel 30 to cause the wire to be pulled.
  • the tensile force detecting unit 102 detects the tensile force of the cable 20, and the pulling force is the pulling force of the reel to the cable 20.
  • the automatic take-up cable reel 30 automatically retracts the cable 20 to prevent the cable 20 from being entangled from the mobile device.
  • the self-mobile device of the embodiment further includes: a navigation and positioning module 106, configured to perform path planning on the self-mobile device.
  • the navigation and positioning module 106 may include a MEMS motion sensor, GPS, combined with pulse radio (UWB) positioning, ultrasonic positioning, laser assisted positioning, etc., wherein the motion sensor may include a gyroscope, an acceleration sensor, and an electronic compass. Wait.
  • the self-moving device of the embodiment of the present invention may further include: a working motor 107 for driving the working disk; a walking motor 108 for driving the mobile device; and a human-machine interaction module 109 for performing Human-computer interaction; wireless communication module 110 and memory 111.
  • the device control unit 103 is connected to each of the above components.
  • the wireless communication module 110 can communicate with the automatic take-up cable reel to assist in repositioning or controlling from the mobile device.
  • the embodiment of the invention also provides an automatic take-up cable reel.
  • the automatic take-up cable reel is fixed in the garage and can be used in the self-mobile device of the above embodiment of the present invention, and has the function of automatically recovering the cable.
  • the automatic take-up cable reel of the present embodiment comprises: a reel 301 for winding a cable 20 for transmitting electrical energy to the self-moving device; and a bracket 302 for supporting the volume
  • the barrel 301, the holder 302 rotates in the direction from the mobile device, so that the outlet of the reel 301 faces the direction from the mobile device.
  • the bracket 302 is horizontally rotatable such that the outlet of the reel 301 always faces the self-moving device, which can avoid wear between the cable 20 and the side wall of the reel 301, and prolong the service life of the cable 20. And it does not hinder the walking of the mobile device alone.
  • the automatic take-up cable reel of the embodiment further includes: a base 303, the base 303 is provided with a rotating shaft 3031, the bracket 302 is fixed on the rotating shaft 3031, and the bracket 302 is on the cable 20 Rotate under tension.
  • the bracket 302 is passively rotated by the pulling force of the cable, and the rotating shaft 3031 is rotated, so that the outlet of the bracket 302 faces the self-moving device.
  • the automatic take-up cable reel of the embodiment adopts a method of actively adjusting the direction of the reel outlet.
  • the automatic retractable cable reel adds a direction detecting unit for detecting the cable receiving Pulling direction; cable tray control unit for detecting according to the direction detecting unit In the direction of the pulling force, the bracket is rotated horizontally so that the outlet of the reel is oriented toward the pulling force.
  • the direction of the self-moving device is determined by the pulling direction of the cable.
  • the cable tray control unit controls the bracket to rotate in the direction, thereby ensuring the cable outlet of the cable.
  • the direction from the mobile device remains the same.
  • the automatic take-up cable reel of the embodiment of the present invention further includes an angle sensor 304 for detecting the angle at which the bracket 302 rotates.
  • the angle sensor 304 can be a gyroscope and the measured angle can be used to assist in determining the path of the regression from the mobile device.
  • the automatic take-up cable reel also includes a cable length measuring device 305 for detecting the outgoing or return length of the cable.
  • the cable length measuring device includes: a rotating wheel that rotates under the driving of the cable outlet or the return line; and a counter for counting the number of revolutions of the rotating wheel.
  • n is the number of revolutions of the wheel. The number of turns is obtained by the counter; the cable is determined according to the direction of rotation of the wheel. Pull out or retract.
  • the automatic take-up cable reel further comprises: an electric shock or short circuit protection device 306 and a wireless communication module 307, and the electric shock or short circuit protection device 306 can be a contactor/circuit breaker, etc., to ensure the safety of the cable reel Sex.
  • the wireless communication module 307 then communicates with the communication on the mobile device.
  • the above modular units are all connected to the cable tray control unit 308 of the automatic take-up cable reel, and are controlled accordingly.
  • the embodiment of the present invention further provides a self-mobile device control method, wherein the self-mobile device shown in this embodiment is connected to a power source through a cable, and the cable is wound on the automatic take-up cable tray, and the self-mobile device may be A self-mobile device as described in the above embodiments.
  • the control method includes: controlling the reciprocating walking of the self-moving device along the parallel path in the working area, wherein the self-moving device returns in a reverse walking manner.
  • the reciprocating walking from the mobile device along the parallel path can ensure that the working area covers the entire working area, wherein the backward walking manner can be reversed by the original path, or firstly deflected by an angle, a reversed trajectory and a forward trajectory.
  • the spacing may be greater than zero and less than the diameter of the working head of the machine, or may be free of spacing.
  • the embodiment of the original road return includes: when the vehicle is moving forward (ie, away from the automatic take-up cable reel), the cable is dragged forward; when returning, the vehicle is moved backward to the initial position to ensure that the path of each forward travel is parallel. Just overlap.
  • the return mode of the embodiment makes Self-mobile devices are not entangled by cables.
  • controlling the walking speed of the self-moving device according to the pulling force of the cable during the walking from the mobile device in a direction away from the automatic take-up cable reel.
  • the traveling speed of the self-moving device is adjusted according to the pulling force, so that the tensile force on the cable 20 is greater than the upper limit.
  • the walking speed of the self-moving device is lowered.
  • the tensile force of the cable 20 exceeds the limit threshold, it indicates that the cable is stuck or has been placed for the longest length, and the control stops walking or retreating from the mobile device.
  • controlling the reciprocating of the self-moving device along the parallel path in the working area in the embodiment comprises: controlling the self-moving device to advance along the current path to the boundary of the working area; controlling the self-moving device from the working area along the current path Regressing to the initial position of the current path at the boundary; controlling the adjacent path from the mobile device to the current path, using the adjacent path as the current path, returning to perform the control from the mobile device along the current path to the boundary of the working area step.
  • the automatic take-up cable reel is fixed indoors and operates from the mobile device in the work area.
  • the mobile device travels from the position near the automatic take-up cable reel to the boundary of the work area (the boundary between the work area and the main road shown in the figure), and then walks backwards from the mobile device.
  • the fourth position then go to the adjacent parallel path on the right side of the previous path in the work area and walk to the right side of the work area in the same way.
  • each time walking to the boundary of the working area it can be determined whether the walking path of the mobile device covers the working area; wherein the walking path of the self-moving device is not covered In the area, the step of controlling the self-moving device to retreat from the boundary of the working area to the initial position of the current path along the current path; controlling the self-moving device to follow the straight line from the current position when the walking path of the mobile device has covered the working area Walk backwards to the vicinity of the automatic take-up cable reel. Since the walking path of the mobile device has covered the working area, the work task from the mobile device has been completed, and therefore, the current position can be directly returned to the starting point along the straight line, and the work is stopped, as shown in Fig. 15E.
  • controlling the adjacent path from the mobile device to the current path includes: controlling a predetermined distance from the mobile device to turn a predetermined distance in the preset direction, wherein the preset direction is perpendicular to the current path and is pointed From the area where the mobile device has not traveled, ⁇ is greater than 0 and less than or equal to 90; and the control is turned from the mobile device to the opposite direction of the preset direction by a degree to the adjacent path of the current path.
  • the adjacent path is parallel to the current path, and the current path described here is the path that was last traveled.
  • step S801 a work area is determined.
  • step S802 the snow blower starts to sweep in a straight line from the starting point, as shown in Fig. 15A.
  • step S803 the snow blower advances to the boundary of the work area.
  • the distance of the snow blower can be set according to the size of the work area, and the snow blower can be controlled to advance to the distance.
  • step S804 the snow blower stops the snow sweeping and returns backwards, as shown in Fig. 15B.
  • step S805 the distance that the snow blower is reversed is controlled to be equal to the forward distance.
  • Step S806 turning left ⁇ ° and starting to travel for a distance as shown in Fig. 15C.
  • step S807 the right angle is turned by ⁇ ° to straighten the body, as shown in Fig. 15D.
  • step S808 the snow blower advances to the boundary of the work area.
  • step S809 it is determined whether the work area has been swept. If yes, step S810 is performed; otherwise, step S804 is performed.
  • step S810 the snow sweeping line is stopped and the line is reversed to the vicinity of the starting point.
  • the self-mobile device described in the embodiment of the present invention may be an automatic snow sweeper, an automatic lawn mower, or the like.

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

一种自移动设备路径规划方法和系统,方法包括获取工作区域的第一侧边方向;控制自移动设备沿第一侧边方向行走;当自移动设备行走到达工作区域边界时,控制自移动设备转向;自移动设备路径规划系统包括控制器(100),用于获取工作区域第一侧边方向的最大长度;转向器(200),转向器(200)的输入端与控制器(100)的第一输出端相连接,转向器(200)用于当自移动设备沿第一侧边方向直线行走的距离达到第一侧边方向的最大长度时,或者当自移动设备碰到边界线时,控制自移动设备转向,自移动设备路径规划方法和系统,通过行走的距离达到第一侧边的长度或者行走到达边界线时,则控制自移动设备转向,不需要人工控制,操作简便,应用广泛。

Description

自移动设备路径规划方法和系统 技术领域
本发明涉及自移动设备及自动化控制技术,特别是涉及一种自移动设备路径规划方法和系统。
背景技术
随着科学技术的发展,扫雪机为人们所熟知,通过使用扫雪机可以方便地对路面上的积雪进行清扫,节约了人力物力和财力。
传统的扫雪机离不开用户的控制,例如,需要人为的控制扫雪机转向、继续行走等操作,使得操作复杂,不利于扫雪机的推广使用。
另外,对于行走设备如割草机、扫雪机、卸煤机等都分为机动和电动两类,其中,电动的行走设备的供电方式又分为蓄电池供电和由电缆接电源供电的方式。蓄电池供电的行走设备需要反复充电,但是其行走路径不受电缆的限制;电缆供电的行走设备,其电能供应充足,有效工作时间长,甚至可以利用市电供电,不用担心电能不够的问题。但是由于电缆容易堆积紊乱,限制了设备行走的行程。
为此,公开号为CN202016783U的中国专利文献公开了一种恒张力卷缆供电装置,该供电装置用于卸煤机时,把电缆的一端与固定电源联接,外引线与卸煤机供电线路联接,卸煤机前进时,卷筒放缆,卸煤机后退时卷筒收缆,从而实现固定电源对行走电机的供电。
然而,虽然上述文献公开的供电装置能够保证放缆的速度与主车行走速度同步,但是,如果主车行走速度过快或者行走距离大于电缆长度时,导致电缆受力过大,容易拉断电缆,尤其是对于自动行走的自移动设备,更容易造成电缆被拉断。
发明内容
本发明解决的技术问题为提供一种自移动设备路径规划方法和系统,可以自动运行,不需要人工控制,并可以防止自移动设备行走速度过快或者行走距离大于电缆长度时,导致电缆受力过大容易拉断电缆。
一种自移动设备路径规划方法,所述方法包括:
获取自移动设备的工作区域的第一侧边方向;
控制所述自移动设备沿工作区域的第一侧边方向行走;
当所述自移动设备行走到达所述工作区域边界时,控制所述自移动设备转变行走方向。
优选的,所述方法包括:
获取自移动设备的工作区域的第一侧边的长度;
控制所述自移动设备沿工作区域的第一侧边方向直线行走;
当所述自移动设备直线行走的距离到达所述工作区域的第一侧边的长度时,控制所述自移动设备转变行走方向。
优选的,所述方法还包括:
获取自移动设备的工作区域的区别于第一侧边的第二侧边的长度,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走;
根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;
判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的第一侧边方向直线行走的步骤。
优选的,根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
通过所述工作区域的第二侧边的长度除以第一距离后减去1来计算所述自移动设备的预设转向次数;
所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
优选的,所述方法还包括:
获取自移动设备的工作区域的区别于第一侧边的第二侧边的长度及与第二侧边位置相对的第三侧边的长度,所述自移动设备沿第一侧边方向朝向第二侧边或第三侧边行走;
通过所述工作区域的第二侧边的长度和第三侧边的长度求平均长度;
根据所述平均长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;
判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的第一侧边方向倾斜一个角度行走的步骤。
优选的,根据所述平均长度以及所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
通过所述平均长度除以第一距离后减去1来计算所述自移动设备的预设转向次数;
所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
优选的,所述方法还包括:
设置所述工作区域的边界线,当所述自移动设备碰到边界线时,控制所述自移动设备转变行走方向;
当所述自移动设备碰到边界线时,记录所述自移动设备沿所述工作区域的第一侧边方向的行走距离;并控制所述自移动设备转变行走方向,使得自移动设备再次沿工作区域的第一侧边方向直线行走,所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反;
当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述自移动设备上一次沿所述工作区域的第一侧边方向的行走距离时,控制所述自移动设备转变行走方向。
优选的,设置所述工作区域的边界线的方法包括:
在工作区域的边界上铺设边界线。
优选的,设置所述工作区域的边界线的方法包括:
在工作区域的边界位置设置多个信号发射器,多个所述信号发射器形成边界线;
所述自移动设备上设有接收信号发射器发射的信号的信号接收器。
优选的,所述方法包括:
控制所述自移动设备沿工作区域的第一侧边方向倾斜一个角度行走;
当所述自移动设备倾斜一个角度行走的距离到达所述工作区域的第一侧边的长度时,控制所述自移动设备转变行走方向。
优选的,所述倾斜角度的确定方法包括:
获取自移动设备的工作区域的区别于第一侧边的第二侧边的形状及长度,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走;
根据所述工作区域的第二侧边的形状和长度计算所述自移动设备的倾斜角。
优选的,所述方法还包括:
获取自移动设备的工作区域的区别于第一侧边的第二侧边,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走,所述第二侧边方向的边界上设置边界线,当所述自移动设备碰到边界线时,控制所述自移动设备转变行走方向;当所述自移动设备碰到边界线时,记录所述自移动设备沿所述工作区域的第一侧边方向的行走距离;并控制所述自移动设备转变行走方向,使得自移动设备再次沿工作区域的第一侧边方向行走,所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反;
当所述自移动设备沿工作区域的第一侧边方向行走的距离达到所述自移动设备上一次沿所述工作区域的第一侧边方向的行走距离时,控制所述自移动设备转变行走方向。
优选的,设置所述工作区域的边界线的方法包括:
在工作区域的边界上铺设边界线。
优选的,设置所述工作区域的边界线的方法包括:
在工作区域的边界位置设置多个信号发射器,多个所述信号发射器形成边界线;
所述自移动设备上设有接收信号发射器发射的信号的信号接收器。
优选的,控制所述自移动设备转变行走方向的步骤包括:
控制所述自移动设备沿所述工作区域的第一侧边方向向未行走的工作区域的方向偏转90度后并行走第二距离,所述第二距离小于或等于所述自移动设备的操作宽度;
在所述自移动设备行走完所述第二距离后,控制所述自移动设备偏转90度,且偏转后所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反。
优选的,所述自移动设备通过电缆与电源连接,所述电缆缠绕在自动收线 电缆盘上,所述方法还包括:
控制所述自移动设备在工作区域内沿平行路径往复行走,其中,所述自移动设备转变行走方向的方式是倒退行走。
优选的,控制所述自移动设备朝远离所述自动收线电缆盘的方向行走过程中,根据所述电缆的拉力控制所述自移动设备的行走速度。
优选的,控制所述自移动设备在工作区域内沿平行路径往复行走包括:
控制所述自移动设备沿当前路径前进至所述工作区域的边界处;
控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置;
控制所述自移动设备转到所述当前路径的相邻路径,将所述相邻路径作为所述当前路径,返回执行控制所述自移动设备沿当前路径前进至所述工作区域的边界处的步骤。
优选的,控制所述自移动设备转到所述当前路径的相邻路径包括:
控制所述自移动设备向预设方向转弯α度行走预设距离,其中,所述预设方向为垂直于所述当前路径并且指向所述自移动设备未行走过的区域,所述α大于0,小于等于90;
控制所述自移动设备向所述预设方向相反的方向转弯α度转到所述当前路径的相邻路径。
优选的,在控制所述自移动设备沿当前路径前进至所述工作区域的边界处之后,所述方法还包括:
在所述自移动设备的行走路径未覆盖所述工作区域时,执行控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置的步骤。
优选的,在所述自移动设备的行走路径已经覆盖所述工作区域时,控制所述自移动设备从当前位置沿直线倒退行走至所述自动收线电缆盘附近。
优选的,所述自移动设备为自动扫雪机。
一种自移动设备路径规划方法,自移动设备的工作区域包括第一侧边及区别于第一侧边的第二侧边,所述第二侧边方向的边界的至少部分设置边界线,所述方法包括:
控制所述自移动设备沿工作区域的第一侧边方向直线行走;
当所述自移动设备碰到所述边界线时,记录所述自移动设备沿所述工作区域的第一侧边方向的行走距离;并控制所述自移动设备转变行走方向,使得自移动设备再次沿工作区域的第一侧边方向直线行走;
当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述自移动设备上一次沿所述工作区域的第一侧边方向直线行走的距离时,控制所述自移动设备转变行走方向。
优选的,设置所述工作区域的边界线的方法包括:
在工作区域的边界上铺设边界线。
优选的,设置所述工作区域的边界线的方法包括:
在工作区域的边界位置设置多个信号发射器,多个所述信号发射器形成边界线;
所述自移动设备上设有接收信号发射器发射的信号的信号接收器。
优选的,获取自移动设备的工作区域的区别于第一侧边的第二侧边的长度;
根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;
判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的第一侧边方向直线行走的步骤。
优选的,根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
通过所述工作区域的第二侧边的长度除以第一距离后减去1来计算所述自移动设备的预设转向次数;
所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
优选的,工作区域的第二侧边方向的边界上设置边界线的部分对应于工作区域的第一侧边方向的长度不固定的部分。
优选的,工作区域的第一侧边方向长度不固定部分的长度小于第一侧边方向长度固定部分的长度;获取工作区域的第一侧边方向长度固定部分的长度,当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述工作区 域的第一侧边方向长度固定部分的长度时,控制所述自移动设备转变行走方向。
优选的,获取工作区域第一侧边方向的最大长度,工作区域的第二侧边方向的边界上设置边界线的部分,对应于工作区域的第一侧边方向的长度小于第一侧边方向的最大长度的部分;
当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述工作区域的第一侧边方向的最大长度时,控制所述自移动设备转变行走方向。
优选的,控制所述自移动设备转向的步骤包括:
控制所述自移动设备沿所述工作区域的第一侧边方向向未行走的工作区域的方向偏转90度后并行走第二距离,所述第二距离小于或等于所述自移动设备的操作宽度;
在所述自移动设备行走完所述第二距离后,控制所述自移动设备偏转90度,且偏转后所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反。
优选的,所述自移动设备通过电缆与电源连接,所述电缆缠绕在自动收线电缆盘上,所述方法还包括:
控制所述自移动设备在工作区域内沿平行路径往复行走,其中,所述自移动设备转变行走方向的方式是倒退行走。
优选的,控制所述自移动设备朝远离所述自动收线电缆盘的方向行走过程中,根据所述电缆的拉力控制所述自移动设备的行走速度。
优选的,控制所述自移动设备在工作区域内沿平行路径往复行走包括:
控制所述自移动设备沿当前路径前进至所述工作区域的边界处;
控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置;
控制所述自移动设备转到所述当前路径的相邻路径,将所述相邻路径作为所述当前路径,返回执行控制所述自移动设备沿当前路径前进至所述工作区域的边界处的步骤。
优选的,控制所述自移动设备转到所述当前路径的相邻路径包括:
控制所述自移动设备向预设方向转弯α度行走预设距离,其中,所述预设方向为垂直于所述当前路径并且指向所述自移动设备未行走过的区域,所述α 大于0,小于等于90;
控制所述自移动设备向所述预设方向相反的方向转弯α度转到所述当前路径的相邻路径。
优选的,在控制所述自移动设备沿当前路径前进至所述工作区域的边界处之后,所述方法还包括:
在所述自移动设备的行走路径未覆盖所述工作区域时,执行控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置的步骤。
优选的,在所述自移动设备的行走路径已经覆盖所述工作区域时,控制所述自移动设备从当前位置沿直线倒退行走至所述自动收线电缆盘附近。
优选的,所述自移动设备为自动扫雪机。
一种自移动设备路径规划系统,自移动设备的工作区域包括第一侧边及区别于第一侧边的第二侧边,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走,第二侧边方向的边界的至少部分设置边界线,所述系统包括:
控制器,用于获取所述工作区域第一侧边方向的最大长度;
转向器,该转向器的输入端与所述控制器的第一输出端相连接,所述转向器用于当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述工作区域的第一侧边方向的最大长度时,或者当所述自移动设备碰到边界线时,控制所述自移动设备转向
优选的,控制器还用于获取工作区域的第二侧边的长度,根据第二侧边的长度和自移动设备的操作宽度,计算所述自移动设备的预设转向次数:
所述自移动设备路径规划系统还包括驱动器,该驱动器的输入端与所述控制器的第二输出端相连接,所述驱动器用于在所述自移动设备的转向次数等于所述自移动设备的预设转向次数时,控制所述自移动设备停机,且在所述自移动设备的转向次数未等于所述自移动设备的预设转向次数时,控制所述自移动设备直线行走。
优选的,所述控制器计算所述自移动设备的预设转向次数是通过第二侧边的长度除以第一距离后减去1进行的;其中,所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
优选的,所述自移动设备包括:
机身主体,与电缆连接,所述电缆用于向所述自移动设备提供电能;
拉力检测单元,用于在所述自移动设备行走时检测所述电缆承受的拉力;
设备控制单元,用于根据所述拉力检测单元检测到的拉力调整所述自移动设备的行走速度。
优选的,所述自移动设备还包括电源输入单元,通过所述电缆与电源连接,用于向所述自移动设备提供电能,其中,在所述电源处所述电缆缠绕在自动收线电缆盘上。
优选的,所述自移动设备还包括导航定位模块,用于对所述自移动设备进行路径规划。
优选的,所述系统包括用于所述的自移动设备的自动收线电缆盘。
优选的,所述自动收线电缆盘包括:
卷筒,用于缠绕向所述自移动设备传输电能的电缆;
支架,用于支撑所述卷筒,所述支架随着所述自移动设备的方向旋转,使所述卷筒的出线口面向所述自移动设备的方向。
优选的,所述自动收线电缆盘还包括:
方向检测单元,用于检测所述电缆受到的拉力方向;
电缆盘控制单元,用于根据所述方向检测单元检测到的拉力方向,水平转动所述支架,以使所述卷筒的出线口朝向所述拉力方向。
优选的,所述自动收线电缆盘还包括:基座,所述基座上设置有旋转轴,所述支架固定在所述旋转轴上,所述支架在所述电缆的拉力作用下转动。
优选的,所述自动收线电缆盘还包括:
角度传感器,用于检测所述支架旋转的角度。
优选的,所述自动收线电缆盘还包括:
电缆长度测量装置,用于检测所述电缆的出线或者回线长度。
优选的,所述电缆长度测量装置包括:
转轮,在所述电缆出线或者回线的带动下转动;
计数器,用于统计所述转轮旋转的圈数。
优选的,所述自移动设备为自动扫雪机。
提供一种自移动设备路径规划方法和系统。
基于此,有必要提供一种自移动设备路径规划方法和系统,可以自动运行,不需要人工控制。
一种自移动设备路径规划方法,所述方法包括:
获取自移动设备的工作区域的宽度;
控制所述自移动设备沿工作区域的宽度方向直线行走;
当所述自移动设备直线行走的距离达到所述工作区域的宽度时,控制所述自移动设备转向。
上述自移动设备路径规划方法,当所述自移动设备直线行走的距离达到所述工作区域的宽度时,则控制所述自移动设备转向,不需要人工控制,操作简便,应用广泛。
在其中一个实施例中,获取自移动设备的工作区域的长度;
根据所述工作区域的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;
判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的宽度方向直线行走的步骤。
在其中一个实施例中,根据所述工作区域的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
通过所述工作区域的长度除以第一距离后减去1来计算所述自移动设备的预设转向次数;
所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
在其中一个实施例中,还包括设置所述工作区域的边界线的步骤;当所述自移动设备碰到边界线时,控制所述自移动设备转向的步骤;
当所述自移动设备碰到边界线时,记录所述自移动设备沿所述工作区域的宽度方向的行走距离;并控制所述自移动设备转向,使得自移动设备再次沿工作区域的宽度方向直线行走;
当所述自移动设备沿工作区域的宽度方向直线行走的距离达到所述自移动设备上一次沿所述工作区域的宽度方向的行走距离时,控制所述自移动设备转 向。该实施例中减少了边界线的使用,降低了成本。
在其中一个实施例中,控制所述自移动设备转向的步骤包括:
控制所述自移动设备向未行走的工作区域的方向偏转90度后,沿所述工作区域的宽度方向行走第二距离;所述第二距离小于或等于所述自移动设备的操作宽度;
在所述自移动设备行走完所述第二距离后,控制所述自移动设备偏转90度,且偏转后所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的宽度方向的行走方向相反。
在其中一个实施例中,所述自移动设备为自动扫雪机。
一种自移动设备路径规划方法,自移动设备的工作区域包括长度方向和宽度方向,工作区域的长度方向的仅一侧边界的至少部分设置边界线,所述方法包括:
控制所述自移动设备沿工作区域的宽度方向直线行走;
当所述自移动设备碰到所述边界线时,记录所述自移动设备沿所述工作区域的宽度方向的行走距离;并控制所述自移动设备转向,使得自移动设备再次沿工作区域的宽度方向直线行走;
当所述自移动设备沿工作区域的宽度方向直线行走的距离达到所述自移动设备上一次沿所述工作区域的宽度方向行走的距离时,控制所述自移动设备转向。
上述自移动设备路径规划方法,自移动设备的工作区域的长度方向的仅一侧边界的至少部分设置边界线,减少了边界线的使用,降低了成本,且当所述自移动设备碰到边界线时,则控制所述自移动设备转向,不需要人工控制,操作简便,应用广泛。
获取自移动设备的工作区域的长度;
根据所述工作区域的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;
判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的宽度方向直线行走的步骤。
在其中一个实施例中,根据所述工作区域的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
通过所述工作区域的宽度除以第一距离后减去1来计算所述自移动设备的预设转向次数;
所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
在其中一个实施例中,工作区域的长度方向的仅一侧边界的设置边界线的部分,对应于工作区域的宽度不固定的部分。
在其中一个实施例中,工作区域的宽度不固定的部分的宽度,小于宽度固定的部分的宽度;获取工作区域的宽度固定的部分的宽度,当所述自移动设备沿工作区域的宽度方向直线行走的距离达到所述工作区域的宽度固定的部分的宽度时,控制所述自移动设备转向。
在其中一个实施例中,获取工作区域的最大宽度;工作区域的长度方向的仅一侧边界的设置边界线的部分,对应于工作区域的宽度小于最大宽度的部分;
当所述自移动设备沿工作区域的宽度方向直线行走的距离达到所述工作区域的最大宽度时,控制所述自移动设备转向。
在其中一个实施例中,控制所述自移动设备转向的步骤包括:
控制所述自移动设备向未行走的工作区域的方向偏转90度,沿所述工作区域的宽度方向行走第二距离;所述第二距离小于或等于所述自移动设备的操作宽度;
在所述自移动设备行走完所述第二距离后,控制所述自移动设备偏转90度,且偏转后所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的宽度方向的行走方向相反。
在其中一个实施例中,所述自移动设备为自动扫雪机。
一种自移动设备路径规划系统,自移动设备的工作区域的长度方向的边界的至少部分设置边界线,所述系统包括:
控制器,用于获取所述工作区域的最大宽度;
转向器,该转向器的输入端与所述控制器的第一输出端相连接,所述转向器用于当所述自移动设备沿工作区域的宽度方向直线行走的距离达到所述工作区域的最大宽度时,或者当所述自移动设备碰到边界线时,控制所述自移动设 备转向。
在其中一个实施例中,控制器还用于获取工作区域的长度,根据工作区域的长度和自移动设备的操作宽度,计算所述自移动设备的预设转向次数;
所述自移动设备路径规划系统还包括驱动器,该驱动器的输入端与所述控制器的第二输出端相连接,所述驱动器用于在所述自移动设备的转向次数等于所述自移动设备的预设转向次数时,控制所述自移动设备停机,且在所述自移动设备的转向次数未等于所述自移动设备的预设转向次数时,控制所述自移动设备直线行走。
在其中一个实施例中,所述控制器计算所述自移动设备的预设转向次数是通过所述工作区域的长度除以第一距离后减去1进行的;其中,所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
在其中一个实施例中,所述自移动设备为自动扫雪机。
上述自移动设备路径规划系统,自移动设备的工作区域的长度方向的仅一侧边界的至少部分设置边界线,减少了边界线的使用,降低了成本,且当所述自移动设备碰到边界线或者当所述自移动设备沿工作区域的宽度方向直线行走的距离达到所述工作区域的最大宽度时,则控制所述自移动设备转向,不需要人工控制,操作简便,应用广泛。
提供一种自移动设备及其控制方法以及自动收线电缆盘。
本发明要解决的技术问题在于,现有技术中自移动设备行走速度过快或者行走距离大于电缆长度时,导致电缆受力过大容易拉断电缆,从而提供一种自移动设备及其控制方法以及自动收线电缆盘。
本发明实施例提供了一种自移动设备,包括:机身主体,与电缆连接,所述电缆用于向所述自移动设备提供电能;拉力检测单元,用于在所述自移动设备行走时检测所述电缆承受的拉力;设备控制单元,用于根据所述拉力检测单元检测到的拉力调整所述自移动设备的行走速度。
可选地,还包括:电源输入单元,通过所述电缆与电源连接,用于向所述自移动设备提供电能,其中,在所述电源处所述电缆缠绕在自动收线电缆盘上。
可选地,还包括:导航定位模块,用于对所述自移动设备进行路径规划。
本发明实施例还提供了一种用于所述的自移动设备的自动收线电缆盘。
可选地,包括:卷筒,用于缠绕向所述自移动设备传输电能的电缆;支架,用于支撑所述卷筒,所述支架随着所述自移动设备的方向旋转,使所述卷筒的出线口面向所述自移动设备的方向。
可选地,还包括:方向检测单元,用于检测所述电缆受到的拉力方向;电缆盘控制单元,用于根据所述方向检测单元检测到的拉力方向,水平转动所述支架,以使所述卷筒的出线口朝向所述拉力方向。
可选地,还包括:基座,所述基座上设置有旋转轴,所述支架固定在所述旋转轴上,所述支架在所述电缆的拉力作用下转动。
可选地,还包括:角度传感器,用于检测所述支架旋转的角度。
可选地,还包括:电缆长度测量装置,用于检测所述电缆的出线或者回线长度。
可选地,电缆长度测量装置包括:转轮,在所述电缆出线或者回线的带动下转动;计数器,用于统计所述转轮旋转的圈数。
本发明实施例还提供了一种自移动设备的控制方法,所述自移动设备通过电缆与电源连接,所述电缆缠绕在自动收线电缆盘上,所述控制方法包括:控制所述自移动设备在工作区域内沿平行路径往复行走,其中,所述自移动设备采用倒退行走的方式返回。
可选地,控制所述自移动设备朝远离所述自动收线电缆盘的方向行走过程中,根据所述电缆的拉力控制所述自移动设备的行走速度。
可选地,控制所述自移动设备在工作区域内沿平行路径往复行走包括:控制所述自移动设备沿当前路径前进至所述工作区域的边界处;控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置;控制所述自移动设备转到所述当前路径的相邻路径,将所述相邻路径作为所述当前路径,返回执行控制所述自移动设备沿当前路径前进至所述工作区域的边界处的步骤。
可选地,控制所述自移动设备转到所述当前路径的相邻路径包括:控制所述自移动设备向预设方向转弯α度行走预设距离,其中,所述预设方向为垂直于所述当前路径并且指向所述自移动设备未行走过的区域,所述α大于0,小于等于90;控制所述自移动设备向所述预设方向相反的方向转弯α度转到所述 当前路径的相邻路径。
可选地,在控制所述自移动设备沿当前路径前进至所述工作区域的边界处之后,所述方法还包括:在所述自移动设备的行走路径未覆盖所述工作区域时,执行控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置的步骤。
可选地,在所述自移动设备的行走路径已经覆盖所述工作区域时,控制所述自移动设备从当前位置沿直线倒退行走至所述自动收线电缆盘附近。
根据本发明实例,通过在自移动设备的机身主体上设置拉力检测单元以检测电缆承受的拉力大小,根据该拉力调整自移动设备的行走速度,使得在电缆承受的拉力大于上限阈值时,降低自移动设备的行走速度可以避免自移动设备行走速度过快导致电缆受力过大,容易拉断电缆的现象,降低自动化自移动设备自动控制的事故发生率。
另外,本发明实施例自移动设备采用电缆供电,现有技术中采用电池供电的自移动设备,要想一次工作时间长,需要增大电池容量,电池容量大,意谓着成本高,体积大,重量重;而为了能无人值守,需要机器具有自动回到基站充电的功能,这势必要增加基站成本,同时回归和充电的时间牺牲了工作效率。本发明实施例通过电缆给自移动设备提供能量,则不存在上述问题,但是电缆给自移动设备带来了限制:电缆容易拉断,容易缠绕。为此,本发明实施例的自移动设备电缆在机器后部,自移动设备拉着电缆往前走,到了边界退着回,同时电缆由电缆盘自动收回,线不会在地上盘绕。再拉着电缆往前走。
本发明实施例中,支架可水平旋转地设置,使得卷筒的出线口始终面向自移动设备,这样能够避免电缆与卷筒的侧壁之间的磨损,延长电缆的使用寿命,并且不对自移动设备的只有行走造成阻碍。
本发明实施例中,自移动设备沿平行路径往复行走能过保证工作区域覆盖整个工作区域,其中,向前行走(即远离自动收线电缆盘)时,拖拽电缆前进;返回时,采用倒退行走至初始位置。自移动设备倒退返回过程中,由于自动收线电缆盘自动收起电缆,相对于自移动设备转弯返回,本实施例的返回方式使得自移动设备不会被电缆缠绕。
附图说明
以上所述的本发明解决的技术问题、技术方案以及有益效果可以通过下面的能够实现本发明的较佳的具体实施例的详细描述,同时结合附图描述而清楚地获得。
附图以及说明书中的相同的标号和符号用于代表相同的或者等同的元件。
图1为一实施例中自移动设备路径规划方法的流程图;
图2为图1中所示的自移动设备路径规划方法的一种应用场景图;
图3为图1所述的自移动设备路径规划方法的进一步的实施例;
图4为一实施例中自移动设备的工作区域;
图5为一实施例中自移动设备的工作区域;
图6为一实施例中自移动设备路径规划方法的流程图;
图7为图6所述的自移动设备路径规划方法的进一步的实施例;
图8为一实施例中自移动设备的工作区域;
图9为一实施例中自移动设备路径规划系统的结构示意图。
图10为本发明实施例中自移动设备的一个具体示例的原理框图;
图11为本发明实施例中自移动设备控制系统的一个具体示例的原理框图;
图12为本发明实施例中自移动设备的另一个具体示例的原理框图;
图13为本发明实施例中自动收线电缆盘的一个具体示例的原理框图;
图14为本发明实施例中自动收线电缆盘的另一个具体示例的原理框图;
图15A至15E为本发明实施例中自移动设备行走控制路线示意图;
图16为本发明实施例中自移动设备的控制方法的一个具体示例的流程图。
其中,                200   转向器
100   控制器          101   机身主体
300   驱动器          103   设备控制单元
102   拉力检测单元    105   电缆堵头
104   电源输入单元    107   工作电机
106   导航定位模块    109   人机交互模块
108   行走电机        111   存储器
110   无线通信模块    20    电缆
                      301   卷筒
303   基座                302   支架
304   角度传感器          3031  旋转轴
306   触电或短路保护装置  305   电缆长度测量装置
308   电缆盘控制单元      307   无线通信模块
3     自动收线电缆盘
具体实施方式
有关本发明的详细说明和技术内容,配合附图说明如下,然而所附附图仅提供参考与说明,并非用来对本发明加以限制。
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用于解释本发明,并不用于限定本发明。
在详细说明根据本发明的实施例前,应该注意到的是,所述的实施例主要在于与自移动设备路径规划方法和系统相关的步骤和系统组件的组合。因此,所属系统组件和方法步骤已经在附图中通过常规符号在适当的位置表示出来了,并且只示出了与理解本发明的实施例有关的细节,以免因对于得益于本发明的本领域普通技术人员而言显而易见的那些细节模糊了本发明的公开内容。
在本文中,诸如左和右,上和下,前和后,第一和第二之类的关系术语仅仅用来区分一个实体或动作与另一个实体或动作,而不一定要求或暗示这种实体或动作之间的任何实际的这种关系或顺序。术语“包括”、“包含”或任何其他变体旨在涵盖非排他性的包含,由此使得包括一系列要素的过程、方法、物品或者设备不仅包含这些要素,而且还包含没有明确列出的其他要素,或者为这种过程、方法、物品或者设备所固有的要素。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,还可以是两个元件内部的连通,可以是无线连接,也可以是有线连接。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
此外,下面所描述的本发明不同实施方式中所涉及的技术特征只要彼此之间未构成冲突就可以相互结合
术语“自移动设备的操作宽度”可以近似为自移动设备的宽度,例如当自移动设备为自动扫雪机时,自移动设备的操作宽度是指自移动设备的扫雪宽度,其可以近似为自动扫雪机的宽度。
本发明自移动设备工作区域包括第一侧边、区别于第一侧边的第二侧边及与第二侧边位置相对的第三侧边,所述自移动设备沿第一侧边方向朝向第二侧边或第三侧边行走。第一侧边方向可以是工作区域的宽度方向,也可以是工作区域的长度方向。当第一侧边与第二侧边及第三侧边总长度不一样时,设定第一侧边为宽度时,则第二侧边及第三侧边为长度,反之,当设定第一侧边为长度时,则第二侧边及第三侧边为宽度。
本发明的一种自移动设备路径规划方法,其包括:
获取自移动设备的工作区域的第一侧边方向;
控制所述自移动设备沿工作区域的第一侧边方向行走;
当所述自移动设备行走到达所述工作区域边界时,控制所述自移动设备转变行走方向。
在该方法中,到达工作区域,当边界的最外侧设置边界线时,该边界指边界线的位置。对于不设置边界线时,比如通过GPS地图,即自移动设备内置或者可获取工作区域地图,边界为地图上的边界。对于工作区域为规则形状,比如长方形时,边界为长度所在的侧边或者宽度所在的侧边,对于工作区域为不规则形状,比如弧形时,边界可以是弧形的弧边位置,边界也可以认为是弧边附近距离弧边较近的位置。该方法实施例中,所述自移动设备的运动轨迹沿着第一侧边方向直线行走到达边界或者与第一侧边方向成一个角度行走到达边界。
第一实施例
本发明的自移动设备路径规划方法的第一实施例中,所述方法包括:
获取自移动设备的工作区域的第一侧边的长度;
控制所述自移动设备沿工作区域的第一侧边方向直线行走;
当所述自移动设备直线行走的距离到达所述工作区域的第一侧边的长度 时,控制所述自移动设备转变行走方向。
在上述方法的进一步实施例中,所述方法还包括:
获取自移动设备的工作区域的区别于第一侧边的第二侧边的长度,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走;
根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;
判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的第一侧边方向直线行走的步骤。
上述根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
通过所述工作区域的第二侧边的长度除以第一距离后减去1来计算所述自移动设备的预设转向次数,所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
在上述方法的进一步实施例中,所述方法还包括:
设置所述工作区域的边界线,当所述自移动设备碰到边界线时,控制所述自移动设备转变行走方向;
当所述自移动设备碰到边界线时,记录所述自移动设备沿所述工作区域的第一侧边方向的行走距离;并控制所述自移动设备转变行走方向,使得自移动设备再次沿工作区域的第一侧边方向直线行走,所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反;
当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述自移动设备上一次沿所述工作区域的第一侧边方向的行走距离时,控制所述自移动设备转变行走方向。
上述设置所述工作区域的边界线的方法可以有多种,一种可以直接在工作区域的边界上铺设边界线,即实际的边界线结构。另一种可以设置虚拟边界线,比如在工作区域的边界位置设置多个信号发射器,多个所述信号发射器形成边界线;所述自移动设备上设有接收信号发射器发射的信号的信号接收器。
在上述方法的进一步实施例中,控制所述自移动设备转变行走方向的步骤 包括:
控制所述自移动设备沿所述工作区域的第一侧边方向向未行走的工作区域的方向偏转90度后并行走第二距离,所述第二距离小于或等于所述自移动设备的操作宽度;
在所述自移动设备行走完所述第二距离后,控制所述自移动设备偏转90度,且偏转后所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反。
第二实施例
第二实施例与第一实施例的主要区别在于,第一实施例中,所述自移动设备沿工作区域的第一侧边方向直线行走,而第二实施例中,所述自移动设备沿工作区域的第一侧边方向倾斜一个角度行走。本发明的自移动设备路径规划方法的第二实施例中,所述方法包括:
获取自移动设备的工作区域的第一侧边的长度;
控制所述自移动设备沿工作区域的第一侧边方向倾斜一个角度行走;
当所述自移动设备倾斜一个角度行走的距离到达所述工作区域的第一侧边的长度时,控制所述自移动设备转变行走方向。
该方法中倾斜角度的确定方法包括:
获取自移动设备的工作区域的区别于第一侧边的第二侧边的形状及长度,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走;
根据所述工作区域的第二侧边的形状和长度计算所述自移动设备的倾斜角。
在上述方法的进一步实施例中,所述方法还包括:
获取自移动设备的工作区域的区别于第一侧边的第二侧边的长度及与第二侧边位置相对的第三侧边的长度,所述自移动设备沿第一侧边方向朝向第二侧边或第三侧边行走;
通过所述工作区域的第二侧边的长度和第三侧边的长度求平均长度;
根据所述平均长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;
判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控 制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的第一侧边方向倾斜一个角度行走的步骤。
上述根据所述平均长度以及所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
通过所述平均长度除以第一距离后减去1来计算所述自移动设备的预设转向次数,所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
在上述方法的进一步实施例中,所述方法还包括:
获取自移动设备的工作区域的区别于第一侧边的第二侧边,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走,所述第二侧边方向的边界上设置边界线,当所述自移动设备碰到边界线时,控制所述自移动设备转变行走方向;
当所述自移动设备碰到边界线时,记录所述自移动设备沿所述工作区域的第一侧边方向的行走距离;并控制所述自移动设备转变行走方向,使得自移动设备再次沿工作区域的第一侧边方向行走,所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反;
当所述自移动设备沿工作区域的第一侧边方向行走的距离达到所述自移动设备上一次沿所述工作区域的第一侧边方向的行走距离时,控制所述自移动设备转变行走方向。
上述设置所述工作区域的边界线的方法可以有多种,一种可以直接在工作区域的边界上铺设边界线,即实际的边界线结构。另一种可以设置虚拟边界线,比如在工作区域的边界位置设置多个信号发射器,多个所述信号发射器形成边界线;所述自移动设备上设有接收信号发射器发射的信号的信号接收器。
在上述方法的进一步实施例中,控制所述自移动设备转变行走方向的步骤包括:
控制所述自移动设备沿所述工作区域的第一侧边方向向未行走的工作区域的方向偏转90度后并行走第二距离,所述第二距离小于或等于所述自移动设备的操作宽度;
在所述自移动设备行走完所述第二距离后,控制所述自移动设备偏转90度,且偏转后所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反。
第三实施例
第三实施例与第一实施例的主要区别在于,第一实施例中,所述自移动设备沿工作区域的第一侧边方向直线行走,可以设置边界线,也可以不设置边界线,直接利用计算沿第一侧边行走的距离控制转向,而第三实施例中,设置边界线,自移动设备的工作区域包括第一侧边及区别于第一侧边的第二侧边,所述第二侧边方向的边界的至少部分设置边界线,本发明的自移动设备路径规划方法的第三实施例中,所述方法包括:
控制所述自移动设备沿工作区域的第一侧边方向直线行走;
当所述自移动设备碰到所述边界线时,记录所述自移动设备沿所述工作区域的第一侧边方向的行走距离;并控制所述自移动设备转变行走方向,使得自移动设备再次沿工作区域的第一侧边方向直线行走;
当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述自移动设备上一次沿所述工作区域的第一侧边方向直线行走的距离时,控制所述自移动设备转变行走方向。
上述设置所述工作区域的边界线的方法可以有多种,一种可以直接在工作区域的边界上铺设边界线,即实际的边界线结构。另一种可以设置虚拟边界线,比如在工作区域的边界位置设置多个信号发射器,多个所述信号发射器形成边界线;所述自移动设备上设有接收信号发射器发射的信号的信号接收器。
在上述方法的进一步实施例中,获取自移动设备的工作区域的区别于第一侧边的第二侧边的长度;根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的第一侧边方向直线行走的步骤。
在上述方法的进一步实施例中,根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
通过所述工作区域的第二侧边的长度除以第一距离后减去1来计算所述自移动设备的预设转向次数;
所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
在上述方法的进一步实施例中,工作区域的第二侧边方向的边界上设置边 界线的部分对应于工作区域的第一侧边方向的长度不固定的部分。工作区域的第一侧边方向长度不固定部分的长度小于第一侧边方向长度固定部分的长度;获取工作区域的第一侧边方向长度固定部分的长度,当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述工作区域的第一侧边方向长度固定部分的长度时,控制所述自移动设备转变行走方向。获取工作区域第一侧边方向的最大长度,工作区域的第二侧边方向的边界上设置边界线的部分,对应于工作区域的第一侧边方向的长度小于第一侧边方向的最大长度的部分;当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述工作区域的第一侧边方向的最大长度时,控制所述自移动设备转变行走方向。
在上述方法的进一步实施例中,控制所述自移动设备转向的步骤包括:
控制所述自移动设备沿所述工作区域的第一侧边方向向未行走的工作区域的方向偏转90度后并行走第二距离,所述第二距离小于或等于所述自移动设备的操作宽度;
在所述自移动设备行走完所述第二距离后,控制所述自移动设备偏转90度,且偏转后所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反。
在上述三个实施例的描述中可以,关于自移动设备的转向,可以是通过旋转一定角度后实现转向,在本发明自移动设备路径规划方法的另一个实施例中,可以通过直接倒退实现转向。当然该直接倒退实现转向同样适用于上述三个实施例的自移动设备路径规划方法。
所述自移动设备通过电缆与电源连接,所述电缆缠绕在自动收线电缆盘上。该实施例的自移动设备路径规划方法包括:
获取自移动设备的工作区域的第一侧边方向;
控制所述自移动设备沿工作区域的第一侧边方向沿平行路径往复行走;
当所述自移动设备行走到达所述工作区域边界时,控制所述自移动设备转变行走方向;其中,所述自移动设备转变行走方向的方式是倒退行走。
在上述方法的进一步实施例中,控制所述自移动设备朝远离所述自动收线电缆盘的方向行走过程中,根据所述电缆的拉力控制所述自移动设备的行走速度。
在上述方法的进一步实施例中,控制所述自移动设备在工作区域内沿平行路径往复行走包括:
控制所述自移动设备沿当前路径前进至所述工作区域的边界处;
控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置;
控制所述自移动设备转到所述当前路径的相邻路径,将所述相邻路径作为所述当前路径,返回执行控制所述自移动设备沿当前路径前进至所述工作区域的边界处的步骤。
在上述方法的进一步实施例中,控制所述自移动设备转到所述当前路径的相邻路径包括:
控制所述自移动设备向预设方向转弯α度行走预设距离,其中,所述预设方向为垂直于所述当前路径并且指向所述自移动设备未行走过的区域,所述α大于0,小于等于90;
控制所述自移动设备向所述预设方向相反的方向转弯α度转到所述当前路径的相邻路径。
在上述方法的进一步实施例中,在控制所述自移动设备沿当前路径前进至所述工作区域的边界处之后,所述方法还包括:
在所述自移动设备的行走路径未覆盖所述工作区域时,执行控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置的步骤。
在所述自移动设备的行走路径已经覆盖所述工作区域时,控制所述自移动设备从当前位置沿直线倒退行走至所述自动收线电缆盘附近。
下面结合附图设定第一侧边为宽度,第二侧边及第三侧边为长度对本发明实施例进行进一步描述。
请参阅图1所示,图1为一实施例中自移动设备路径规划方法的流程图,在该实施例中,方法包括:
S102:获取自移动设备的工作区域的宽度W。通常自动扫雪机的应用场景为马路,自动扫雪机沿马路的宽度方向开始扫雪,因此此处是获取自移动设备的工作区域的宽度W。如果在其他实施例中,自动扫雪机沿的是工作区域的长 度方向行走时,可以首先获取该工作区域的长度L。
S104:控制自移动设备沿工作区域的宽度方向直线行走。
S106:判断自移动设备直线行走的距离是否达到所述工作区域的宽度。
S108:当自移动设备直线行走的距离达到工作区域的宽度时,则控制自移动设备转向,否则返回步骤S104,控制自移动设备继续沿工作区域的宽度方向直线行走。
上述自移动设备路径规划方法,当所述自移动设备直线行走的距离达到所述工作区域的宽度W时,则控制所述自移动设备转向,不需要人工控制,操作简便,应用广泛。
请参阅图2所示,图2为图1中所示的自移动设备路径规划方法的一种应用场景图。在图2中,自移动设备的工作区域为矩形,该矩形的宽度为W,长度为L。自移动设备沿宽度W的方向行走,当直线行走的距离达到宽度W时,自移动设备即转向行走,具体可以参见图2中所示的箭头。
请参阅图3所示,图3为图1所述的自移动设备路径规划方法的进一步的实施例。该实施例中的方法可以包括以下步骤:
S302:获取自移动设备的工作区域的长度L和宽度W。其中工作区域的宽度是W是为了控制自移动设备的转向,工作区域的长度L是为了获取自移动设备的预设转向次数,从而控制自移动设备工作完成后的停机。
S304:根据工作区域的长度L和自移动设备的操作宽度a计算自移动设备的预设转向次数。
S306:控制自移动设备沿工作区域的宽度W方向直线行走。
S308:判断自移动设备直线行走的距离是否达到所述工作区域的宽度W。
S310:当自移动设备直线行走的距离达到工作区域的宽度W时,则控制自移动设备转向,否则返回步骤S306,控制自移动设备继续直线行走。
S314:判断自移动设备的转向次数是否等于预设转向次数。
S316:若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的宽度方向直线行走的步骤,即步骤S306。
在该实施例中,不仅可以自动控制自移动设备的工作,还可以准确地判断出自移动设备在工作区域的工作是否完成,并在工作完成后,控制该自移动设 备停机。
请继续参阅图2所示,假设自移动设备的操作宽度为a,步骤S304中计算自移动设备的预设转向次数,可以通过W/a-1来计算。在一种实施例中,也可以通过工作区域的宽度W除以第一距离b后减去1来计算自移动设备的预设转向次数;第一距离b为自移动设备的操作宽度的0.8至1倍,即自移动设备的预设转向次数等于W/b-1,b=(0.8-1)a,这样可以确保自移动设备行走的路径完全覆盖该工作区域。例如当W=10米,a=1米时,自移动设备的预设转向次数可以为10/1-1=9次,也可以为10/0.8-1=11.5,即为12次,或者为10/0.9-1≈10.1,即为11次,即转向次数为11次。在实际应用中,可以根据需要来进行设置。
请参阅图4所示,图4为一实施例中自移动设备的工作区域的示意图。在该实施例中,即图3中的边c,其上设置有边界线,边d和边e上未设置边界线,这样可以减少边界线的使用,降低成本。结合图4所示,所述方法还包括设置工作区域的边界线的步骤;以及当自移动设备碰到边界线时,则控制自移动设备转向的步骤。当自移动设备碰到边界线时,记录自移动设备沿工作区域的宽度W方向的行走距离;并控制所述自移动设备转向,使得自移动设备再次沿工作区域的宽度W方向直线行走;当所述自移动设备沿工作区域的宽度方向直线行走的距离达到自移动设备上一次沿工作区域的宽度方向的行走距离时,控制所述自移动设备转向。可以参见图4中的箭头所示。
也可以参阅图5所示,图5为一实施例中自移动设备的工作区域的示意图。在该实施例中,边AB上铺设有边界线,另外通过辅助线AE将工作区域分成为三角形ABE和矩形AECD,该辅助线在实际使用中是不存在的,在此仅是为了方便说明,该自移动设备可以沿图5中的箭头方向行走,当碰到边界线或当行走距离达到工作区域的宽度W时,则该自移动设备转向。
其中控制自移动设备转向的步骤可以包括:控制自移动设备向未行走的工作区域的方向偏转90度后,沿工作区域的宽度方向行走第二距离;第二距离小于或等于自移动设备的操作宽度或上述的第一距离。在自移动设备行走完所述第二距离后,控制自移动设备偏转90度,且偏转后自移动设备的行走方向与自移动设备上次沿工作区域的宽度方向的行走方向相反。具体可以分为两种情况, 一种是自移动设备直线行走的距离达到工作区域的宽度W,一种是自移动设备碰到边界线。
第一种情况请结合图2或图5所示,当自移动设备直线行走距离达到工作区域的宽度W时,控制自移动设备转向的步骤包括:当自移动设备行走的直线长度达到工作区域的宽度W时,控制自移动设备向未行走的工作区域的方向偏转90度后,沿工作区域的宽度W方向行走第二距离;第二距离小于等于自移动设备的操作宽度a或者该第一距离;在自移动设备行走完第二距离后,控制自移动设备偏转90度后,行走工作区域的宽度W的距离,且偏转后自移动设备的行走方向与自移动设备上次沿工作区域的宽度W方向的行走方向相反;当自移动设备行走工作区域的宽度W的距离后,控制自移动设备向未行走的工作区域的方向偏转90度后,沿工作区域的长度L方向行走第三距离,且第二距离与第三距离的和可以为第一距离b或自移动设备的操作宽度a;当自移动设备行走完第三距离后,控制自移动设备偏转90度后继续行走,且偏转后自移动设备的行走方向与自移动设备上次沿工作区域的宽度W方向的行走方向相反。即结合图5所示首先自移动设备由K点沿KM方向,即工作区域的宽度W方向行走工作区域的宽度W的距离,到达M点,此时自移动设备偏转90度后行走第二距离到达N点,然后偏转90度后行走工作区域的宽度W的距离到达0点,再偏转90度后行走第三距离到达P点后偏转90度,一次为周期,往复进行,直至最后一次偏转,其中第二距离MN与第三距离0P的和为第一距离b或自移动设备的操作宽度a。
第二种情况请继续参阅图5所示,当自移动设备碰到边界线时,则控制自移动设备转向的步骤包括:当自移动设备碰到边界线时,记录自移动设备沿工作区域的宽度W方向的行走距离;且控制自移动设备向未行走的工作区域的方向偏转90度后,沿工作区域的长度L方向行走第二距离;第二距离小于或等于自移动设备的操作宽度a或第一距离b;在自移动设备行走完第二距离后,控制自移动设备偏转90度后,行走自移动设备上一次沿工作区域的宽度W方向的行走距离,且偏转后自移动设备的行走方向与自移动设备上次沿工作区域的宽度W方向的行走方向相反;当自移动设备行走的距离达到自移动设备上一次沿工作区域的宽度W方向的行走距离时,控制自移动设备向未行走的工作区域的 方向偏转90度后,沿工作区域的长度L方向行走第三距离,且第二距离与第三距离的和可以为第一距离b或自移动设备的操作宽度a;当自移动设备行走完第三距离后,控制自移动设备偏转90度后继续行走,且偏转后自移动设备的行走方向与自移动设备上次沿工作区域的宽度W方向的行走方向相反。即首先自移动设备由F点沿FG方向,即工作区域的宽度W方向行走到达G点,此时自移动设备偏转90度后行走第二距离到达Q点,然后偏转90度后行走上一次沿工作区域的宽度方向行走的距离到达I点,再偏转90度后行走第三距离到达J点后偏转90度,一次为周期,往复进行,直至最后一次偏转,其中第二距离GQ与第三距离IJ的和可以为第一距离b或自移动设备的操作宽度a。请参阅图6所示,图6为一实施例中自移动设备路径规划方法的流程图,在该实施例中,自移动设备的工作区域包括长度方向和宽度方向,工作区域的长度方向的仅一侧边界的至少部分设置边界线,该方法可以包括:
S602:控制自移动设备沿工作区域的宽度方向直线行走。如图4中的箭头所示。
S604:判断自移动设备是否碰到边界线。具体可以结合图4所示,当自移动设备碰到设置在边c上的边界线时,自移动设备转向。
S606:当自移动设备碰到边界线时,则记录自移动设备沿工作区域的宽度方向的行走距离,并控制自移动设备转向,使得自移动设备再次沿工作区域的宽度方向直线行走;否则返回步骤S602,控制自移动设备继续沿工作区域的宽度方向直线行走。
S608:当自移动设备沿工作区域的宽度方向直线行走的距离达到自移动设备上一次沿工作区域的宽度方向行走的距离时,控制自移动设备转向。
上述自移动设备路径规划方法,自移动设备的工作区域的长度方向的仅一侧边界的至少部分设置边界线,减少了边界线的使用,降低了成本,且当所述自移动设备碰到边界线时,则控制所述自移动设备转向,不需要人工控制,操作简便,应用广泛。
在一种优选的实施方式中,请参阅图7所示,图7为图6所述的自移动设备路径规划方法的进一步的实施例。该实施例中的方法可以包括以下步骤:
S702:获取自移动设备的工作区域的长度L。
S704:根据工作区域的长度L和自移动设备的操作宽度a计算自移动设备的预设转向次数。
S706:控制自移动设备沿工作区域的宽度方向直线行走。
S708:判断自移动设备是否碰到边界线。
S710:当自移动设备碰到边界线时,则控制自移动设备转向,否则返回步骤S706,控制自移动设备继续直线行走。
S714:判断所述自移动设备的转向次数是否等于所述预设转向次数。
S716:当自移动设备的转向次数等于自移动设备的预设转向次数时,则控制自移动设备停机。
S718:当自移动设备的转向次数未等于自移动设备的预设转向次数时,则返回控制所述自移动设备直线行走的步骤。
上述自移动设备路径规划方法,当自移动设备碰到边界线时,则控制自移动设备转向,不需要人工控制,操作简便,应用广泛。
请参与图8所示,图8为图7中所示的自移动设备路径规划方法的一种应用场景图。在图8中,该自移动设备的工作区域的宽度为W,长度为L。自移动设备的操作宽度为a,步骤S604中计算自移动设备的预设转向次数,可以通过W/a-1来计算。在一种实施例中,也可以通过工作区域的宽度除以第一距离b后减去1来计算自移动设备的预设转向次数;第一距离b为自移动设备的操作宽度的0.8至1倍,即自移动设备的预设转向次数等于W/b-1,b=(0.8-1)a,这样可以确保自移动设备行走的路径完全覆盖该工作区域。例如当W=10米,a=1米时,自移动设备的预设转向次数可以为10/1-1=9次,也可以为10/0.9-1≈10.1次,即转向次数为11次,或者为10/0.8-1≈11.5,即转向次数为12次。在实际应用中,可以根据需要来进行设置。
请继续参阅图8并结合图5所示,在其中一个是实施例中,作区域的长度方向的仅一侧边界的设置边界线的部分,对应于工作区域的宽度不固定的部分。例如图5中三角形ABE处,工作区域的宽度的大小是改变的,因此在其长度方向的一侧,AB处设置有边界线,而图5矩形AECD处,工作区域的宽度的大小是固定的,因此无需设置边界线。图8中边GH和边HI处的工作区域的宽度是改变的,因此在边GH和边HI处均设置有边界线。
在上述实施例中,工作区域的宽度不固定的部分的宽度,小于宽度固定的部分的宽度;获取工作区域的宽度固定的部分的宽度,当自移动设备沿工作区域的宽度方向直线行走的距离达到工作区域的宽度固定的部分的宽度时,控制所述自移动设备转向。该实施例可以结合图5所示,即当沿线KM行走时,自移动设备行走的距离达到工作区域的宽度固定部分的宽度时,其转向,沿线MN行走。
在其中一个实施例中,该方法还可以包括获取工作区域的最大宽度;工作区域的长度方向的仅一侧边界的设置边界线的部分,对应于工作区域的宽度小于最大宽度的部分;当自移动设备沿工作区域的宽度方向直线行走的距离达到工作区域的最大宽度时,控制自移动设备转向。
请继续参阅图8所示,该自移动设备的行走过程中的每次转向均以是否碰到边界线为判断依据,不需要根据自移动设备的工作区域的长度来进行判断。当自移动设备碰到边界线时,则控制自移动设备转向的步骤包括:当自移动设备碰到边界线时,记录自移动设备沿工作区域的宽度W方向的行走距离;且控制自移动设备向未行走的工作区域的方向偏转90度后,沿工作区域的长度L方向行走第二距离;第二距离小于等于第一距离b或自移动设备的操作宽度a;在自移动设备行走完第二距离后,控制自移动设备偏转90度后,行走自移动设备上一次沿工作区域的宽度W方向的行走距离,且偏转后自移动设备的行走方向与自移动设备上次沿工作区域的宽度W方向的行走方向相反;当自移动设备行走的距离达到自移动设备上一次沿工作区域的宽度W方向的行走距离时,控制自移动设备向未行走的工作区域的方向偏转90度后,沿工作区域的长度L方向行走第三距离,且第二距离与第三距离的和可以为第一距离b或者自移动设备的操作宽度a;当自移动设备行走完第三距离后,控制自移动设备偏转90度后继续行走,且偏转后自移动设备的行走方向与自移动设备上次沿工作区域的长度L方向的行走方向相反。即图8中,由A点处行走至B点,碰到边界线,则偏转90度后,行走第二距离至点C,再偏转90度后行走至点D,再偏转90度后,行走第三距离至点E,其中第二距离BC与第三距离DE的和可以为第一距离b或者自移动设备的操作宽度a。
请参阅图9所示,图9为一实施例中自移动设备路径规划系统的结构示意 图。在该实施例中,自移动设备的工作区域的长度方向的边界的至少部分设置边界线,系统包括控制器100以及转向器200;该转向器200的输入端与控制器100的第一输出端相连接。控制器100用于获取所述工作区域的最大宽度;转向器200用于当自移动设备直线行走路径的长度达到工作区域的最大宽度时,或者当自移动设备碰到边界线时,控制自移动设备转向。上述自移动设备路径规划系统,自移动设备的工作区域的长度方向的仅一侧边界的至少部分设置边界线,减少了边界线的使用,降低了成本,且当所述自移动设备碰到边界线或者当所述自移动设备沿工作区域的宽度方向直线行走的距离达到所述工作区域的最大宽度时,则控制所述自移动设备转向,不需要人工控制,操作简便,应用广泛。
在其中一个实施例中,控制器还用于获取工作区域的长度,根据工作区域的长度L和自移动设备的操作宽度a,计算自移动设备的预设转向次数。自移动设备路径规划系统还包括驱动器300,该驱动器300的输入端与所述控制器的第二输出端相连接,驱动器300用于在自移动设备的转向次数未等于自移动设备的预设转向次数时,控制自移动设备行走,在自移动设备的转向次数等于自移动设备的预设转向次数时,控制自移动设备停机,且在自移动设备的转向次数未等于自移动设备的预设转向次数时,控制自移动设备直线行走。在其中一个实施例中,控制器100计算自移动设备的预设转向次数是通过工作区域的宽度除以第一距离b后减去1进行的;其中,第一距离b为自移动设备的操作宽度a的0.8至1倍。
在其中一个实施例中,如图10所示,该自移动设备包括:机身主体101、拉力检测单元102和设备控制单元103。机身主体101与电缆20连接,电缆20用于向自移动设备提供电能;拉力检测单元102用于在自移动设备行走时检测电缆20承受的拉力,该拉力检测单元102可以采用应力传感器进行拉力检测;设备控制单元103用于根据拉力检测单元102检测到的拉力调整自移动设备的行走速度。
本发明实施例的电缆20的一端与机身主体101连接,另一端与外部电源连接,该外部电源可以是交流电源(如市电),也可以是直流电源。可选地,为了安全起见,交流电源可通过AC/AC降压,或AC/DC降压,降到安全电压;高电 压直流电源可通过DC/AC降压,或DC/DC降压,降到安全电压。
自移动设备的行走速度由其自移动设备本身的控制策略来控制,当其速度过快时容易出现:电缆20放线的速度小于自移动设备行走速度,使电缆20承受的拉力过大,致使电缆20被扯断或者电缆接头脱落。本实施例中,采用一种速度控制反馈机制,通过在自移动设备的机身主体101上设置拉力检测单元102以检测电缆20承受的拉力大小,根据该拉力调整自移动设备的行走速度,使得在电缆20承受的拉力大于上限阈值时,降低自移动设备的行走速度,当电缆20承受的拉力为超过极限阈值时表示电缆被卡死或者已经放到最长长度,控制自移动设备停止行走或者后退。当然,也可以在电缆20承受的拉力小于下限阈值时,提高自移动设备的行走速度到一定值。这样,可以避免自移动设备行走速度过快导致电缆受力过大,容易拉断电缆的现象,降低自移动设备自动控制的事故发生率。
另外,本发明实施例自移动设备采用电缆供电,现有技术中采用电池供电的自移动设备,要想一次工作时间长,需要增大电池容量,电池容量大,意味着成本高,体积大,重量重;而为了能无人值守,需要机器具有自动回到基站充电的功能,这势必要增加基站成本,同时回归和充电的时间牺牲了工作效率。本发明实施例通过电缆给自移动设备提供能量,则不存在上述问题,但是电缆给自移动设备带来了限制:电缆容易拉断,容易缠绕。为此,本发明实施例的自移动设备电缆在机器后部,自移动设备拉着电缆往前走,到了边界退着回,同时电缆由电缆盘自动收回,线不会在地上盘绕。再拉着电缆往前走。
在上述系统的进一步实施例中,如图11所示,本发明实施例的自移动设备还包括:电源输入单元104,设置在机身主体101上,该电源输入单元104通过电缆20与电源连接,用于向自移动设备提供电能,其中,在电源处电缆20缠绕在自动收线电缆盘30上。
本实施例中,采用自动收线电缆盘30进行电缆20的收放,如图11所示,当自移动设备向前(远离自动收线电缆盘30)行走时,电缆堵头105对电缆20产生拉力,顺着电缆20,拉力作用在自动收线电缆盘30的卷筒上致使其放线,其中,拉力检测单元102检测电缆20承受的拉力,该拉力为卷筒对电缆20的拉力,根据该拉力对自移动设备的速度进行控制;当自移动设备退回至自动收 线电缆盘30时,自动收线电缆盘30自动收起电缆20,避免电缆20缠绕自移动设备。
在上述系统的进一步实施例中,如图12所示,本实施例的自移动设备还包括:导航定位模块106,用于对自移动设备进行路径规划。导航定位模块106可以包括mems运动传感器、GPS,结合脉冲无线电(Ultra-Wideband,简称UWB)定位、超声波定位、激光辅助定位等进行路径规划,其中,运动传感器可以包括陀螺仪、加速度传感器、电子罗盘等。
如图12所示,本发明实施例的自移动设备还可以包括:工作电机107,用于驱动工作盘工作;行走电机108,用于驱动自移动设备行走;人机交互模块109,用于进行人机交互;无线通信模块110以及存储器111。其中,设备控制单元103与上述这些元器件分别相连接。无线通信模块110可以与自动收线电缆盘进行通信,帮助自移动设备回归定位或者进行控制等。
本发明实施例还提供了一种自动收线电缆盘。该自动收线电缆盘固定在车库内,可以用于本发明上述实施例的自移动设备,具有自动回收电缆的功能。
在上述系统的进一步实施例中,如图13所示,本实施例的自动收线电缆盘包括:卷筒301,用于缠绕向自移动设备传输电能的电缆20;支架302,用于支撑卷筒301,支架302随着自移动设备的方向旋转,使卷筒301的出线口面向自移动设备的方向。
本实施例中,支架302可水平旋转地设置,使得卷筒301的出线口始终面向自移动设备,这样能够避免电缆20与卷筒301的侧壁之间的磨损,延长电缆20的使用寿命,并且不对自移动设备的只有行走造成阻碍。
在上述系统的进一步实施例中,本实施例的自动收线电缆盘还包括:基座303,基座303上设置有旋转轴3031,支架302固定在旋转轴3031上,支架302在电缆20的拉力作用下转动。
本实施例中,支架302在电缆的拉力作用下被动地发生转动,旋转轴3031发生旋转,使得支架302的出线口朝向自移动设备。
作为上述实施方式的一种可替代方式,本实施例的自动收线电缆盘采用主动调节卷筒出线口方向的方式,具体地,自动收线电缆盘增加了方向检测单元,用于检测电缆受到的拉力方向;电缆盘控制单元,用于根据方向检测单元检测 到的拉力方向,水平转动支架,以使卷筒的出线口朝向拉力方向。
本实施例中,由电缆的拉力方向来确定自移动设备的方向,在方向检测单元检测到电缆承受的拉力方向时,电缆盘控制单元控制支架转动至该方向上,从而保证电缆的出线口与自移动设备的方向保持一致。
在上述系统的进一步实施例中,如图14所示,本发明实施例的自动收线电缆盘还包括角度传感器304,用于检测支架302旋转的角度。该角度传感器304可以是陀螺仪,测得的角度可以用于协助自移动设备确定回归的路径。
自动收线电缆盘还包括:电缆长度测量装置305,用于检测电缆的出线或者回线长度。具体地,电缆长度测量装置包括:转轮,在电缆出线或者回线的带动下转动;计数器,用于统计转轮旋转的圈数。通过将电缆和一个已知直径D的转轮摩擦而得到电缆伸缩长度L=n*π*D,n为转轮旋转圈数,该圈数由计数器统计得到;根据转轮旋转方向确定电缆是拉出还是缩回。
在上述系统的进一步实施例中,自动收线电缆盘还包括:触电或短路保护装置306和无线通信模块307,触电或短路保护装置306可以是触保器/断路器等,保证电缆盘的安全性。无线通信模块307则与自移动设备上的通信进行通信。上述模块单元均与自动收线电缆盘的电缆盘控制单元308连接,由其进行相应的控制。
本发明实施例还提供了一种自移动设备的控制方法,其中,本实施例中所示的自移动设备通过电缆与电源连接,电缆缠绕在自动收线电缆盘上,该自移动设备可以是上述实施例中所述的一种自移动设备。控制方法包括:控制自移动设备在工作区域内沿平行路径往复行走,其中,自移动设备采用倒退行走的方式返回。
本实施例中,自移动设备沿平行路径往复行走能过保证工作区域覆盖整个工作区域,其中,倒退行走的方式可以是采用原路倒退,或先要偏转一个角度,倒退的轨迹和前进的轨迹平行,其间隔可大于0且小于机器的工作头的直径,也可以无间隔。具体地,原路返回的实施方式包括:向前行走(即远离自动收线电缆盘)时,拖拽电缆前进;返回时,采用倒退行走至初始位置,保证每次向前行走的路径平行不重叠即可。自移动设备倒退返回过程中,由于自动收线电缆盘自动收起电缆,相对于自移动设备转弯返回,本实施例的返回方式使得 自移动设备不会被电缆缠绕。
在进一步实施例中,控制自移动设备朝远离自动收线电缆盘的方向行走过程中,根据电缆的拉力控制自移动设备的行走速度。
本实施例中,通过在自移动设备的机身主体101上设置拉力检测单元102以检测电缆20承受的拉力大小,根据该拉力调整自移动设备的行走速度,使得在电缆20承受的拉力大于上限阈值时,降低自移动设备的行走速度,当电缆20承受的拉力为超过极限阈值时表示电缆被卡死或者已经放到最长长度,控制自移动设备停止行走或者后退。当然,也可以在电缆20承受的拉力小于下限阈值时,提高自移动设备的行走速度到一定值。这样,可以避免自移动设备行走速度过快导致电缆受力过大,容易拉断电缆的现象,降低自移动设备自动控制的事故发生率。
在进一步实施例中,本实施例中控制自移动设备在工作区域内沿平行路径往复行走包括:控制自移动设备沿当前路径前进至工作区域的边界处;控制自移动设备沿当前路径从工作区域的边界处倒退行走至当前路径的初始位置;控制自移动设备转到当前路径的相邻路径,将相邻路径作为当前路径,返回执行控制自移动设备沿当前路径前进至工作区域的边界处的步骤。
如图15A至15D所示,自动收线电缆盘固定在室内,自移动设备在工作区域内工作。自移动设备从工作区域的左侧开始,从靠近自动收线电缆盘的位置向前行驶至工作区域的边界处(图中所示的工作区域与主干道的边界),然后自移动设备倒退行走至初四位置,然后转到工作区域内之前路径的右侧的相邻的平行路径,按照相同方式行走至工作区域的右侧边界。
在控制自移动设备按照上述方式进行工作行走的过程中,每次行走至工作区域的边界处,可以判断自移动设备的行走路径是否覆盖工作区域;其中,在自移动设备的行走路径未覆盖工作区域时,执行控制自移动设备沿当前路径从工作区域的边界处倒退行走至当前路径的初始位置的步骤;在自移动设备的行走路径已经覆盖工作区域时,控制自移动设备从当前位置沿直线倒退行走至自动收线电缆盘附近。自移动设备的行走路径已经覆盖工作区域表示自移动设备的工作任务已经完成,因此,可以从当前位置直接沿直线退回至起点,并停止工作,如图15E所示。
作为一种可选实施方式,控制自移动设备转到当前路径的相邻路径包括:控制自移动设备向预设方向转弯α度行走预设距离,其中,预设方向为垂直于当前路径并且指向自移动设备未行走过的区域,α大于0,小于等于90;控制自移动设备向预设方向相反的方向转弯α度转到当前路径的相邻路径。该相邻路径与当前路径平行,这里所述的当前路径即为上一次行走过的路径。
下面以扫雪机为例,结合图16描述本发明实例的控制方法的一种可选实施方式,具体如图16所示,包括:
步骤S801,确定工作区域。
步骤S802,扫雪机从起点沿直线前进开始扫雪,如图15A。
步骤S803,扫雪机前进到工作区域的边界处。可以根据工作区域的大小,设置扫雪机前进的距离,控制扫雪机前进至该距离处。
步骤S804,扫雪机停止扫雪,并倒退返回,如图15B。
步骤S805,控制扫雪机倒退的距离等于前进的距离。
步骤S806,向左转弯α°,并启动行走一段距离,如图15C所示。
步骤S807,向右转弯α°,使机身摆直,如图15D所示。
步骤S808,扫雪机前进到工作区域的边界处。
步骤S809,判断工作区域是否已经扫完,如果是,则执行步骤S810,反之,则执行步骤S804。
步骤S810,停止扫雪直线倒退至起点附近。
本发明实施例中所述的自移动设备可以是自动扫雪机、自动割草机等设备。
显然,上述实施例仅仅是为清楚地说明所作的举例,而并非对实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。而由此所引伸出的显而易见的变化或变动仍处于本发明创造的保护范围之中。
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的 普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。

Claims (52)

  1. 一种自移动设备路径规划方法,其特征在于,所述方法包括:
    获取自移动设备的工作区域的第一侧边方向;
    控制所述自移动设备沿工作区域的第一侧边方向行走;
    当所述自移动设备行走到达所述工作区域边界时,控制所述自移动设备转变行走方向。
  2. 根据权利要求1所述的自移动设备路径规划方法,其特征在于:所述方法包括:
    获取自移动设备的工作区域的第一侧边的长度;
    控制所述自移动设备沿工作区域的第一侧边方向直线行走;
    当所述自移动设备直线行走的距离到达所述工作区域的第一侧边的长度时,控制所述自移动设备转变行走方向。
  3. 根据权利要求2所述的自移动设备路径规划方法,其特征在于:所述方法还包括:
    获取自移动设备的工作区域的区别于第一侧边的第二侧边的长度,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走;
    根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;
    判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的第一侧边方向直线行走的步骤。
  4. 根据权利要求3所述的自移动设备路径规划方法,其特征在于:根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
    通过所述工作区域的第二侧边的长度除以第一距离后减去1来计算所述自移动设备的预设转向次数;
    所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
  5. 根据权利要求2所述的自移动设备路径规划方法,其特征在于:所述方法还包括:
    获取自移动设备的工作区域的区别于第一侧边的第二侧边的长度及与第二侧边位置相对的第三侧边的长度,所述自移动设备沿第一侧边方向朝向第二侧边或第三侧边行走;
    通过所述工作区域的第二侧边的长度和第三侧边的长度求平均长度;
    根据所述平均长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;
    判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的第一侧边方向倾斜一个角度行走的步骤。
  6. 根据权利要求5所述的自移动设备路径规划方法,其特征在于:根据所述平均长度以及所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
    通过所述平均长度除以第一距离后减去1来计算所述自移动设备的预设转向次数;
    所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
  7. 根据权利要求2所述的自移动设备路径规划方法,其特征在于:所述方法还包括:
    设置所述工作区域的边界线,当所述自移动设备碰到边界线时,控制所述自移动设备转变行走方向;
    当所述自移动设备碰到边界线时,记录所述自移动设备沿所述工作区域的第一侧边方向的行走距离;并控制所述自移动设备转变行走方向,使得自移动设备再次沿工作区域的第一侧边方向直线行走,所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反;
    当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述自移动设备上一次沿所述工作区域的第一侧边方向的行走距离时,控制所述自移动设备转变行走方向。
  8. 根据权利要求7所述的自移动设备路径规划方法,其特征在于:设置所述工作区域的边界线的方法包括:
    在工作区域的边界上铺设边界线。
  9. 根据权利要求7所述的自移动设备路径规划方法,其特征在于:设置所述工作区域的边界线的方法包括:
    在工作区域的边界位置设置多个信号发射器,多个所述信号发射器形成边界线;所述自移动设备上设有接收信号发射器发射的信号的信号接收器。
  10. 根据权利要求1所述的自移动设备路径规划方法,其特征在于:所述方法包括:
    控制所述自移动设备沿工作区域的第一侧边方向倾斜一个角度行走;
    当所述自移动设备倾斜一个角度行走的距离到达所述工作区域的第一侧边的长度时,控制所述自移动设备转变行走方向。
  11. 根据权利要求10所述的自移动设备路径规划方法,其特征在于:所述倾斜角度的确定方法包括:
    获取自移动设备的工作区域的区别于第一侧边的第二侧边的形状及长度,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走;
    根据所述工作区域的第二侧边的形状和长度计算所述自移动设备的倾斜角。
  12. 根据权利要求10所述的自移动设备路径规划方法,其特征在于:所述方法还包括:
    获取自移动设备的工作区域的区别于第一侧边的第二侧边,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走,所述第二侧边方向的边界上设置边界线,当所述自移动设备碰到边界线时,控制所述自移动设备转变行走方向;
    当所述自移动设备碰到边界线时,记录所述自移动设备沿所述工作区域的第一侧边方向的行走距离;并控制所述自移动设备转变行走方向,使得自移动设备再次沿工作区域的第一侧边方向行走,所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反;
    当所述自移动设备沿工作区域的第一侧边方向行走的距离达到所述自移动设备上一次沿所述工作区域的第一侧边方向的行走距离时,控制所述自移动设备转变行走方向。
  13. 根据权利要求12所述的自移动设备路径规划方法,其特征在于:设置所述工作区域的边界线的方法包括:
    在工作区域的边界上铺设边界线。
  14. 根据权利要求12所述的自移动设备路径规划方法,其特征在于:设置所述工作区域的边界线的方法包括:
    在工作区域的边界位置设置多个信号发射器,多个所述信号发射器形成边界线;所述自移动设备上设有接收信号发射器发射的信号的信号接收器。
  15. 根据权利要求1至14任意一项所述的自移动设备路径规划方法,其特征在于:控制所述自移动设备转变行走方向的步骤包括:
    控制所述自移动设备沿所述工作区域的第一侧边方向向未行走的工作区域的方向偏转90度后并行走第二距离,所述第二距离小于或等于所述自移动设备的操作宽度;
    在所述自移动设备行走完所述第二距离后,控制所述自移动设备偏转90度,且偏转后所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反。
  16. 根据权利要求1所述的自移动设备路径规划方法,其特征在于:所述自移动设备通过电缆与电源连接,所述电缆缠绕在自动收线电缆盘上,所述方法还包括:
    控制所述自移动设备在工作区域内沿平行路径往复行走,其中,所述自移动设备转变行走方向的方式是倒退行走。
  17. 根据权利要求16所述的自移动设备路径规划方法,其特征在于:控制所述自移动设备朝远离所述自动收线电缆盘的方向行走过程中,根据所述电缆的拉力控制所述自移动设备的行走速度。
  18. 根据权利要求16所述的自移动设备路径规划方法,其特征在于:控制所述自移动设备在工作区域内沿平行路径往复行走包括:
    控制所述自移动设备沿当前路径前进至所述工作区域的边界处;
    控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置;
    控制所述自移动设备转到所述当前路径的相邻路径,将所述相邻路径作为所述当前路径,返回执行控制所述自移动设备沿当前路径前进至所述工作区域的边界处的步骤。
  19. 根据权利要求18所述的自移动设备路径规划方法,其特征在于:控制所述自移动设备转到所述当前路径的相邻路径包括:
    控制所述自移动设备向预设方向转弯α度行走预设距离,其中,所述预设方向为垂直于所述当前路径并且指向所述自移动设备未行走过的区域,所述α大于0,小于等于90;
    控制所述自移动设备向所述预设方向相反的方向转弯α度转到所述当前路径的相邻路径。
  20. 根据权利要求18所述的自移动设备路径规划方法,其特征在于:在控制所述自移动设备沿当前路径前进至所述工作区域的边界处之后,所述方法还包括:在所述自移动设备的行走路径未覆盖所述工作区域时,执行控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置的步骤。
  21. 根据权利要求18所述的自移动设备路径规划方法,其特征在于:在所述自 移动设备的行走路径已经覆盖所述工作区域时,控制所述自移动设备从当前位置沿直线倒退行走至所述自动收线电缆盘附近。
  22. 根据权利要求1至14及16至21任意一项所述的自移动设备路径规划方法,其特征在于:所述自移动设备为自动扫雪机。
  23. 一种自移动设备路径规划方法,其特征在于,自移动设备的工作区域包括第一侧边及区别于第一侧边的第二侧边,所述第二侧边方向的边界的至少部分设置边界线,所述方法包括:
    控制所述自移动设备沿工作区域的第一侧边方向直线行走;
    当所述自移动设备碰到所述边界线时,记录所述自移动设备沿所述工作区域的第一侧边方向的行走距离;并控制所述自移动设备转变行走方向,使得自移动设备再次沿工作区域的第一侧边方向直线行走;
    当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述自移动设备上一次沿所述工作区域的第一侧边方向直线行走的距离时,控制所述自移动设备转变行走方向。
  24. 根据权利要求23所述的自移动设备路径规划方法,其特征在于:设置所述工作区域的边界线的方法包括:
    在工作区域的边界上铺设边界线。
  25. 根据权利要求23所述的自移动设备路径规划方法,其特征在于:设置所述工作区域的边界线的方法包括:
    在工作区域的边界位置设置多个信号发射器,多个所述信号发射器形成边界线;所述自移动设备上设有接收信号发射器发射的信号的信号接收器。
  26. 根据权利要求23所述的自移动设备路径规划方法,其特征在于:获取自移动设备的工作区域的区别于第一侧边的第二侧边的长度;
    根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数;
    判断所述自移动设备的转向次数是否等于所述预设转向次数,若是,则控制所述自移动设备停机,否则返回控制所述自移动设备沿工作区域的第一侧边方向直线行走的步骤。
  27. 根据权利要求26所述的自移动设备路径规划方法,其特征在于:根据所述工作区域的第二侧边的长度和所述自移动设备的操作宽度计算所述自移动设备的预设转向次数的步骤为:
    通过所述工作区域的第二侧边的长度除以第一距离后减去1来计算所述自移动 设备的预设转向次数;
    所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
  28. 根据权利要求23所述的自移动设备路径规划方法,其特征在于:工作区域的第二侧边方向的边界上设置边界线的部分对应于工作区域的第一侧边方向的长度不固定的部分。
  29. 根据权利要求28所述的自移动设备路径规划方法,其特征在于:工作区域的第一侧边方向长度不固定部分的长度小于第一侧边方向长度固定部分的长度;获取工作区域的第一侧边方向长度固定部分的长度,当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述工作区域的第一侧边方向长度固定部分的长度时,控制所述自移动设备转变行走方向。
  30. 根据权利要求23所述的自移动设备路径规划方法,其特征在于:获取工作区域第一侧边方向的最大长度,工作区域的第二侧边方向的边界上设置边界线的部分,对应于工作区域的第一侧边方向的长度小于第一侧边方向的最大长度的部分;
    当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述工作区域的第一侧边方向的最大长度时,控制所述自移动设备转变行走方向。
  31. 根据权利要求23至30任意一项所述的自移动设备路径规划方法,其特征在于:控制所述自移动设备转向的步骤包括:
    控制所述自移动设备沿所述工作区域的第一侧边方向向未行走的工作区域的方向偏转90度后并行走第二距离,所述第二距离小于或等于所述自移动设备的操作宽度;
    在所述自移动设备行走完所述第二距离后,控制所述自移动设备偏转90度,且偏转后所述自移动设备的行走方向与所述自移动设备上次沿所述工作区域的第一侧边方向的行走方向相反。
  32. 根据权利要求23所述的自移动设备路径规划方法,其特征在于:所述自移动设备通过电缆与电源连接,所述电缆缠绕在自动收线电缆盘上,所述方法还包括:
    控制所述自移动设备在工作区域内沿平行路径往复行走,其中,所述自移动设备转变行走方向的方式是倒退行走。
  33. 根据权利要求32所述的自移动设备路径规划方法,其特征在于:控制所述自移动设备朝远离所述自动收线电缆盘的方向行走过程中,根据所述电缆的拉力控制所述自移动设备的行走速度。
  34. 根据权利要求33所述的自移动设备路径规划方法,其特征在于:控制所述自移动设备在工作区域内沿平行路径往复行走包括:
    控制所述自移动设备沿当前路径前进至所述工作区域的边界处;
    控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置;
    控制所述自移动设备转到所述当前路径的相邻路径,将所述相邻路径作为所述当前路径,返回执行控制所述自移动设备沿当前路径前进至所述工作区域的边界处的步骤。
  35. 根据权利要求34所述的自移动设备路径规划方法,其特征在于:控制所述自移动设备转到所述当前路径的相邻路径包括:
    控制所述自移动设备向预设方向转弯α度行走预设距离,其中,所述预设方向为垂直于所述当前路径并且指向所述自移动设备未行走过的区域,所述α大于0,小于等于90;
    控制所述自移动设备向所述预设方向相反的方向转弯α度转到所述当前路径的相邻路径。
  36. 根据权利要求34所述的自移动设备路径规划方法,其特征在于:在控制所述自移动设备沿当前路径前进至所述工作区域的边界处之后,所述方法还包括:在所述自移动设备的行走路径未覆盖所述工作区域时,执行控制所述自移动设备沿所述当前路径从所述工作区域的边界处倒退行走至所述当前路径的初始位置的步骤。
  37. 根据权利要求34所述的自移动设备路径规划方法,其特征在于:在所述自移动设备的行走路径已经覆盖所述工作区域时,控制所述自移动设备从当前位置沿直线倒退行走至所述自动收线电缆盘附近。
  38. 根据权利要求23至30及32至37任意一项所述的自移动设备路径规划方法,其特征在于:所述自移动设备为自动扫雪机。
  39. 一种自移动设备路径规划系统,自移动设备的工作区域包括第一侧边及区别于第一侧边的第二侧边,所述自移动设备沿第一侧边方向朝向或远离第二侧边行走,其特征在于,第二侧边方向的边界的至少部分设置边界线,所述系统包括:
    控制器,用于获取所述工作区域第一侧边方向的最大长度;
    转向器,该转向器的输入端与所述控制器的第一输出端相连接,所述转向器用于当所述自移动设备沿工作区域的第一侧边方向直线行走的距离达到所述工作 区域的第一侧边方向的最大长度时,或者当所述自移动设备碰到边界线时,控制所述自移动设备转向。
  40. 根据权利要求39所述的自移动设备路径规划系统,其特征在于:控制器还用于获取工作区域的第二侧边的长度,根据第二侧边的长度和自移动设备的操作宽度,计算所述自移动设备的预设转向次数:
    所述自移动设备路径规划系统还包括驱动器,该驱动器的输入端与所述控制器的第二输出端相连接,所述驱动器用于在所述自移动设备的转向次数等于所述自移动设备的预设转向次数时,控制所述自移动设备停机,且在所述自移动设备的转向次数未等于所述自移动设备的预设转向次数时,控制所述自移动设备直线行走。
  41. 根据权利要求40所述的自移动设备路径规划系统,其特征在于:所述控制器计算所述自移动设备的预设转向次数是通过第二侧边的长度除以第一距离后减去1进行的;其中,所述第一距离为所述自移动设备的操作宽度的0.8至1倍。
  42. 根据权利要求39所述的自移动设备路径规划系统,其特征在于:所述自移动设备包括:
    机身主体,与电缆连接,所述电缆用于向所述自移动设备提供电能;
    拉力检测单元,用于在所述自移动设备行走时检测所述电缆承受的拉力;
    设备控制单元,用于根据所述拉力检测单元检测到的拉力调整所述自移动设备的行走速度。
  43. 根据权利要求42所述的自移动设备路径规划系统,其特征在于:所述自移动设备还包括电源输入单元,通过所述电缆与电源连接,用于向所述自移动设备提供电能,其中,在所述电源处所述电缆缠绕在自动收线电缆盘上。
  44. 根据权利要求43所述的自移动设备路径规划系统,其特征在于:所述自移动设备还包括导航定位模块,用于对所述自移动设备进行路径规划。
  45. 根据权利要求42至44任意一项所述的自移动设备路径规划系统,其特征在于:所述系统包括用于所述的自移动设备的自动收线电缆盘。
  46. 根据权利要求45所述的自移动设备路径规划系统,其特征在于:所述自动收线电缆盘包括:
    卷筒,用于缠绕向所述自移动设备传输电能的电缆;
    支架,用于支撑所述卷筒,所述支架随着所述自移动设备的方向旋转,使所述卷筒的出线口面向所述自移动设备的方向。
  47. 根据权利要求46所述的自移动设备路径规划系统,其特征在于:所述自动收线电缆盘还包括:
    方向检测单元,用于检测所述电缆受到的拉力方向;
    电缆盘控制单元,用于根据所述方向检测单元检测到的拉力方向,水平转动所述支架,以使所述卷筒的出线口朝向所述拉力方向。
  48. 根据权利要求46所述的自移动设备路径规划系统,其特征在于:所述自动收线电缆盘还包括:基座,所述基座上设置有旋转轴,所述支架固定在所述旋转轴上,所述支架在所述电缆的拉力作用下转动。
  49. 根据权利要求46-48任意一项所述的自移动设备路径规划系统,其特征在于:所述自动收线电缆盘还包括:
    角度传感器,用于检测所述支架旋转的角度。
  50. 根据权利要求46-48任意一项所述的自移动设备路径规划系统,其特征在于:所述自动收线电缆盘还包括:
    电缆长度测量装置,用于检测所述电缆的出线或者回线长度。
  51. 根据权利要求50所述的自移动设备路径规划系统,其特征在于:所述电缆长度测量装置包括:
    转轮,在所述电缆出线或者回线的带动下转动;
    计数器,用于统计所述转轮旋转的圈数。
  52. 根据权利要求39-44任意一项所述的自移动设备路径规划系统,其特征在于:所述自移动设备为自动扫雪机。
PCT/CN2017/107458 2016-10-24 2017-10-24 自移动设备路径规划方法和系统 Ceased WO2018077160A1 (zh)

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
CN201610926272.3 2016-10-24
CN201610926272.3A CN107974995B (zh) 2016-10-24 2016-10-24 自移动设备路径规划方法和系统
CN201610937574.0 2016-10-25
CN201610937574.0A CN107974996B (zh) 2016-10-25 2016-10-25 一种自动行走设备及其控制方法以及自动收线电缆盘

Publications (1)

Publication Number Publication Date
WO2018077160A1 true WO2018077160A1 (zh) 2018-05-03

Family

ID=62023094

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2017/107458 Ceased WO2018077160A1 (zh) 2016-10-24 2017-10-24 自移动设备路径规划方法和系统

Country Status (1)

Country Link
WO (1) WO2018077160A1 (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114680734A (zh) * 2020-12-28 2022-07-01 尚科宁家(中国)科技有限公司 清洁机器人及其清洁方法
CN115328112A (zh) * 2021-04-22 2022-11-11 苏州宝时得电动工具有限公司 自移动设备、移动轨迹调整方法及计算机可读存储介质
CN118913276A (zh) * 2024-07-17 2024-11-08 山东神力起重机械有限公司 一种自动控制卸煤的控制系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101276223A (zh) * 2007-03-28 2008-10-01 松下电器产业株式会社 自主行走装置和用于使该装置工作的计算机程序
CN102759924A (zh) * 2011-04-28 2012-10-31 苏州宝时得电动工具有限公司 自动工作系统、自动行走设备及其转向方法
CN103141210A (zh) * 2013-03-13 2013-06-12 江苏春花杰佳电器有限公司 智能割草机系统及割草方法
CN203070099U (zh) * 2013-01-05 2013-07-17 科沃斯机器人科技(苏州)有限公司 自移动机器人长边作业移动控制总成
CN103909514A (zh) * 2013-01-05 2014-07-09 科沃斯机器人科技(苏州)有限公司 自移动机器人长边作业移动控制总成及其控制方法
EP3018548A1 (en) * 2014-11-07 2016-05-11 F. Robotics Acquisitions Ltd. Domestic robotic system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101276223A (zh) * 2007-03-28 2008-10-01 松下电器产业株式会社 自主行走装置和用于使该装置工作的计算机程序
CN102759924A (zh) * 2011-04-28 2012-10-31 苏州宝时得电动工具有限公司 自动工作系统、自动行走设备及其转向方法
CN203070099U (zh) * 2013-01-05 2013-07-17 科沃斯机器人科技(苏州)有限公司 自移动机器人长边作业移动控制总成
CN103909514A (zh) * 2013-01-05 2014-07-09 科沃斯机器人科技(苏州)有限公司 自移动机器人长边作业移动控制总成及其控制方法
CN103141210A (zh) * 2013-03-13 2013-06-12 江苏春花杰佳电器有限公司 智能割草机系统及割草方法
EP3018548A1 (en) * 2014-11-07 2016-05-11 F. Robotics Acquisitions Ltd. Domestic robotic system

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114680734A (zh) * 2020-12-28 2022-07-01 尚科宁家(中国)科技有限公司 清洁机器人及其清洁方法
CN114680734B (zh) * 2020-12-28 2023-04-07 尚科宁家(中国)科技有限公司 清洁机器人及其清洁方法
CN115328112A (zh) * 2021-04-22 2022-11-11 苏州宝时得电动工具有限公司 自移动设备、移动轨迹调整方法及计算机可读存储介质
CN118913276A (zh) * 2024-07-17 2024-11-08 山东神力起重机械有限公司 一种自动控制卸煤的控制系统

Similar Documents

Publication Publication Date Title
CN107974996B (zh) 一种自动行走设备及其控制方法以及自动收线电缆盘
EP2325714B1 (en) Control method of performing rotational traveling of robot cleaner
CN102768535B (zh) 自动工作系统、自动行走设备及其转向方法
CA2959143C (en) Autonomous traveling body device
WO2017166971A1 (zh) 自动工作系统、自动行走设备及其转向方法
WO2017198222A1 (zh) 自动工作系统,自移动设备及其控制方法
CN208196812U (zh) 一种迎宾机器人
KR20160097051A (ko) 로봇충전복귀장치 및 그 복귀방법
CN206930787U (zh) Agv型车辆检查系统
JP6422703B2 (ja) 自律走行体装置
CN107249415A (zh) 自律型走行体
CN116324337A (zh) 通过航位推算导航机器人割草机
CN204581162U (zh) 智能保洁机器人
KR100876691B1 (ko) 청소기의 충전 시스템 및 그 제어방법
CN103584798A (zh) 智能吸尘器控制系统及智能吸尘器清扫方法
CN116600635B (zh) 通过导线导航机器人割草机
JP2009146327A (ja) 自走式機器およびそのプログラム
CN219587301U (zh) 一种水池清洁设备行走路径规划系统
WO2023104087A1 (zh) 自动工作系统、自动工作方法和计算机可读存储介质
CN217911827U (zh) 一种清洁机
WO2024198236A1 (zh) 割草机的控制方法、设备及存储介质
EP4659558A1 (en) Control method for autonomous operation device, and autonomous operation device
CN204427933U (zh) 卧式吸尘器
CN211308773U (zh) 障碍行走机器人
KR100533005B1 (ko) 이동로봇의 에지감지장치 및 방법

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

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

Country of ref document: EP

Kind code of ref document: A1