Listando arquivos de um diretorio e seus subdiretorios

Pessoal, estou utilizando uma função para listar os arquivos existentes em um diretório e em seus subdiretórios, esta funcionando direitinho , mas a função esta listando todos os arquivos dos subdiretorios existentes de uma vez.

Aklguem poderia me ajudar para qeu listasse apenas o diretorio e assim que entrar em um subdiretorio ficasse listado apenas o subdiretório? Podendo voltar ao anterior?

Abaixo, segue a função utilizada:

<?php
function fs($pasta=".",$i=0) {
$diretorio=opendir($pasta);

while ($arquivo=readdir($diretorio)) {

if ($arquivo!="."&&$arquivo!="..") {
$path=$pasta."/".$arquivo;
for ($c=0; $c<$i; $c++) {
echo "   ";
}

if (is_dir($path)) {

echo "<b>+ ".$arquivo."</b><br>\n";
fs($path,$i+1);

} else {

echo "<a href='$path'>- ".$arquivo."<br>\n</a>";
}
}
}
closedir($diretorio);
}

fs(".");
?>