Update point_finder to actually work
Update point_finder to actually work

- Still need to transform coordinates and publish them to arm.

zimmermegan/smarda,zimmermegan/smarda,zimmermegan/smarda,zimmermegan/smarda,zimmermegan/smarda,zimmermegan/smarda