Update RKMath.c