Added setRPM function

control speed by rpm rather than by velocity/motor power