This disclosure relates generally to discovering a remotely located mirror in the field of view of a laser range finder, including characterizing the mirror and utilizing the discovered remote mirror to enhance the performance of the laser range finder.
There are applications in which a distance measurement is needed for a plurality of locations in the environment surrounding a distance measurement system. There are existing technologies that provide such distance information in the form of a 3-dimensional (3D) point cloud that represents the 3D coordinates of points on objects in the local environment. An ongoing challenge is to enhance these distance measurement systems, for example to provide improved coverage range, measurement density, measurement accuracy, measurement relevance. One challenge is that most cases real-world applications of distance measurement (e.g. ranging in autonomous vehicles) can encounter obstacles that dynamically obstruct portions of the field of view (FOV). For example, the trailer of a tractor-trailer truck can obstruct a dynamically varying portion of the FOV of a distance measurement system located in the tractor portion of the truck.
One exemplary distance measurement technology is computer stereo vision in which 3D information is extracted from 2-dimensional (2D) images obtained by a digital camera, by comparing captured information about the scene from two vantage points. Another exemplary distance measurement technology is light detection and ranging (LIDAR) in which a light emitter (e.g. a laser diode) illuminates one or more directions in a field of view and the time associated with the reflections from each of the one or more directions is used to measure distance to objects in the associated direction. Several varieties of LIDAR are presently used. For example, flash LIDAR illuminates many points at once with light in a FOV and uses an array of detectors to sense reflections and associated times. Scanned LIDAR can use a pulsed laser to scan the FOV and sequentially measure laser reflections.
Another challenge with LIDAR is that the FOV represents the limited set of directions in which the LIDAR can directly measure distance to surrounding locations. Conventional mechanical LIDAR can have a rotating sensor head that spins around an axis and provides a 360 degree FOV in the azimuthal plane and a limited (e.g. +/−20 degree) FOV in the elevation plane. Hence the directions in which a LIDAR can provide direct range measurements from the surrounding environment can be limited by the system design. In a related challenge the LIDAR is often mounted on a platform (e.g. a car, truck, or airplane) and this platform obstructs some of the FOV. Therefore insofar as I am aware, no previous LIDAR system effectively addresses the challenge of adapting the limited FOV to the often-obstructed and changing local environment in real-world applications (e.g. autonomous vehicles or smart buildings).
A remote mirror whose location or existence may be initially unknown to a laser range finder poses challenges and opportunities. Specifically, a remote mirror at some distance from a laser range finder in the FOV of the range finder can provide indirect reflections from otherwise inaccessible locations (e.g. around corners). Various embodiments of the present disclosure relate to detecting and characterizing a remotely located mirror in the FOV of a laser range finder system. In several cases the remotely located mirror can initially have an unknown position, shape and size (e.g. a reflector attached to a shipping container that can be used by a LIDAR in an autonomous truck or a mirror located in a building that can be discovered by a robot with a LIDAR, or a mirror on a passenger vehicle such as on a door with unknown placement relative to a LIDAR). Various embodiments provide for discovering the presence of a remote mirror in the FOV of a laser range finder, tracking the remote mirror position and increasing the utilization of a remote mirror (e.g. density of laser pulses generated by a LIDAR in a portion of the FOV containing the remote mirror).
In one embodiment a LIDAR system includes a laser generator, a laser positioner to scan a FOV, a reflection receiver or detector and an electronic circuitry such as a processing subassembly. The processing subassembly processes aspects of reflections from the FOV and thereby identifies a remote mirror located in the FOV, associated with some of reflection data. The processing subassembly can identify the location of the remote mirror (e.g., an angular range within a FOV) and use a variety of techniques to determine the range of angles in the FOV associated with the remotely located mirror. The processing subassembly can further characterize a transfer function of the mirror (i.e. the relationship between the angle of the laser beam produced by a laser positioner attached to the remote mirror and the angle of the reflected beam from the remote located mirror). The LIDAR system can use the characterization of the mirror to estimate reflection locations in 3D space associated with laser beams or reflections deflected by the remote mirror and subsequently detected by the laser range finder.
One exemplary aspect of several embodiments of the present disclosure is directed to a method for a LIDAR to discover a remotely located mirror, located at an initially unknown location in the local environment, to perform a laser ranging scan of a field of view that utilizes the discovered mirror, and to identify a subset of laser reflections that have been deflected by the remote mirror and compensate the corresponding reflection data. In one aspect the laser range finder can comprise a laser reflection detector and a portion of the FOV of the detector can be associated with a discovered mirror in the local environment (e.g. a LIDAR on a truck with a large wing-mirror can have a large but variable portion of the detector FOV occupied by the wing mirror). A laser range finder can have a detector that generates a sequence of laser pulses, thereby illuminating the surrounding environment. The laser pulses can reflect from objects in the local surroundings and the laser range finder can receive a set of laser reflections. Reflections can arrive in a set of reflection directions. For example, the detector can be scanned in a raster pattern or a rotating pattern. The detector field of view can be considered the set of all possible reflection directions. In a simple case wherein a laser reflection travels directly from the reflecting object to the detector the 3D reflection location can be determined using the time of flight (TOF) of the laser reflection (i.e., time elapsed since outgoing laser pulse) and the reflection direction.
Several embodiments of this disclosure deal with the special case of reflections from a remote mirror. In some embodiments the initial location of the remote mirror can be unknown. A remote mirror can be very useful (e.g. a convex wing mirror provides an expanded FOV that is often beyond the range of directions forming the unaided detector FOV). However, reflections that arrive from reflection directions in the detector FOV associated with the mirror have been deflected. Therefore an aspect of several embodiments is to identify the subset laser reflections (the deflected subset) that have undergone deflection by the remote mirror. Subsequently, a 3D location can be computed for each laser reflection including performing a correction step performed when computing the 3D location corresponding to laser reflections in the deflected subset. In this way the laser range finder or a system with a laser range finder can account for the effect of the remote mirror when computing 3D locations representative of reflection locations (e.g. when computing a 3D point cloud). In some embodiments the curvature and placement of the remote mirror can be learned by the laser range finder and the correction step can improve the accuracy of the 3D location associated with reflections from the mirror (e.g. the correction can determine a correct 3D reflection location accounting for the deflection in the mirror). In other embodiments, the correction step separates out the deflected subset of laser reflections and provides them as a secondary point cloud (e.g. provides a smaller separate point cloud, distinct from the main point cloud, that shows relative placement of reflection locations for the deflected subset of laser reflections).
In a related second group of embodiments a laser range finder system has a dynamically steerable laser assembly capable of steering a sequence of outgoing laser pulses in a dynamically selectable, non-uniform and modifiable manner. The steerable laser assembly is controlled by a set of laser steering parameters, similar to how a 3-D printer is dynamically controlled by a set of parameters describing an object. In response to obtaining a location estimate for a remote mirror (e.g. a 2-D range of direction in a FOV or a 3D range of coordinates) the laser range finder system generates a set of laser steering parameters operable to improve the utilization of the remote mirror. For example, the remote mirror (e.g. wing mirrors in automotive applications) can be a convex mirror, which increases the angular range of reflections captured by the mirror but makes objects appear smaller. Hence several embodiments provide a method to discover a remote mirror in the FOV and generate laser steering parameters to interrogate the mirror with a customized non-uniform pattern of laser pulses (e.g. increased density, decreased angular spacing, smaller or larger laser spot sizes, or optimized laser intensity). In another embodiment, a laser range finder system can selectively magnify a portion of the FOV containing a remote mirror, thereby providing a higher density of laser reflections from a remote mirror and increasing its utilization. For example. A set of laser steering parameters based on a location estimate for a remote mirror can be used to position a controllable magnifier within a flash LIDAR, thereby magnifying a portion of the FOV estimated to contain a remote mirror
In a third group of embodiments a remote mirror positioning system is disclosed that controls (e.g. adjusts) a remote mirror based at least in part on processing reflection data from laser reflections, wherein at least some of the laser reflections have undergone deflection by the remote mirror. The remote mirror positioning system is useful for adjusting remote mirrors to provide enhanced utility for laser range finder or to dynamically compensate for changes in the local environment, such as when an articulated vehicle makes a sharp turn. In one embodiment a remote mirror control system comprises a laser transceiver subassembly and processing subassembly with a transceiver operable to transmit position signals to a mirror positioner. The laser transceiver functions to transmit a set of laser pulses, gather a corresponding set of laser reflections and generate corresponding reflection data. Some of the laser reflections have been deflected by a remote mirror in the FOV of the laser transceiver. The processing subassembly processes at least some of the reflection data and thereby generates a position signal. The transceiver transmits the position signal to mirror the positioner that is mechanically coupled to the remote mirror. Embodiments of the remote mirror positioning system can provide feedback control of a remote mirror when the position of the remote mirror is not fully controllable or initially known by the mirror positioning system.
In a related fourth group of embodiments a laser range finder can be operatively coupled to a positioning mechanism (e.g. a mirror positioner) attached to a remote mirror on a vehicle or in the local environment (e.g. a LIDAR on a truck that is connected to a remote mirror on a cargo trailer attached to the truck). The laser range finder can discover the position of the remote mirror and can reposition the remote mirror in response to a change in shape or position of the vehicle. For example, a tractor-trailer truck can have a LIDAR located in the tractor portion that discovers and utilizes a remote mirror located in the trailer. The trailer can be articulated relative to the tractor and the laser range finder can control the remote mirror to adapt as the tractor-trailer makes a sharp turn providing optimized coverage. In another embodiment a laser range finder is mounted on a first portion of an articulated vehicle and a set of reflectors on a second portion that is articulated relative to the first portion, and received some or all of the incoming sequence of laser pulses from the laser range finder. The laser range finder discovers and controls a remote mirror to compensate for the articulation of the second (e.g. trailer) portion relative to the first (e.g. tractor) portion. In this way the controllable remote mirror ensures the FOV associated with the set of reflectors on the second portion remains invariant to the articulation of the vehicle.
The techniques described in this specification can be implemented to achieve the following exemplary advantages:
Several embodiments provide a laser range finder that can identify and estimate the location of a remote mirror. Laser range finders in autonomous vehicles are very likely to inadvertently and sporadically experience mirrors in their field of view. Therefore the accuracy of 3D laser range finding is improved by the disclosed systems and methods to detect and estimated the location of remote mirrors.
In a related advantage several embodiments enable tracking of a remote mirror in the FOV of a laser range finder, following mirror detection. For example, a large variation in range, reflection location, time of flight or depth in a small window of the FOV can be used to identify the presence of a remotely located convex mirror. In several embodiments a LIDAR can track the bounds of a region of the FOV identified to contain a remote mirror.
A laser range finder according to several embodiments can increase the use a discovered remote mirror to provide laser reflections from locations outside of the direct FOV (e.g. around corners). Convex mirrors have been used with limited success on roadways to help drivers see around corners. Such mirrors are sometimes found on country roads or sharp bends in roads. A drawback with convex mirrors is that objects are distorted and appear smaller than they really are. Hence drivers have difficulty understanding or utilizing convex mirrors and this has limited their deployment. Several embodiments of the present disclosure can enable an autonomous vehicle with a laser range finder to discover a remote mirror, zoom in (e.g. with optical or digital zoom) on the remote mirror to improve utilization of the mirror (i.e., magnify the remote field of view provided by the mirror) and use learned or stored characterization about the mirror to better understand the remote field of view offered by the mirror. For example, a remote roadside mirror can have defining features (e.g. a size or a model number indicator) that helps a laser range finder to recognize the type or model of remote mirror and thereby select a set of stored characteristics for the roadside mirror (e.g. the curvature, angular range, size).
In another advantage a laser range finder can identify a deflected subset of a set of laser reflections thereby enabling more accurate 3D ranging in an environment with remote mirrors.
Similarly, a laser range finder can identify and isolate reflection data from the deflected subset of laser reflections thereby providing a clear indication that the reflection data is from a mirror. For example, in one aspect a LIDAR can identify that a subset of a set of laser reflections have characteristics indicating that they come from a remote mirror. The LIDAR may not initially know the transfer function of the remote mirror and may isolate the subset as representing a deflected subset with known relative placement but unknown absolute placement relative to other laser reflections in the FOV.
Several embodiments enable gathering more information from a remote mirror by estimating the mirror location and then densely scanning the remote mirror, or estimated mirror location, with a laser range finder (e.g. greater than average density of laser pulses). In another advantage, a system for remotely controlling a remote mirror based on processing laser reflections can automate the process of provisioning mirrors (e.g. automatically characterize and provision a remote mirror attached to the trailer of a truck when a new trailer is attached to the truck), and improve the effectiveness of discovered mirrors (e.g. adjust the mirror position to provide greatest blind-spot coverage).
In yet another advantage, a system that controls the position of a remote mirror based at least in part on processing laser reflections can automatically adjust the remote mirror in response to a changing shape of a host vehicle (e.g. trailer position) and thereby compensate the indirect FOV from the remote mirror for changes in the vehicle shape (e.g. dynamic blind-spot coverage for a trailer during sharp turns). While such changing mirror position might confuse a vehicle driver and hence be inappropriate, an automated system can easily receive feedback regarding the changing orientation of a remote mirror and the anticipated indirect field of view expected from the remote mirror in response to the change in orientation.
In another advantage a remote mirror and laser steering parameters operable to distribute laser range measurement in a LIDAR can be adapted in combination to specific road conditions. For example, a set of remote mirrors on a vehicle trailer and an associated set of laser steering parameters can be adapted to scan a particular indirect FOV (e.g. a known blindspot of the LIDAR) during a sharp turn and adapted differently on a straight highway.
In another advantage, the most expensive component of a laser range finder is often the detector array (e.g. a focal plane array). Aspects of the present invention enable lower cost components such as remote mirrors to be disposed on a trailer (or cargo containers) while the expensive components can be located in the tractor portion of a vehicle and utilize the remote mirrors. Specific aspects provide methods for automatically discovering the location of these mirrors. Hence a long-haul truck driver can attach a trailer to a tractor and several embodiments disclosed herein provide for automatically discovering and characterizing a set of remote mirrors on the tractor or trailer that can enhance vehicle safety and autonomy.
Unlike digital cameras where light is received from many points at once, a laser range finder (e.g. 110 in
Steerable Laser Assembly
LIDARs often provide laser ranging in a plurality of directions (e.g. a FOV) and thereby generate data for a 3D topology map of the surroundings. To accomplish this LIDAR can have a steerable laser assembly. For the purpose of this disclosure a steerable laser assembly is an assembly that scans one or more laser beams within a FOV. A steerable laser assembly can include a laser generator (e.g. a laser diode) and a laser positioner (e.g. a rotating scanning mirror) to position the laser beam in a variety of directions during a scan of the FOV. The steerable laser assembly can be mechanically-steerable (e.g. containing moving parts to direct a laser beam) or electronically-steerable (e.g. containing an optical phased array to form a laser beam in one of many directions).
In many LIDARs a mechanically steerable laser assembly rotates with a constant angular velocity and thereby scans the FOV with uniform measurement spacing (e.g. 1 laser pulse and 1 measurement for every 1 degree of the azimuthal FOV). The pattern of generated laser pulses is uniform and largely determined by the angular velocity of the rotating components. The angular velocity can be selected for many mechanical LIDAR (e.g. 5-20 Hz for the HDL-64E from Velodyne Inc. or Morgan Hill, Calif.), but remains constant (or nearly constant) from one rotation to the next. The uniform angular spacing of laser pulses within the FOV is simple and somewhat inherent in rotating LIDARs, but is sub-optimal for gathering the most information from the FOV. For example, large sections of the FOV can return a predictable, time-invariant, homogeneous response, such as reflections from walls or unoccupied sections of a highway.
Dynamically Steerable Laser Assembly
In a mechanical LIDAR the inertia of the spinning components prevents rapid changes in the angular velocity that would be necessary to dynamically steer a laser beam to produce a complex non-uniform and dynamically defined patterns of laser pulses. Recently, advancements in electronically-steerable lasers and phased array laser beam forming have made it possible to dynamically steer a laser beam within a FOV. Electronically-scanned LIDARs are solid-state and comprise no moving parts (e.g. the model S3 from Quanergy Inc. of Sunnyvale, Calif.). In a solid state LIDAR, the absence of inertia associated with moving parts makes it possible to move a laser beam with a complex trajectory thereby producing a series of laser pulses with non-uniform spacing, density, and location in the FOV.
For the purpose of this disclosure, dynamically steerable laser assemblies are a subset of steerable laser assemblies wherein the assembly can dynamically steer one or more laser beams by accepting inputs (e.g. user commands) and thereby dynamically changing aspects of the laser beam such as beam power, spot size, intensity, pulse repetition frequency, beam divergence, scan rate or trajectory. A dynamically steerable laser assembly can change aspects of one or more laser beams several times during a scan of the FOV. For example, a differentiating aspect of many dynamically steerable laser assemblies over traditional laser assemblies is circuitry operable to process instructions while the laser beam scans the FOV and continually adjust the direction of a laser beam. This is similar to the dynamic manner in which a 3D printer dynamically rasters a polymer filament to print an arbitrary shaped object. A traditional mechanically steered LIDAR, with associated inertia, can only implement small changes in angular velocity during each scan (e.g. changing from 20 Hz to 20.5 Hz scan rate in the course of a single 360 degree rotation). In contrast, it can be appreciated that a dynamically steerable LIDAR can make several changes to aspects of the laser pulse pattern in the course of a single scan of the FOV (e.g. rapidly changing the trajectory of a laser beam by 90 degrees within 10 milliseconds or tracing the outline of a complex shape with many turns during a single scan).
For the purpose of this disclosure dynamically steering a laser beam with a steerable laser assembly is the process of providing input data to the steerable laser assembly that causes the steerable laser assembly to dynamically modulate at least one aspect of the resulting laser pulse sequence during a scan of the FOV. Exemplary modulated aspects can include the beam or pulse power, spot-size, intensity, pulse repetition frequency (PRF), beam divergence, scan rate or trajectory of the laser beam. For example, a laser assembly that is designed to raster scan a FOV with a constant scan rate and pulse rate (e.g. PRF) is acting as a steerable laser assembly but is not being dynamically steered. The distinction is that such a laser assembly is not receiving input or acting on previous input and dynamically altering aspects of the beam pattern during the course of each scan of the FOV. However, the same steerable laser assembly could be dynamically steered by providing input signals that cause the steerable laser assembly to generate a variable laser power at locations in the FOV, based on the input signals (e.g. thereby generating an image on a surface in the FOV). A trajectory change can be a direction change (i.e., a direction formed by a plurality of pulses) or a speed or scan rate change (i.e., how fast the laser is progressing in a single direction across the FOV). For example, dynamically steering a steerable laser assembly can be dynamically changing the angular velocity, thereby causing the inter-pulse spacing to increase or decrease and generating a dynamic laser pulse density. In one aspect dynamic steering can often be recognized as the process of implementing dynamic control of a laser pulse pattern during a scan of a FOV.
In the context of the present disclosure many rotating LIDAR do comprise steerable laser assemblies, but these assemblies are not dynamically steerable since neither the power nor the trajectory of the laser beam is dynamically controllable within a single scan of the FOV. However, a rotating or mechanical LIDAR could be dynamically steered, for example by providing input data that causes the laser to dynamically vary the laser pulse rate within a scan of the FOV, since the net result is a system that can guide or steer the laser to produce a non-uniform density laser pulse pattern in particular parts of the FOV.
In many laser range finders the laser is periodically pulsed as the laser assembly moves along a trajectory and the exact location of each laser pulse in the FOV is controlled. Nevertheless such a periodically pulsed laser generator can be used in a steerable laser assembly to produce a complex shaped region with greater than average spatial density pulse, for example by increasing the laser dwell time within the complex shaped region. In this way a periodically pulsed laser generator (e.g. a laser diode) can produce a greater density of pulses in the complex shaped region. Other laser range finding systems transmit a continuous laser signal, and ranging is carried out by modulating and detecting changes in the intensity of the laser light. In a continuous laser beam systems the distance to a reflection location is determined based on the phase difference between the received and transmitted laser signals.
In one aspect a dynamically steered laser range finder can be used to mine the FOV for the boundaries. For example, a LIDAR can generate a laser pulses with a 3 milliradian beam divergence, thereby resulting in a 30 cm radius laser spot size at a distance of 200 m. This small laser spot size enables the LIDAR to identify the boundaries of an object at 200 m. In many cases the resolution of objects at considerable range is limited by the number of pulses devoted to an object rather than the ability of each pulse to identify a boundary. Therefore once a boundary is detected a dynamically steerable laser assembly could be dynamically steered to investigate and refine estimates of the boundary by devoting more pulses to the object. In contrast RADAR has much greater beam divergence and hence a much wider spot size impacts the object (often many times the object size). Hence the reflections from beam-steered RADAR represent the reflections from many points on the object, thereby making beam steered RADAR useful for object detection but impractical for detailed boundary localization. Hence, a small change in beam angle provides little if any actionable information regarding the edges of an object. In contrast the spot size of the laser remains small relative to the boundary of many important objects (people, dogs, curbs). The present technology enables the boundaries of such objects to be dynamically determined by a process of iteratively refining the scan points for the electronically steered LIDAR. For example, a LIDAR with dynamic steering could use a bisection algorithm approach to iteratively search for the boundary of a pedestrian in the FOV. The LIDAR could first process laser reflection data to identify that a 3D point P1 in the point cloud has a TOF consistent with the pedestrian and can subsequently scan iteratively to the right and left of P1 with decreasing angular range (e.g. in a bisection approach) to estimate the exact location of the boundary between the pedestrian and the surrounding environment. In general, this technique can be used to investigate changes in range (e.g. time of flight changes) within a point cloud to iteratively improve boundary definition.
In
Dynamically Steerable Laser Range Finder
Steerable laser assembly 120 can comprise one or more laser generators 420, a laser positioner 430, and one or more detectors 440. The one or more laser generators 420 can be laser diodes (to produce one or more laser beams (e.g. beam 435) at one or more locations in the FOV determined by the laser positioner 430. Laser positioner 430 functions to steer one or more laser beams (e.g. beam 435) in the FOV based on the laser steering parameters. Laser positioner 430 can mechanically steer a laser beam from laser generator 420. Rotating LIDARs often use a mechanically steered laser positioner. An exemplary mechanically steered laser positioner 430 can include mechanical means such as a stepper motor or an induction motor to move optical components relative to the one or more laser generators. The optical components in an exemplary mechanical laser positioner can include one or more mirrors, gimbals, prisms, lenses and diffraction grating. Acoustic and thermal means have also been used to control the position of the optical elements in the laser positioner 430 relative to the one or more laser generators 420. Laser positioner 430 can also be a solid state laser positioner, having no moving parts and instead steering an incoming laser beam using electronic means to steer the laser beam 435 in an output direction within the FOV. For example, an electronically steerable laser assembly can have a solid state laser positioner comprising a plurality of optical splitters (e.g. Y-branches, directional couplers, or multimode interference couplers) to split an incoming laser beam into multiple portions. The portions of the incoming laser beam can then be transmitted to a plurality of delay line where each portion is delayed by a selectable amount (e.g. delaying a portion by a fraction of a wavelength). Alternatively, the delay lines can provide wavelength tuning (e.g. selecting slightly different wavelengths from an incoming laser beam). The variable delayed portions of the incoming laser beam can be combined to form an output laser beam at an angle defined at least in part by the pattern of delays imparted by the plurality of delay lines. The actuation mechanism of the plurality of delay lines can be thermo-optic actuation, electro-optic actuation, electro-absorption actuation, magneto-optic actuation or liquid crystal actuation. Laser positioner 430 and one or more laser generators 420 can be combined onto a chip-scale optical scanning system such as DARPA's Short-range Wide-field-of-view extremely agile electronically steered Photonic Emitter (SWEEPER).
Detector 440 can contain light sensors 450 (e.g. photodiodes, avalanche photodiodes, PIN diodes or charge coupled devices CCDs), signal amplifiers (e.g. operational amplifiers or transconductance amplifiers), a time of flight calculator circuit 455 and an intensity calculator 460. Detector 440 can comprise one or more photodiodes, avalanche photodiode arrays, charge coupled device (CCD) arrays, single photon avalanche detectors (SPADs), streak cameras, amplifiers and lenses to focus and detect reflected laser light from laser beam 435. The construction of the steerable laser assembly 120 can co-locate detector 440 and laser positioner 430 such that detector 440 is pointed in the direction of the outgoing laser beam and can focus the detector on a narrow part of the FOV where the reflected light is anticipated to come from.
The steerable laser assembly 120 of laser range finder 405 can generate a pulsed or continuous laser beam 435. Steerable laser assembly 120 can receive one or more laser reflections 445 corresponding to laser beam 440. Laser range finder 405 can contain a light sensor 450 to detect reflected light from the laser pulses or continuous laser beam.
Steerable laser assembly 120 can contain a time of flight calculator 455 to calculate the time of flight associated with a laser pulse striking an object and returning. The time of flight calculator 455 can also function to compare the phase angle of the reflected laser beam with the phase of the corresponding outgoing laser beam and thereby estimate the time-of-flight. Time of flight calculator 455 can also contain an analog-to-digital converter to detect an analog signal resulting from reflected photons and convert it to a digital signal. Laser range finder 405 can contain an intensity calculator 460 to calculate the intensity of reflected light.
Laser range finder 405 can contain a data aggregator 465 to gather digitized data from time of flight calculator 455 and intensity calculator 460 or 3D location calculator 464. Data aggregator 465 can group data into packets for transmitter 470 or sensor data processor 475. Laser range finder 405 can contain a transmitter 470 to transmit data packets. Transmitter 470 can send the data to a processing subassembly (e.g. a computer or a remote located sensor data processor) for further analysis using a variety of wired or wireless protocols such as Ethernet, RS232 or 802.11.
Laser range finder 405 can contain a sensor data processor 475 to process sensor data and thereby identify features or classifications for some or all of the FOV. For example, data processor 475 can identify features in the FOV such as boundaries and edges of objects using feature identifier 480. Data processor 475 can use feature localizer 485 to determine a region in which the boundaries or edges lie. Similarly a classifier 490 can use patterns of sensor data to determine a classification for an object in the FOV. For example, classifier 490 can use a database of previous objects and characteristic features stored in object memory 495 to classify parts of the data from the reflected pulses as coming from vehicles, pedestrians or buildings. In the embodiment of
When operably linked to steerable laser assembly 120 the processing subassembly 520 can perform one or more embodiments of the method to find, utilize and correct for a remote mirror in the FOV of laser range finder 510.
A laser steering parameter can be a region width 504 or a region height 506. The width and height can be expressed in degrees within the FOV. One exemplary set of laser steering parameters could include a start location, region width and region height thereby defining a four sided region in the FOV. Other laser steering parameters in the exemplary set of laser steering parameters can indicate how to tailor a scan within this region, such as laser scan speed 514, laser pulse size 516 or number of laser pulses 518.
A laser steering parameter can be one or more region boundaries 508 defining the bounds of a region. A laser steering parameter can be one or more laser pulse locations 511. Pulse locations 511 can provide instructions to a steerable laser to move to corresponding positions in the FOV and generate on or more laser pulses. In some embodiments the laser can be generating a laser beam while being steered from one location to another and can dwell for some time at the laser pulse locations. In other embodiments the steerable laser can use these points 511 to generate discrete pulses at defined locations. In such embodiments the laser beam can be generated at discrete pulse locations and can dwell at the pulse location for some time.
A laser steering parameter can be one or more path waypoints 512, which define points in a FOV where a steerable laser can traverse or points at which the steerable laser can implement direction changes.
Remote Mirror
Turning to
In the context of laser range finders, two possible categories of mirrors are: integrated mirrors that are integrated or attached to the range finder and remote mirrors that are observed by the laser range finder in the local environment (e.g. a mirror on a passing vehicle that appears in the range finder FOV but is not associated with a laser range finder). Laser range finders use integrated mirrors to perform a variety of functions. For example, an integrated scanning mirror in a rotating LIDAR (e.g. HDL-64e from Velodyne Inc. of Morgan Hill, Calif.) can distribute laser pulses in a plurality of directions. Similarly, U.S. Pat. No. 9,285,477 issued to Smith discloses a compensation mirror that deflects outgoing and incoming laser pulses that have been distributed by a scanning mirror in a plurality of directions. In the Smith patent, the compensation mirror is part of the laser range finder, has a known position and occupies the entire FOV of the scanning mirror (i.e., all outgoing and incoming laser beams are deflected by the compensation mirror). Integrated mirrors (e.g. attached or integrated) in laser range finders can be characterized during the design or manufacturing process. Therefore, the effect of integrated mirrors can be accounted for at the design stage. Similarly, an integrated mirror in a laser range finder can be controlled by the laser range finder (e.g. rotating a scanning mirror to a controlled direction), and thereby provide a predictable effect on a laser pulse.
In contrast, when a laser range finder encounters a remote mirror in the local vicinity, several aspects of the remote mirror can be unknown (e.g. mirror shape, dimensions or orientation) or uncontrolled (e.g. mirror location in the FOV). For the purpose of this disclosure a mirror is a remote mirror with regard to an optical assembly if the mirror is neither attached to nor integrated into the optical assembly. In some cases the remote mirror can have a variable location in the FOV of the optical system (e.g. laser range finder, optical detector or steerable laser assembly). The location of the remote mirror can be controlled or uncontrolled by the optical system. Exemplary remote mirrors include wing-mirrors and rear-view mirrors in vehicles and roadside mirrors.
In the context of a laser range finder a remote mirror can function to occupy a portion of the FOV (e.g. a subset of all laser directions in which the range finder can perform laser ranging) and provide indirect laser reflections that have been deflected by the remote mirror. As such, a remote mirror can deflect outgoing laser pulses from a laser range finder and thereby provide laser reflections from locations beyond the set of reflection locations that can be directly reached by the laser range finder. A remote mirror can be placed at some fixed or variable distance from a laser range finder (e.g. 10 meters). In this way the remote placement of the remote mirror acts to provide an alternative FOV. For example, an integrated compensation mirror such as disclosed in U.S. Pat. No. 9,285,477 can reposition an outgoing laser pulse but cannot compensate for obstacles in the local environment. However, a remote mirror with suitable placement at some distance from the laser range finder can provide a valuable alternative FOV (e.g. around corners or in a vehicle blind spot).
A remote mirror can have transient placement in the FOV of a laser range finder, such as stationary roadside mirror that appears briefly in the FOV of a laser range finder attached to a passing vehicle. A remote mirror can occupy a variable or fixed portion of the FOV of a laser range finder. A remote mirror can have a variable orientation (e.g. a variable angle of rotation or compass direction) while occupying a fixed portion of the FOV of a laser range finder. For example, a wing-mirror on an autonomous vehicle can occupy a fixed portion of the FOV of a range finder while having an unknown orientation. A remote mirror can occupy a portion of the FOV of a laser range finder that is initially unknown to a laser range finder (i.e., initially unknown placement) but is later learned by processing aspects of sensor data (e.g. camera imagery or laser reflection data). A remote mirror and a laser range finder can be attached to a common host vehicle. Alternatively, a remote mirror can be stationary and the laser range finder can be on a host vehicle operable to move relative to the remote mirror. A remote mirror can be dedicated to a laser range finder (e.g. a wing-mirror dedicated to a laser range finder on an autonomous vehicle). Alternatively, a remote mirror can be shared by many laser range finders (e.g. a remote road-side mirror at a busy traffic intersection). A remote mirror can have a concave, convex, flat or complex shape. A remote mirror can constructed from a reflective metal, metallized glass or metallized plastic. A remote mirror can occupy a small portion of the FOV of a laser range finder (e.g. a small 5×5 degree portion of the FOV) that is operable to provide detailed range data regarding a remote FOV, such as a larger remote field of view provided by a small convex remote mirror.
Hence, two relevant challenges when utilizing a remote mirror with a laser range finder are to firstly discover and track the location of a remote mirror with the laser range finder and secondly to determine a correction step in the process of identifying a 3D location representative of the reflection location for the subset of laser reflections that have undergone deflection by a remote mirror. Several embodiments of the present disclosure are directed to systems and methods for discovering and correcting for a remote mirror in the FOV of a laser range finder. In particular, several embodiments provide a method for measuring reflection data, including distance and direction data, for a set of laser reflections resulting from a sequence of outgoing laser pulses. The method can identify the location of a remote mirror with variable or unknown location in the FOV and determine a subset of the set of laser reflections that have undergone deflection by the remote mirror in the process of reaching the laser range finder (i.e., a deflected subset). The method can then compute a 3D location for each of the laser reflections in the set of laser reflections from the corresponding reflection data and apply a correction step in the computation process for those laser reflections in the deflected subset. In some embodiments the correction step can function to generate 3D locations for deflected laser reflections that are more representative of the actual reflection locations than without the correction step.
In some embodiments, the method can generate a 3D location for the complete set of reflections (e.g. as is commonly output by many LIDAR in a .las file format) and the then post process the 3D locations to apply the correction step to the initial 3D location corresponding to reflections in the deflected subset of reflections. In this way, a standard steerable laser assembly such as those found in many LIDAR can be used to gather laser reflections and output 3D locations, via a communication link, to a processing subassembly (e.g. 520 in
Steerable laser assembly 120 can rotate or scan thereby enabling the laser generator 420 to generate a set of outgoing laser pulses (e.g. 650a, 650b) in a variety of different directions. Following each outgoing laser pulse, detector 440 can monitor for laser reflections (e.g. 660a, and 660b) within a detector FOV 670. The detector FOV can be defined as the set of all possible directions at the detector in which an incoming laser reflection can reach the detector. Each reflection (e.g. 660a) detected by the detector has an associated reflection direction within the detector FOV 670.
Some of the outgoing laser pulses e.g. 650a are reflected by objects in the FOV and generate corresponding laser reflection (e.g. 660a). Other outgoing laser pulses (e.g. 650b) are deflected by a remote mirror 620 and are subsequently reflected from an object (e.g. vehicle 630). Reflection 660b can travel a similar path to laser pulse 650b, being deflected by the remote mirror towards detector 440. In this way, an outgoing beam 650b causes a reflection 660b that is measured by the detector to come from the direction of the mirror, when it actually comes from reflection location 675. In some embodiments, a correction step performed by electronic circuitry in the laser range finder 610a provides means to identify the actual reflection location 675 for laser reflection 660b instead of identifying the remote mirror 620 as the reflection location. Remote mirror 620 can provide valuable information regarding the location of vehicle 630 to a variety of systems in vehicle 615, such as collision avoidance systems and autonomous driving systems. In the embodiment of
Deflected Subset of Laser Reflections
In one aspect of several embodiments a portion 730 of the FOV can contain a remote mirror. In some embodiments the mirror portion 730 encompasses some of the mirror and in some embodiments the mirror portion encompasses the entire remote mirror. In one aspect, the portion 730 can be considered the subset of the set of all directions in the detector FOV in which reflections come from the remote mirror. The mirror portion 730 of the FOV is interesting because some or all of the laser reflections with directions in the mirror portion are from reflection locations outside of the mirror portion (i.e., the remote mirror is deflecting an incoming laser reflection from another location). Previous laser range finders use the time of flight and the incoming direction of laser reflections to calculate a 3D location for each laser reflection. When this approach is applied to reflection from the mirror portion 730 of FOV 670, some or all of the 3D locations are incorrect due to the deflection of the laser reflection. For example, vehicle 630 appears to be in the upper right corner of FOV 670. A laser range finder without the benefit of this disclosure would likely construct a 3D location map for reflection locations and place the laser reflections from vehicle 630 along the direction of a vector starting at the detector 440 and ending at the center of the remote mirror 620. The result would be the correct estimated distance for vehicle 630 but the wrong reflection location.
Hence one aspect of several embodiments of this invention is to identify those laser reflections that are in the deflected subset 740 of the set of laser reflections 720. In one embodiment of this disclosure laser range finder 710 can gather a set of laser reflections and compute reflection data indicative of the time-of-flight of each laser reflection and a direction associated with each reflection (i.e., the location in the FOV or the direction can be a pixel in a detector array that detects the laser reflection or a 2-D angular coordinate of a direction in the FOV in which the detector was pointing). The detector 440 can transmit the set of reflection data to an electronic circuit (e.g. 3D location calculator 466 in
In one aspect of several embodiments a laser range finder (e.g. 710) can determine the subset 740 of laser reflections that have been deflected by a mirror. A first group of embodiments can involve analyzing the set of laser reflections to identify a subset that has undergone deflection. A second group of embodiments can determine the deflected subset by discovering and tracking the location of the mirror in the FOV and thereby calculate a set of directions (e.g. mirror portion of the FOV) for which laser reflections must have undergone deflection.
In a related exemplary embodiment, a mirror location estimate or a mirror portion 730 of FOV 670 can be determined by identifying laser reflections indicative of the frame or support structure of a remote mirror (i.e., portions that are not themselves deflective but indicate the a location of a mirror). For example, laser reflections (e.g. 660e) from the frame 830 of a remote mirror, or reflections (e.g. 660f) from the support structure of the remote mirror can indicate the placement of the remote mirror 820.
Laser range finder 810 can obtain a location estimate for remote mirror 820 by processing sensor data (e.g. camera image data) based on location feature (e.g. protrusions or bumps 835a and 835b). Location features can be identified by camera image data or by laser reflections (e.g. reflection 660g). For example, laser range finder 810 can comprise a processing subassembly (520 in
A wireless radio transmitter 837 associated with remote mirror 820 can transmit or broadcast the location or orientation of the remote mirror, thereby providing a location estimate to electronic circuitry in the laser range finder. Similarly a wired communication link 850 between the remote mirror and the laser range finder can transmit information regarding the placement of the remote mirror. Wireless radio transmitter 837 can be part of a transceiver (e.g. a Bluetooth, Zigbee or Wi-Fi transceiver) Wireless radio transmitter 837 can be part of a radio frequency transponder system (e.g. an RFID system). The wired communication link 850 can be similar in both protocol and structure to communication link 530 in
In one example, a plurality of roadside remote mirrors (e.g. 820) could be placed at strategic points along a roadway. Circuitry coupled to the remote mirrors (e.g. a GPS or indoor positioning system circuitry) could learn the location of the remote mirror (e.g. a GPS coordinate, or a relative location such as at the corner of the hallway at a specified height or relative location at an road intersection) and relay this information to laser range finders (e.g. 810) that are attached to systems that approach the vicinity of one or more of the remote mirrors (e.g. laser range finders on autonomous vehicles). In this way a remote mirror can transmit a location estimate (e.g. the GPS coordinates of the remote mirror) to electronic circuitry in the laser range finder. Similarly, sensors on the remote mirrors can detect the orientation (e.g. pointing Northeast) of a remote mirror and report this direction or orientation to one or more approaching laser range finders using wired or wireless communication links. In one example, a remote mirror deployed in an environment (e.g. roadway, building, school zone, parking structure) can be one of a set of standard remote mirrors with a characteristic curvature or shape that is indicated by a model number of the remote mirror. The remote mirror can use wireless transmitter 837 or wired link 850 to transmit or broadcast the model number of the remote mirror. The laser range finder can access one or more properties of the remote mirror (e.g. location estimate, shape, height, curvature, characteristic shape of the mirror, field of view, reflectivity or purpose) stored in a local or remote memory based on the identifying information (e.g. model number) transmitted by the remote mirror. For example, an exemplary remote mirror could be a standard remote mirror from a series of such remote mirrors that are deployed on vehicle trailers, railway cars or shipping containers. A laser range finder could be located on a tractor (e.g. a truck) designed to pull such a trailer. The exemplary remote mirror could be designed to augment the FOV of the laser range finder. Initially (e.g. prior to determining a location estimate for the remote mirror) the placement of the exemplary remote mirror on the trailer could be unknown. A wired or wireless connection (e.g. transmitter 837 or wired link 850) can announce the model number for the exemplary remote mirror (e.g. the model number within the standard series of such remote mirrors). Similarly, a wired or wireless transmitter associated with the remote mirror can transmit a location estimate (e.g. a specific location or a range of locations). The laser range finder can then use the model number and the location estimate or orientation information to identify a portion 730 of the FOV 670 that contains the remote mirror or a deflected subset 740 of the laser reflections. Interestingly, this portion can vary greatly with operation of a vehicle, particularly when the remote mirror is mounted to an articulated portion of a vehicle. Therefore, in one aspect of several embodiments the location estimate and the mirror portion 730 are continuously determined from sensor data. Laser range finder 810 can determine a subset 740 of the laser reflections within the FOV that have undergone deflection by the remote mirror.
In another embodiment, wireless transceiver 837 or wired link 850 can transmit identity location or orientation information regarding the remote mirror 820. Subsequently, for a given laser reflection in a set of laser reflections the laser range finder 810 can use the information supplied by the remote mirror to determine if that laser reflection has been deflected by the remote mirror. For example, remote mirror could report that it is located at the bend in a road (e.g. 640 in
In the previous example one or more laser reflections from a set of laser reflections (e.g. 720 in
Another exemplary method to determine if a laser reflection has been deflected by a remote mirror uses the nature of images reflected in the mirror. For example, remote mirrors such as wing-mirrors and roadside mirrors are often convex in order to capture a wider FOV than an equivalent sized flat mirror. For this reason wing-mirrors on vehicles often carry a warning sign “Warning—Objects in mirror are closer than they appear” The convex nature of a remote mirror can cause a wide variation of the laser reflections provided by the relative small portion of the FOV occupied by the remote mirror. A laser range finder can have a predefined set of criteria or rules based on aspects of laser reflections that are used to determine if a reflection has undergone deflection in a remote mirror. Exemplary criteria can be based on variations in the time-of-flight of reflections or identification of unusually small objects (e.g. smaller than expected people and cars in the reflected data). For example, a subset of the set of laser reflections that exhibit a large variation in time of flight (e.g. indicating ranges between 60 m and 160 m) in a small 5×5 angular range of the FOV can satisfy a criteria, thereby defining that all laser reflection in that 5×5 degree portion of the FOV should be determined to have undergone deflection by a remote mirror. In another example a subset of the set of laser reflection identified to indicate a car with unusual distortion or an unusual size scale can be used to satisfy a criterion and thereby all reflections from a related portion of the FOV can be determined to have undergone deflection by a remote mirror.
Yet another method to determine if a laser reflection (e.g. 660b) has undergone deflection by a remote mirror 820 can be to perturb the position of the remote mirror (e.g. using a mirror positioner 840 such as a motor or an actuator) and thereby identify a portion of the FOV that is modulated when the remote mirror is perturbed. A laser reflection can be determined to have undergone deflection in the remote mirror if it comes from the portion of the FOV that has been identified to undergo a change (i.e., point at a different reflection location) when the mirror is perturbed (e.g. rotated, translated or vibrated). For example, a first reflection R1 (e.g. 660b) with an associated direction D1 in the detector FOV 670 can have a time-of-flight of 1 microsecond relative to an outgoing laser pulse, thereby indicating a distance to the reflection location is 150 m based on a speed of light of 300 m per microsecond. Laser range finder 810 can seek to determine if reflection R1 has undergone deflection by remote mirror 870 using the following method: firstly emit a laser pulse and measure reflection R1, secondly command mirror positioner 840 to rotate mirror 820 slightly, thirdly emit a second laser pulse operable to cause a reflection R2 from the same direction D1 as reflection R1 and observe if reflection R2 has a considerably different time of flight (e.g. 2 microseconds instead of 1 microsecond) or a considerably different associated range (e.g. 250 m instead of 150 m). Finally, the laser range finder can determine if R1 has been deflected by a remote mirror based on a measure of the range or time-of-flight difference between R1 and R2. If R1 is determined to be in the deflected subset of all reflection then associated direction D1 in the FOV can be included in the mirror portion of the FOV.
In a related example, laser range finder 810 can vary the position of remote mirror 820 in a periodic manner (e.g. rotating the mirror slightly back and forth), thereby producing a periodic variation in the laser reflections in the mirror portion and helping to identify the mirror portion 730 of FOV 670. In another related example, a remote mirror that is not controlled by the laser range finder can execute a periodic position change (e.g. a momentary rotation or vibration) operable to cause one or more laser range finders in the vicinity to experience a shift in range or time of flight from laser reflections within the mirror portion 730 of FOV 670 for each laser range finder. For example, an autonomous vehicle approaching a roundabout with a remote mirror could discover and track the location of the remote mirror based on deliberate variations (e.g. small vibrations or rotations) of the remote mirror. In one embodiment the remote mirror can perform a continuous or periodic scanning motion so as to increase the range of reflection locations (i.e., the indirect FOV) provided by the remote mirror.
In another embodiment, the remote mirror can have a characteristic curvature that is initially unknown to the laser range finder. For a given orientation of the remote mirror the curvature characteristic of the mirror acts like a transfer function converting the incident directions of laser reflections from reflection locations into a deflected directions travelling towards the detector in the laser range finder. In one aspect of this embodiment the remote mirror can change its position several times (e.g. perform a slow sweep or rotation) and the laser range finder can perform processing (e.g. correlation analysis) on the laser reflections received at various orientations and thereby determine the characteristic curvature of the remote mirror. For example, an object can reflect laser pulses such that the laser pulses are deflected by different parts of the remote mirror in different orientations as the remote mirror moves, thereby enabling a laser range finder to characterize the curvature of the surface of the remote mirror. The remote mirror can also announce its characteristic curvature using the wireless transmitter 837 or wired communication link 850.
In one aspect of several related embodiments, upon obtaining a characteristic curvature and orientation for the remote mirror the laser range finder can use this information to determine a corrected 3D location for laser reflections that are determined to have undergone deflection by the remote mirror.
3D Depth Map
The accuracy of computed 3D locations (e.g. location 915c) corresponding to laser reflections that have undergone deflection by a remote mirror 620 can be improved by performing one or more correction steps (illustrated by arrow 935) in the process of computing the corresponding 3D locations. In one aspect of several embodiments the deflected subset 740 of the set of laser reflections are first identified and then a correction step is performed during the process of calculating the corresponding 3D locations. The correction step can generate a subset of corrected 3D locations 940 corresponding to the deflected subset of laser reflections. In several embodiments the correction step can account for at least in part the deflection of the deflected subset 740 of laser reflections by the remote mirror. Exemplary corrections (illustrated by arrow 935) can include operations on the incident direction associated with a laser reflection in the deflected subset such as adding, subtracting, multiplying or dividing a vector associated with the incident direction by another correction vector or scalar. A more complex correction step could be to determine the position of the mirror in 3D space, calculate the incident angle of a laser reflection on the remote mirror and compute a corrected 3D location based on the position of the mirror and the estimated incident angle. In a related embodiment, laser range finder 910 can obtain data indicative of the curvature and/or orientation of remote mirror 620, and can then compute a corrected 3D location based at least in part on the curvature of the remote mirror.
In another exemplary embodiment, a remote mirror (e.g. a roadside mirror on a road bend) can have a known transfer function (e.g. relating incident and outgoing angle on the mirror). Laser range finder 910 can then obtain the transfer function of the remote mirror 620 (e.g. by receiving the transfer function in signals from the remote mirror or by lookup of mirror characteristics for a particular road intersection). Laser range finder 810 can then use the location of the remote mirror and the transfer function to determine a relationship between incident direction on the remote mirror and the incident direction of deflected laser reflections on the detector 440. Laser range finder 910 can use this relationship as a correction step in the process of generating 3D locations corresponding to laser reflections in the deflected subset 740.
Operation
Processing subassembly 520 can include a sensor data processor (e.g. processor 475 in
A 3D location for a deflected laser reflection can be computed using one or more correction steps that are based at least in part on the accuracy of a previous corrected 3D location. For example, the accuracy of a previous 3D location computed using a correction step to account at least in part for a remote mirror can be compared against a 3D location for the same reflection location gathered directly from the same reflection location. In this way a laser range finder can perform a closed loop comparison of corrected 3D locations and uncorrected 3D locations for the same reflection point from different points in time.
At step 1130 a 3D location is computed for each laser reflection in the set of laser reflections. At step 1130, for each laser reflection in the set of laser reflections sub-step 1140 is performed to determine if the laser reflection has undergone deflection by the remote mirror and depending on the outcome either sub-step 1150 or 1160 is performed in order to determine the corresponding 3D location. At step 1140 method 1100 determines whether a laser reflection from the set of laser reflections has undergone deflection by the remote mirror. Step 1140 can use one or more approaches previously described to make the determination of whether each laser reflection has been deflected by the remote mirror. Exemplary detection methods can include detecting aspects of the reflection (e.g. reflection range), the dynamic range of surrounding laser reflections, consistency with surrounding laser reflections and a reflection direction that is associated with a remote mirror. Upon determination that a laser reflection has not undergone deflection by a remote mirror at step 1150 a 3D location indicative of a reflection location corresponding to the laser reflection is calculated. At step 1150 a laser reflection can be considered to have a reflection location along the reflection direction of the incoming laser reflection (i.e., the reflection arrives directly from the reflection location without changing direction along the way).
Upon determination at step 1140 that a laser reflection has undergone deflection by a remote mirror the method performs step 1160. At step 1160 a 3D location indicative of a reflection location corresponding to the laser reflection is calculated including performing at least one correction step in the calculation of the 3D location. The at least one correction step can function to account for deflection of the laser reflection by the remote mirror (e.g. improve the accuracy of the computed 3D location relative to the corresponding reflection location for the laser reflection). Alternatively, the correction step can function to isolate, identify or indicate the 3D locations corresponding to laser reflections that have undergone deflections (e.g. isolating the corresponding 3D locations by modifying the 3D location relative to undeflected 3D locations to occupy a particular portion of a 3D depth map).
At step 1145 a 3D location indicative of a corresponding reflection location is computed for each laser reflection in the set of laser reflections. The computing at step 1145 includes at least one correction step performed exclusively when computing 3D locations corresponding to the laser reflection in the first subset of the set of laser reflections. For example, step 1145 can include performing with a processor a set of instructions stored in a computer memory to determine a 3D location corresponding to each laser reflection in the set of laser reflections. The at least one correction step can comprise one or more instructions that are only included in the set of instructions performed for a laser reflection when that laser reflection is in the first subset of the set of laser reflections.
In a related embodiment, step 1125 can be performed to determine the location of the remote mirror. The location of the remote mirror can be a 3D location, a range of 3D locations, a 2D location within the FOV or a range of locations within the FOV. The location of the remote mirror can subsequently be used at step 1135 to determine the subset of the set of laser reflections that have been deflected by the remote mirror. For example, the mirror can be estimated or determined to occupy a first 2D angular range in the detector FOV (i.e., an azimuthal angular range and an elevation angular range). All laser reflections determined by the detector to have incoming directions within the 2D angular range in the FOV can be considered to have undergone deflection by the remote mirror.
A Remote Mirror with Non-Uniform Laser Range Finding
A mirror in the local environment of a laser range finder can augment a direct field of view (i.e., all the directions that the laser range finder can receive a reflection directly) with an indirect field of view. A convex mirror compresses a large field of view into a smaller reflected image which can be difficult for humans to understand or intuitively recognize due to distortion or size scale. A laser range finder can interrogate such a convex mirror with a dense set of incident laser pulses (e.g. with a greater spatial density than the average laser pulse density for the whole FOV) thereby increasing utilization of the remote mirror and increasing the amount of refection data gathered from the remote FOV provided by the remote mirror. For example, a convex roadside mirror may only occupy a 10-by-10 degree portion of a LIDAR's field of view but may offer insight into a 90 degree range of input angles thereby providing a 90 degree indirect field of view to the LIDAR. In one embodiment, a laser range finder identifies a mirror region of range finder FOV that containing a remote mirror and generates a dense non-uniform subset of laser pulses in the mirror region, thereby interrogating the indirect field of view offered by the remote mirror and improving the utilization of the remote mirror.
Mirrors serve a variety of useful purposes that aid human visual activities. For example, rearview mirrors help drivers see objects behind the vehicle without turning their heads and roadside mirrors help drivers see around bends in the road. Similarly, mirrors on trailers help drivers to see the sides and rear of trailers. Cameras can perform some of the functions of mirrors by capturing a remote field of view but cameras capture an image and recreate a representation of the image elsewhere. The recreated image is only representative of the rays of light incident on the camera CCD array. In contrast, mirrors can deflected rays of light from objects in an indirect field of view towards an observer, thereby providing direct optical detection (i.e., actual light rays not recreated reflections) from remote objects.
While a mirror can provide a useful indirect FOV they often distort the shape and condense the size of reflected objects. This can be confusing to humans. For example, vehicle wing mirrors are typically convex mirrors designed to gather a reflections from a greater angular range (i.e., indirect FOV) than an equivalent flat mirror. This convex shape causes reflections to appear smaller and hence many wing-mirrors carry a warning label stating “Objects are closer than they appear”. Humans can have difficulty making use of remote mirrors because of distortions and image size reduction. For example, a driver could require an increased reaction time to comprehend a distorted image in a roadside mirror (e.g. showing reflections from around a bend in the road). Similarly, the condensing nature of convex mirrors makes them ineffective when drivers are far away. Hence roadside mirrors have been used with only limited success for vehicles driven by humans.
Interestingly, computer-based optical ranging systems (e.g. LIDARs) can make better use of remote mirrors, thereby promoting their use in autonomous driving applications. Reasons for this include the ability of computer systems to zoom in on a discovered remote mirror with greater acuity than humans and thereby gather a wealth of information from the indirect FOV offered by the remote mirror even at considerable distance from the remote mirror. For example, consider a remote mirror (e.g. a roadside mirror) encountered by a laser range finding system on an autonomous vehicle. The remote mirror may not be a permanent fixture in the FOV of the laser range finder. Alternatively, the remote mirror may be a permanent fixture but have a placement (e.g. location in or portion of the FOV) that is variable and not under the direct control of the laser range finder. The laser range finder can start by learning the location of the remote mirror and then can dynamically increase the density of laser ranging measurements in the region of the field of view containing the remote mirror. In this way, a mirror (e.g. a roadside mirror 100 m away) may occupy a small portion of the field of view of the laser range finder but offer reflections from a wide range of angles (e.g. a large indirect FOV). A laser range finder according to one embodiment could generate a non-uniform measurement distribution in the range finder FOV with a high density of measurements located in a portion of the FOV that interrogates the remote mirror and gains a wealth of information about objects reflected in the remote mirror. For example, imagine a remote mirror at an traffic intersection that occupies 1-5% of the FOV of a laser range finder on an approaching vehicle 100 m away and uses a denser than average subset of laser pulses to map the distance to objects reflected in the remote mirror. Such a system could generate a 3-D depth map of the traffic intersection by interrogating the remote mirror while approaching the intersection. In another aspect the remote mirror at the intersection can have a variable orientation (e.g. can rotate or scan) and can report or broadcast the position of the remote mirror, thereby facilitating the approaching laser range finder to correct the laser beams deflected by the remote mirror.
Therefore one aspect of several embodiments is to identify and track the variable location of a remote mirror in the FOV of a laser range finder. Another aspect of several embodiments is to dynamically control the laser range finder to increase the density of laser ranging measurements in a region of the FOV that contains the remote mirror. For example, in one exemplary embodiment a laser range finder periodically determines a region of the FOV that contains a remote mirror, and generates instructions to dynamically steer a steerable laser assembly to track the location of the remote mirror with a high density of laser pulses relative to the average laser pulse density for the whole FOV. A detector in the laser range finder can thereby receive a dense plurality of laser reflections from the region of space reflected in the remote mirror.
In one simple embodiment, a method for increasing the utilization of a remote mirror by a laser range finder comprises the steps of: obtaining at electronic circuitry a location estimate for a remote mirror located in the vicinity of a laser transceiver, operating a laser transceiver subassembly comprising a laser generator and a laser detector, based at least in part on the location estimate and thereby detecting a set of laser reflections from a corresponding set of outgoing laser pulses such that a first subset of the laser reflections are deflected by the remote mirror and that first subset has a greater than average density in the laser transceiver FOV.
In another simple embodiment, a laser range finder apparatus with enhanced utilization of a remote mirror comprises: Electronic circuitry at least some of which is coupled to a laser transceiver subassembly, wherein the electronic circuitry obtains a location estimate for a remote mirror. The laser transceiver subassembly comprises a laser generator, a detector and means to generate a high density measurement region with a higher than average density of laser reflection measurements (e.g. more reflection data gathered per unit solid angle or angular area in the detector FOV). The electronic circuitry instructs the means to generate the high density measurement region to position the high density measurement region such that a subset of the set of reflections measured by the detector is both deflected by the remote mirror and has a greater than average measurement density.
For example, a laser range finder can scan a FOV with a 360 azimuthal range and a 20 vertical range. The laser range finder can scan the FOV with a nominal measurement density of one outgoing and reflected laser pulse every 5 degree in the azimuthal direction. The laser range finder can detect a vehicle wing-mirror in the FOV and control a laser transceiver subassembly (e.g. a steerable laser assembly) to increase the measurement density to one measurement every 1 degree in the azimuthal direction in a small portion of the FOV, the small portion being based on a location estimate for a remote mirror. The laser range finder can thereby receive a first subset of the laser reflections that has been deflected by the remote mirror and with a greater than average density (e.g. 1 measurement every 1 degree). The higher density subset of reflection can be very useful for improving the utilization of the remote mirror. For example, if the remote mirror condenses a 50 degree angular range (e.g. a remote mirror FOV) into a 10 degree portion of the detector FOV the high density subset of the laser reflections would serve to provide one measurement for every 1 degree of azimuthal range, thereby corresponding to one measurement every five degrees of the angular range captured by the remote mirror.
Various embodiments can improve the utilization of a remote mirror by scanned laser range finders and flash-based laser range finders. Hence, several embodiments provide a method to discover remote convex mirror in the FOV and develop laser steering parameters designed to interrogate the remote mirror more effectively, for example with a customized non-uniform sequence of laser pulses that has increased density, decreased angular spacing, smaller or larger laser spot sizes, or optimized laser intensity.
In a scanned laser range finder embodiment, a laser transceiver subassembly can be a steerable laser assembly operable to scan a laser beam in a dynamic non-uniform sequence based on instructions from coupled electronic circuitry. The steerable subassembly can comprise a laser generator, a laser positioner and a detector. The electronic circuitry can determine a location estimate for a remote mirror. The electronic circuitry can instruct the steerable laser assembly to scan the FOV in a non-uniform manner based on the location estimate and thereby generate a set of laser reflections with a first subset that has been both deflected by the remote mirror and has a greater than average density, thereby providing enhanced utilization of the remote mirror.
In a flash LIDAR embodiment, the laser generator can generate a set of laser pulses that illuminate some or all of the FOV at once. Hence with a flash LIDAR it is difficult to increase the pulse density specifically in a region of the FOV containing the mirror. In a flash LIDAR embodiment reflections arrive at the detector from many locations in the detector FOV at once. Hence the detector is often an array of individual detectors (e.g. a focal plane array or a CCD). A flash LIDAR can selectively magnify a portion of the FOV onto a portion of the detector, thereby providing a variable measurement density from different regions of the FOV. A magnifying component (e.g. a lens) can be controlled based on the estimated location of the remote mirror to provide a subset of the set of laser reflections with greater than average measurement density and the subset can also be selected to include those reflections that have undergone deflection by the remote mirror. Hence a flash LIDAR with dynamically steerable magnification of a portion of the FOV (e.g. a zoom lens that can be moved relative to a detector array), can implement one embodiment of the remote mirror utilization method.
In the embodiment of
Turning in detail to
In several other embodiments the electronic circuitry 1240 can receive sensor data and obtain the location estimate for the remote mirror by processing the sensor data. For example, a processing subassembly (e.g. 520 in
Laser range finder 1210 can include a steering parameter generator/modifier, which can generate a set of steering parameters (e.g. instructions) operable to dynamically steer the steerable laser assembly to generate a non-uniform distribution of laser pulses in the FOV, based on the location estimate for the remote mirror.
Steering parameter generator/modifier 410 can transmit the set of steering parameters to the laser transceiver subassembly 1210 (e.g. steerable laser subassembly). In the embodiment of
Turning to
One challenge with flash LIDAR is limited measurement density (i.e., the number of measurements gathered from each laser flash). Often the FOV is uniformly magnified onto the detector array 1275. Interestingly, the embodiment of
Upon estimating the location of a remote mirror in the FOV several embodiments can dynamically vary other properties of the outgoing laser pulses (e.g. pulse intensity, laser spot size, laser divergence angle, pulse repetition rate, or laser color) to increase utilization of the remote mirror for ranging activities. For example,
LIDAR with Feedback Control of Remote Mirror
In a related area, autonomous vehicles may increasing rely on mirrors to augment the direct FOV of several sensors (e.g. laser range finders and cameras) with an indirect FOV provided by directions in the FOV of the sensors for which light is deflected by the mirrors. In several situations these mirrors can be remote mirrors and have aspects that complicate their interaction with autonomous vehicle sensors. Exemplary remote mirror aspects can include transient placement in the FOV of a sensor, occupying a small (e.g. <10%) variable portion of the FOV of a sensor, uncontrolled variable position in the FOV of a sensor and uncontrolled variable distance of the remote mirror and placement of the remote mirror on an unknown part of a vehicle enabling unforeseen movement independently of the sensor. Modern laser range finders (e.g. LIDARs) often incorporate rotating or scanning mirrors to scan a FOV and have used compensation mirrors to deflect all outgoing laser pulses. These mirrors are typically incorporated into the housing of the range finder and have a predetermined position in the FOV of the laser range finder (e.g. a compensation mirror or a scanning mirror). The controlled motion or controlled position of integrated mirrors enables the manufacturer to anticipate the effect of the mirror on a laser beam or accurate characterize the transfer function of the mirror. For example, a scanning mirror in a rotating LIDAR is assumed to deflect one or more laser beams from a laser generator in a predetermined manner as the scanning mirror rotates. For example, a scanning mirror in a LIDAR is characterized by the manufacturer and a dedicated position sensor is often provided such that the direction of a laser reflection can be estimated from the known characteristics and position of the scanning mirror.
In the real world a laser range finder can encounter remote located mirrors that are not well characterized (e.g. occupies an unknown position, or occupies a variable and unknown region of the FOV). A remote mirror may have unknown characteristics such as curvature, orientation, distance and occupy an unknown region of the FOV. In one example, a remote mirror on the trailer of an articulated truck can provide a very useful indirect FOV (e.g. in a blind spot behind the trailer). One challenge for a laser range finders with control over a remote mirror (e.g. on a vehicle trailer) is to select a position (e.g. orientation) for that remote mirror that provides the most effective indirect portion of the FOV (e.g. that portion in which laser reflection have been deflected by the remote mirror). In several aspects this challenge can be likened to how rental-car customers often adjust the wing-mirrors on their rental car, based on their preferences and visual feedback. A remote mirror can be useful for laser range finding as well as computer vision system (e.g. camera systems) on an autonomous or semi-autonomous vehicle. In one aspect the remote mirror can be remotely positioned based at least in part on processing laser reflections that have undergone deflection by the remote mirror.
Consider that an autonomous articulated truck can benefit greatly from remote located mirrors located on the trailer. The tractor portion can contain a laser range finder and can have an electrical cable with a separable coupling (e.g. an electrical connector) operable to connect to a mirror positioner to position a remote mirrors on a trailer. During a typical week the tractor can pull a variety of different trailers, each comprising a different arrangement and placement of remote mirrors. Hence in one aspect of several embodiments a method includes the steps of coupling two communication components (e.g. the two halves of an electrical connector) to form a communication link between a laser range finder in the tractor of a vehicle and a remote mirror in the trailer portion of an articulated vehicle. Upon establishing a communication link with a remote mirror, the laser range finder with remote mirror control capability can adjust the one or more remote mirrors. Electronic circuitry (e.g. a processing subassembly) can send position signals to the remote mirror to adjust the remote mirror based on a criterion (e.g. that some of the rear of the trailer must appear in reflections from the remote mirror) or based on stored preferences. In one aspect the mirror positioning signals can be based on processed aspects of laser reflections that have been deflected by the remote mirror, thereby providing rangebased feedback control of the remote mirror to address the challenges associated with the unknown remote mirror characteristics.
Consider that upon sensing a new remote mirror coupled to a laser range finder several key aspects may be unknown such as the location of the remote mirror in 3D space relative to the laser range finder, the portion of the FOV of the laser range finder occupied by the remote mirror, the orientation (e.g. direction) of the remote mirror or the actual locations of objects reflected in the remote mirror (e.g. the indirect FOV). While the initial orientation of the remote mirror can be reported to a processing subassembly in the laser range finder, properties such as the reflection locations provided by the remote mirror and the portion of the FOV in which laser reflections are deflected by the remote mirror can require feedback of reflection data and subsequent adjustment of the remote mirror.
In one exemplary embodiment, a method for provisioning a remote mirror by a laser range finder includes the steps of; generating a set of outgoing laser pulse, detecting a corresponding set of laser reflections including at least some reflections that have been deflected by the remote mirror. The exemplary method then generates reflection data from the set of laser reflections and processes at least some of the reflection data to generate one or more position signals operable to instruct a mirror positioner to change the position of the remote mirror. In some embodiments the method continues to adjust the remote mirror based on gathered laser reflections until a criterion is satisfied (e.g. a quality aspect of the remote FOV offered by the remote mirror, or a determination of the portion of the FOV in which reflections are deflected by the remote mirror). In one example, the processing subassembly can process the reflection data and adjust the remote mirror position until a criterion is satisfied such as seeing a portion of the trailer in the deflected subset of laser reflections is achieved. Embodiments of this disclosure enable the mirror to be provisioned by the laser range finder based on desired range or desired reflection location.
In one embodiment a system for adjusting a remote mirror can comprise a laser transceiver subassembly to gather laser ranging data, a processing subassembly, a remote mirror, a mirror positioner, a communication cable and a separable coupling (e.g. an electrical connector). The system for adjusting the remote mirror operates to position the remote mirror based on processing reflection data from a set of laser reflections, including some laser reflections that have undergone deflection in the remote mirror.
Laser transceiver subassembly 1520 can further comprise a detector 440. Laser detector 440 can comprise a single photodiode, pin diode or an array of photo diodes, pin diode or charge coupled devices (CCDs) that functions to receive a set of laser reflections corresponding to a set of outgoing laser pulses from the laser generator and thereby generate reflection data. A remote mirror 620 positioned in the FOV 670 causes some of the set of laser reflections (e.g. 1525a) to undergo deflection by the remote mirror prior to reaching the detector. Other laser reflections (e.g. 1525b) reach the detector directly.
Detector 440 can comprise circuitry to generate reflection data corresponding to the set of laser reflections indicative of the reflection location. Detector 440 can transmit at least some of the reflection data to a processing subassembly 520. Reflection data can include a corresponding range for each laser reflection in the set of laser reflections. The range can be calculated based on the time of flight of the corresponding laser reflection relative to the transmission time of a corresponding outgoing laser pulse. For example, if light travels at 300 meters per microsecond and the time of flight of a reflection is 1 microsecond then the range for the laser reflection can be estimated as 150 meters from the detector. Reflection data can include a corresponding direction for each laser reflection in the set of laser reflections. The direction can be at least a two-dimensional direction. The direction corresponding to each laser reflection can be a measure of the direction of a mechanically steerable laser assembly at the time of arrival of the laser reflection or can be a pixel (e.g. single element) of a detector array indicating the direction in which the laser reflection struck a detector comprising an array of elements (e.g. photodetectors). In
Processing subassembly 520 can be housed in laser range finder 1510 with laser transceiver subassembly 1520 or can be a separate processing subassembly coupled to laser transceiver subassembly 1520 by a communication link (e.g. an Ethernet cable). Processing subassembly 520 can perform a variety of functions including processing at least some of the reflection data and thereby generating one or more position signals operable to cause a mirror positioner 840 to change the position of remote mirror 620. For example, processing subassembly 520 can process at least some of the reflection data, to identify a subset of the laser reflections that has been deflected by remote mirror 620 (or the corresponding subset of the reflection data) and thereby generate a position signal based on the identified subset. In another example processing subassembly 520 can identify a deflected subset of the reflection data and evaluate a test on the deflected subset of the reflection data and determine one or more position signals for the mirror positioner based on the test result.
Processing subassembly 520 can further comprise a transmitter 1530. Mirror positioner 840 can comprise a receiver 1535 that functions to communicatively couple the processing subassembly 520 to the mirror positioner 840. Transmitter 1530 can transmit position signals using a cable 1540 comprising at least one wire to carry position signals to the mirror positioner. The cable 1540 can be designed to carry a specific signal protocol such as an Ethernet cable, CANBUS cable, a serial communication cable, USB cable. Alternatively the communication cable can carry voltage pulses designed to actuate a mechanical motor or actuation component in the mirror positioner. Cable 1540 can include one or more signal wires to carry position signals and one or more power wires to carry power from electronic circuitry to the mirror positioner.
In one example, many tractor-trailer vehicles use coiled cables (e.g. SAE J2394 7-conductor cables) for coupling ABS brakes in the trailer to ABS controllers in the tractor portion. A tractor-trailer truck with a remote mirror 620 and mirror positioner 840 located on the trailer can transmit position signals from electronic circuitry (e.g. processing subassembly 520) located in the tractor portion using one or more SAE J2394 standard coiled cables. Cable 1540 can have a separable coupling, such as connector 1545a, (e.g. a 7-way connector, common in commercial vehicles) operable to connect a corresponding connector 1545b connected to mirror positioner 1545b. Connectors 1545a and 1545b can provide a separable communication link for transmitting position signals from communication circuitry (e.g. processing subassembly 520) to the mirror positioner 840.
Transmitter 1530 can be a wired transceiver such as a CANBUS, SAE J1939 or Ethernet transceiver. Transmitter 1530 can receive position data from processing subassembly 520 and subsequently generate corresponding position signals based on the position data. For example, transmitter 1530 can perform actions such as assigning a communication address to mirror positioner 840 and then generating position signals using the assigned address and the position data.
Transmitter 1530 can also be a wireless transmitter that utilizes an antenna 1550a to transmit one or more position signals wirelessly to a corresponding receiver 1535 and antenna 1550b at the mirror positioner. Transmitter 1530 can use a variety of short range wireless protocols (e.g. Bluetooth, Zigbee, or Wi-Fi) to transmit position signals to the mirror positioner. For the purposes of this disclosure a short range wireless signal is a wireless signal with an effective operating range of less than 400 m. Transmitter 1530 can use a variety of long range wireless protocols such as 3G, 4G or 5G protocols to transmit position signals. For the purpose of this disclosure a long range wireless protocol has a range greater than 400 m. Transmitter 1530 can be responsible for forming a wired or wireless link between electronic circuitry (e.g. processing subassembly 520) and the mirror positioner 840, including receiver discovery, protocol arbitration, address assignment advertising and link maintenance. In one example, upon receiving power a remote mirror positioner 840 can begin advertising its presence and capabilities. Transmitter 1530 can be part of a transceiver that receives the advertising signals from the remote mirror positioner and establishes a communication link operable to transfer position signals from the processing subassembly 520 to the mirror positioner 840.
The mirror positioner 840 can be mechanically coupled to the remote mirror 620 and communicatively coupled to processing subassembly 520. Mirror positioner 840 can function to position the remote mirror in response to receiving one or more position signals from the processing subassembly or other electronic circuitry attached to the laser transceiver subassembly 1520. Mechanical positioner 840 can comprise a motor or actuator (e.g. a steeper motor, a linear actuator, or servo motor) to change the position of remote mirror 620.
The mirror positioner 840 can change the orientation of a remote mirror (e.g. cause the mirror to rotate by a specified amount or to a specified direction about an axis). For example, the mirror positioner can comprise an axle 1570 around which the remote mirror can rotate. In some instances position signals cause a change in position by a specific amount (e.g. 1 degree per voltage pulse). A position signal can specify a change in position relative to a known or unknown starting position for the remote mirror. In some instances position signals can specify a specific position (e.g. a position signals that specifies positioning a remote mirror at 12 o'clock relative to a trailer) The mirror positioner can change the location of the mirror, for example by extending axle 1570 to raise or lower the remote mirror by a specified amount or to a known height.
A position signal can cause the mirror positioner to perform a discrete position change on the remote mirror (e.g. a single position change from North to West facing). An example of a discrete position change in response to a position signals can be a one-time rotation of a stepper motor by 10 degrees, or raising a mechanical coupling by 1 cm. A position signals can be a discrete position signal if it causes the mirror positioner to perform a non-continuous change in the position of a remote mirror. The non-continuous position change can be a single position change or a non-continuous sequence (e.g. change the position of the remote mirror from North to West in 10 degree increments with a 1 second pause in between each increment). For the purpose of this disclosure a mirror positioner that causes a remote mirror to discretely change the position of a remote mirror is performing a non-continuous or discrete position change.
Alternatively, a position signal can causes the mirror positioner to continuously change the position of the mirror (e.g. a signal that causes the mirror positioner to spin the remote mirror). For example, one or more position signals from a processing subassembly 520 can cause the mirror to rotate or scan from side to side at a new speed. For the purpose of this disclosure a position signal is a continuous position signal if it causes the remote mirror to continuously change position. A mirror positioner that causes a remote mirror to continuously change position is performing a continuous position change. For example, a continuous sequence of discrete position signals, can cause a mirror positioner to perform a continuous position change on a remote mirror.
In a first simple embodiment, a remote mirror control system 1500 comprises a laser transceiver subassembly 1520, electronic circuitry (e.g. processing subassembly 520) and a means to transmit position signals to a mirror positioner 840, thereby controlling a remote mirror 620 that appears in the FOV 670 of the laser transceiver subassembly 1520. The means to transmit position signals to remote mirror position 840 can include one or more of electrical cable 1540, connector 1545a, transmitter 1530 and antenna 1550a.
In a second embodiment a laser range finder 1510 comprises laser transceiver 1520, and processing subassembly 520. Laser range finder 1510 can be operably coupled to mirror positioner 840 and operable to generate one or more position signals based on processing reflection data and thereby cause mirror positioner 840 to change the position of a remote mirror in the FOV of laser range finder 1510.
In a third embodiment a remote mirror control system 1500 can include a laser range finder 1510 and means to transmit position signals to a mirror positioner 840, thereby controlling a remote mirror 620 that appears in the FOV 670 of the laser transceiver subassembly. In another related embodiment a remote mirror control system 1500 can include a laser range finder 1510, one or more mirror positioners (e.g. 840) coupled to one or more remote mirrors (e.g. 620) and means to transmit position signals to a mirror positioner 840. In response to processing at least some of the reflection data from the detector 440 processing subassembly 520 can transmit control signals to the mirror positioner to change the position of the remote mirror. Processing subassembly 520 can receive sensor data (e.g. from steering sensor 1531 indicating the steering angle of a vehicle or camera data indicating the orientation of the vehicle or surrounding scene). The processing subassembly can generate a criterion based on the sensor data. The criterion can be a measure of performance of the remote mirror or the laser range finder system 1510, such as the ability to see a particular blind spot around a vehicle when turning. The processing subassembly can perform feedback control of the remote mirror in order to satisfy the criterion. For example, the processing subassembly can repeatedly generate and transmit signals to the mirror positioner to reposition the mirror in a process to eventually satisfy the criterion based on the laser reflections in the deflected subset. In some embodiments one or more position signals can be selected based on a known lookup table or transfer function that uses the steering angle of the vehicle as an input. For example, a steering angle of 15 degrees can cause the processing subassembly to command the remote mirror to reorient to provide coverage of a blind spot.
In a related embodiment a remote mirror 1650 and a corresponding mirror positioner 840 can be located on the trailer portion 1630. Upon connecting a new trailer to the tractor an operator or a robot can attach connectors 1545a and 1545b. Following attachment of the connectors, cable 1540 can supply power to mirror positioner 840 and communicatively couple laser range finder 1610 to mirror positioner 840. Remote mirror 1650 can be one of a plurality of remote mirrors on trailer 1630 that are communicatively coupled by cable 1530 and connector 1545a. Hence the remote mirror positioning system can be used to dynamically learn and adjust the position of remote mirrors in the FOV of laser range finder 1610. In some embodiments laser reflections can travel directly from the laser range finder 1610 to a remote mirror on the trailer. In other embodiment laser reflections (e.g. angular range 1640) are deflected by a plurality of mirrors in the path to and from a remote mirror. For example, laser reflections that undergo deflection by remote mirror 1650 also undergo deflection by wing-mirror 1625a in the process of reaching the detector in laser range finder 1610. For this and other reasons the transfer function between position signals and reflection data can be complex be best learned by performing a sequence of initial adjustments on the remote mirrors. Several embodiments of this disclosure provide a system and method for learning the arrangement-specific transfer function between remote mirrors and their effect on the FOV of a laser range finder (e.g. laser range finder 1610 in a tractor of an articulated vehicle). For example, upon attaching a new trailer, laser range finder 1610 can perform a series of adjustments to remote mirror 1650 to ensure that the range of possible reflection locations includes the space behind the trailer where person 160 can be standing. The series of adjustments can include first processing at least some of the reflection data form a detector in the laser range finder and thereby adjusting wing-mirror 1625a to position remote mirror 1650 in the FOV of wing-mirror 1625a. The series of adjustments can further include processing at least some of the reflection data and thereby generating position signals to cause the mirror positioner 840 to change the position of remote mirror 1650 until a criterion involving the reflection locations offered by remote mirror 1650 is satisfied.
At step 1720 one or more detectors in the laser transceiver subassembly detects a set of laser reflections corresponding to at least one of the set of outgoing laser pulses and thereby generating reflection data, wherein at least some of the laser reflections in the set of reflections have undergone deflection by a remote mirror. At step 1730 at least some of the reflection data is processed and one or more position signals are thereby generated. In one embodiment the at least some of the laser reflection data includes data from at least one laser reflection that has been deflected by the remote mirror. At step 1740 the one or more position signals are transmitted to a mirror positioner that changes the position of the remote mirror, based at least in part on the one or more position signals.
In a group of related embodiments one or more remote mirrors on an articulated vehicle can be used by a laser range finding system to provide laser ranging of indirect fields of view outside of FOV of the laser range finder that can be accessed directly. When the articulated vehicle is travelling in a straight line these remote mirrors can occupy a first position that can be optimized for driving in a straight line. The laser range finder can process at least some of the reflection data and identify objects or aspects of the region shown in the remote mirrors (e.g. a range of remote reflection locations behind the articulated vehicle). The laser range finder can identify a portion of the FOV in which laser reflections are deflected by the remote mirror. At some later time the vehicle can execute a turn and sensor data from one or more sources can indicate the turn (e.g. an angle detector on the trailer kingpin or steering angle measured by the steering wheel). In response to receiving sensor data indicating the turn, the laser range finder can calculate an updated location or orientation for one or more remote mirrors in the FOV. In another aspect a processing subassembly associated with a laser range finder can signal a mirror positioner associated with the remote mirrors to change the position of the remote mirrors to compensate for the change in shape of the articulated vehicle. For example, when executing a sharp right turn the processing subassembly can sense the turn and instruct one or more mirror positioners to turn the mirrors to compensate for a laser ranging blind-spot that would otherwise occur if the remote mirrors were not repositioned during the turn. Therefore, in one aspect a processing subassembly can dynamically track the position of the remote mirrors as the vehicle turns and in another aspect the processing subassembly associated with the laser range finder can instruct the mirror positioner to compensate for the change in position of the remote mirror.
While the above description contains many specificities, these should not be construed as limitations on the scope of any embodiment, but as exemplifications of various embodiments thereof. Many other ramifications and variations are possible within the teachings of the various embodiments. Thus the scope should be determined by the appended claims and their legal equivalents, and not by the examples given.
Any of the methods (including user interfaces) described herein may be implemented as software, hardware or firmware, and may be described as a non-transitory computer-readable storage medium storing a set of instructions capable of being executed by a processor (e.g., computer, tablet, smartphone, etc.), that when executed by the processor causes the processor to control perform any of the steps, including but not limited to: displaying, communicating with the user, analyzing, modifying parameters (including timing, frequency, intensity, etc.), determining, alerting, or the like.
When a feature or element is herein referred to as being “on” another feature or element, it can be directly on the other feature or element or intervening features and/or elements may also be present. In contrast, when a feature or element is referred to as being “directly on” another feature or element, there are no intervening features or elements present. It will also be understood that, when a feature or element is referred to as being “connected”, “attached” or “coupled” to another feature or element, it can be directly connected, attached or coupled to the other feature or element or intervening features or elements may be present. In contrast, when a feature or element is referred to as being “directly connected”, “directly attached” or “directly coupled” to another feature or element, there are no intervening features or elements present. Although described or shown with respect to one embodiment, the features and elements so described or shown can apply to other embodiments. It will also be appreciated by those of skill in the art that references to a structure or feature that is disposed “adjacent” another feature may have portions that overlap or underlie the adjacent feature.
Terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of the invention. For example, as used herein, the singular forms “a”, “an” and “the” are intended to include the plural forms as well, unless the context clearly indicates otherwise. It will be further understood that the terms “comprises” and/or “comprising,” when used in this specification, specify the presence of stated features, steps, operations, elements, and/or components, but do not preclude the presence or addition of one or more other features, steps, operations, elements, components, and/or groups thereof. As used herein, the term “and/or” includes any and all combinations of one or more of the associated listed items and may be abbreviated as “/”.
Spatially relative terms, such as “under”, “below”, “lower”, “over”, “upper” and the like, may be used herein for ease of description to describe one element or feature's relationship to another element(s) or feature(s) as illustrated in the figures. It will be understood that the spatially relative terms are intended to encompass different orientations of the device in use or operation in addition to the orientation depicted in the figures. For example, if a device in the figures is inverted, elements described as “under” or “beneath” other elements or features would then be oriented “over” the other elements or features. Thus, the exemplary term “under” can encompass both an orientation of over and under. The device may be otherwise oriented (rotated 90 degrees or at other orientations) and the spatially relative descriptors used herein interpreted accordingly. Similarly, the terms “upwardly”, “downwardly”, “vertical”, “horizontal” and the like are used herein for the purpose of explanation only unless specifically indicated otherwise.
Although the terms “first” and “second” may be used herein to describe various features/elements (including steps), these features/elements should not be limited by these terms, unless the context indicates otherwise. These terms may be used to distinguish one feature/element from another feature/element. Thus, a first feature/element discussed below could be termed a second feature/element, and similarly, a second feature/element discussed below could be termed a first feature/element without departing from the teachings of the present invention.
Throughout this specification and the claims which follow, unless the context requires otherwise, the word “comprise”, and variations such as “comprises” and “comprising” means various components can be co-jointly employed in the methods and articles (e.g., compositions and apparatuses including device and methods). For example, the term “comprising” will be understood to imply the inclusion of any stated elements or steps but not the exclusion of any other elements or steps.
In general, any of the apparatuses and methods described herein should be understood to be inclusive, but all or a sub-set of the components and/or steps may alternatively be exclusive, and may be expressed as “consisting of” or alternatively “consisting essentially of” the various components, steps, sub-components or sub-steps.
As used herein in the specification and claims, including as used in the examples and unless otherwise expressly specified, all numbers may be read as if prefaced by the word “about” or “approximately,” even if the term does not expressly appear. The phrase “about” or “approximately” may be used when describing magnitude and/or position to indicate that the value and/or position described is within a reasonable expected range of values and/or positions. For example, a numeric value may have a value that is +/−0.1% of the stated value (or range of values), +/−1% of the stated value (or range of values), +/−2% of the stated value (or range of values), +/−5% of the stated value (or range of values), +/−10% of the stated value (or range of values), etc. Any numerical values given herein should also be understood to include about or approximately that value, unless the context indicates otherwise. For example, if the value “10” is disclosed, then “about 10” is also disclosed. Any numerical range recited herein is intended to include all sub-ranges subsumed therein. It is also understood that when a value is disclosed that “less than or equal to” the value, “greater than or equal to the value” and possible ranges between values are also disclosed, as appropriately understood by the skilled artisan. For example, if the value “X” is disclosed the “less than or equal to X” as well as “greater than or equal to X” (e.g., where X is a numerical value) is also disclosed. It is also understood that the throughout the application, data is provided in a number of different formats, and that this data, represents endpoints and starting points, and ranges for any combination of the data points. For example, if a particular data point “10” and a particular data point “15” are disclosed, it is understood that greater than, greater than or equal to, less than, less than or equal to, and equal to 10 and 15 are considered disclosed as well as between 10 and 15. It is also understood that each unit between two particular units are also disclosed. For example, if 10 and 15 are disclosed, then 11, 12, 13, and 14 are also disclosed.
Although various illustrative embodiments are described above, any of a number of changes may be made to various embodiments without departing from the scope of the invention as described by the claims. For example, the order in which various described method steps are performed may often be changed in alternative embodiments, and in other alternative embodiments one or more method steps may be skipped altogether. Optional features of various device and system embodiments may be included in some embodiments and not in others. Therefore, the foregoing description is provided primarily for exemplary purposes and should not be interpreted to limit the scope of the invention as it is set forth in the claims.
The examples and illustrations included herein show, by way of illustration and not of limitation, specific embodiments in which the subject matter may be practiced. As mentioned, other embodiments may be utilized and derived there from, such that structural and logical substitutions and changes may be made without departing from the scope of this disclosure. Such embodiments of the inventive subject matter may be referred to herein individually or collectively by the term “invention” merely for convenience and without intending to voluntarily limit the scope of this application to any single invention or inventive concept, if more than one is, in fact, disclosed. Thus, although specific embodiments have been illustrated and described herein, any arrangement calculated to achieve the same purpose may be substituted for the specific embodiments shown. This disclosure is intended to cover any and all adaptations or variations of various embodiments. Combinations of the above embodiments, and other embodiments not specifically described herein, will be apparent to those of skill in the art upon reviewing the above description.
This application is a continuation-in-part of International Application No. PCT/US17/46385, filed Aug. 10, 2017, which claims the benefit of priority to of U.S. provisional patent application Ser. No. 62/372,934, filed on Aug. 10, 2016.
Number | Name | Date | Kind |
---|---|---|---|
3927402 | Thompson | Dec 1975 | A |
4464115 | Simpson et al. | Aug 1984 | A |
4627734 | Rioux | Dec 1986 | A |
4688937 | Konig et al. | Aug 1987 | A |
4943157 | Reding | Jul 1990 | A |
5231401 | Kaman et al. | Jul 1993 | A |
5638164 | Landau | Jun 1997 | A |
5914826 | Smallwood | Jun 1999 | A |
6055490 | Dunne | Apr 2000 | A |
6091037 | Bachschmid | Jul 2000 | A |
7064817 | Schmitt et al. | Jun 2006 | B1 |
7089114 | Huang | Aug 2006 | B1 |
7299892 | Radu | Nov 2007 | B2 |
7446733 | Hirimai | Nov 2008 | B1 |
7608948 | Nearhoof | Oct 2009 | B2 |
8666104 | Ivey | Mar 2014 | B2 |
8675887 | Yuan | Mar 2014 | B2 |
8752969 | Kane et al. | Jun 2014 | B1 |
8786835 | Reardon et al. | Jul 2014 | B1 |
8878901 | Meinherz | Nov 2014 | B2 |
8948591 | Scherbarth | Feb 2015 | B2 |
9002511 | Hickerson et al. | Apr 2015 | B1 |
9069059 | Vogt et al. | Jun 2015 | B2 |
9097800 | Zhu | Aug 2015 | B1 |
9121703 | Droz et al. | Sep 2015 | B1 |
9128190 | Ulrich et al. | Sep 2015 | B1 |
9199643 | Zeng | Dec 2015 | B1 |
9279796 | Weisberg | Mar 2016 | B1 |
9285477 | Smith et al. | Mar 2016 | B1 |
9383753 | Templeton et al. | Jul 2016 | B1 |
9625582 | Gruver et al. | Apr 2017 | B2 |
9804264 | Villeneuve et al. | Oct 2017 | B2 |
10151836 | O'Keeffe | Dec 2018 | B2 |
10185027 | O'Keeffe | Jan 2019 | B2 |
10302746 | O'Keeffe | May 2019 | B2 |
10408940 | O'Keeffe | Sep 2019 | B2 |
20050057741 | Anderson et al. | Mar 2005 | A1 |
20050237218 | Tang | Oct 2005 | A1 |
20060104585 | Cho | May 2006 | A1 |
20060161270 | Luskin | Jul 2006 | A1 |
20070024841 | Kloza | Feb 2007 | A1 |
20070289860 | Newman | Dec 2007 | A1 |
20080068584 | Mori | Mar 2008 | A1 |
20090147239 | Zhu et al. | Jun 2009 | A1 |
20090219962 | Meyers et al. | Sep 2009 | A1 |
20090262760 | Krupkin et al. | Oct 2009 | A1 |
20090273770 | Bauhahn et al. | Nov 2009 | A1 |
20100026982 | Kludas et al. | Feb 2010 | A1 |
20110181201 | Hollis | Jul 2011 | A1 |
20130127854 | Shpunt et al. | May 2013 | A1 |
20130222791 | Steffey et al. | Aug 2013 | A1 |
20140240721 | Herschbach | Aug 2014 | A1 |
20140270237 | Wang | Sep 2014 | A1 |
20140270264 | Wang | Sep 2014 | A1 |
20140350836 | Stettner et al. | Nov 2014 | A1 |
20150185246 | Dakin et al. | Jul 2015 | A1 |
20150192677 | Yu et al. | Jul 2015 | A1 |
20150247703 | Teetzel et al. | Sep 2015 | A1 |
20150286340 | Send et al. | Oct 2015 | A1 |
20150307020 | Salter et al. | Oct 2015 | A1 |
20150378011 | Owechko | Dec 2015 | A1 |
20160047896 | Dussan | Feb 2016 | A1 |
20160245919 | Kalscheur et al. | Aug 2016 | A1 |
20160282468 | Gruver et al. | Sep 2016 | A1 |
20170024877 | Versace et al. | Jan 2017 | A1 |
20170169703 | Carrasco et al. | Jun 2017 | A1 |
20170176990 | Keller et al. | Jun 2017 | A1 |
20180059248 | O'Keeffe | Mar 2018 | A1 |
20180074175 | O'Keeffe | Mar 2018 | A1 |
20180106890 | O'Keeffe | Apr 2018 | A1 |
20180156896 | O'Keeffe | Jun 2018 | A1 |
20190107711 | Blanche et al. | Apr 2019 | A1 |
20190120939 | O'Keeffe | Apr 2019 | A1 |
20190196579 | Shpunt et al. | Jun 2019 | A1 |
20190317193 | O'Keeffe | Oct 2019 | A9 |
20190324124 | O'Keeffe | Oct 2019 | A1 |
Number | Date | Country |
---|---|---|
WO2016011557 | Jan 2016 | WO |
Entry |
---|
International Search Report and Written Opinion for PCT Patent Application No. PCT/US17/46385, dated Nov. 2, 2017, 18 pages. |
Vojnovic; Notes on optical fibres and fibre bundles; Gray Institute, Department of Oncology, University of Oxford; 15 pages; retrieved from the internet (http://users.ox.ac.uk/-atdgroup/referencematerial/Notes%20on%20optical%fibres%20and%fibre%20bundels.pdf); (year of pub. sufficiently earlier than effective US filing date and any foreign priority date) 2012. |
O'Keeffe; U.S. Appl. No. 15/857,960 entitled “Planning a lidar scan with smart test vectors,” filed Dec. 29, 2017. |
O'Keeffe; U.S. Appl. No. 15/851,686 entitled Distributed laser range finder with fiber optics and micromirrors,' filed Dec. 21, 2017. |
Beger et al.; Data fusion of extremely high resolution aerial imagery and LiDAR data for automated railroad centre line reconstruction; ISPRS Journal of Photogrammetry and Remote Sensing; 66(6); pp. S40-S51; Dec. 1, 2011. |
Teo et al.; Pole-Like Road Object Detection From Mobile Lidar System Using a Coarse-to-Fine Approach; IEEE Journal of Selected Topics in Applied Earth Observations and Remote Sensing; 8(10); pp. 4805-4818; Oct. 2015. |
Number | Date | Country | |
---|---|---|---|
20190025427 A1 | Jan 2019 | US |
Number | Date | Country | |
---|---|---|---|
62372934 | Aug 2016 | US |
Number | Date | Country | |
---|---|---|---|
Parent | PCT/US2017/046385 | Aug 2017 | US |
Child | 15815695 | US |