Updated port to work using mega digitalports
Merged origin