Working simple april tag detection node