Added controller code which is first attempt at arduino code