The present disclosure relates generally to an aerial navigation system having an aerial module and a robotic device therein. More specifically, this disclosure relates to a navigation control unit for controlling navigation of the robotic device within a convex quadrilateral volume of the aerial module.
An unmanned aerial vehicle (UAV) (or uncrewed aerial vehicle, commonly known as a drone) is an aircraft without a human pilot on board and a type of unmanned vehicle. UAVs are a component of an unmanned aircraft system (UAS), which include a UAV, a ground-based controller, and a system of communications between the two. The flight of UAVs may operate with various degrees of autonomy, either under remote control by a human operator or autonomously by onboard computers.
Traditional wired robotic devices require manual control of their movements by a trained operator using a joystick apparatus. However, this is an overly labour-intensive process, and requires significant motor skills on the part of the human operator.
According to an aspect of the present disclosure, there is provided an aerial navigation system comprising an aerial module having four anchor points mounted on top of four upright members respectively at substantially same height from a ground, a carrier device coupled to a first set of four electric motors mounted at the four anchor points through a set of first wires. The set of first wires, the four upright members and the ground effectively define a volume. The carrier device is moveable in a bounded horizontal plane defined by the four anchor points. The aerial module also has a robotic device coupled to the carrier device through a second wire. The robotic device is adapted to move vertically relative to the carrier device through activation of a fifth electric motor provided in either of the robotic device or the carrier device. The aerial navigation system further comprises a control unit that is coupled to the first set of four electric motors at the four anchor points and the fifth electric motor at either of the robotic device or the carrier device for controlling the three-dimensional movement of the robotic device for permitting navigation of the robotic device from a current location to a target location inside the defined volume.
According to an aspect of the present disclosure, there is provided a method for operating an aerial navigation system to control aerial movement of a robotic device therein. The method includes providing four upright members supported by a ground and mounting top portions of the four upright members with four anchor points respectively at a substantially same height from the ground. The method further includes providing an electric motor from a first set of four electric motors and a wire from a set of first wires to each of the four anchor points to operably support movement of a carrier device in a bounded horizontal plane defined by the four anchor points. The method further includes suspending the robotic device from the carrier device using a second wire such that the robotic device is moveable within a volume defined by the set of first wires, the four upright members and the ground by a fifth electric motor provided at either of the robotic device or the carrier device. The method further includes synchronising operations of the first set of four electric motors at the four anchor points and the fifth electric motor at either of the robotic device or the carrier device to permit the robotic device to be moved from a current location to a target location within the volume.
In yet another aspect, the present disclosure provides a non-transitory computer readable medium having computer-executable instructions stored thereon. These computer-executable instructions when executed by a processor cause the processor to determine a current location of a robotic device within a volume, calculate a route between the current location of the robotic device and a target location based on depth related obstacle information output by a depth detecting sensor, compute parameters including a number of rotation steps (nrot), a direction of rotation (dir), and a speed of rotation (θ) for a first set of four electric motors provided at four anchor points on four upright support members to move a carrier device moveably connected to the first set of four electric motors and a fifth electric motor on either of a robotic device or the carrier device moveably connected to the carrier device, and move the robotic device from a current location to a target location within the volume by synchronising operations of the first set of electric motors provided at the four anchor points and the fifth electric motor on either of the robotic device or the carrier device based, at least in part, on the depth related obstacle information and the computed parameters for each of the electric motors.
It will be appreciated that features of the present disclosure are susceptible to being combined in various combinations without departing from the scope of the present disclosure as defined by the appended claims.
The summary above, as well as the following detailed description of illustrative embodiments, is better understood when read in conjunction with the appended drawings. For the purpose of illustrating the present disclosure, exemplary constructions of the disclosure are shown in the drawings. However, the present disclosure is not limited to specific methods and instrumentalities disclosed herein. Moreover, those in the art will understand that the drawings are not to scale. Wherever possible, like elements have been indicated by identical numbers.
In the accompanying drawings, an underlined number is employed to represent an item over which the underlined number is positioned or an item to which the underlined number is adjacent. A non-underlined number relates to an item identified by a line linking the non-underlined number to the item. When a number is non-underlined and accompanied by an associated arrow, the non-underlined number is used to identify a general item at which the arrow is pointing.
The following detailed description illustrates embodiments of the present disclosure and ways in which they can be implemented. Although the best mode of carrying out the present disclosure has been disclosed, those skilled in the art would recognize that other embodiments for carrying out or practicing the present disclosure are also possible.
In embodiments herein, the projection of the anchor points 101 onto the ground G represents the vertices of a convex quadrilateral. Although, the aerial module 107 is shown to include four anchor points 101 mounted on top of four upright members 105, a person skilled in the art will acknowledge that the present disclosure can be similarly applied in cases where, or when, the aerial module 107 includes less than or more than four anchor points as well.
The aerial module 107 includes a carrier device 103 coupled to a first set of four electric motors 111a, 111b, 111c, and 111d mounted at the four anchor points 101 through a set of first wires 102 (hereinafter individually referred to as ‘the first wire’ and denoted using identical numeral ‘102’). In an example, each of these electric motors 111a, 111b, 111c, and 111d may be implemented by use of a direct current (DC) stepper motor. For sake of brevity, the first set of four electric motors 111a-111d will hereinafter be individually referred to as ‘the first electric motor’, or collectively as ‘the first set of electric motors’ or ‘the four electric motors’ and denoted using reference numeral ‘111’). Each of the four electric motors 111 includes a rotor (not shown). Each rotor (not shown) is coupled with a first end of the first wire 102, which is arranged so that the rest of the wire 102 is at least partly wrapped around the rotor. The other end of each wire 102 is coupled with the carrier device 103.
The carrier device 103 is adapted to operably move within a bounded horizontal plane 121 defined by the elevated anchor points 101. This movement is achieved through the activation of the electric motors 111 at the anchor points 101 to cause the first wire 102 coupled to each electric motor 111 to be further wound or unwound from the rotor of the electric motor 111, thereby shortening or lengthening each first wire 102.
The aerial module 107 further includes a robotic device 106 coupled to the carrier device 103 through a second wire 109. Thus, the set of first wires 102, the upright members 105 and the ground G effectively define a volume 104 within which the robotic device 106 resides, or moves.
The robotic device 106 is adapted to move vertically relative to the carrier device 103. This movement is achieved through the activation of a fifth electric motor 113 provided to either of the carrier device 103 or the robotic device 106 to cause the second wire 109 coupled to a rotor of the fifth electric motor 113 to be further wound, or unwound, from the rotor of the fifth electric motor 113, thereby shortening or lengthening the second wire 109. In an example, the fifth electric motor 113 may be implemented by use of a direct current (DC) stepper motor.
A control unit 114 is coupled to the first set of four electric motors 111 at the four anchor points 101 and the fifth electric motor 113 at either of the carrier device 103 or the robotic device 106 for controlling a three-dimensional movement of the robotic device 106 to permit navigation from a current location to a target location inside the defined volume 104. The control unit 114 may be implemented as one or more microprocessors, microcomputers, microcontrollers, digital signal processors, logic circuitries, and/or any devices that manipulate data based on one or more instructional codes. The control unit 114 may be implemented as a combination of hardware and software, for example, programmable instructions that are consistent with implementation of one or more functionalities disclosed herein.
While
In an embodiment of the present disclosure, the current location of the robotic device 106 is to be determined by the control unit 114. The operations of each of the electric motors 111, 113 at respective ones of the anchor points 101 and the robotic device 106 are synchronized, by the control unit 114 using a shared real-time synchronization interface 116 therein, to allow the robotic device 106 to navigate from the current location and reach the target location within the defined volume 104.
In an embodiment of the present disclosure, to implement navigation of the robotic device 106, the 3D movement of the robotic device 106 is decomposed into movement in two planes to deliver horizontal and vertical movement respectively. The horizontal movement is achieved by moving the carrier device 103 in the bounded horizontal plane 121. The vertical movement is achieved by moving the robotic device 106 in a vertical plane (not shown) perpendicular to the bounded horizontal plane 121. A maximum extent of the vertical plane is bounded between the ground G and the bounded horizontal plane 121, and thereafter, width-wise between the four upright members 105.
A current position of the carrier device 103 in the CDRS plane 301 is shown as a point A whose coordinates are (xA, yA). This point A is connected to the vertices P1, P2, P3 and P4 by line segments of length l1, l2, l3 and l4 respectively, where these lengths correspond with the lengths of the first wires 102 moveably supporting the carrier device 103.
In an embodiment of the present disclosure, the location of the robotic device 106 within the volume 104 is defined by the following parameters:
The CDRS plane 301 is defined in the bounded horizontal plane 121 and, as shown, has the origin O located in the same point as the first anchor point P1 302. A first primary axis (the Ox axis) of the CDRS plane 301 is defined by a line connecting the first anchor point P1 to a second anchor point P2. The second primary axis (the Oy axis) of the CDRS plane 301 is defined by a line orthogonally arranged to the Ox axis and intersecting the Ox axis at the origin O.
The first vertex P1 corresponds to the origin O of the CDRS plane 301. Thus, xP1=0 and yP1=0. From this, it can also be inferred that yP2=0. The remaining coordinates of the second and third vertices P2 and P3 are computed based on known distances {dP1P2, dP2P3, dP3P4, dP1P4} between the four anchor points 101. More specifically,
xP4 is computed then from the triangles P1P4P′4 (wherein P′4 is the projection of the P4 vertex onto the Ox axis of the CDRS plane 301) and P4P3P′3 as follows:
From:
x
P
2
+y
P
2
=d
P
P
2, and (5)
(xP
y
P
=√{square root over (dP
x
P
2−2xP
x
P
2−2xP
−2(xP
Where
k=d
P
P
2
−d
P
P
2
+x
P
2
+y
P
2 (11)
2yP
4yP
4(xP
Referring back to
l
1
2
=x
A
2
+y
A
2 (15)
l
2
2=(xP2−xA)2+yA2 (16)
Combining the two expressions (15) and (16), the coordinates (xA, yA) of the start point A can be established as follows:
The lengths l3 and l4 may be derived in an analogous fashion from the vertices P3 and P4.
With combined reference to
l′
1=√{square root over (xA′2+yA′2)} (21)
l′
2=√{square root over ((xP
l′
3=√{square root over ((xP
l′
4=√{square root over ((xP
Referring back to
In an embodiment of the present disclosure, the control unit 114 is configured to compute parameters for each electric motor 111 to cause movement of the carrier device 103 along the navigation route, or trajectory, from the start point A to the end point A′ in the CDRS plane 301 as shown in the views of
diri=sign(li−l′i) (26)
Each local computing device may be provided with a buffer. Using the above equations, the control unit 114 may calculate the movement parameters (nroti, diri and θi) for each electric motor 111 and communicate the movement parameters for a given electric motor 111 to the local computing device associated therewith. The local computing device may store the movement parameters (nroti, diri and θi) in its buffer.
In an embodiment of the present disclosure, synchronisation of movements of all electric motors is achieved through their connection through a real-time synchronization interface such as, for example, with use of an EtherCAT microchip to allow the carrier device 103 to be moved at a pre-defined speed ξ (e.g. ξ=0.1 m/s). The pre-defined speed and direction of travel computed by the control unit 114 for the robotic device 106 may take into account a balance, for instance, between one or more imperatives including, but not limited to, reducing travel time subject to the constraints imposed by the physical limitations of the aerial module 107; or executing smooth starting and stopping of the robotic device 106 whilst ensuring safe movement of the robotic device 106 within the volume of the aerial module 107.
As each local computing device is synchronized through the shared real-time synchronization interface 116 of the control unit 114 to ensure simultaneous yet independent control and operation of the respective electric motors, it is to be understood that the set of first wires 102 moveably connecting each anchor point 101 to the carrier device 103 is maintained taut by mutually optimized speeds, directions and numbers of rotation executed by corresponding ones of the electric motors via the computed parameters (nroti, diri and θi). However, it is hereby contemplated that in alternative embodiments of the present disclosure, the set of first wires 101 may not be taut, rather, the carrier device 103 may be partially suspended in relation to the bounded horizontal plane 121 using pre-computed slack willfully, or deliberately, imparted to one or more of the first wires 101, as computed by the control unit 114 depending upon specific requirements of an application.
With execution of a navigation algorithm by the control unit 114, the system's movements are expanded from the bounded horizontal plane 121 to the volume 104, that is, the system movements may be expanded from the CDRS plane 301 to the volume 104. Specifically, the robotic device 106 may be lowered/raised from its current altitude HCD to a target height zT (being the altitude of the robotic device 106 at the target location corresponding to the end point A′ indicated in
In an embodiment of the present disclosure, equipped with the foregoing formulation, a closed loop control system (including for example, model-based predictive control mechanisms) may be implemented to adapt the parameters for movement of each electric motor from the first set of four electric motors and the fifth electric motor in real time to confirm with curvilinear kinematics. Such adaptation would allow the robotic device 106 to autonomously implement 3D curvilinear trajectories including spiral, conchoid, helical and hemispherical flight paths. Furthermore, the above formulation supports adaptive control of velocity during different stages of the curvilinear trajectory, such that the robotic device 106 accelerates/decelerates to different velocities at different stages of the curvilinear trajectory. These features would enable the aerial module 107 to be implemented for use in enhanced autonomous reconnaissance and surveillance applications. Example use cases may include, but are not limited to, detailed sweep-in views of a surveyed scene, adaptive top down and side-ways views of stacked or tall items (for example, pallets in a warehouse facility), or items partially obscured by one or more obstacles, and tracking of subjects moving in a curvilinear path.
Moreover, referring to
As shown, at step 602, the method 600 includes providing four upright members 105 supported by the ground G and mounting top portions of the four upright members 105 with the four anchor points 101 respectively at the substantially same height h from the ground G.
At step 604, the method 600 further includes providing an electric motor from the first set of four electric motors 111 and a wire from the set of first wires 102 to each of the four anchor points 101 to operably support movement of the carrier device 103 in the bounded horizontal plane 121 defined by the four anchor points 101.
At step 606, the method 600 further includes suspending the robotic device 106 from the carrier device 103 using the second wire 107 such that the robotic device 106 is moveable within the volume 104 defined between the ground surface G and the bounded horizontal plane 121 by a fifth electric motor 113 of either of the carrier device 103 or the robotic device 106.
At step 608, the method 600 includes synchronising operations of the first set of four electric motors 111 at the four anchor points 101 and the fifth electric motor 113 at either of the carrier device 103 or the robotic device 106 to permit the robotic device 106 to be moved from its current location to the target location within the volume 104.
In an embodiment, the method 600 includes providing the mechanical grabbing claw 201 and the sixth electric motor 203 to the robotic device 106. The mechanical grabbing claw 203 is operated by the sixth electric motor 201 to catch, hold and release the desired payload.
In an embodiment, the method 600 includes computing parameters for each of the four electric motors 111 at respective anchor points 104 to cause movement of the carrier device 103 from the start point A to the end point A′ in the bounded horizontal plane 121 in which the movement of the carrier device 103 is achieved by varying a length of at least three wires 102 from the set of first wires 102. Further, in this embodiment, the method 600 also includes computing parameters for the fifth electric motor 113 at either of the robotic device 106 or the carrier device 106 to cause the robotic device 106 to vertically move from its current altitude HCD to the target height zT. As disclosed earlier herein, the target height zT is the altitude of the robotic device 106 at the target location corresponding to the end point A′ of the carrier device 103 in the bounded horizontal plane 121. The movement of the robotic device 106 is achieved by varying a length of the second wire 109.
In an embodiment, the method 600 includes determining the current location of the robotic device 106 within the volume 104, and calculating a route between the current location and the target location of the robotic device 106. The method 600 further includes calculating, by the control unit 114, the route for the robotic device 106 based, in part, on the computed parameters and the depth related obstacle information output by the depth detecting sensor with the depth detecting sensor being positioned on the robotic device 106.
In an embodiment, the method 600 further includes computing at least three parameters for the movement of the robotic device 106 within the volume 104, and wherein the at least three parameters include the number of rotation steps (nrot), the direction of rotation (dir), and the speed of rotation (θ) for each of the electric motors from the first set of electric motors 111 and the fifth electric motor 113. Further, the method 600 also includes moving the carrier device 103 at a pre-defined speed and direction within the volume 104 by synchronizing individual movements of the electric motors 111 in real-time based on the at least three computed parameters.
It is hereby contemplated that functions consistent with the present disclosure can be embodied as one or more computer-executable software instructions or code that may be stored on a non-transitory computer readable medium. It should be noted that the control unit 114 of the present disclosure may also include one or more processors, micro-processors, controllers, micro-controllers, actuators and the like to individually, or collectively, control operation of the various electric motors in a manner consistent with the present disclosure. These processors, micro-processors, controllers, micro-controllers, actuators and the like may be readily embodied in the form of general purpose computers or application specific controllers that can be readily implemented for use in facilitating operation of the control unit 114 disclosed herein. These software instructions when executed by a processor of the control unit 114 can cause the processor to determine the current location of the robotic device 106 within the volume 104, calculate the route between the current location and the target location of the robotic device 106, and synchronise operations of the electric motors 111, 113 at the anchor points 104 of the upright support members 103 and the carrier device 103 for moving the robotic device 106 from its current location to the target location within the volume 104.
Modifications to embodiments of the present disclosure described in the foregoing are possible without departing from the scope of the present disclosure as defined by the accompanying claims. Expressions such as “including”, “comprising”, “incorporating”, “consisting of”, “have”, “is” used to describe and claim the present disclosure are intended to be construed in a non-exclusive manner, namely allowing for items, components or elements not explicitly described also to be present. Reference to the singular is also to be construed to relate to the plural.
This application claims priority to and the benefit of U.S. Provisional Application Ser. No. 63/034,155, filed Jun. 3, 2020, U.S. Provisional Application Ser. No. 63/034,165, filed Jun. 3, 2020, and U.S. Provisional Application Ser. No. 63/043,816, filed Jun. 25, 2020, the entire disclosures of which are hereby incorporated by reference.
Number | Date | Country | |
---|---|---|---|
63043816 | Jun 2020 | US | |
63034155 | Jun 2020 | US | |
63034165 | Jun 2020 | US |