Recursive Estimation

Transcription

1 Recursive Estimation Raffaello D Andrea Spring 04 Problem Set : Bayes Theorem and Bayesian Tracking Last updated: March 8, 05 Notes: Notation: Unlessotherwisenoted,x, y,andz denoterandomvariables, f x (x)(ortheshort hand f(x)) denotes the probability density function of x, and f x y (x y) (or f(x y)) denotes the conditional probability density function of x conditioned on y. The expected value is denoted by E[ ], the variance is denoted by Var[ ], and Pr(Z) denotes the probability that the event Z occurs. A normally distributed random variable x with mean µ and variance σ is denoted by x N ( µ,σ ). Please report any errors found in this problem set to the teaching assistants (michaemu@ethz.ch or mwm@ethz.ch).

2 Problem Set Problem Mr. Jones has devised a gambling system for winning at roulette. When he bets, he bets on red, and places a bet only when the ten previous spins of the roulette have landed on a black number. He reasons that his chance of winning is quite large since the probability of eleven consecutive spins resulting in black is quite small. What do you think of this system? Problem Consider two boxes, one containing one black and one white marble, the other, two black and one white marble. A box is selected at random with equal probability and a marble is drawn at random with equal probability from the selected box. What is the probability that the marble is black? Problem In Problem, what is the probability that the first box was the one selected given that the marble is white? Problem 4 Urn contains two white balls and one black ball, while urn contains one white ball and five black balls. One ball is drawn at random with equal probability from urn and placed in urn. A ball is then drawn from urn at random with equal probability. It happens to be white. What is the probability that the transferred ball was white? Problem 5 Stores A, B and C have 50, 75, 00 employees, and respectively 50, 60 and 70 percent of these are women. Resignations are equally likely among all employees, regardless of sex. One employee resigns and this is a woman. What is the probability that she works in store C? Problem 6 a) A gambler has in his pocket a fair coin and a two-headed coin. He selects one of the coins at random with equal probability, and when he flips it, it shows heads. What is the probability that it is the fair coin? b) Suppose that he flips the same coin a second time and again it shows heads. What is now the probability that it is the fair coin? c) Suppose that he flips the same coin a third time and it shows tails. What is now the probability that it is the fair coin? Problem 7 Urn has five white and seven black balls. Urn has three white and twelve black balls. An urn is selected at random with equal probability and a ball is drawn at random with equal probability from that urn. Suppose that a white ball is drawn. What is the probability that the second urn was selected?

3 Problem 8 An urn contains b black balls and r red balls. One of the balls is drawn at random with equal probability, but when it is put back into the urn c additional balls of the same color are put in with it. Now suppose that we draw another ball at random with equal probability. Show that the probability that the first ball drawn was black, given that the second ball drawn was red is b/(b+r +c). Problem 9 Three prisoners are informed by their jailer that one of them has been chosen to be executed at random with equal probability, and the other two are to be freed. Prisoner A asks the jailer to tell him privately which of his fellow prisoners will be set free, claiming that there would be no harm in divulging this information, since he already knows that at least one will go free. The jailer refuses to answer this question, pointing out that if A knew which of his fellows were to be set free, then his own probability of being executed would rise from / to /, since he would then be one of two prisoners. What do you think of the jailer s reasoning? Problem 0 Let x and y be independent random variables. Let g( ) and h( ) be arbitrary functions of x and y, respectively. Define the random variables v g(x) and w h(y). Prove that v and w are independent. That is, functions of independent random variables are independent. Problem Let x be a continuous, uniformly distributed random variable with x X [ 5,5]. Let z x+n z x+n, where n and n are continuous random variables with probability density functions α (+n ) for n 0 f n (n ) α ( n ) for 0 n 0 otherwise, ( α + n ) for n 0 ( f n (n ) α n ) for 0 n 0 otherwise, where α and α are normalization constants. Assume that the random variables x, n, n are independent, i.e. f(x,n,n ) f(x)f(n )f(n ). a) Calculate α and α. b) Use the change of variables formula from Lecture to show that f zi x(z i x) f ni (z i x). c) Calculate f(x z 0,z 0). d) Calculate f(x z 0,z ). e) Calculate f(x z 0,z ).

4 Problem Consider the following estimation problem: an object B moves randomly on a circle with radius. The distance to the object can be measured from a given observation point P. The goal is to estimate the location of the object, see Figure. y B distance - θ L P x Figure : Illustration of the estimation problem. The object B can only move in discrete steps. The object s location at time k is given by x(k) {0,,...,N }, where θ(k) π x(k) N. The dynamics are x(k) mod (x(k )+v(k), N), k,,..., where v(k) with probability p and v(k) otherwise. Note that mod (N, N) 0 and mod (, N) N. The distance sensor measures z(k) (L cosθ(k)) +(sinθ(k)) +w(k), where w(k) represents the sensor error which is uniformly distributed on [ e, e]. We assume that x(0) is uniformly distributed and x(0), v(k) and w(k) are independent. Simulate the object movement and implement a Bayesian tracking algorithm that calculates for each time step k the probability density function f(x(k) z( : k)). a) Test the following settings and discuss the results: N 00, x(0) N 4, e 0.5, (i) L, p 0.5, (ii) L, p 0.5, (iii) L, p 0.55, (iv) L 0., p 0.55, (v) L 0, p b) How robust is the algorithm? Set N 00, x(0) N 4, e 0.5, L, p 0.55 in the simulation, but use slightly different values for p and e in your estimation algorithm, ˆp and ê, respectively. Test the algorithm and explain the result for: (i) ˆp 0.45, ê e, (ii) ˆp 0.5, ê e, (iii) ˆp 0.9, ê e, (iv) ˆp p, ê 0.9, (v) ˆp p, ê

5 Sample solutions Problem We introduce a discrete random variable x i, representing the outcome of the ith spin with x i {red,black}. We assume that both are equally likely and ignore the fact that there is a 0 or a 00 on a Roulette board. Assuming independence between spins, we have Pr(x k,x k,x k,...,x ) Pr(x k ) Pr(x k )...Pr(x ). The probability of eleven consecutive spins resulting in black is Pr(x black,x 0 black,x 9 black,...,x black) ( ) This value is actually quite small. However, given that the previous ten were black, we calculate Pr(x black x 0 black,x 9 black,...,x black) (by independence assumption) Pr(x black) Pr(x red x 0 black,x 9 black,...,x black) i.e. it is equally likely that ten black spins in a row are followed by a red spin, as that they are followed by another black spin (by the independence assumption). Mr. Jones system is therefore no better than randomly betting on black or red. Problem We introduce two discrete random variables. Let x {,} represent which box is chosen (box or ) with probability f x () f x (). Furthermore, let y {b,w} represent the color of the drawn marble, where b is a black and w a white marble with probabilities f y x (b ) f y x (w ), f y x (b ), f y x(w ). Then, by the total probability theorem, we find f y (b) f y x (b ) f x ()+f y x (b ) f x () + 7. Problem f x y ( w) f y x(w ) f x () f y (w) f y (b)

6 Problem 4 Let x {b,w} represent the color of the ball drawn from urn, where f x (b), f x(w), and y {b,w} be the color of the ball subsequently drawn from urn. Considering the different possibilities, we have f y x (b b) 6 7 f y x (w b) 7 f y x (b w) 5 7 f y x (w w) 7. We seek the probability that the transferred ball was white, given that the second ball drawn is white and calculate f x y (w w) f y x(w w) f x (w) f y (w) f y x (w b) f x (b)+f y x (w w) f x (w) Problem 5 We introduce two discrete random variables, x {A,B,C} and y {M,F}, where x represents which store an employee works in, and y the sex of the employee. From the problem description, we have f x (A) f x (B) 75 5 f x (C) , and the probability that an employee is a woman is f y x (F A) f y x (F B) 5 f y x (F C) 7 0. We seek the probability that the resigning employee works in store C, given that it is a woman and calculate f x y (C F) f y x(f C) f x (C) f y (F) i {A,B,C} f y x (F i) f x (i) Problem 6 a) Let x {F,U} represent whether it is a fair (F) or an unfair (U) coin with f x (F) f x (U). We introduce y {h,t} to represent how the toss comes up (heads or tails) with f y x (h F) f y x (t F) f y x (h U) f y x (t U) 0. 6

7 We seek the probability that the drawn coin is fair, given that the toss result is heads and calculate f x y (F h) f y x(h F) f x (F) f y (h) f y x (h F) f x (F) } {{ } fair coin +f y x (h U) f x (U) } {{ } unfair coin 4 + b) Let y represent the result of the first flip and y that of the second flip. We assume conditional independence between flips (conditioned on x), yielding f y,y x(y,y x) f y x(y x) f y x(y x).. We seek the probability that the drawn coin is fair, given that the both tosses resulted in heads and calculate f x y,y (F h,h) f y,y x(h,h F) f x (F) f y,y (h,h) ( ) } {{ } fair coin + }{{} unfair coin 5. c) Obviously, the probability then is, because the unfair coin cannot show tails. Formally, we show this by introducing y to represent the result of the third flip and computing f x y,y,y (F h,h,t) f y,y,y x(h,h,t F) f x (F) f y,y,y (h,h,t) ( ) } {{ } fair coin + 0 } {{ } unfair coin. Problem 7 We introduce the following two random variables: x {,} represents which box is chosen (box or ) with probability f x () f x (), y {b,w} represents the color of the drawn ball, where b is a black and w a white ball with probabilities f y x (b ) 7 f y x (b ) 5 f y x (w ) 5 f y x (w ) 5. We seek the probability that the second box was selected, given that the ball drawn is white and calculate f x y ( w) f y x(w )f x () f y (w)

8 Problem 8 Let x {B,R} be the color (black or red) of the first ball drawn with f x (B) b f x (R) r b+r ; and let x {B,R} be the color of the second ball with b+r and b f x x (B R) b+r+c f x x (B B) b+c b+r +c f x x (R R) c+r b+r +c r f x x (R B) b+r+c. We seek the probability that the first ball drawn was black, given that the second ball drawn is red and calculate f x x (B R) f x x (R B) f x (B) f x (R) c+r b+r+c r } {{ b+r } first red r b+r+c b b+r r + b+r +c b } {{ b+r } first black b b+r +c. Problem 9 We can approach the solution in two ways: Descriptive solution: The probability that A is to be executed is, and there is a chance of that one of the others was chosen. If the jailer gives away the name of one of the fellow prisoners who will be set free, prisoner A does not get new information about his own fate, but the probability of the remaining prisoner (B or C) to be executed is now. The probability of A being executed is still. Bayesian analysis: Let x represent which prisoner is to be executed, where x {A,B,C}. We assume that it is a random choice, i.e. f x (A) f x (B) f x (C). Now let y {B,C} be the prisoner name given away by the jailer. We can now write the conditional probabilities: 0 if x y (the jailer does not lie) f y x (y x) if x A (A is to be executed, jailer mentions B and C with equal probability) if x A (jailer is forced to give the name of the other prisoner to be set free). You could also do this with a table: y x f y x (y x) B A / B B 0 B C C A / C B C C 0 To answer the question, we have to compare f x y (A ȳ), ȳ {B,C}, with f x (A): 8

9 f x y (A ȳ) f y x(ȳ A)f x (A) f y (ȳ) }{{} f y x (ȳ A) }{{} f y x (ȳ ȳ) k {A,B,C} f y x (ȳ k) f x (k) + }{{} f y x (ȳ notȳ), where(notȳ) C ifȳ B and(notȳ) B ifȳ C. Thevalueoftheposteriorprobability is the same as the prior one, f x (A). The jailer is wrong: prisoner A gets no additional information from the jailer about his own fate! See also Wikipedia: Three prisoners problem, Monty Hall problem. Problem 0 Consider the joint cumulative distribution F v,w ( v, w) Pr((v v) and (w w)) Pr((g(x) v) and (h(y) w)). We define the sets A v and A w as below: A v { x X : g(x) v } A w { y Ȳ : h(y) w}. Now we can deduce F v,w ( v, w) Pr((x A v ) and (y A w )) v, w Pr(x A v )Pr(y A w ) (by independence assumption) Pr(g(x) v)pr(h(y) w) Pr(v v)pr(w w) F v ( v)f w ( w). Therefore v and w are independent. Problem a) By definition of a PDF, the integrals of the PDFs f ni (n i ), i, must evaluate to one, which we use to find the α i. We integrate the probability density functions, see the following figure: f n f n α α α 4α n n 9

10 For n, we obtain f n ( n )d n α 0 (+ n )d n + ( α + ) 0 α. Therefore α. For n, we get 0 ( f n ( n )d n α + ) n d n + Therefore α. α ( + ) α. ( n )d n 0 ( n ) d n b) The goal is to calculate f zi x(z i x) from z i g(n i,x) : x+n i and the given PDFs f ni (n i ), i,. We apply the change of variables formula for CRVs with conditional PDFs: f zi x(z i x) f n i x(n i x) g n i (n i,x) (just think of x as a parameter that parametrizes the PDFs). The proof for this formula is analogous to the proof in the lecture notes for a change of variables for CRVs with unconditional PDFs. We find that g n i (n i,x), for all n i,x and, therefore, the fraction in the change of variables formula is well-defined for all values of n i and x. Due to the independence of n i and x, f ni x(n i x) f ni (n i ) : f zi x(z i x) f n i x(n i x) g n i (n i,x) f n i (n i ). Substituting n i z i x, we finally obtain f zi x(z i x) f ni (n i ) f ni (z i x). c) We use Bayes theorem to calculate f x z,z (x z,z ) f z,z x(z,z x)f x (x). () f z,z (z,z ) First, we calculate the prior PDF of the CRV x, which is uniformly distributed: { f x (x) 0 for 5 x 5. 0 otherwise In b), we showed by change of variables that f(z i x) f ni (z i x). Since n,n are independent, it follows that z,z are conditionally independent given x. Therefore, we can rewrite the measurement likelihood as f z,z x(z,z x) f z x(z x)f z x(z x). 0

11 We calculate the individual conditional PDFs f zi x(z i x): α ( z +x) for 0 z x f z x(z x) f n (z x) α (+z x) for z x 0 0 otherwise. The conditional PDF of z given x is illustrated in the following figure: f z x(z x) α x x z x+ Analogously ( α z + x) for 0 z x ( f z x(z x) f n (z x) α + z x) for z x 0 0 otherwise. Let numxbethenumeratorof thebayes rulefraction (). Given themeasurementsz 0, z 0, we find numx 0 f z x(0 x)f z x(0 x). We consider four different intervals of x: [ 5, ], [,0], [0,] and [,5]. Evaluating numx for these intervals results in: for x [ 5, ] or x [,5], numx 0 for x [,0], numx 0 α (+x)α (+ x ) for x [0,], numx 0 α ( x)α ( x ) (+ 0 (+x) x ) ( 0 ( x) x ). Finally, we need to calculate the denominator of the Bayes rule fraction (), the normalization constant, which can be calculated using the total probability theorem: f z,z (z,z ) f z,z x(z,z x)f x (x)dx Evaluated at z z 0, we find f z,z (0,0) 0 ( (+x) + x ) dx+ 0 0 ( ) 4. 0 numx dx. ( ( x) x ) dx

12 Finally, we obtain the posterior PDF f x z,z (x 0,0) numx 4 numx f z,z (0,0) 0 for 5 x, x (+x)( + x ) for x ( x)( x ) for 0 x which is illustrated in the following figure: f x z,z (x 0,0) 6 5 x The posterior PDF is symmetric about x 0 with a maximum at x 0: both sensors agree. d) Similar to the above. Given z 0, z, we write the numerator as numx 0 f z x(0 x)f z x( x). () Again, we consider the same four intervals: for x [ 5, ] or x [,5], numx 0 for x [,0], for x [0,] Normalizing yields numx ( 0 α (+x)α + ) x 40 (+x) numx ( 0 α ( x)α + ) x ( x ). 40 f z,z (0,) numxdx The solution is therefore 0 for 5 x, x 5 f x z,z (x 0,) (+x) for x 0 x for 0 x.

13 The posterior PDF is depicted in the following figure: f x z,z (x 0,) x The probability values are higher for positive x values because of the measurement z. e) We start in the same fashion: given z 0 and z, numx 0 f z x(0 x)f z x( x). However, the intervals of positive probability of f z x(0 x) and f z x( x) do not overlap, i.e. numx 0 x [ 5,5]. In other words, given our noise model for n and n, there is no chance to measure z 0 and z. Therefore, f x z,z (x 0,) is not defined. Problem The Matlab code is available on the class webpage. We notice the following: a) (i) The PDF remains bimodal for all times. The symmetry in measurements and motion makes it impossible to differentiate between the upper and lower half circle. (ii) The PDF is initially bimodal, but the bias in the particle motion causes one of the two modes to have higher values after a few time steps. (iii) We note that this sensor placement also works. Note that the resulting PDF is not as sharp because more positions explain the measurements. (iv) The resulting PDF is uniform for all k,,... With the sensor in the center, the distance measurement provides no information on the particle position (all particle positions have the same distance to the sensor). b) (i) The PDF has higher values at the position mirrored from the actual position, because the estimator model uses a value ˆp that biases the particle motion in the opposite direction. (ii) The PDF remains bimodal, even though the particle motion is biased in one direction. This is caused by the estimator assuming that the particle motion is unbiased, which makes both halves of the circle equally likely. (iii) The incorrect assumption on the motion probability ˆp causes the estimated PDF to drift away from the real particle position until it is forced back by measurements that cannot be explained otherwise. (iv) The resulting PDF is not as sharp because the larger value of ê implies that more states are possible for the given measurements. (v) The Bayesian tracking algorithm fails after a few steps (division by zero in the measurement update step). This is caused by a measurement that is impossible to explain with the present particle position PDF and the measurement error distribution defined by ê. Note that ê underestimates the possible measurement error. This leads to measurements where the true error (with uniform distribution defined by e) contains an error larger than is assumed possible in the algorithm.