Almost finalized find_local_max.m, just a little bit more