Finish RCS forces and control

- micro-optimisations to `RCSport`
close #7
close #3