First attempt to add ergocub sw documentation (#318)

First attempt to add ergocub sw documentation (#318) #639