added debug message, robotconstants class, implement launcher reset and shoot