算術周り再度整理

使いにくそうなmath周りを使いやすく特にfunction.h
次はmatrix整理したらquatに取り掛かりたい