Added correct YPR values for 2 class-generation
Bugfix (double i++). New method for +/- generation