Finished simple get mass function
added simple COM calculation