Losing patience with Numpy and ros messages, switching it over to arrays and tuples
Converted to using arrays and tuples. Worked first time....