Method enforce_margin

Makes sure the LSPs are stable. @param lsp @param len @param margin

(final float[] lsp,
                                    final int len,
                                    final float margin)