Rewrite code to C++

Code for doorlock-zephyr is a bit convoluted now, there was a need to re-write it to C++ in order to have language supporting OOP programming

Another features introduced in the second MR is enabling new input types.

CC: @lucaseri