Initialized some variables, gave throttle more authority, changed intWithPolygon Ind1 and Ind2 to int from uint8_t