github/PythonRobotics
1
1
Fork 0
mirror of https://github.com/AtsushiSakai/PythonRobotics.git synced 2026-04-22 03:00:22 -04:00
Code Issues Packages Projects Releases Wiki Activity

add test for circle_fitting

Browse Source
This commit is contained in:
Atsushi Sakai
2018-05-12 22:14:44 +09:00
parent 17b87c0822
commit 3c4d1c457a
2 changed files with 24 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

20
Mapping/circle_fitting/circle_fitting.py
View File

@@ -12,6 +12,8 @@ import math
import random
import numpy as np
show_animation = True
def circle_fitting(x, y):
"""
@@ -120,15 +122,17 @@ def main():
ex, ey, er, error = circle_fitting(x, y)
print("Error:", error)
plt.cla()
plt.axis("equal")
plt.plot(0.0, 0.0, "*r")
plot_circle(cx, cy, cr)
plt.plot(x, y, "xr")
plot_circle(ex, ey, er, "-r")
plt.pause(dt)
if show_animation:
plt.cla()
plt.axis("equal")
plt.plot(0.0, 0.0, "*r")
plot_circle(cx, cy, cr)
plt.plot(x, y, "xr")
plot_circle(ex, ey, er, "-r")
plt.pause(dt)
print("Done")
if __name__ == '__main__':
# main1()
main()