added a motor_inversion4. Loop freq. with logging 40 Hz.

The method motor_inversion4 hacks the implementation from
M.Wieremma's MS Thesis to accomodate it to Erle. The response seems
reasonable but the PIDs still need to be tuned.