This disclosure relates to identifying stairs from footfalls.
A robot is generally defined as a reprogrammable and multifunctional manipulator designed to move material, parts, tools, or specialized devices through variable programmed motions for a performance of tasks. Robots may be manipulators that are physically anchored (e.g., industrial robotic arms), mobile robots that move throughout an environment (e.g., using legs, wheels, or traction based mechanisms), or some combination of a manipulator and a mobile robot. Robots are utilized in a variety of industries including, for example, manufacturing, transportation, hazardous environments, exploration, and healthcare. As such, the ability of robots to traverse environments with obstacles or features requiring various means of coordinated leg movement provides additional benefits to such industries.
One aspect of the disclosure provides a method of identifying stairs from footfalls. The method includes receiving, at data processing hardware, a plurality of footfall locations of a robot traversing an environment. Here, each respective footfall location indicates a location where a leg of the robot contacted a support surface beneath the robot. The method also includes determining, by the data processing hardware, a plurality of candidate footfall location pairs based on the plurality of footfall locations. The candidate footfall location pair may also include a respective first candidate footfall location and a respective second candidate footfall location. The method also includes clustering, by the data processing hardware, the respective first candidate footfall location into a first respective cluster group based on a height of the respective first candidate footfall location. The method further includes clustering, by the data processing hardware, the respective second candidate footfall location into a second respective cluster group based on a height of the respective second candidate footfall location. The method additionally includes generating, by the data processing hardware, a stair model by representing each of the cluster groups as a corresponding stair among a set of stairs in the robot environment and delineating each stair based on a respective midpoint between each adjacent cluster group. Implementations of the disclosure may include one or more of the following optional features. In some examples, the method may further include for each pair of adjacent footfall locations defined by a respective first footfall location and a respective second footfall location adjacent to the respective first footfall location in position among the plurality of footfall locations, determining, by the data processing hardware, whether a vertical distance between the respective first footfall location and the respective second footfall location satisfies a stair height threshold, the stair height threshold corresponding to a height of a stair riser. In some configurations the method also includes determining, by the data processing hardware, whether a horizontal distance between the respective first footfall location and the respective second footfall location satisfies a stair depth threshold where the stair depth threshold corresponds to a depth of a stair tread. Optionally, when both (i) the vertical distance satisfies the stair height threshold and (ii) the horizontal distance satisfies the stair depth threshold, the method may include identifying, by the data processing hardware, the respective pair of adjacent footfall locations as a respective one of the plurality of candidate footfall location pairs.
In some implementations, a plurality of cluster groups indicate an orientation for the stair model, the orientation corresponding to a vector direction that a set of stairs ascend or descend within the environment. Here, after clustering each of the respective first and second footfall locations into the respective cluster groups for each candidate footfall location pair of the plurality of candidate pairs, the method may include identifying, by the data processing hardware, among the respective cluster groups, a first cluster group and a second cluster group adjacent to the first cluster group, the identified first and second clustered groups each may include one or more respective candidate footfall locations. The method further includes determining, by the data processing hardware, a respective first candidate footfall location among the one or more candidate footfall locations in the first cluster group and a respective second candidate footfall location among the one or more candidate footfall locations in the second cluster group, the respective first candidate footfall location separated by a minimum horizontal distance from the respective second candidate footfall location, and generating, by the data processing hardware, a stair edge for the stair model at a horizontal midpoint between the identified respective first candidate footfall location in the first cluster group and the identified respective second candidate footfall location in the second cluster group. Optionally, a plurality of cluster groups indicate an orientation for the stair model, the orientation corresponding to a vector direction that a set of stairs ascend or descend within the environment, and the stair edge extending in a direction perpendicular to the vector direction of the orientation for the plurality of cluster groups.
Additionally, the method may include communicating, by the data processing hardware, the stair model to a control system for the robot to navigate the stairs represented by the stair model in an autonomous drive mode. The method further includes, after generating the stair model, while the robot traverses the environment, detecting, by the data processing hardware, that the robot is approaching a location represented by the stair model and orienting, by the data processing hardware, the robot to an orientation for the stair model, the orientation corresponding to a vector direction that the set of stairs ascend or descend within the environment. In some examples, orienting the robot may include directing sensors on the robot to face the vector direction defined by the stair model. The method may include augmenting, by the data processing hardware, a perception map of the environment with the stair model. In some implementations, the robot is a quadruped robot.
Another aspect of the disclosure provides a robot configured to identify stairs from footfalls. The robot includes a body, two or more legs coupled to the body and configured to traverse an environment, and a stair modeling system in communication with the robot. The modeling system includes data processing hardware and memory hardware in communication with the data processing hardware, the memory hardware storing instructions that when executed on the data processing hardware cause the data processing hardware to perform operations. The operations include receiving a plurality of footfall locations of the two or more legs traversing the environment, each respective footfall location indicating a location where one of the two of more legs of the robot contacted a support surface beneath the robot. The operations also include determining a plurality of candidate footfall location pairs based on the plurality of footfall locations, each candidate footfall location pair including a respective first candidate footfall location and a respective second candidate footfall location. For each candidate footfall location pair of the plurality of candidate footfall location pairs, the operations additionally include clustering the respective first candidate footfall location into a first respective cluster group based on a height of the respective first candidate footfall location and clustering the respective second candidate footfall location into a second respective cluster group based on a height of the respective second candidate footfall location. The operations also includes generating a stair model by representing each of the cluster groups as a corresponding stair among a set of stairs in the robot environment and delineating each stair based on a respective midpoint between each adjacent cluster group. Implementations of the disclosure may include one or more optional features. In some implementations, for each pair of adjacent footfall locations defined by a respective first footfall location and a respective second footfall location adjacent to the respective first footfall location in position among the plurality of footfall locations, the operations include determining whether a vertical distance between the respective first footfall location and the respective second footfall location satisfies a stair height threshold, the stair height threshold corresponding to a height of a stair riser. The operations also include determining whether a horizontal distance between the respective first footfall location and the respective second footfall location satisfies a stair depth threshold, the stair depth threshold corresponding to a depth of a stair tread and when both (i) the vertical distance satisfies the stair height threshold and (ii) the horizontal distance satisfies the stair depth threshold, identifying the respective pair of adjacent footfall locations as a respective one of the plurality of candidate footfall location pairs.
In some examples, a plurality of cluster groups indicate an orientation for the stair model where the orientation corresponding to a vector direction that a set of stairs ascend or descend within the environment. In some configurations, after clustering each of the respective first and second footfall locations into the respective cluster groups for each candidate footfall location pair of the plurality of candidate pairs, the operations also include identifying among the respective cluster groups, a first cluster group and a second cluster group adjacent to the first cluster group. In these examples, the identified first and second clustered groups each may include one or more respective candidate footfall locations. Here, the operations may further include determining a respective first candidate footfall location among the one or more candidate footfall locations in the first cluster group and a respective second candidate footfall location among the one or more candidate footfall locations in the second cluster group. Additionally or alternatively, the operations may also include a respective first candidate footfall location separated by a minimum horizontal distance from the respective second candidate footfall location and generating a stair edge for the stair model at a horizontal midpoint between the identified respective first candidate footfall location in the first cluster group and the identified respective second candidate footfall location in the second cluster group.
In some configurations, a plurality of cluster groups indicate an orientation for the stair model where the orientation corresponds to a vector direction that a set of stairs ascend or descend within the environment. Here, the stair edge extends in a direction perpendicular to the vector direction of the orientation for the plurality of cluster groups. The operations further may include communicating the stair model to a control system for the robot to navigate the stairs represented by the stair model in an autonomous drive mode. The operations further may include, after generating the stair model, while the robot traverses the environment, detecting that the robot is approaching a location represented by the stair model and orienting the robot to an orientation for the stair model, the orientation corresponding to a vector direction that the set of stairs ascend or descend within the environment. Orienting the robot may include directing sensors on the robot to face the vector direction defined by the stair model. Optionally, the operations may include augmenting a perception map of the environment with the stair model. In some examples, the two or more legs may include four legs defining a quadruped robot.
The details of one or more implementations of the disclosure are set forth in the accompanying drawings and the description below. Other aspects, features, and advantages will be apparent from the description and drawings, and from the claims.
Like reference symbols in the various drawings indicate like elements.
As legged-robots maneuver about environments, the robots may encounter terrain (e.g., human-made structures) that requires precise leg movement and foot placement (i.e., distal end placement). To provide precise leg movement and foot placement, when systems of the robot recognize different types of terrain, the movement control systems of the robot may constrain the robot's movement to traverse the terrain in order to prevent mistakes, even small mistakes, which may lead to catastrophic issues for the robot. For example, when humans traverse stairs, this task requires a degree of coordination (e.g., eye-to-foot coordination). Without the coordination, a human may misstep, slip, trip, or fall on the stairs. Robots may encounter the same misfortunes, but lack natural coordination. Therefore, robots need systems and methods to coordinate precise leg movements.
Stairs 20, 20a-n generally refer to a group of more than one stair 20 (i.e., a group of n stairs 20) designed to bridge a vertical distance. To bridge the vertical distance, stairs 20a-n typically run a horizontal distance with a given rise in vertical height over a pitch (or pitch line). Each stair 20 traditionally includes a tread 22 and a riser 24. The tread 22 of a stair 20 refers to a horizontal part of the stair 20 that is stepped on while a riser 24 refers to a vertical portion of the stair 20 between each tread 22. The tread 22 of each stair 20 spans a tread depth “d” measuring from an outer edge 26 of a stair 20 to the riser 24 between stairs 20. For a residential, a commercial, or an industrial structure, some stairs 20 also include nosing as part of the edge 26 for safety purposes. Nosing, as shown in
Stair-like terrain more generally refers to terrain that varies in height over some distance. Stair-like terrain may resemble stairs in terms of a change in elevation (e.g., an inclined pitch with a gain in elevation or a declined pitch with a loss in elevation). However, with stair-like terrain the delineation of treads 22 and risers 24 is not as obvious. Rather, stair-like terrain may refer to terrain with tread-like portions that allow a robot to have enough traction to plant a stance limb and sequentially or simultaneously use a leading limb to ascend or to descend over an adjacent vertical obstruction (resembling a riser) within the terrain. For example, stair-like terrain my include rubble, an inclined rock scramble, damaged or deteriorating traditional stairs, etc.
Referring to
In order to traverse the terrain, each leg 120 has a distal end 124 that contacts a surface 12 of the terrain (i.e., a traction surface). In other words, the distal end 124 of the leg 120 is the end of the leg 120 used by the robot 100 to pivot, plant, or generally provide traction during movement of the robot 100. For example, the distal end 124 of a leg 120 corresponds to a foot of the robot 100. In some examples, though not shown, the distal end 124 of the leg 120 includes an ankle joint JA such that the distal end 124 is articulable with respect to the lower member 122L of the leg 120.
The robot 100 has a vertical gravitational axis (e.g., shown as a Z-direction axis AZ) along a direction of gravity, and a center of mass CM, which is a point where the weighted relative position of the distributed mass of the robot 100 sums to zero. The robot 100 further has a pose P based on the CM relative to the vertical gravitational axis AZ (i.e., the fixed reference frame with respect to gravity) to define a particular attitude or stance assumed by the robot 100. The attitude of the robot 100 can be defined by an orientation or an angular position of the robot 100 in space. Movement by the legs 120 relative to the body 110 alters the pose P of the robot 100 (i.e., the combination of the position of the CM of the robot and the attitude or orientation of the robot 100). Here, a height (i.e., vertical distance) generally refers to a distance along (e.g., parallel to) the z-direction (i.e., z-axis AZ). The sagittal plane of the robot 100 corresponds to the Y-Z plane extending in directions of a y-direction axis AY and the z-direction axis AZ. In other words, the sagittal plane bisects the robot 100 into a left and right side. Generally perpendicular to the sagittal plane, a ground plane (also referred to as a transverse plane) spans the X-Y plane by extending in directions of the x-direction axis AX and the y-direction axis AY. The ground plane refers to a support surface 12 where distal ends 124 of the legs 120 of the robot 100 may generate traction to help the robot 100 move about the environment 10. Another anatomical plane of the robot 100 is the frontal plane that extends across the body 110 of the robot 100 (e.g., from a left side of the robot 100 with a first leg 120a to a right side of the robot 100 with a second leg 120b). The frontal plane spans the X-Z plane by extending in directions of the x-direction axis AX and the z-direction axis Az.
When a legged-robot moves about the environment 10, the legs 120 of the robot undergo a gait cycle. Generally, a gait cycle begins when a leg 120 touches down or contacts a support surface 12 and ends when that same leg 120 once again contacts the ground surface 12. Here, touchdown is also referred to as a footfall defining a point or position where the distal end 124 of a locomotion-based structure 120 falls into contact with the support surface 12. The gait cycle may predominantly be divided into two phases, a swing phase and a stance phase. During the swing phase, a leg 120 performs (i) lift-off from the support surface 12 (also sometimes referred to as toe-off and the transition between the stance phase and swing phase), (ii) flexion at a knee joint JK of the leg 120, (iii) extension of the knee joint JK of the leg 120, and (iv) touchdown (or footfall) back to the support surface 12. Here, a leg 120 in the swing phase is referred to as a swing leg 120SW. As the swing leg 120SW proceeds through the movement of the swing phase 120SW, another leg 120 performs the stance phase. The stance phase refers to a period of time where a distal end 124 (e.g., a foot) of the leg 120 is on the support surface 12. During the stance phase a leg 120 performs (i) initial support surface contact which triggers a transition from the swing phase to the stance phase, (ii) loading response where the leg 120 dampens support surface contact, (iii) mid-stance support for when the contralateral leg (i.e., the swing leg 120SW) lifts-off and swings to a balanced position (about halfway through the swing phase), and (iv) terminal-stance support from when the robot's COM is over the leg 120 until the contralateral leg 120 touches down to the support surface 12. Here, a leg 120 in the stance phase is referred to as a stance leg 120ST.
In order to maneuver about the environment 10, the robot 100 includes a sensor system 130 with one or more sensors 132, 132a-n (e.g., shown as a first sensor 132, 132a and a second sensor 132, 132b). The sensors 132 may include vision/image sensors, inertial sensors (e.g., an inertial measurement unit (IMU)), force sensors, and/or kinematic sensors. Some examples of sensors 132 include a camera such as a stereo camera, a scanning light-detection and ranging (LIDAR) sensor, or a scanning laser-detection and ranging (LADAR) sensor. In some configurations, the robot 100 includes two stereo cameras as sensors 132 at a front end of the body 110 of the robot 100 (i.e., a head of the robot 100 adjacent the front legs 120a-b of the robot 100) and one stereo camera as a sensor 132 at a back end of the body 110 of the robot 100 adjacent rear legs 120c-d of the robot 100. In some examples, the sensor 132 has a corresponding field(s) of view Fv defining a sensing range or region corresponding to the sensor 132. For instance,
Referring to
When surveying a field of view FV with a sensor 132, the sensor system 130 generates sensor data 134 (also referred to as image data) corresponding to the field of view FV. In some examples, the sensor data 134 is image data that corresponds to a three-dimensional volumetric point cloud generated by a three-dimensional volumetric image sensor 132. Additionally or alternatively, when the robot 100 is maneuvering about the environment 10, the sensor system 130 gathers pose data for the robot 100 that includes inertial measurement data (e.g., measured by an IMU). In some examples, the pose data includes kinematic data and/or orientation data about the robot 100, for instance, kinematic data and/or orientation data about joints J or other portions of a leg 120 of the robot 100. With the sensor data 134, a perception system 180 of the robot 100 may generate maps 182 for the terrain about the environment 10.
While the robot 100 maneuvers about the environment 10, the sensor system 130 gathers sensor data 134 relating to the terrain of the environment 10 and/or structure of the robot 100 (e.g., joint dynamics and/or odometry of the robot 100). For instance,
With continued reference to
Additionally or alternatively, the computing system 140 includes computing resources that are located remotely from the robot 100. For instance, the computing system 140 may communicate via a network 150 with a remote system 160 (e.g., a remote computer/server or a cloud-based environment). Much like the computing system 140, the remote system 160 includes remote computing resources such as remote data processing hardware 162 and remote memory hardware 164. Here, sensor data 134 or other processed data (e.g., data processing locally by the computing system 140) may be stored in the remote system 160 and may be accessible to the computing system 140. In some examples, the computing system 140 is configured to utilize the remote resources 162, 164 as extensions of the computing resources 142, 144 such that resources of the computing system 140 may reside on resources of the remote system 160.
In some implementations, as shown in
In some examples, the control system 170 includes at least one controller 172, a path generator 174, a step locator 176, and a body planner 178. The control system 170 may be configured to communicate with at least one sensor system 130 and any other system of the robot 100 (e.g., the perception system 180, the odometry system 190, and/or the stair modeler 200). The control system 170 performs operations and other functions using hardware 140. The controller 172 is configured to control movement of the robot 100 to traverse about the environment 10 based on input or feedback from the systems of the robot 100 (e.g., the control system 170, the perception system 180, the odometry system 190, and/or the stair modeler 200). This may include movement between poses and/or behaviors of the robot 100. For example, the controller 172 controls different footstep patterns, leg patterns, body movement patterns, or vision system sensing patterns.
In some examples, the controller 172 includes a plurality of controllers 172 where each of the controllers 172 has a fixed cadence. A fixed cadence refers to a fixed timing for a step or swing phase of a leg 120. For example, the controller 172 instructs the robot 100 to move the legs 120 (e.g., take a step) at a particular frequency (e.g., step every 250 milliseconds, 350 milliseconds, etc.). With a plurality of controllers 172 where each controller 172 has a fixed cadence, the robot 100 can experience variable timing by switching between controllers 172. In some implementations, the robot 100 continuously switches/selects fixed cadence controllers 172 (e.g., re-selects a controller 170 every 3 milliseconds) as the robot 100 traverses the environment 10.
In some implementations, the control system 170 includes specialty controllers 172 that are dedicated to a particular control purpose. For example, the control system 170 may include one or more stair controllers 172 dedicated to planning and coordinating the robot's movement to traverse a set of stairs 20. For instance, a stair controller 172 may ensure the footpath for a swing leg 120SW maintains a swing height to clear a riser 24 and/or edge 26 of a stair 20. Other specialty controllers 172 may include the path generator 174, the step locator 176, and/or the body planner 178. Referring to
The perception system 180 is a system of the robot 100 that helps the robot 100 to move more precisely in a terrain with various obstacles. As the sensors 132 collect sensor data 134 for the space about the robot 100 (i.e., the robot's environment 10), the perception system 180 uses the sensor data 134 to form one or more maps 182 for the environment 10. Once the perception system 180 generates a map 182, the perception system 180 is also configured to add information to the map 182 (e.g., by projecting sensor data 134 on a preexisting map) and/or to remove information from the map 182.
Referring further to
In some configurations, the robot 100 is configured to traverse the environment 10 autonomously. For example, the robot 100 has an autonomous mode that, when engaged (e.g., by an operator of the robot 100), allows the system(s) of the robot 100 to operate the robot 100 to move about the environment 10 and/or perform actions within the environment 10 without further input from an external source (e.g., an entity that operates or supervisors the robot 100 by providing inputs to the robot 100). In order to engage the autonomous mode, the robot 100 first surveys the environment 10 to generate one or more maps 182 using the perception system 180. In other words, prior to the autonomous mode, the robot 100 undertakes a mapping process to collect sensor data 134 of the environment 10 that will be autonomously or semi-autonomously traversed. In some examples, an operator manually drives the robot 100 (i.e., moves the robot 100 by user input) through the environment 10 (e.g., using a remote controller 172). By the robot 100 first gathering its surroundings in the environment 10, the mapping process provides environmental context to systems of the robot 100 to enable the systems to autonomously operate the robot 100.
Generally speaking, the mapping process calibrates the robot 100 to features in the environment 10; allowing the robot 100 to have the ability to autonomously or semi-autonomously operate subsequent to the mapping process. Here, semi-autonomously refers to the ability of the robot 100 to perform certain tasks (e.g., specialized tasks) independent of external inputs. For example, the robot 100 has a stair mode where the robot 100 is able to traverse stairs without external inputs or a palletizing mode where the robot 100 packs or unpacks boxes in an independent manner. In some configurations, an operator of the robot 100 identifies (e.g., turns on a mode of the robot 100) that he or she wishes to operate the robot 100 autonomously or semi-autonomously (e.g., for specialized autonomous activities). Once the robot 100 receives such an identification, systems associated with the robot 100 may prompt the operator to perform the initial mapping process if it has not been previously performed by the robot 100.
During the initial mapping process, there are particular features in the environment 10 that the robot 100 is trying to recognize. One of these features is stairs 20. Particularly, stairs 20 are a feature that may affect the robot's navigation of an environment 10. For instance, stairs 20 may pose a sudden hazard to the robot 100 when the robot 100 encounters stairs 20. If the robot 100 approaches the stairs 20 from above and did not know ahead of time that the stairs 20 existed, the robot 100 may not have much time to decide whether the sudden perceived drop-off in elevation is actually safe for the robot 100 to navigate. For example, the robot 100 while navigating a hallway suddenly approaches the end of the hallway and first perceives that stairs 20 ascend/descend from a doorway perpendicular to the end of the hallway. With sensors 132 unable to see through walls, the walls of the hallway would make the stairs 20 directly off the hallway seem invisible to the robot 100 until the robot 100 was located in front of the stairs 20. Depending to the gait of the robot 100 and/or speed of approach, sudden decision making by the robot 100 to navigate the stairs 20 may be problematic and/or dangerous for the robot 100 and/or its surroundings.
If instead, a robot 100 knew that it was approaching stairs 20, the robot 100 may prepare to navigate the stairs 20; increasing the robot's ability to navigate the stairs 20 successfully. In other words, the robot 100 may position its body 110, legs 120, or structure to improve navigation of the stairs 20. For instance, when the robot 100 approaches stairs 20, it may change the angles or heights of its sensors 132 to increase its capabilities to perceive the stairs 20 (e.g., avoid potential occlusions). The robot 100, with its sensors 132, may peer upwards, downwards, and/or change its body height to optimize its perception of the stair structure. In some examples, the robot 100 is configured to navigate the stairs 20 at a particular orientation or pose P (e.g., alignment) such that the robot 100 minimizes structural collisions with the stairs 20 themselves. As an example, the robot 100 descends stairs backwards (e.g., head up and rear legs 120 first) to prevent articulation of its locomotion structures 120 from colliding with the risers 24 of the stairs 20. Here, to descend the stairs 20 backwards, the robot 100 may need to turn around. In some implementations, the robot 100 may be configured to center itself with respect to the stairs 20 in order to provide the robot 100 with the greatest lateral space as the robot 100 ascends/descends stairs 20. Each of these particular alignments, used to improve the ability of the robot 100 to navigate the stairs 20, may be planned in advance when the initial mapping process identifies stairs 20 in the environment 10.
In some configurations, the robot 100 is able to automatically engage a stair mode for the robot 100. For example, when the robot 100 knows at least a rough location of stairs 20 within the environment 10, the robot 100 activates the stair mode when the robot 100 is adjacent to or within a threshold distance of the stairs 20. In some implementations, the robot 100 is configured to prevent or to warn a user or operator from engaging the stair mode when, based on the initial mapping process, the robot 100 is aware that the robot 100 is not within a particular range of stairs 20. By selectively activating the stair mode only when stairs 20 are imminent (e.g., within the threshold distance/range), the robot 100 may conserve processing resources (e.g., CPU usage) and/or intelligently use computing resources. For example, the robot 100 is aware that the robot 100 does not need to detect stairs 20 and optimizes its detection for other features in the environment 10.
With reference to
A footfall 128, much like a footprint, refers to a spatial location where a distal end 124 of a locomotion structure 120 of the robot 100 contacted the support surface 12. A footfall 128 may also be referred to interchangeably as a footfall location. In some examples, the footfall 128 corresponds to a touchdown for a foot 124 of a leg 120 of the robot 100. Since a footfall 128 includes a spatial location in the environment 10 where a touchdown occurred, the footfall 128 includes coordinate/odometry information to identify the location in the environment 10. The location information corresponding to a footfall 128 may be relative location information (e.g., relative to a position of a waypoint Wp or other feature in the environment 10) or global location information. For example, the footfall 128 has a three dimensional coordinate position relative to the global world reference frame (e.g., corresponds to an x, y, z location).
As footfalls 128 occur while the robot 100 traverses the environment 10 during the initial mapping process, systems (e.g., the sensor system 130, perception system 180, and/or odometry system 190) of the robot 100 are able to determine that a footfall 128 occurs and to store the footfall 128 (e.g., locational/contact information about the footfall 128 and/or the robot 100 at the time of the footfall 128). In some examples, each time a foot 124 of the robot 100 contacts a support surface 12, one or more sensors 132 of the robot 100 detect the contact as a footfall 128. In some implementations, systems (e.g., the perception system 180 and/or odometry system 190) of the robot 100 record footfalls 128 by querying sensor data 134 from contact detection sensors 132 (e.g., sensors 132 that measure forces experienced at the legs/feet 120, 124 of the robot 100) to determine whether a particular foot 124 of the robot 100 is in contact with a support surface 12 at the time of the query. When a sensor 132 indicates that a particular foot 124 is indeed in contact with a support surface 12, the systems of the robot 100 determine the location of the contact (e.g., in the world reference frame) and store this information along with the footfall 128. For example, the perception system 180 stores footfalls 128 in data structures associated with edges E for a map 182 generated during the initial mapping process.
Referring to
In some implementations, the parameters include a stair height threshold 214 and a stair depth threshold 216. When identifying a candidate pair 212 of footfalls 128, the identifier 210 determines whether the footfalls 128 satisfy each threshold 214, 216 before classifying the footfalls 128 as a candidate pair 212. For instance. The identifier 210 may determine whether the footfalls 128 satisfy these thresholds 214, 216 in either order (e.g., first the stair height threshold 214 and then the stair depth threshold 216 or vice versa). In order to determine whether the two footfalls 128 satisfy these thresholds 214, 216, the identifier 210 determines a locational position of each footfall 128 (e.g., x, y, z coordinate position) and determines a distance between each footfall 128 (e.g., with respect to each coordinate—Δx, Δy, Δz). Here, a height (e.g., vertical distance) generally refers to a measurement (e.g., Δz) in the z-direction along an axis parallel to a gravitational axis of the robot 100 while the depth (e.g., horizontal distance) refers to a measurement in the XY plane (e.g., Δx or Δy) that occurs perpendicular to the gravitation axis of the robot 100. With the distance between each footfall 128 of a potential candidate pair, the identifier 210 compares these distances to the appropriate thresholds 214, 216. For instance, the identifier 210 compares the height distance measurement between the footfalls 128 to the stair height threshold 214 and a depth distance measurement between the footfalls 128 to the stair depth threshold 216.
In some configurations, the stair height threshold 214 corresponds to a height range between a particular stair height minimum 204min and a stair height maximum 204max. In other words, based on the gait of robot 100 and/or the structural configuration of the robot 100, there is a particular height for the robot 100 where, above this height, the robot 100 needs to change its natural gait/swing trajectory to ensure clearance of the this height change for the foot 124 of the robot 100 while, below this height, the robot 100 does not need to alter its natural gait/swing trajectory. Due to this inherent swing trajectory, the stair detector 200 may be configured to ignore modeling a stair 20 when the height change is lower than the height minimum 204min. That is, although shallow stairs 20 with riser heights less than the height minimum 204min exist, these stairs 20 do not pose much of a navigability risk to the robot 100 and/or need special gait instructions. Similarly, due to range of motion limitations and/or gait limitations, there is a particular height above which the robot 100 cannot step without a more powerful movement (e.g., a jump). In other words, the robot 100 has a maximum swing height that ensures its feet 124 clear an object below this height. As such, a height greater than this height (i.e., the stair height maximum 204max), even if the height of a stair riser 24 (e.g., a large amphitheater stair), is an outlier height that stair detector 200 may be configured to ignore when modeling a stair 20. With the stair height minimum 204min and the stair height maximum 204max, the identifier 210 may configure the stair height threshold 214 as a range of height values between the stair height minimum 204min and the stair height maximum 204max. In other words, if the height measurement between two footfalls 128 is a between the stair height minimum 204min and the stair height maximum 204max, the height measurement satisfies the stair height threshold 214. In contrast, when the height measurement is greater than the stair height maximum 204max or less than the stair height minimum 204min, the height measurement fails to satisfy the stair height threshold 214.
Referring to
The stair detector 200 also includes a stair recognizer 220. The stair recognizer 220, is configured to, based on candidate pairs 212 of footfalls 128, determine stairs 20 corresponding to the footfalls 128 of the candidate pairs 212. Stated differently, the identifier 210 of the detector 200 is tasked with identifying footfalls 128 that occur on treads 22 of a stair 20 based positional data while the recognizer 220 is then configured to model each stair 20 for a stair model 202 based on clusters of footfalls 128 corresponding to candidate pairs 212. With this approach, the identifier 210 serves as a form of a filter that filters out footfalls 128 that likely do not exist on stairs 20 and the recognizer 220 constructs the model 202 based on the remaining filtered footfall data.
Referring to
Once the footfalls 128 from the candidate pairs 212 are defined by cluster groups 222, the recognizer 220 has established where it believes top surfaces for treads 22 of the stairs 20 to be, but the stair model 202 still lacks some form of horizontal delineation between each stair 20 in the model 202. In some examples, the recognizer 220 defines an edge 26 of each stair 20 to be where one cluster group 222 changes to its neighboring cluster group 222. For instance,
In some configurations, the model 202 designates an orientation for the stairs 20 of the model 202. In other words, the model 202 defines a vector direction VD for the stairs 20 of the model 202. Here, the vector direction VD refers to a vector that defines the direction and/or slope of the stairs 20 in three-dimensional space. When the robot 100 uses the model 202 navigating the environment 10, the robot 100 may orient itself or its sensors 132 with the vector direction VD to aid the robot 100 in perceiving the stairs 20 or aligning with the stairs 20. In some examples, the robot 100 navigates the stairs 20 better when the body 110 of the robot 100 is aligned with the vector direction VD than not. This alignment may afford the robot 100 the greatest lateral deviation while traversing the stairs 20 (e.g., by traversing the center of the stairs 20) and potentially prevent the robot 100 from colliding with the stair structure itself. In some configurations, in order to determine the vector direction VD, the recognizer 220 determines the center of each cluster group 222 (e.g., the centroids of the collection of footfalls 128 included in a cluster group 222). Here, the recognizer 220 define the vector direction VD as a vector extending from a cluster group 222 at a first end of a stair model 202 to a cluster group 222 at a second end of the stair model 202.
The computing device 400 includes a processor 410 (e.g., data processing hardware), memory 420 (e.g., memory hardware), a storage device 430, a high-speed interface/controller 440 connecting to the memory 420 and high-speed expansion ports 450, and a low speed interface/controller 460 connecting to a low speed bus 470 and a storage device 430. Each of the components 410, 420, 430, 440, 450, and 460, are interconnected using various busses, and may be mounted on a common motherboard or in other manners as appropriate. The processor 410 can process instructions for execution within the computing device 400, including instructions stored in the memory 420 or on the storage device 430 to display graphical information for a graphical user interface (GUI) on an external input/output device, such as display 480 coupled to high speed interface 440. In other implementations, multiple processors and/or multiple buses may be used, as appropriate, along with multiple memories and types of memory. Also, multiple computing devices 400 may be connected, with each device providing portions of the necessary operations (e.g., as a server bank, a group of blade servers, or a multi-processor system).
The memory 420 stores information non-transitorily within the computing device 400. The memory 420 may be a computer-readable medium, a volatile memory unit(s), or non-volatile memory unit(s). The non-transitory memory 420 may be physical devices used to store programs (e.g., sequences of instructions) or data (e.g., program state information) on a temporary or permanent basis for use by the computing device 400. Examples of non-volatile memory include, but are not limited to, flash memory and read-only memory (ROM)/programmable read-only memory (PROM)/erasable programmable read-only memory (EPROM)/electronically erasable programmable read-only memory (EEPROM) (e.g., typically used for firmware, such as boot programs). Examples of volatile memory include, but are not limited to, random access memory (RAM), dynamic random access memory (DRAM), static random access memory (SRAM), phase change memory (PCM) as well as disks or tapes.
The storage device 430 is capable of providing mass storage for the computing device 400. In some implementations, the storage device 430 is a computer-readable medium. In various different implementations, the storage device 430 may be a floppy disk device, a hard disk device, an optical disk device, or a tape device, a flash memory or other similar solid state memory device, or an array of devices, including devices in a storage area network or other configurations. In additional implementations, a computer program product is tangibly embodied in an information carrier. The computer program product contains instructions that, when executed, perform one or more methods, such as those described above. The information carrier is a computer- or machine-readable medium, such as the memory 420, the storage device 430, or memory on processor 410.
The high speed controller 440 manages bandwidth-intensive operations for the computing device 400, while the low speed controller 460 manages lower bandwidth-intensive operations. Such allocation of duties is exemplary only. In some implementations, the high-speed controller 440 is coupled to the memory 420, the display 480 (e.g., through a graphics processor or accelerator), and to the high-speed expansion ports 450, which may accept various expansion cards (not shown). In some implementations, the low-speed controller 460 is coupled to the storage device 430 and a low-speed expansion port 490. The low-speed expansion port 490, which may include various communication ports (e.g., USB, Bluetooth, Ethernet, wireless Ethernet), may be coupled to one or more input/output devices, such as a keyboard, a pointing device, a scanner, or a networking device such as a switch or router, e.g., through a network adapter.
The computing device 400 may be implemented in a number of different forms, as shown in the figure. For example, it may be implemented as a standard server 400a or multiple times in a group of such servers 400a, as a laptop computer 400b, as part of a rack server system 400c, or as part of the robot 100.
Various implementations of the systems and techniques described herein can be realized in digital electronic and/or optical circuitry, integrated circuitry, specially designed ASICs (application specific integrated circuits), computer hardware, firmware, software, and/or combinations thereof. These various implementations can include implementation in one or more computer programs that are executable and/or interpretable on a programmable system including at least one programmable processor, which may be special or general purpose, coupled to receive data and instructions from, and to transmit data and instructions to, a storage system, at least one input device, and at least one output device.
These computer programs (also known as programs, software, software applications or code) include machine instructions for a programmable processor, and can be implemented in a high-level procedural and/or object-oriented programming language, and/or in assembly/machine language. As used herein, the terms “machine-readable medium” and “computer-readable medium” refer to any computer program product, non-transitory computer readable medium, apparatus and/or device (e.g., magnetic discs, optical disks, memory, Programmable Logic Devices (PLDs)) used to provide machine instructions and/or data to a programmable processor, including a machine-readable medium that receives machine instructions as a machine-readable signal. The term “machine-readable signal” refers to any signal used to provide machine instructions and/or data to a programmable processor.
The processes and logic flows described in this specification can be performed by one or more programmable processors executing one or more computer programs to perform functions by operating on input data and generating output. The processes and logic flows can also be performed by special purpose logic circuitry, e.g., an FPGA (field programmable gate array) or an ASIC (application specific integrated circuit). Processors suitable for the execution of a computer program include, by way of example, both general and special purpose microprocessors, and any one or more processors of any kind of digital computer. Generally, a processor will receive instructions and data from a read only memory or a random access memory or both. The essential elements of a computer are a processor for performing instructions and one or more memory devices for storing instructions and data. Generally, a computer will also include, or be operatively coupled to receive data from or transfer data to, or both, one or more mass storage devices for storing data, e.g., magnetic, magneto optical disks, or optical disks. However, a computer need not have such devices. Computer readable media suitable for storing computer program instructions and data include all forms of non-volatile memory, media and memory devices, including by way of example semiconductor memory devices, e.g., EPROM, EEPROM, and flash memory devices; magnetic disks, e.g., internal hard disks or removable disks; magneto optical disks; and CD ROM and DVD-ROM disks. The processor and the memory can be supplemented by, or incorporated in, special purpose logic circuitry.
To provide for interaction with a user, one or more aspects of the disclosure can be implemented on a computer having a display device, e.g., a CRT (cathode ray tube), LCD (liquid crystal display) monitor, or touch screen for displaying information to the user and optionally a keyboard and a pointing device, e.g., a mouse or a trackball, by which the user can provide input to the computer. Other kinds of devices can be used to provide interaction with a user as well; for example, feedback provided to the user can be any form of sensory feedback, e.g., visual feedback, auditory feedback, or tactile feedback; and input from the user can be received in any form, including acoustic, speech, or tactile input. In addition, a computer can interact with a user by sending documents to and receiving documents from a device that is used by the user, for example, by sending web pages to a web browser on a user's client device in response to requests received from the web browser.
A number of implementations have been described. Nevertheless, it will be understood that various modifications may be made without departing from the spirit and scope of the disclosure. Accordingly, other implementations are within the scope of the following claims.
This U.S. patent application is a continuation of, and claims priority under 35 U.S.C. § 120 from U.S. patent application Ser. No. 16/877,680, filed on May 19, 2020, which claims priority under 35 U.S.C. § 119(e) to U.S. Provisional Patent Application No. 63/012,614, filed on Apr. 20, 2020, each of which is considered part of the disclosure of this application and is hereby incorporated by reference in its entirety.
Number | Date | Country | |
---|---|---|---|
63012614 | Apr 2020 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 16877680 | May 2020 | US |
Child | 18444491 | US |