Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history
yaml
---
r: 283821
b: refs/heads/master
c: 38fd54e
h: refs/heads/master
i:
  283819: a0fc91e
v: v3
  • Loading branch information
Lars-Peter Clausen authored and Mark Brown committed Nov 29, 2011
1 parent 0032d61 commit 79f1fd3
Show file tree
Hide file tree
Showing 3 changed files with 68 additions and 14 deletions.
2 changes: 1 addition & 1 deletion [refs]
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: a4c1d7e66719b326431c6e617da07cab0caedbca
refs/heads/master: 38fd54ee38624a52c28d65fadfd452c9c49fb152
75 changes: 62 additions & 13 deletions trunk/sound/soc/codecs/sigmadsp.c
Original file line number Diff line number Diff line change
Expand Up @@ -11,6 +11,7 @@
#include <linux/firmware.h>
#include <linux/kernel.h>
#include <linux/i2c.h>
#include <linux/regmap.h>
#include <linux/module.h>

#include "sigmadsp.h"
Expand Down Expand Up @@ -44,6 +45,10 @@ struct sigma_action {
struct sigma_firmware {
const struct firmware *fw;
size_t pos;

void *control_data;
int (*write)(void *control_data, const struct sigma_action *sa,
size_t len);
};

static inline u32 sigma_action_len(struct sigma_action *sa)
Expand Down Expand Up @@ -75,7 +80,7 @@ static size_t sigma_action_size(struct sigma_action *sa)
* the firmware should be stopped after this action, 1 otherwise.
*/
static int
process_sigma_action(struct i2c_client *client, struct sigma_action *sa)
process_sigma_action(struct sigma_firmware *ssfw, struct sigma_action *sa)
{
size_t len = sigma_action_len(sa);
int ret;
Expand All @@ -87,7 +92,7 @@ process_sigma_action(struct i2c_client *client, struct sigma_action *sa)
case SIGMA_ACTION_WRITEXBYTES:
case SIGMA_ACTION_WRITESINGLE:
case SIGMA_ACTION_WRITESAFELOAD:
ret = i2c_master_send(client, (void *)&sa->addr, len);
ret = ssfw->write(ssfw->control_data, sa, len);
if (ret < 0)
return -EINVAL;
break;
Expand All @@ -105,7 +110,7 @@ process_sigma_action(struct i2c_client *client, struct sigma_action *sa)
}

static int
process_sigma_actions(struct i2c_client *client, struct sigma_firmware *ssfw)
process_sigma_actions(struct sigma_firmware *ssfw)
{
struct sigma_action *sa;
size_t size;
Expand All @@ -119,7 +124,7 @@ process_sigma_actions(struct i2c_client *client, struct sigma_firmware *ssfw)
if (ssfw->pos > ssfw->fw->size || size == 0)
break;

ret = process_sigma_action(client, sa);
ret = process_sigma_action(ssfw, sa);

pr_debug("%s: action returned %i\n", __func__, ret);

Expand All @@ -133,23 +138,23 @@ process_sigma_actions(struct i2c_client *client, struct sigma_firmware *ssfw)
return 0;
}

int process_sigma_firmware(struct i2c_client *client, const char *name)
static int _process_sigma_firmware(struct device *dev,
struct sigma_firmware *ssfw, const char *name)
{
int ret;
struct sigma_firmware_header *ssfw_head;
struct sigma_firmware ssfw;
const struct firmware *fw;
u32 crc;

pr_debug("%s: loading firmware %s\n", __func__, name);

/* first load the blob */
ret = request_firmware(&fw, name, &client->dev);
ret = request_firmware(&fw, name, dev);
if (ret) {
pr_debug("%s: request_firmware() failed with %i\n", __func__, ret);
return ret;
}
ssfw.fw = fw;
ssfw->fw = fw;

/* then verify the header */
ret = -EINVAL;
Expand All @@ -161,29 +166,29 @@ int process_sigma_firmware(struct i2c_client *client, const char *name)
* overflows later in the loading process.
*/
if (fw->size < sizeof(*ssfw_head) || fw->size >= 0x4000000) {
dev_err(&client->dev, "Failed to load firmware: Invalid size\n");
dev_err(dev, "Failed to load firmware: Invalid size\n");
goto done;
}

ssfw_head = (void *)fw->data;
if (memcmp(ssfw_head->magic, SIGMA_MAGIC, ARRAY_SIZE(ssfw_head->magic))) {
dev_err(&client->dev, "Failed to load firmware: Invalid magic\n");
dev_err(dev, "Failed to load firmware: Invalid magic\n");
goto done;
}

crc = crc32(0, fw->data + sizeof(*ssfw_head),
fw->size - sizeof(*ssfw_head));
pr_debug("%s: crc=%x\n", __func__, crc);
if (crc != le32_to_cpu(ssfw_head->crc)) {
dev_err(&client->dev, "Failed to load firmware: Wrong crc checksum: expected %x got %x\n",
dev_err(dev, "Failed to load firmware: Wrong crc checksum: expected %x got %x\n",
le32_to_cpu(ssfw_head->crc), crc);
goto done;
}

ssfw.pos = sizeof(*ssfw_head);
ssfw->pos = sizeof(*ssfw_head);

/* finally process all of the actions */
ret = process_sigma_actions(client, &ssfw);
ret = process_sigma_actions(ssfw);

done:
release_firmware(fw);
Expand All @@ -192,6 +197,50 @@ int process_sigma_firmware(struct i2c_client *client, const char *name)

return ret;
}

#if IS_ENABLED(CONFIG_I2C)

static int sigma_action_write_i2c(void *control_data,
const struct sigma_action *sa, size_t len)
{
return i2c_master_send(control_data, (const unsigned char *)&sa->addr,
len);
}

int process_sigma_firmware(struct i2c_client *client, const char *name)
{
struct sigma_firmware ssfw;

ssfw.control_data = client;
ssfw.write = sigma_action_write_i2c;

return _process_sigma_firmware(&client->dev, &ssfw, name);
}
EXPORT_SYMBOL(process_sigma_firmware);

#endif

#if IS_ENABLED(CONFIG_REGMAP)

static int sigma_action_write_regmap(void *control_data,
const struct sigma_action *sa, size_t len)
{
return regmap_raw_write(control_data, le16_to_cpu(sa->addr),
sa->payload, len - 2);
}

int process_sigma_firmware_regmap(struct device *dev, struct regmap *regmap,
const char *name)
{
struct sigma_firmware ssfw;

ssfw.control_data = regmap;
ssfw.write = sigma_action_write_regmap;

return _process_sigma_firmware(dev, &ssfw, name);
}
EXPORT_SYMBOL(process_sigma_firmware_regmap);

#endif

MODULE_LICENSE("GPL");
5 changes: 5 additions & 0 deletions trunk/sound/soc/codecs/sigmadsp.h
Original file line number Diff line number Diff line change
Expand Up @@ -9,8 +9,13 @@
#ifndef __SIGMA_FIRMWARE_H__
#define __SIGMA_FIRMWARE_H__

#include <linux/device.h>
#include <linux/regmap.h>

struct i2c_client;

extern int process_sigma_firmware(struct i2c_client *client, const char *name);
extern int process_sigma_firmware_regmap(struct device *dev,
struct regmap *regmap, const char *name);

#endif

0 comments on commit 79f1fd3

Please sign in to comment.