add const specifier for methods in rigid_body.*