# HG changeset patch # User Nicolas Saunier # Date 1391145031 18000 # Node ID f0ce17ea9273ce30702c1e9f7cbd3d7e2cbb2c6c # Parent 4a62c3b1eb3a15941c0208cf1c1d5a67cef075bf# Parent ea907ae19d8c191abb66953e899ea01e229ab948 merge done with Sohail s code diff -r 4a62c3b1eb3a -r f0ce17ea9273 scripts/TTCcomputation.py --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/scripts/TTCcomputation.py Fri Jan 31 00:10:31 2014 -0500 @@ -0,0 +1,22 @@ +def TTC(x1,y1,x2,y2,v1x,v1y,v2x,v2y,l): + + a = pow(v1x-v2x,2) + pow(v1y-v2y,2) + b = 2 * ((x1-x2) * (v1x-v2x) + (y1-y2) * (v1y-v2y)) + c = pow(x1-x2,2) + pow(y1-y2,2) - pow(l,2) + + if pow(b,2) >= 4*a*c: + ttc1 = (-b + sqrt(pow(b,2) - 4*a*c)) / (2*a) + ttc2 = (-b - sqrt(pow(b,2) - 4*a*c)) / (2*a) + if ttc1 >= 0 and ttc2 >= 0: + ttc = min(ttc1,ttc2) + else: + if ttc1 < 0: + ttc = ttc + if ttc2 < 0: + ttc = ttc1 + if ttc1 < 0 and ttc2 < 0: + ttc = [] + else: + ttc = [] + + return ttc