/* Copyright (c) 2007 Scott Lembcke
 * Copyright (c) 2021 @aismann; Peter Eismann, Germany; dreifrankensoft
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 */
#include <stdlib.h>
#include <stdio.h>
#if !defined(_USE_MATH_DEFINES)
#    define _USE_MATH_DEFINES
#endif
#include <math.h>
#include <string.h>

#include "chipmunk/chipmunk_private.h"
#include "chipmunk/chipmunk_unsafe.h"
#include "ChipmunkDemo.h"

static void update(cpSpace* space, double dt)
{
    cpSpaceStep(space, dt);
}

static cpSpace* init(void)
{
    cpSpace* space = cpSpaceNew();
    cpSpaceSetIterations(space, 5);
    space->damping = 0.1;

    cpShape *shape1, *shape2;

    cpFloat mass = 1.0f;

    {
        cpFloat size = 100.0;

        cpBody* body = cpSpaceAddBody(space, cpBodyNew(mass, cpMomentForBox(mass, size, size)));
        cpBodySetPosition(body, cpv(100.0, 50.0f));

        shape1 = cpSpaceAddShape(space, cpBoxShapeNew(body, size, size, 0.0));
    }
    {
        cpFloat size = 100.0;

        cpBody* body = cpSpaceAddBody(space, cpBodyNew(mass, cpMomentForBox(mass, size, size)));
        cpBodySetPosition(body, cpv(120.0, -40.0f));
        cpBodySetAngle(body, 1e-2);

        shape2 = cpSpaceAddShape(space, cpBoxShapeNew(body, size, size, 0.0));
    }

    {
        cpFloat size        = 100.0;
        const int NUM_VERTS = 5;

        cpVect verts[NUM_VERTS];
        for (int i = 0; i < NUM_VERTS; i++)
        {
            cpFloat angle = -2 * M_PI * i / ((cpFloat)NUM_VERTS);
            verts[i]      = cpv(size / 2.0 * cos(angle), size / 2.0 * sin(angle));
        }

        cpBody* body = cpSpaceAddBody(space, cpBodyNew(mass, cpMomentForPoly(mass, NUM_VERTS, verts, cpvzero, 0.0)));
        cpBodySetPosition(body, cpv(100.0, 50.0f));

        shape1 = cpSpaceAddShape(space, cpPolyShapeNew(body, NUM_VERTS, verts, cpTransformIdentity, 0.0));
    }
    {
        cpFloat size        = 100.0;
        const int NUM_VERTS = 4;

        cpVect verts[NUM_VERTS];
        for (int i = 0; i < NUM_VERTS; i++)
        {
            cpFloat angle = -2 * M_PI * i / ((cpFloat)NUM_VERTS);
            verts[i]      = cpv(size / 2.0 * cos(angle), size / 2.0 * sin(angle));
        }

        cpBody* body = cpSpaceAddBody(space, cpBodyNew(mass, cpMomentForPoly(mass, NUM_VERTS, verts, cpvzero, 0.0)));
        cpBodySetPosition(body, cpv(100.0, -50.0f));
        shape2 = cpSpaceAddShape(space, cpPolyShapeNew(body, NUM_VERTS, verts, cpTransformIdentity, 5.0));
    }

    {
        cpFloat size   = 150.0;
        cpFloat radius = 25.0;

        cpVect a     = cpv(size / 2.0, 0.0);
        cpVect b     = cpv(-size / 2.0, 0.0);
        cpBody* body = cpSpaceAddBody(space, cpBodyNew(mass, cpMomentForSegment(mass, a, b, 0.0)));
        cpBodySetPosition(body, cpv(0, 25));

        shape1 = cpSpaceAddShape(space, cpSegmentShapeNew(body, a, b, radius));
    }
    {
        cpFloat radius = 50.0;

        cpBody* body = cpSpaceAddBody(space, cpBodyNew(mass, cpMomentForCircle(mass, 0.0f, radius, cpvzero)));
        cpBodySetPosition(body, cpv(0, -25));

        shape2 = cpSpaceAddShape(space, cpCircleShapeNew(body, radius, cpvzero));
    }

    return space;
}

static void destroy(cpSpace* space)
{
    ChipmunkDemoFreeSpaceChildren(space);
    cpSpaceFree(space);
}

ChipmunkDemo Example = {
    "Template to start (GJK)", 1.0f / 60.0f, init, update, ChipmunkDemoDefaultDrawImpl, destroy,
};