1- import numpy as np
2-
31import fcl
2+ import numpy as np
43
54
65def print_collision_result (o1_name , o2_name , result ):
7- print ("Collision between {} and {}:" . format ( o1_name , o2_name ) )
6+ print (f "Collision between { o1_name } and { o2_name } :" )
87 print ("-" * 30 )
9- print ("Collision?: {}" . format ( result .is_collision ) )
10- print ("Number of contacts: {}" . format ( len (result .contacts )) )
8+ print (f "Collision?: { result .is_collision } " )
9+ print (f "Number of contacts: { len (result .contacts )} " )
1110 print ("" )
1211
1312
1413def print_continuous_collision_result (o1_name , o2_name , result ):
15- print ("Continuous collision between {} and {}:" . format ( o1_name , o2_name ) )
14+ print (f "Continuous collision between { o1_name } and { o2_name } :" )
1615 print ("-" * 30 )
17- print ("Collision?: {}" . format ( result .is_collide ) )
18- print ("Time of collision: {}" . format ( result .time_of_contact ) )
16+ print (f "Collision?: { result .is_collide } " )
17+ print (f "Time of collision: { result .time_of_contact } " )
1918 print ("" )
2019
2120
2221def print_distance_result (o1_name , o2_name , result ):
23- print ("Distance between {} and {}:" . format ( o1_name , o2_name ) )
22+ print (f "Distance between { o1_name } and { o2_name } :" )
2423 print ("-" * 30 )
25- print ("Distance: {}" . format ( result .min_distance ) )
24+ print (f "Distance: { result .min_distance } " )
2625 print ("Closest Points:" )
2726 print (result .nearest_points [0 ])
2827 print (result .nearest_points [1 ])
@@ -166,25 +165,25 @@ def print_distance_result(o1_name, o2_name, result):
166165# =====================================================================
167166cdata = fcl .CollisionData ()
168167manager1 .collide (cdata , fcl .defaultCollisionCallback )
169- print ("Collision within manager 1?: {}" . format ( cdata .result .is_collision ) )
168+ print (f "Collision within manager 1?: { cdata .result .is_collision } " )
170169print ("" )
171170
172171cdata = fcl .CollisionData ()
173172manager2 .collide (cdata , fcl .defaultCollisionCallback )
174- print ("Collision within manager 2?: {}" . format ( cdata .result .is_collision ) )
173+ print (f "Collision within manager 2?: { cdata .result .is_collision } " )
175174print ("" )
176175
177176# =====================================================================
178177# Managed internal (n^2) distance checking
179178# =====================================================================
180179ddata = fcl .DistanceData ()
181180manager1 .distance (ddata , fcl .defaultDistanceCallback )
182- print ("Closest distance within manager 1?: {}" . format ( ddata .result .min_distance ) )
181+ print (f "Closest distance within manager 1?: { ddata .result .min_distance } " )
183182print ("" )
184183
185184ddata = fcl .DistanceData ()
186185manager2 .distance (ddata , fcl .defaultDistanceCallback )
187- print ("Closest distance within manager 2?: {}" . format ( ddata .result .min_distance ) )
186+ print (f "Closest distance within manager 2?: { ddata .result .min_distance } " )
188187print ("" )
189188
190189# =====================================================================
@@ -194,19 +193,19 @@ def print_distance_result(o1_name, o2_name, result):
194193rdata = fcl .CollisionData (request = req )
195194
196195manager1 .collide (fcl .CollisionObject (mesh ), rdata , fcl .defaultCollisionCallback )
197- print ("Collision between manager 1 and Mesh?: {}" . format ( rdata .result .is_collision ) )
196+ print (f "Collision between manager 1 and Mesh?: { rdata .result .is_collision } " )
198197print ("Contacts:" )
199198for c in rdata .result .contacts :
200- print ("\t O1: {}, O2: {}" . format ( c . o1 , c . o2 ) )
199+ print (f "\t O1: { c . o1 } , O2: { c . o2 } " )
201200print ("" )
202201
203202# =====================================================================
204203# Managed many to many collision checking
205204# =====================================================================
206205rdata = fcl .CollisionData (request = req )
207206manager3 .collide (manager2 , rdata , fcl .defaultCollisionCallback )
208- print ("Collision between manager 2 and manager 3?: {}" . format ( rdata .result .is_collision ) )
207+ print (f "Collision between manager 2 and manager 3?: { rdata .result .is_collision } " )
209208print ("Contacts:" )
210209for c in rdata .result .contacts :
211- print ("\t O1: {}, O2: {}" . format ( c . o1 , c . o2 ) )
210+ print (f "\t O1: { c . o1 } , O2: { c . o2 } " )
212211print ("" )
0 commit comments