Trying to get things working with higher resolutions, but planning and obstacle avoidance keep getting stuck in obstacles
