fixed euler angle calc and added a simple example cpp