型に単位[MKS]も含まれる言語ってないの？
次元の合わない式はコンパイルエラー。

double force[kg*m/(s*s)];
とか。
デバッグに便利そうだけどコーディングは面倒？