Added LED heart beat when not slithering.
Run the the PIDs twice per main loop (instead of one)