Added possibility to send position command to the robot. Needs to be cleaned (Thanks to Alessio Rocchi's Help!)
Added light , moved plugin