stp: add protocol implementation

Signed-off-by: Constantin Musca <constantin.musca@gmail.com>