Add JSON message generator to send stall detection status
Add drive and stop functionality to JSON parser