Add more tests
Add Body get_angle