Using @N8Fear solution
Address @thomaseichinger comments about comments
doxygen and clean up based on @haukepetersen comments
deleted extra parens and added spaces