Cone Parameter Estimation from Simulated Range/Doppler Data

Transcription

1 Cone Parameter Estimation from Simulated Range/Doppler Data William DeMeo and Jon Guerin June 9, 005 The Forward Model The forward model describes the process by which a given spinning cone produces a range/doppler image. The model accounts for various cone parameters, most notably aspect (cone orientation), irradiance, spin rate, and cone shape (diameter and length). To date, our model has not accounted for the effects of speckle or wobbling. Given a fixed aspect (angle and range), and no speckle, the range/doppler images are thought to be unique, but we did not prove this. The forward model works by sampling points on the cone and calculating the contribution each point makes to the range/doppler image. The sampling is done by taking successive points on the cone surface separated by a fixed arc length distance, resulting in a roughly evenly sampled cone. The goal is to use the forward model to estimate three of the parameters (namely, spin rate, length and diameter). We parameter values describing a cone that yields a range/doppler image that is closest in norm (i.e. Euclidean distance) to the data (the observed range/doppler image).. Problem Statement and Parameters of Interest Given is a range/cross-range image that we assume was generated by a cone having a fixed, known orientation relative to the laser radar system. (We shall call the latter the telescope. ) Without loss of generality, we fix a coordinate system with origin at the center of the base of the cone, letting the base of the cone occupy the yz-plane and taking the major axis of the cone to be the x-axis. (See Fig. ) To specify the orientation of the cone relative to the telescope we use a vector A, which we shall call the aspect vector, and which extends from the origin at the base of the cone to the telescope position. Cone Orientation: some implementation details. To represent that the cone is oriented relative to the telescope in such that we are looking at the side of the cone i.e. the cone s major axis is orthogonal to the vector that extends from the telescope to the base of the cone we use an aspect vector A = [0; -dist; 0];, where the entry dist is some distance from the telescope to the base of the cone. When the cone is head-on i.e. the cone s major axis is parallel to the vector that extends from the telescope to the cone we represent its orientation with an aspect vector A = [dist, 0, 0];. A 45 degree view of the cone is specified with aspect vector A = [angle, -angle, 0];. We ran simulations for each of these three cases, each time taking the cone aspect vector as given, and varying the three other cone parameters (i.e. length, spin-rate, and base-diameter parameters). In particular, this simplies the geometry of the problem by assuming that the cone is always fixed relative to the coordinate system. If we want to represent that the orientation of the cone relative to the telescope has changed, we simply allow the telescope position to vary and leave the cone coordinates.

2 . Forward Model in Detail First we construct a forward model which, given a cone with fixed orientation and parameter values (L 0, S 0, D 0 ), specifies the range/cross-range image that such a cone would generate. We can then use this forward model to solve the inverse problem. That is, given a range/cross-range image, which cone (or cones) could have produce such an image, according to the forward model. Z Y X Figure :. Velocity. First we compute the velocity of any point on the surface of the cone. This is the product of the scalar speed times the unit motion vector (i.e., a unit vector pointing in the direction of motion). First we compute the speed. Suppose the spin rate of the cone (i.e., the rate at which the cone spins around its major axis) is S 0 revolutions per second. For a point p = (x, y, z) on the cone surface, the speed at p depends upon S 0 and the radius of a cross-section of the cone at p. Since we have fixed the major axis of the cone to be the x-axis, the radius at p = (x, y, z) depends only on x. Indeed, it is easy to see in Fig. that the radius of the cone at p is r(p) = r 0 r 0 x, L 0 where r 0 = D 0 /. (Recall, D 0 is the cone s base diameter, so r 0 = D 0 / is the radius at the base.) Therefore, the point p travels the circumference πr(p) of the cone S 0 times per second, with speed ( S(p) = πr(p)s 0 = π r 0 r ) 0 x S 0 L 0 To compute the unit motion vector at p, assume the cone spins in a counter-clockwise direction relative to a viewer looking down the positive x-axis at the yz-plane. Then the unit motion vector has a 0 x-component and is tangent to the cone at p: T (p) = (0, sin(tan (z/y)), cos(tan (z/y))).

3 Therefore, the velocity vector at p is: V(p) = S(p)T (p) = [ πr 0 ( xl 0 )S 0] T (p). Doppler. The doppler at any point p on the cone surface is given by the inner product D(p) = V(p) A λ 0 A, where λ 0 is the wavelength of the outgoing laser pulse. Range. The range at any point p on the cone surface is given by R(p) = A p. However, for the purpose of creating the range/cross-range image, we center the range values about the origin and use the relative range, R(p) = A p A. Irradiance. The irradiance at any point p on the cone surface is proportional to the inner product of the outward-pointing unit normal to the surface at p and the unit vector direction of the light source (which, in this case, is the laser). Let n(p) denote the unit normal to the surface at p. We derive a formula for n(p) and then compute the irradiance as (proportional to) the inner product of n(p) with the normalized aspect vector A/ A. We previously derived an equation for the tangent vector T. Once we compute a second vector T, that is tangent to the surface and orthogonal to T, the cross product T T will yield the normal to the surface. It should be clear from Fig. that the following tangent vector is the one we need: T (p) = T (x, y, z) = (L 0 x, y, z) T (p) = (L 0 x, y, z) (L0 x) + y + z Therefore, using the right-hand rule to ensure that we get the outward-pointing vector, the normal to the surface is given by e e e n(p) = (T T )(p) = T () T () T () T () T () T () where, for lack of better notation, T i (j) denotes the jth entry of the vector T i (p). Substituting for T and T and performing the cross product results in the unit normal vector n(p) = α z sin(tan (z/y)) + y cos(tan (z/y)) (L 0 x) cos(tan (z/y)) (L 0 x) sin(tan (z/y))) where α = / (L 0 x) + y + z. Finally, the irradiance is proportional to the inner product of the unit normal and the unit aspect. That is, I(p) n(p) A/ A. () The constant of proportionality is not important since it depends on the reflectivity characteristics of the cone surface at the point p. As long as we assume all points are the same in this regard, the right hand side of () will give irradiances values for all points that are correct relative to one another.

4 Range/Cross-range Image. For a given point (r, c) in the range/cross-range domain, we compute the range/cross-range value as follows: G(r, c) = I + (p), where I + is the positive irradiance, p S(r,c) I + (p) = max{0, I(p)}, and, if C R denotes the set of points on the cone surface, S(r, c) = {p C : R(p) r < ɛ r, D(p) c < ɛ c }. We use the positive irradiance I + because negative values of I correspond precisely to those points on the cone surface that are hidden from view (i.e., on the back-side of the cone relative to the detector). The set S(r, c) is the collection of points on the cone surface that contribute irradiance values to this particular range/cross-range, (r, c).. Parameter Estimation Since we assume the aspect vector A is known (and since the object is assumed to be a cone) there remain only three unknown parameters which must be estimated. These are the cone s length L (meters), spin rate S (Hertz), and base diameter D (meters). We carried out the estimation in two different ways. First we used a Matlab optimization function that does not require us to supply the gradients of the range/cross-range function with respect to each parameter. Second, to compare with and verify the results of the Matlab optimizer, we wrote an optimization function (in spin cone estimate.m Sec.. describes the algorithm) that relies on gradient information. For this purpose, rather than derive closed form expressions, we approximated the required gradients using a basic finite difference scheme. It may be possible to derive closed form gradient equations. However, as the dependence of the range/doppler image values on the parameters is defined implicitly in terms of an integral, the derivation is non-trivial. Detected Data The detected data is from RME experiments on 4/8/98. The pulse-burst laser radar data can be used to generate range/doppler images. This tests were images of a cone on the ground and not in the sky, so the front and back stop feedback must be removed first. Then you can proceed to rack and stack the return signal to get the range/doppler image. A pulse burst signal consists of numerous micropulses that form a macropulse in the shape of a pulse tone. The duration of the macropulse is 6 microseconds. The duration of the micropulse is nanoseconds. There are 40 nanoseconds between micropulses. The rack and stack refers to chopping up the return signal to align the micropulses. So this is done in 40 nanosecond intervals which corresponds to a 6 meter range. Then for each range you perform a Fourier transform to get the doppler information. The doppler frequency range turns out to be +/-.5 MHz. That is why the local oscillator on the laser is set to 6.5 MHz. It is to try to center the micropulse at that frequency but the location is not guaranteed. Simulations and Experimental Results For the experiments, we did not use the detected data because we had yet to model the speckle. Instead we used the forward model to generate the ideal result and tried to estimate the parameters from there. It is useful to know if the ideal model can be optimized. In general, we found that it is possible to optimize To compute the value of the range/doppler image at a specific range/cross-range coordinate (r,c), we integrate the irradiance over a region on the cone surface that corresponds to (r,c). It is this region that depends on the parameters. 4

5 the ideal model using the basic Matlab fminsearch. This required using enough sample points on the cone. Too few points lead to terrible results. For example, we saw huge differences in cm vs 5 mm arc length sampling. We also made graphs to visualize the function to optimize by varying two parameters at a time and the 5 mm graphs were considerably smoother. We also expected and observed that when the cone is coming directly at you, it is not possible to estimate the spin rate because you are not getting any spin doppler readings. We also started implementing the use of better optimizers such as LBFGSB and an optimizer that allows for parameter constraints and confidence regions. We finished a version allowing for parameter constraints, but have not computed confidence regions. 4. Guerin s Experiments.. Experimental Settings code mfiles/flttd/spin test.m Cone distance 9,000 meters Aspect 90 (sideways), 0 (head-on), or 45 degrees Arc length meters (S)Spin rate rps (D)Base Diameter 0.75 meters (L)Cone length meters Outgoing wavelength Range/doppler graph (80x5 points) range [-, ] doppler [.5 0 6, ].. Experimental Results E0 - initial parameter estimates EF - final parameter estimates Aspect 90 deg E0 S= D=.75 L= EF S= D=0.75 L= Aspect 45 deg E0 S= D=.75 L= EF S= D=0.75 L= Aspect 0 deg E0 S= D=.75 L= EF S=4.96 D=0.75 L= Aspect 45 deg E0 S= D=.75 L= EF S= D=0.75 L= Aspect 45 deg (only unexpected result) in spin cone estimate.m, but see also spin cone estimate test.m 4 Upon briefly considering this idea, it became less clear that confidence regions generated by the non-linear least squares estimation procedure in spin cone estimate.m would provide any meaningful information. Most likely, rather than tell us about our final parameter estimates, such statistics would indicate levels of confidence in the estimated parameter steps at each successive iteration. 5

6 E0 S= D=0.5 L= EF S=.79 D=0.709 L=.64. DeMeo s Experiments Using our forward model, simulated range/cross-range data are generated for an ideal cone having parameters values θ t = (L t, S t, D t ). (Examples of the parameter values we used are given below.) The resulting image, D = D(θ t ), is stored in an (In our Matlab code the array storing this real data is named rd). A new range/cross-range image is produced with the forward model using some arbitrary initial guesses, denoted θ 0, for the length, spin-rate, and base diameter parameters. This new image, G(θ 0 ), is stored in a second 80 5 array (called g in our Matlab programs), and is evaluated based on how close it is, in Euclidean distance, to the given data D. More precisely, we consider the norm difference, D G(θ 0 ), and proceed with an iterative scheme for estimating parameter values ˆθ which satisfy D G(ˆθ) = min D G(θ) θ Starting with θ 0, D, and G(θ 0 ), to arrive at the next estimate, θ, we proceed as follows:. Approximate G(θ ) by a first order Taylor expansion about θ 0, G(θ ) G(θ 0 ) + G(θ 0 ) (θ θ 0 ), where G(θ 0 ) is the gradient of G evaluated at θ 0. Then D G(θ ) is approximately D G(θ 0 ) G(θ 0 ) (θ θ 0 ) = Z G(θ 0 )η, where η = θ θ 0. (We approximate the gradient of G by computing its finite differences using the forward model.). Solve the OLS problem Z G(θ 0 )ˆη = min Z G(θ 0 )η. η. The new parameter estimate is θ = θ 0 + ˆη... Experimental Settings True Parameter Values 5 length L = m, spin-rate S = Hz, base-diameter D = 0.75m. Initial Parameter Estimates (Guesses) length θ = m, spin-rate θ = Hz, base-diameter θ = m. Other Notable Parameter Settings Arc-length for the sampling grid on the cone: 0.0m (arc = 0.0;). Differential used for computing gradients: 5% (delta =.05;). Distance from laser to center of base of cone: 9km (dist = 9000). These and other parameter values were held fixed for the three experiments below. Their Matlab definitions were set (in spin cone estimate test.m) as follows: 5 These are the parameter values used to generate the simulated raw data. Success is achieved if our parameter estimates converge to these values. 6

7 arc = 0.0; % cone sampling rate (arc length, circle spacing) L = ; % length of the cone S = ; % spin rate D = 0.75; % base diameter Lambda0 = 0.5*0^-6;%outgoing wavelength min_range = -; max_range = ; min_doppler = -.5*0^6; max_doppler =.5*0^6; theta = [; ; ]; % Initial guess: length, spin rate, base diameter delta =.05; % finite difference step-size (in percent of param value) TOL = 0^-8; % optimizer error tolerance for convergence LN = ; % contrain parameters? (0,) <-> (no,yes) LB = [.5;.5;.5]; % lower bounds on parameter values UB = [ 5; 5; 5]; % upper bounds on parameter values MAXITERS=50; % maximum number of iterations.. Experimental Results A range/cross-range image produced with the forward model using the true parameter values (L=, S=, D=0.75) is taken as real data, and stored in the array rd. A second range/cross-range image is produced using the initial guesses for length, spin-rate, and base diameter, and the result is stored in the array g. The iterative estimation procedure was performed (in the Matlab script spin cone estimate test.m), yielding the results given below. The results correspond to three different scenarios, distinguished only by cone orientation. All other parameters we left unchanged. In particular, the length, spin-rate, and base diameter parameter values of the true cone were fixed at m, Hz, and 0.75m, respectively.. Aspect vector: A = [0; -dist; 0] (90 degrees) After 50 iterations, estimates were: L =.0048, S =.0008, D = with residual: rd-g = Here rd is the range/cross-range image for the simulated data and g is that produced by the forward model using the cone parameter estimates, (L, S, D) = (.0059,.9995, 0.750). Convergence of the iterative procedure is illustrated in Fig... Aspect vector: A = [0; -dist; 0] ( head-on ) After 50 iterations, estimates were: L =.0004, S =, D = with residual: rd-g = Convergence of the iterative procedure is illustrated in Fig... Aspect vector: A = [angle, -angle, 0] (45 degrees) where angle = sqrt(dist^/), and dist set at 9km. After 50 iterations, estimates were: L =.00069, S =.99767, D = with residual: rd-g = Convergence of the iterative procedure is illustrated in Fig. 4. 7

8 90 degree angle orientation S = Hz L = m D = 0.75m 0.05 error = Head On Cone Orientation S = Hz L = m D = 0.75m 0. norm of residuals Figure : Convergence of the non-linear least squares estimation of cone parameters for perpendicular (90 degree) view. Algorithm converges to the correct parameter values for length, spin rate, and base diameter. 45 degree angle orientation Figure : Convergence of the non-linear least squares estimation of cone parameters for head-on (0 degree) view. Algorithm converges to the correct parameter values for length and base diameter. However, spin rate estimate does not change from the original guess of Hz, which is what we expect for this orientation Figure 4: Convergence of the non-linear least squares estimation of cone parameters for diagonal (45 degree) view. Algorithm converges to the correct parameter values for length, spin rate, and base diameter. 8