Development of a Contest Machine "Tokiwa" for ROBOCON2000