Reduced EKF to 50Hz

Drastically reduced CPU load (~35% only)
Transmit new current and battery mavlink messages
Update
Merge branch 'reducedFrequency' into mavlinkUpdate
HOTFIX current message subscribtion
Enable correct behaviour for TESTPHASE