adjusted colors, distances
sped up parallel movement
minimized gripper delays
fixed bluetooth error
added dPrint function and check of second rear sonar