SD-Card write function added + updated test function

Note: UART functions not yet commited since they are in an early
development stage!