Changed getdirection() param to uint_8*
Added menu traversal
Added menu FSM with interrupt