How to climb platform in auton

Hi my team is trying to figure out how to climb the platform for autonomous skills. What control loop would probably work best.

i would use an inertial sensor or gyro, and set the speed of the motors to the angle of the robot, making it stop when it is level.