Update vitalsTEST.cpp

Added code that should determine wheel drops and publish to a string