[HTELE]: add first version for homeposition and -direction

direction calculation may be wrong, but it distance is ok.