HSV Filter for Red Cube + Green Square
Use Realsense for 3D Positions in Base Frame
If cube/square is not in frame, move robot upward to increase FoV
Move 1 cm over Red Cube
Lower down for final pick
No Orientation needed as cube fits in gripper for all rotations
Move back to green square for drop off