Removed servo stuff and rearranged the pins