Fixed crashing at connection time if pixhawk MAV_COMP_ID value was previously changed.
Reworked code to reduce number of unnecessary virtual function calls
Merge pull request #897 from anton-matosov/master

Fixed crashing at connection time if pixhawk MAV_COMP_ID is not set to default (50)