A livello di codice non ci sono errori, vale a dire che la funzione è impostata correttamente, così come il costrutto if: a questo punto dovresti, autonomamente, analizzare tutte le condizioni (magari con un output per controllare i valori); se non ci sono errori sarà sicuramente un problema di logica del calcolo di compenetrazione.
Fai i calcoli e fammi sapere


Ciao