Added missing includes for raspberry pi and macros declarations
Added simple test program