Basic functionality working

Added support for:
- pin mode
- write
- read