Added support of ECHO packet type

- Echo packet handling
- Minor fixes