Fixed compile errors and warnings.

[samvik]

Was unable to build the project. Had to add a few casts and remove unused headers. With this patch I am able to build (and run) with platformio.

[tuanpmt]

Thanks