finishes the new algo of the hexapod
before lapasan copy merged
after lapasan copy being merged
implements return and millis commands in order to fix the previous bugs