added TODO
Revert "removed unused code"

This reverts commit 8785488b1615655133d3cc17eeac550a9abce25e.
removed unnecessary docstring
write coordinates
renamed variable