Several corrections for P-Element

If the calculated output power is less than zero the motor will go backwards.