Added hierarchical steering

Steering priority: forward, backward, turn. Implemented using
hierarchical if-else