Sensor-based motion planning in three dimensions for a highly redundant snake robot | Synapse