release/grindV2.py

import bge
import math

def main():
    cont = bge.logic.getCurrentController()
    own = cont.owner
    player = cont.owner
    scene = bge.logic.getCurrentScene()
    #grindDar = cont.sensors['grindDar']
    grindEmpty = scene.objects['grindEmpty']
    grindDar = grindEmpty.sensors['grindDar2']    
    rGround = cont.sensors['r_Ground']
    control_bottom = scene.objects['control_bottom']
    #grindCol_bottom 
    grindTouch = control_bottom.sensors['grindCol_bottom']
    #grindTouch = cont.sensors['grindCol']
    invertCol = cont.sensors['invertCol']
    invertObjs = invertCol.hitObjectList
    invert_on = own['invert_on']
    detectedObjects = grindDar.hitObjectList
    lastObject = own['grindTrackObj']
    nearestObject = None
    minDist = None
    #act = cont.actuators["Target"]
    test = own["test"]
    grindold = own["grindOld"]
    lgobj = own["lGobj"]
    countdown = own['grindCountdown'] 
    #print(lgobj)
    ray = cont.sensors["GuardDuty"] # get the ray sensor attached to the controller named GuardDuty
    gt_cd = own["gt_cd"]
    pos = ray.hitPosition # get position where the game object hit by ray
    linVelocity = own.getLinearVelocity(False)
    linVelocity2 = own.getLinearVelocity(True)
    pos[2] = pos[2] + 1 
    norm = ray.hitNormal
    STANCE = own["stance"]
    orientation = own.worldOrientation
    test = ray.hitObject
    xyz = own.worldOrientation.to_euler()
    rotz = math.degrees(xyz[2])
    roty = math.degrees(xyz[1]) 
    #print(roty)
    roty = abs(roty) 
    sub = 0
    align_strength = .3
    align_strength2 = .2
    touched = grindTouch.triggered
    lgf = own['last_grind_frame']
    gsf = own['grind_start_frame']
    framenum = own['framenum']
    last_ground_frame = own['lF_ground_frame']
    frames_since_ground = framenum - last_ground_frame
    frames_since_grind = framenum - lgf
    frames_grinding = framenum - gsf
    #if framenum - lgf > 60:
    minus = framenum - gsf
    grindspeed_rail = .996 #multiplied by current speed
    grindspeed_cement = .995 #multiplied by current speed
    grindDar_timer = own["grindDar_timer"]
    last_grindDar = 0
    last_manual = own["manual"]
    joinit = 0
    rot = own.getAxisVect( [0.0, 0.0, 1.0])
    dropin = own['dropinTimer']
    nearestObject = None
    last_hit = own['grindDar_hit']
    jump_timer = own['jump_timer']
    grind_jump = own['grind_jump']
    lastGround = own['lF_ground2']
    OG_PLAYER_POS = own.worldPosition
    grindvect = None
    grindyvect = None
    skipcol = 0
    skipconst = 0
    try:
        no_grind_pull = own['no_grind_pull']
    except:    
        own['no_grind_pull'] = 0
        no_grind_pull = 0
    #no grind
    no_grind = 0
    if jump_timer > 50:
        no_grind = 1
    
    #check manual
    manual = 0
    own["nogrindsound"] = 0
    
#---------###########___###########-----------    
#start new                     #######     
##----------##############----------############

#grindvect func
    grindvect = None
    grindyvect = None
    lastobj = own["grindTouchobj"]
    grindpos = own["grindpos"]
    player_e = own.worldOrientation.to_euler()
    player_rotz = math.degrees(player_e[2]) 
    velxb = linVelocity2.x
    player_e = own.worldOrientation.to_euler()
    
    ogrot = own.orientation
    ogrot = player_e
    
    if (framenum - gsf) > 15:
        velx = linVelocity2.x
        vely = linVelocity2.y
        #print("limit speed")
    else:    
         velx = linVelocity2.x
         vely = linVelocity2.y     
    if abs(own['pregrind_vely']) > abs(vely) and own['LAST_GRIND'] == 0:
        convely = own['pregrind_vely']
    else:
        convely = vely  
    def grindvect(obj):
        STANCE = own['stance']
        if obj != None:
            grinder_e = obj.worldOrientation.to_euler()
            grinder_rotz = math.degrees(grinder_e[2])            
            rot = player_rotz - grinder_rotz
        if rot >= 0 and rot < 45: 
            grindvect = "pos"
        if rot >= 45 and rot < 90: 
            grindvect = "pos" 
            grindyvect = "pos"
        if rot >= 90 and rot < 135: 
            grindvect = "neg"
            grindyvect = "neg"
        if rot >= 135 and rot < 180: 
            grindvect = "neg"
        if rot >= 180 and rot < 225: 
            grindvect = "neg"
        if rot >= 225 and rot < 270: 
            grindvect = "neg"
            grindyvect = "pos"
        if rot >= 270 and rot < 315: 
            grindvect = "pos" 
            grindyvect = "neg"
        if rot >= 315: 
            grindvect = "pos"
        if rot < 0 and rot >= -45: 
            grindvect = "pos"
        if rot < -45 and rot >= -90: 
            grindvect = "pos"
            grindyvect = "neg"
        if rot < -90 and rot >= -135: 
            grindvect = "neg"
            grindyvect = "pos"
        if rot < -135 and rot >= -180: 
            grindvect = "neg"  
        if rot < -180 and rot >= -225: 
            grindvect = "neg" 
        if rot < -225 and rot >= -270: 
            grindvect = "neg"
            grindyvect = "neg"
        if rot < -270 and rot >= -315: 
            grindvect = "pos" 
            grindyvect = "pos"
        if rot < -315: 
            grindvect = "pos"   

        rot = round((rot * .01), 1)
        rot *= 100

        #print(own['inverting'])
        if frames_grinding > 20 and own['inverting'] == False: 
            #print("setting stance")       
            if (rot == 90 or rot == -270) and STANCE == True:
                #print("90 fak stance")
                own['stance'] = 1
                STANCE = 1
            if (rot == 90 or rot == -270) and STANCE == False:
                #print("90 fak stance")
                own['stance'] = 1
                STANCE = 1
            if (rot == -90 or rot == 270) and STANCE == True:
                #print("-90 reg stance")
                own['stance'] = 0
                STANCE = 0
            if (rot == -90 or rot == 270) and STANCE == False:
                #print("-90 reg stance")                        
                own['stance'] = 0
                STANCE = 0
    def grindrotvel(obj):        
        skipconst = 1              
        joinit = 0
        grinder_e = obj.worldOrientation.to_euler()
        grinder_rotz = math.degrees(grinder_e[2]) 
        grinder_vect = obj.getAxisVect( [1, 0, 0]) 
        grinder_vectz = obj.getAxisVect( [0, 0, 1]) 
        rot = player_rotz - grinder_rotz        
        rayhit = ray.hitObject
        own['grind_rot'] = rot
        vect = obj.getAxisVect( [1.0, 0.0, 0.0])
        xyzb = obj.worldOrientation.to_euler()
        rotzb = math.degrees(xyzb[2])   
        grindpos = "None"         
        align = "None"
        sub_converted = 0
        rotz = math.degrees(xyz[2])
        roty = math.degrees(xyz[1])
        bsrot = [ 0.0, 0.0, 1.570796327]    
        negbsrot = [ 0.0, 0.0, -1.570796327]
        zvel = own.linearVelocity
        zvel = zvel.z * .95
        if grindold == 0:
            if rotz < 0:
                rotz = rotz + 360
            if rotzb < 0:
                rotzb = rotzb + 360    
            if rotz > rotzb:
                sub_converted = rotz - rotzb
            if rotz < rotzb:
                sub_converted = rotzb - rotz

        #z align
        #print("zalign") 
        stre = .15
        player.alignAxisToVect(grinder_vectz, 2, stre)                                                  
        
        if rot >= 0 and rot < 45:
            player.alignAxisToVect(grinder_vect, 0, align_strength)
            grindvect = "pos"
            #player.applyForce([0, 0, 0], True)            
            player.setLinearVelocity([velxb, 0.0, zvel], 1)  
            grindpos = "reg_5050"
            print("50-1")


        elif rot >= 45 and rot < 90:  
            player.alignAxisToVect([-grinder_vect.y, grinder_vect.x, 0], 0, align_strength)
            grindvect = "pos"
            align = "pos"            
            player.setLinearVelocity([0, convely, zvel], 1)   
            grindpos = "reg_board"     
            grindyvect = "pos"
            #print("bs1, don't switch")       
                           
        elif rot >= 90 and rot < 135:  
            grinder_vect = grinder_vect * -1                
            player.alignAxisToVect([grinder_vect.y, -grinder_vect.x, 0], 0, align_strength) 
            grindvect = "neg"
            align = "neg"
            grindyvect = "neg"
            player.setLinearVelocity([0, convely, zvel], 1)
            grindpos = "reg_board"  
            #print("-bs2, don't switch?")          
                     
        elif rot >= 135 and rot < 180:
            player.alignAxisToVect(-grinder_vect, 0, align_strength)
            grindvect = "neg"
            player.setLinearVelocity([velxb, 0.0, zvel], 1) 
            grindpos = "reg_5050"
            #print("50-2")
           
        elif rot >= 180 and rot < 225:
            player.alignAxisToVect(-grinder_vect, 0, align_strength)
            grindvect = "neg"
            player.setLinearVelocity([velxb, 0.0, zvel], 1)
            grindpos = "reg_5050" 
            #print("50-3")
            
        elif rot >= 225 and rot < 270:
            player.alignAxisToVect([grinder_vect.y, -grinder_vect.x, 0], 0, align_strength)
            grindvect = "neg"
            align = "pos"
            player.setLinearVelocity([0, convely, zvel], 1)
            grindpos = "reg_board"
            grindyvect = "pos"
            #print("bs3")             
           
        elif rot >= 270 and rot < 315:
            player.alignAxisToVect([grinder_vect.y, -grinder_vect.x, 0], 0, align_strength) 
            grindvect = "pos" 
            align = "neg"
            player.setLinearVelocity([0, convely, zvel], 1)
            grindpos = "reg_board"   
            grindyvect = "neg"
            #print("-bs4")          
            
        elif rot >= 315:
            player.alignAxisToVect(grinder_vect, 0, align_strength)
            grindvect = "pos"
            player.setLinearVelocity([velxb, 0.0, zvel], 1)
            grindpos = "reg_5050"
            #print("50-4")
                         
#-------------------------------------------------------------            
        elif rot < 0 and rot >= -45:
            player.alignAxisToVect(grinder_vect, 0, align_strength)
            grindvect = "pos"
            player.setLinearVelocity([velxb, 0.0, zvel], 1)  
            grindpos = "reg_5050" 
            #print("50-5")                    
        elif rot < -45 and rot >= -90:
            grinder_vect = grinder_vect * -1
            player.alignAxisToVect([-grinder_vect.y, grinder_vect.x, 0], 0, align_strength)
            grindvect = "pos"
            align = "neg"
            player.setLinearVelocity([0, convely, zvel], 1)
            grindpos = "reg_board"   
            #print("-bs5")           
            grindyvect = "neg"
        elif rot < -90 and rot >= -135:
            player.alignAxisToVect([grinder_vect.y, -grinder_vect.x, 0], 0, align_strength)
            grindvect = "neg"
            align = "pos"
            player.setLinearVelocity([0, convely, zvel], 1)
            grindpos = "reg_board"  
            grindyvect = "pos"
            #print("bs6")                   
        elif rot < -135 and rot >= -180:
            player.alignAxisToVect(-grinder_vect, 0, align_strength)
            grindvect = "neg"   
            player.setLinearVelocity([velxb, 0.0, zvel], 1)  
            grindpos = "reg_5050" 
            #print("50-6")       
        elif rot < -180 and rot >= -225:
            player.alignAxisToVect(-grinder_vect, 0, align_strength) 
            grindvect = "neg"           
            player.setLinearVelocity([velxb, 0.0, zvel], 1)  
            grindpos = "reg_5050" 
            #print("50-7")
        elif rot < -225 and rot >= -270:
            grinder_vect = grinder_vect * -1
            player.alignAxisToVect([grinder_vect.y, -grinder_vect.x, 0], 0, align_strength) 
            grindvect = "neg"
            align = "neg"
            player.setLinearVelocity([0, convely, zvel], 1)
            grindpos = "reg_board"   
            grindyvect = "neg"
            #print("-bs7")              
        elif rot < -270 and rot >= -315:
            player.alignAxisToVect([-grinder_vect.y, grinder_vect.x, 0], 0, align_strength) 
            grindvect = "pos"
            align = "pos"
            player.setLinearVelocity([0, convely, zvel], 1)
            grindpos = "reg_board"    
            grindyvect = "pos"
            #print("bs8")                                   
        elif rot < -315:
            player.alignAxisToVect(grinder_vect, 0, align_strength) 
            grindvect = "pos"                     
            player.setLinearVelocity([velxb, 0.0, zvel], 1)  
            grindpos = "reg_5050"  
            #print("50-8")

        own['grindpos'] = grindpos
        own['grindvect'] = grindvect
        own['grindervect'] = grinder_vect
        try:   
            own['grindyvect'] = grindyvect
            
        except:
            pass 
                
#@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@        
    def grind(obj):
        try:
            grindyvect = own['grindyvect']
        except:
            grindyvect = 0 
        grindvect = own['grindvect'] 
        
        if 'rail' in obj:
            own["grindSound"] = "rail" 
        else:
            own["grindSound"] = "concrete"
        own['lGobj'] = obj         
        
        grinding = 1                
        
        framenum = own['framenum']
        lastairframe = own['lF_air_frame']
        jumpside = 0
        if (framenum - lastairframe) < 10:
            player_pos = own['jumpPos'] 
            jumpside = 1   
        else:    
            player_pos = OG_PLAYER_POS
        player_pos = own.worldPosition    
        try:    
            if 1 == 1:       
                grinder_pos = obj.worldPosition 
                worldVect = [1, 0, 0]
                vect = obj.getAxisVect(worldVect)      
                go = obj.worldOrientation
                grinder_axis = [0,1,0]
                try: 
                    delta = player_pos - grinder_pos
                except:
                    #print("delta broke: ", player_pos, grinder_pos)
                    pass 
                delta = delta.cross(vect)
                if delta[2] >= 0:
                    grindside = "right"
                else:
                    grindside = "left"
                if (delta[2] > .00001 or delta[2] < -.00001) and (delta[2] < .8 or delta[2] < -.8):
                    rotation = own.worldOrientation[2] - obj.worldOrientation[2]
                    player_e = own.worldOrientation.to_euler()
                    player_rotz = math.degrees(player_e[2])
                    grinder_e = obj.worldOrientation.to_euler()
                    grinder_rotz = math.degrees(grinder_e[2])
                    deltamove = delta[2] * .3
                    #print(round(deltamove, 4), "deltamove")
                    #5050
                    if own["grindpos"] == "reg_5050":
                        #print("missing delta")
                        if (jumpside == 1 or jumpside == 0) and grindvect == "pos":
                            move = [0, deltamove, 0]
                            #print("1deltamove", deltamove)
                            own.applyMovement(move, True)    
                        if (jumpside == 1 or jumpside == 0) and grindvect == "neg":
                            move = [0, -deltamove, 0]
                            #print("2deltamove -", deltamove)
                            own.applyMovement(move, True)  
                    #board
                    if own["grindpos"] == "reg_board":
                        if grindvect == "neg":
                            if (jumpside == 1 or jumpside == 0) and grindyvect == "pos":
                                move = [-deltamove, 0, 0]
                                #print("3deltamove", deltamove)
                                own.applyMovement(move, True)        
                            if (jumpside == 1 or jumpside == 0) and grindyvect == "neg":
                                move = [deltamove, 0, 0]
                                #print("4deltamove -", deltamove)
                                own.applyMovement(move, True)            
                        if grindvect == "pos":
                            if (jumpside == 1 or jumpside == 0) and grindyvect == "pos":
                                move = [deltamove, 0, 0]
                                #print("5deltamove", deltamove)
                                own.applyMovement(move, True)        
                            if (jumpside == 1 or jumpside == 0) and grindyvect == "neg":
                                move = [-deltamove, 0, 0]
                                own.applyMovement(move, True)                    
                own['grindside'] = grindside    
        except:
            pass
        #speed limit    
        velo = own.getLinearVelocity(True)
        touchobj = obj
        if touchobj != None and gt_cd == 0:       
            if 'rail' in touchobj:
                newvelx = velo.x * grindspeed_rail   
                newvely = velo.y * grindspeed_rail
            else:
                newvelx = velo.x * grindspeed_cement  
                newvely = velo.y * grindspeed_cement            
            player.setLinearVelocity([newvelx, newvely, velo.z], 1)   
            player_rot = own.worldOrientation[2]
            grinder_rot = touchobj.worldOrientation[2]
            player_rot = own.getAxisVect( [0.0, 0.0, 1.0])
            xyz3 = own.worldOrientation.to_euler()
            player_rot = math.degrees(xyz3[2])
            xyz4 = touchobj.worldOrientation.to_euler()
            grinder_rot = math.degrees(xyz4[2]) 
            if player_rot < 0:
                player_rot = abs(player_rot) + 180
            if grinder_rot < 0:
                grinder_rot = abs(grinder_rot) + 180                   
            subtraction = player_rot - grinder_rot
        
    def invertpos(detectedObjects):
        minDist = None
        nearestObject = None
        for obj in detectedObjects:
            dist = own.getDistanceTo(obj)
            if (minDist is None or dist < minDist):
                nearestObject = obj
                minDist = dist
        if nearestObject != None:                            
            own.linearVelocity.x = 0
            own.linearVelocity.y = 0
               
            
    
    if grindDar.positive == False and grindTouch.positive and grindold == 0 and dropin == 0 and grind_jump == 0 and own["grindoutturn"] == 0 and gt_cd == 0 and manual == 0 and no_grind == 0 and nearestObject != lastObject and own['grindjumpturn'] == 0 and own['gt_cd2'] == 0 and own['air_mover'] == False:
        print("touching, no dar")
    #print(grindold, "grindold")        
    if grindDar.positive:
        detectedObjects = grindDar.hitObjectList
        dist = 0
        for obj in detectedObjects:
            dist = own.getDistanceTo(obj)
            if (minDist is None or dist < minDist):
                nearestObject = obj
                minDist = dist     
        
#@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@        
        #init grind
        
        if invert_on:
            invertpos(detectedObjects)
            own['inverting'] = True
        else:
            own['inverting'] = False
        grind_dist = .8#.6
        if dist < grind_dist and grindold == 0 and dropin == 0 and grind_jump == 0 and own["grindoutturn"] == 0 and gt_cd == 0 and manual == 0 and no_grind == 0 and nearestObject != lastObject and own['grindjumpturn'] == 0 and own['gt_cd2'] == 0 and invert_on == False and own['air_mover'] == False and no_grind_pull == 0:   
            print("new grind trigger")           
            npos = nearestObject.worldPosition
            
            
        #grind
        #print(dist)
        if dist < grind_dist and dropin == 0 and grind_jump == 0 and manual == 0 and no_grind == 0 and own['airup'] == 0 and own['grindoutturn'] == 0 and own['grindjumpturn'] == 0 and own['manual'] == 0 and own['gt_cd2'] < 55 and invert_on == False and own['air_mover'] == False and no_grind_pull == 0 and own['last_invert'] == False:
            #print("grind")    
            hitObject, hitPoint, hitNormal = own.rayCast(nearestObject.worldPosition, own.worldPosition, .0, 'grind')
            if grindold == 0:
                if grindTouch.positive:
                    nearpos = nearestObject.worldPosition
                    if hitNormal != None:
                        stre = .05
                        own.alignAxisToVect(hitNormal, 2, stre) 
                        print("align")                   
                    own.worldPosition = [nearpos.x, nearpos.y, nearpos.z + .2975]
                    print('moving world')

            grindold = True
            own['grindold_timer'] = 0
            own["grindHit"] = True
            #print("grinding")
            grind_height_dif = (own.worldPosition[2] - nearestObject.worldPosition[2]) - .287
            worldPos = own.worldPosition
            if grind_height_dif > -.05:#02:
                grindvect(nearestObject)          
                grindrotvel(nearestObject)
                grind(nearestObject)


    else:
        #grindold = False 
        own['grindold_timer'] += 1
        own["grindHit"] = False
        own['inverting'] = False   
    
    if own['grindold_timer'] > 5:
        grindold = False
        own['grind_start_frame'] = framenum
        own["grindSound"] = None
    
    
#@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@    
       
#if you are touching grinder and last_manual is off keep manual off
    if (own['fak_nmanual'] == 1 or own['reg_nmanual'] == 1 or own['fak_manual'] == 1 or own['reg_manual'] == 1) and lastGround == True and grindold == False:
        manual = 1
        if last_manual == 0 and grindTouch.triggered == True:
            manual = 0
        own["nogrindsound"] = 1
    grindhit = own["grindHit"]

    if abs(own['pregrind_vely']) > abs(vely) and own['LAST_GRIND'] == 0:
        convely = own['pregrind_vely']
    else:
        convely = vely    

    off = 0

    if touched == True:
        own["grindTouchobj"] = grindTouch.hitObject
    else:
        own["grindTouchobj"] = None  
 
    if ray.triggered and dropin == 0:
        lgobj = ray.hitObject
        own['lGobj'] = lgobj
        obj = ray.hitObject
        #prop = obj.get("property", None)
        linVelocity3 = own.getLinearVelocity(True)
        grindpos2 = own["grindpos"]
        regboard = "reg_board"
        fakboard = "fak_board"
        if obj is not None:        
            if 'rail' in ray.hitObject:
                own["grindSound"] = "rail" 
            else:
                own["grindSound"] = "concrete"
        own['lGobj'] = lgobj    
    else:
        lgobj = "empty"
        own['lGobj'] = lgobj
    def timer():
        countdown = own["grindCountdown"]
        if touched == 1:
            countdown = 20
        else:
            countdown = countdown - 1
        own['grindCountdown'] = countdown
    def aligntimer():
        if own['grindOld'] == 0 and ray.triggered == 1:
            own['aligntimer'] = 20
        if own['grindOld'] == 1 and ray.triggered == 1:
            own['aligntimer'] = own['aligntimer'] - 1
        if own['grindOld'] == 0 and ray.triggered == 0:
            own['aligntimer'] = 0   

    def invertpos():
        minDist = None
        nearestObject = None
        for obj in invertObjs:
            dist = own.getDistanceTo(obj)
            if (minDist is None or dist < minDist):
                nearestObject = obj
                minDist = dist
        vect = nearestObject.getAxisVect( [1.0, 0.0, 0.0])
        #own.alignAxisToVect(vect, 0, 0)
        own.worldPosition = [nearestObject.worldPosition.x, nearestObject.worldPosition.y, nearestObject.worldPosition.z +.1]
       #own.setLinearVelocity([0, 0.0, 0], 1)                    



            
    def set_pregrind_vel():
        if grindDar.triggered == False and ray.triggered == False:
            own['pregrind_velx'] = linVelocity2.x
            own['pregrind_vely'] = linVelocity2.y
            own['pregrind_velz'] = linVelocity2.z
            
    def stop_bounce():
        if grindTouch.triggered and no_grind == 0 and grind_jump == 0 and jump_timer < 30:
            linVelocity4 = own.getLinearVelocity(True)
            if linVelocity4.z > 0:
                own.setLinearVelocity([linVelocity4.x, linVelocity4.y, 0], 1)
                        
    if jump_timer < 30 :
        own['grind_jump'] = 0 
    if grindold == False and ray.triggered:
        own['grind_start_frame'] = own['framenum']  
        
    if grindDar_timer > 0:
        grindDar_timer -= 1
    if grindDar_timer > 0 and ray.triggered == False and touched == True  and own['footplant_on'] == False and manual == 0:
        obj = grindTouch.hitObject 
        own.worlPosition = obj.worldPosition
    if ray.triggered == False:
        own["nogrindsound"] = 1                               
    timer()    
    aligntimer()
    stop_bounce()   
                   
    own['grindOld'] = grindold 
    own['test'] = test
    own['grindTrackObj'] = nearestObject
    own['grindDar_hit'] = grindDar.positive
    own['lastTouched'] = touched
    own['grindTouch'] = grindTouch.triggered
    own["grindDar_timer"] = grindDar_timer
    own["last_grindDar"] = last_grindDar
    linVelocity3 = own.getLinearVelocity(True)
    set_pregrind_vel()
    own['last_z'] = own.worldPosition.z
    own["manual"] = manual

main()