Fixed Bug: did not work with older firware revs

Fixed so that it now works with firmware protocol 1