xgmath: fixed major bugs, added floatarray mad/lerpto