added a function for roll and pitch on the cmps10
clean up of the existing code