TECS-WIP : Height filtering improvements