First hardware upload. Code is mostly working