Math: added rotate() method to Matrix3f

this is the core method used to update the DCM matrix with a gyro
vector. Moving it to AP_Math allows us to have a test for it