Add shift weighting function
Shift matrix helper function working
Working on schedule creation algorithm