servoboard: firmware: code aufgeräumt linked nicht mehr :(