Fixed Arduino Code and added button to motorshield