Utility functions

Utility functions includes Bubble Sort, size of matrix, RMSE, diagonal...