Page 1 of 1

### How to do distance measurement between two dynamic objects

Posted: 02 Dec 2019, 18:04
Hello,

I'm trying to measure distance between two dynamic objects. Attaching a screenshot showcasing what I'm doing. The robot is moving along the teal line, and cuboid on the bottom is moving along the blue line.

I couldn't find an API like simGetDistance(robot_handle, cuboid_handle) to return dynamic distance between those two objects, so I have to try something else. Below is what I've tried so far.

1. I tried simGetObjectPosition of those two object respectively, then I apply Euclidean distance to calculate their distance, However, here comes the problematic part to me. Because of the objects are moving, I have to calculate the distance with time goes forward. What I come up with is to use simWait() with a high frequency. But no matter how frequent I adjust the parameter in simWait(), the returned distance is always ~0.37 (which I expect to be more diverse in [0.2, 1.0] ). Attaching my code below:

Code: Select all

``````robot_position = simGetObjectPosition(robot_handle, -1)
cuboid_position = simGetObjectPosition(cuboid_handle, -1)
r_dist = math.sqrt(math.pow((robot_position-cuboid_position),2) + math.pow((robot_position-cuboid_position),2))
while furthest_dis < r_dist do
furthest_dis = r_dist
simWait(0.001, true)
r_dist = math.sqrt(math.pow((robot_position-cuboid_position),2) + math.pow((robot_position-cuboid_position),2))
end
``````
2. I tried adding a graph in the scene which monitoring the distance of the two objects. The distance graph looks just right, but how can I get the data that graph gets? Since the graph could get the right data, I believe there's some way the program could measure the distance in a timely fashion, it's just me didn't discover it yet. Could you please help?

### Re: How to do distance measurement between two dynamic objects

Posted: 02 Dec 2019, 20:24
After taking a closer look to `sim.readDistance`, I found out it actually return 2 values, where the second return value is what I'm looking for. I suggest the admin to modify the api document for this method a little, because the 'C return value' is confusing, move smallestDistance into return values.

### Re: How to do distance measurement between two dynamic objects

Posted: 03 Dec 2019, 11:46
Hi,

the documentation of `sim.readDistance` looks about right to me: `smallestDistance` is already in the Lua return values section. C return values applies only to C/C++ API, not to Lua scripts.

### Re: How to do distance measurement between two dynamic objects

Posted: 03 Dec 2019, 14:14
You can also use `sim.checkDistance`. In that case, you do not need to register a distance object previously. Also, for the robot, you could define a collection, then measure the distance between that collection and the cuboid.

Cheers